First version Tray Feeder ready for test
- Tray feeder implementation ready for first tests - Some refactoring of packml function names - Added .xtv file to project again because of linking issues - Added hmi button for packml complete command - Started media cabinet
This commit is contained in:
@@ -174,7 +174,7 @@ END_VAR]]></Declaration>
|
||||
IF stRobotInputs.stSafetyStatus.bEstop_Resettable THEN
|
||||
_iSSM := 10;
|
||||
ELSE
|
||||
_eCmd := E_PackMLCmd.ABORT;
|
||||
M_CmdAbort();
|
||||
END_IF
|
||||
ELSE
|
||||
// Go to activate state
|
||||
@@ -198,7 +198,7 @@ END_VAR]]></Declaration>
|
||||
IF _tonTimer.Q THEN
|
||||
_tonTimer(IN := FALSE);
|
||||
// TODO trigger error message
|
||||
_eCmd := E_PackMLCmd.ABORT;
|
||||
M_CmdAbort();
|
||||
END_IF
|
||||
|
||||
IF (NOT stRobotInputs.stSafetyStatus.bEstop) THEN
|
||||
@@ -229,7 +229,7 @@ END_VAR]]></Declaration>
|
||||
_tonTimer(IN := FALSE);
|
||||
stRobotOutputs.stRobotControl.bActivate := FALSE;
|
||||
// TODO trigger error message
|
||||
_eCmd := E_PackMLCmd.ABORT;
|
||||
M_CmdAbort();
|
||||
END_IF
|
||||
|
||||
// Check homing
|
||||
@@ -254,7 +254,7 @@ END_VAR]]></Declaration>
|
||||
_tonTimer(IN := FALSE);
|
||||
stRobotOutputs.stRobotControl.bHome := FALSE;
|
||||
// TODO trigger error message
|
||||
_eCmd := E_PackMLCmd.ABORT;
|
||||
M_CmdAbort();
|
||||
END_IF
|
||||
|
||||
// Set wrf
|
||||
@@ -266,19 +266,19 @@ END_VAR]]></Declaration>
|
||||
END_IF
|
||||
|
||||
IF xExecError THEN
|
||||
_eCmd := E_PackMLCmd.ABORT;
|
||||
M_CmdAbort();
|
||||
END_IF
|
||||
|
||||
// Set trf
|
||||
33:
|
||||
M_ExecuteCmd(E_Meca_Cmds.SET_TRF, 0, 0, 92, 0, 180, 90, xDone => xExecDone, xError => xExecError);
|
||||
M_ExecuteCmd(E_Meca_Cmds.SET_TRF, 0, 0, 91, 0, 180, 90, xDone => xExecDone, xError => xExecError);
|
||||
|
||||
IF xExecDone THEN
|
||||
_iSSM := 34;
|
||||
END_IF
|
||||
|
||||
IF xExecError THEN
|
||||
_eCmd := E_PackMLCmd.ABORT;
|
||||
M_CmdAbort();
|
||||
END_IF
|
||||
|
||||
// Move to save position
|
||||
@@ -290,7 +290,7 @@ END_VAR]]></Declaration>
|
||||
END_IF
|
||||
|
||||
IF xExecError THEN
|
||||
_eCmd := E_PackMLCmd.ABORT;
|
||||
M_CmdAbort();
|
||||
END_IF
|
||||
|
||||
// Robot ready
|
||||
|
||||
Reference in New Issue
Block a user