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:
@@ -58,32 +58,32 @@ _xReleaseAlarms := PRG_Safety.xEStopOk;
|
||||
|
||||
IF _xClear THEN
|
||||
_xClear := FALSE;
|
||||
_fbRobot.M_Clear();
|
||||
_fbRobot.M_CmdClear();
|
||||
END_IF
|
||||
|
||||
IF _xReset THEN
|
||||
_xReset := FALSE;
|
||||
_fbRobot.M_Reset();
|
||||
_fbRobot.M_CmdReset();
|
||||
END_IF
|
||||
|
||||
IF _xStart THEN
|
||||
_xStart := FALSE;
|
||||
_fbRobot.M_Start();
|
||||
_fbRobot.M_CmdStart();
|
||||
END_IF
|
||||
|
||||
IF _xHold THEN
|
||||
_xHold := FALSE;
|
||||
_fbRobot.M_Hold();
|
||||
_fbRobot.M_CmdHold();
|
||||
END_IF
|
||||
|
||||
IF _xUnhold THEN
|
||||
_xUnhold := FALSE;
|
||||
_fbRobot.M_Unhold();
|
||||
_fbRobot.M_CmdUnhold();
|
||||
END_IF
|
||||
|
||||
IF _xStop THEN
|
||||
_xStop := FALSE;
|
||||
_fbRobot.M_Stop();
|
||||
_fbRobot.M_CmdStop();
|
||||
END_IF
|
||||
|
||||
_rtStopRobotFromSafety(CLK := PRG_Safety.xStopRobot);
|
||||
@@ -167,7 +167,7 @@ CASE _iState OF
|
||||
// Only start with robot in idle then put into aligner
|
||||
IF _stRobotStatus.eStateCurrent = E_PackMLState.IDLE THEN
|
||||
_stRobotJobParams.eJob := E_KukaRobot_JobNumberRobot.PUT_INTO_ALIGNER;
|
||||
_fbRobot.M_Start();
|
||||
_fbRobot.M_CmdStart();
|
||||
_iState := 10;
|
||||
END_IF
|
||||
END_IF
|
||||
@@ -175,7 +175,7 @@ CASE _iState OF
|
||||
// Wait for part in aligner
|
||||
10:
|
||||
IF (_stRobotStatus.eStateCurrent = E_PackMLState.IDLE) THEN
|
||||
_fbAligner.M_Start();
|
||||
_fbAligner.M_CmdStart();
|
||||
_iState := 20;
|
||||
END_IF
|
||||
|
||||
@@ -188,14 +188,14 @@ CASE _iState OF
|
||||
20:
|
||||
IF (_fbAligner.stStatus.eStateCurrent = E_PackMLState.COMPLETED) THEN
|
||||
_stRobotJobParams.eJob := E_KukaRobot_JobNumberRobot.GET_FROM_ALIGNER;
|
||||
_fbRobot.M_Start();
|
||||
_fbRobot.M_CmdStart();
|
||||
_iState := 40;
|
||||
END_IF
|
||||
|
||||
// Get from aligner done, reset aligner
|
||||
40:
|
||||
IF (_stRobotStatus.eStateCurrent = E_PackMLState.IDLE) THEN
|
||||
_fbAligner.M_Reset();
|
||||
_fbAligner.M_CmdReset();
|
||||
_iState := 45;
|
||||
END_IF
|
||||
|
||||
@@ -203,7 +203,7 @@ CASE _iState OF
|
||||
IF _xStartCycle THEN
|
||||
_xStartCycle := FALSE;
|
||||
_stRobotJobParams.eJob := E_KukaRobot_JobNumberRobot.PUT_INTO_ETCHER1;
|
||||
_fbRobot.M_Start();
|
||||
_fbRobot.M_CmdStart();
|
||||
_iState := 50;
|
||||
END_IF
|
||||
|
||||
@@ -218,7 +218,7 @@ CASE _iState OF
|
||||
IF _xStartCycle THEN
|
||||
_xStartCycle := FALSE;
|
||||
_stRobotJobParams.eJob := E_KukaRobot_JobNumberRobot.GET_FROM_ETCHER1;
|
||||
_fbRobot.M_Start();
|
||||
_fbRobot.M_CmdStart();
|
||||
_iState := 70;
|
||||
END_IF
|
||||
|
||||
@@ -226,7 +226,7 @@ CASE _iState OF
|
||||
70:
|
||||
IF (_stRobotStatus.eStateCurrent = E_PackMLState.IDLE) THEN
|
||||
_stRobotJobParams.eJob := E_KukaRobot_JobNumberRobot.PUT_INTO_ALIGNER;
|
||||
_fbRobot.M_Start();
|
||||
_fbRobot.M_CmdStart();
|
||||
_iState := 10;
|
||||
END_IF
|
||||
|
||||
|
||||
Reference in New Issue
Block a user