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:
2026-02-15 10:04:59 +01:00
parent d6a4fc6e42
commit 0c40092d8f
26 changed files with 1259 additions and 190 deletions

View File

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