Started fixes for HMI

This commit is contained in:
2026-03-06 08:39:54 +01:00
parent 64f561b0c5
commit bcff5a1132
16 changed files with 899 additions and 270 deletions

View File

@@ -79,6 +79,9 @@ VAR
_fbRobot : FB_Mecademics;
xDisableVacuum AT %Q* : BOOL;
// Internals
_xOpenChuckClamp : BOOL;
END_VAR
]]></Declaration>
<Implementation>
@@ -100,8 +103,11 @@ ELSE
_tpEjectChuck(IN := FALSE);
END_IF
// Todo bessere implementierung finden
_xOpenChuckClamp := xOpenChuckClamp OR stHMIInterface.stChuckUnlockCmd.xRequest;
_fbUnlockLeft(
xAutomaticOpen:= xOpenChuckClamp,
xAutomaticOpen:= _xOpenChuckClamp,
xReleaseErrors:= xReleaseAlarms,
stValveConfig:= _stValveUnlockLeftCfg,
xReleaseManualMode:= xReleaseManualMode,
@@ -109,7 +115,7 @@ _fbUnlockLeft(
stHMIInterface:= stHMIInterface.stChuckUnlockLeft);
_fbUnlockRight(
xAutomaticOpen:= xOpenChuckClamp,
xAutomaticOpen:= _xOpenChuckClamp,
xReleaseErrors:= xReleaseAlarms,
stValveConfig:= _stValveUnlockRightCfg,
xReleaseManualMode:= xReleaseManualMode,

View File

@@ -26,8 +26,7 @@ VAR
_xDone : BOOL;
_xError : BOOL;
_iDS : INT;
END_VAR
]]></Declaration>
END_VAR]]></Declaration>
<Implementation>
<ST><![CDATA[SUPER^(stPackMLHMIInterface := stPackMLHMIInterface);
@@ -257,6 +256,7 @@ END_VAR]]></Declaration>
M_CmdAbort();
END_IF
// Set wrf
32:
M_ExecuteCmd(E_Meca_Cmds.SET_WRF, 163.5, -34.79, 465, -180, 0, 180, xDone => xExecDone, xError => xExecError);
@@ -271,7 +271,8 @@ END_VAR]]></Declaration>
// Set trf
33:
M_ExecuteCmd(E_Meca_Cmds.SET_TRF, 0, 0, 91, 0, 180, 90, xDone => xExecDone, xError => xExecError);
// SetTrf(32.38 , 27.52, 91, 0, 180, -90)
M_ExecuteCmd(E_Meca_Cmds.SET_TRF, 32.38, 27.52, 91, 0, 180, -90, xDone => xExecDone, xError => xExecError);
IF xExecDone THEN
_iSSM := 34;