Some improvements and fixes
- Added robot schift params for aligning etcher 1 position - Added HMI Interface to robot fb - Added machine LED's at main cabinet - Aligner now works in auto mode - Added HMI interface to etcher station - Added cReleaseAlarms to HeatCoolPlates - Added HMI interface to HVTester - STarted tray feeder response parsing - Fixed some packml base state machine bugs
This commit is contained in:
@@ -45,6 +45,11 @@ VAR
|
||||
diOffsetPosY AT %Q* : DINT;
|
||||
diThickness AT %Q* : DINT;
|
||||
|
||||
// Offsets for etcher 1 in um
|
||||
diOffsetXE1 AT %Q* : DINT := -280;
|
||||
diOffsetYE1 AT %Q* : DINT := 340;
|
||||
diOffsetZE1 AT %Q* : DINT := 0;
|
||||
|
||||
// Inputs
|
||||
stState AT %I* : ST_KukaRobot_State;
|
||||
dwErrorBits AT %I* : DWORD;
|
||||
@@ -137,7 +142,7 @@ _xRobotReady := stState.bExt
|
||||
// =============================
|
||||
// Call isa88 base state machine
|
||||
// =============================
|
||||
SUPER^();
|
||||
SUPER^(stPackMLHMIInterface := THIS^.stPackMLHMIInterface);
|
||||
|
||||
|
||||
// ==============================
|
||||
@@ -475,11 +480,21 @@ END_VAR]]></Declaration>
|
||||
// Safety reset timout fb
|
||||
_tonTimeout(IN := FALSE);
|
||||
|
||||
_iSSM := 20;
|
||||
_iSSM := 15;
|
||||
|
||||
// Check mirrored values
|
||||
15:
|
||||
IF abyMirrorToolsAndPositions[0] = stJobParams.byGripperNumber
|
||||
AND abyMirrorToolsAndPositions[1] = stJobParams.byChuckNumber
|
||||
AND abyMirrorToolsAndPositions[2] = stJobParams.byPlaceOnHotplate
|
||||
AND abyMirrorToolsAndPositions[3] = stJobParams.byPlaceOnCoolPlate
|
||||
THEN
|
||||
_iSSM := 20;
|
||||
END_IF
|
||||
|
||||
// Wait for robot program start
|
||||
20:
|
||||
_tonTimeout(IN := TRUE, PT := T#5S);
|
||||
_tonTimeout(IN := TRUE, PT := T#15S);
|
||||
|
||||
// If job number is read back correct, go to next state
|
||||
IF awJobStatesFromRobot[0] = stJobs.wJobNrForRobot THEN
|
||||
|
||||
Reference in New Issue
Block a user