Added first hmi interface implementation
This commit is contained in:
@@ -11,6 +11,9 @@ END_VAR
|
||||
VAR_OUTPUT
|
||||
xVacuumEnabled : BOOL;
|
||||
END_VAR
|
||||
VAR_IN_OUT
|
||||
stHMIInterface : ST_HMI_Aligner;
|
||||
END_VAR
|
||||
VAR
|
||||
xActivateVacuum AT %Q* : BOOL := FALSE;
|
||||
xDeactivateVacuum AT %Q* : BOOL := TRUE;
|
||||
@@ -22,9 +25,6 @@ VAR
|
||||
_fbXAxis : FB_AxisPTP;
|
||||
_fbYAxis : FB_AxisPTP;
|
||||
|
||||
_rXPosToGo : REAL;
|
||||
_rYPosToGo : REAL;
|
||||
|
||||
_rtExecute : R_TRIG;
|
||||
_xStartAlign : BOOL;
|
||||
END_VAR
|
||||
@@ -56,22 +56,10 @@ _fbYAxis(
|
||||
// =============================
|
||||
// Call isa88 base state machine
|
||||
// =============================
|
||||
SUPER^(stPackMLHMIInterface := THIS^.stPackMLHMIInterface);
|
||||
SUPER^(stPackMLHMIInterface := stHMIInterface.stStationCmds);
|
||||
|
||||
_rtExecute(CLK:= xExecute, Q=> _xStartAlign);
|
||||
|
||||
// Drei mal ausführen damit die Position genau ist
|
||||
IF _xStartAlign THEN
|
||||
|
||||
_rXPosToGo := DINT_TO_REAL(diXOffset) * -0.001;
|
||||
_rYPosToGo := ((DINT_TO_REAL(diYOffset) * 0.001) - 37.5) * -1;
|
||||
|
||||
IF (ABS(_rXPosToGo) < 10.0) AND (ABS(_rYPosToGo) < 10.0) AND (NOT _fbXAxis.xError) AND (NOT _fbYAxis.xError) THEN
|
||||
_fbXAxis.M_MoveRel(lrRelDist := _rXPosToGo);
|
||||
_fbYAxis.M_MoveRel(lrRelDist := _rYPosToGo);
|
||||
END_IF
|
||||
END_IF
|
||||
|
||||
// Handle enable disable vacuum command
|
||||
xActivateVacuum := xEnableVacuum;
|
||||
xDeactivateVacuum := (NOT xEnableVacuum);
|
||||
|
||||
Reference in New Issue
Block a user