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:
2026-03-03 14:11:58 +01:00
parent dbfa6fc7cc
commit 0ea0887bb4
17 changed files with 4430 additions and 486 deletions

View File

@@ -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