174 lines
4.8 KiB
XML
174 lines
4.8 KiB
XML
<?xml version="1.0" encoding="utf-8"?>
|
|
<TcPlcObject Version="1.1.0.1">
|
|
<POU Name="FB_Etcher" Id="{e75b6d70-36db-4c78-b78d-a594609441d1}" SpecialFunc="None">
|
|
<Declaration><![CDATA[FUNCTION_BLOCK FB_Etcher EXTENDS FB_PackMLGeneric
|
|
VAR_INPUT
|
|
xOpenDoor : BOOL;
|
|
xEnableVacuum : BOOL;
|
|
xOpenChuckClamp : BOOL;
|
|
xEjectChuck : BOOL;
|
|
xReleaseManualMode : BOOL;
|
|
xReleaseAlarms : BOOL;
|
|
xConfirmAlarms : BOOL;
|
|
END_VAR
|
|
VAR_OUTPUT
|
|
xDoorOpen : BOOL;
|
|
xChuckClampOpen : BOOL;
|
|
xVacuumEnabled : BOOL;
|
|
END_VAR
|
|
VAR_IN_OUT
|
|
stHMIInterface : ST_HMI_Etcher;
|
|
END_VAR
|
|
VAR
|
|
_fbValveDoor : FB_Valve('Door');
|
|
_stValveDoorCfg : ST_ValveConfig := (
|
|
xHasClosedFeedback := TRUE,
|
|
xHasOpenFeedback := TRUE,
|
|
timTimeoutOpen := T#5S,
|
|
timTimeoutClose := T#5S);
|
|
|
|
|
|
_fbUnlockLeft : FB_Valve('Clamping left');
|
|
_stValveUnlockLeftCfg : ST_ValveConfig := (
|
|
xHasClosedFeedback := TRUE,
|
|
xHasOpenFeedback := TRUE,
|
|
timTimeoutOpen := T#5S,
|
|
timTimeoutClose := T#5S);
|
|
|
|
|
|
_fbUnlockRight : FB_Valve('Clamping right');
|
|
_stValveUnlockRightCfg : ST_ValveConfig := (
|
|
xHasClosedFeedback := TRUE,
|
|
xHasOpenFeedback := TRUE,
|
|
timTimeoutOpen := T#5S,
|
|
timTimeoutClose := T#5S);
|
|
|
|
|
|
_fbEjectFront : FB_Valve('Clamping front');
|
|
_stValveClampingFrontCfg : ST_ValveConfig := (
|
|
xHasClosedFeedback := TRUE,
|
|
xHasOpenFeedback := TRUE,
|
|
timTimeoutOpen := T#5S,
|
|
timTimeoutClose := T#5S);
|
|
|
|
|
|
_fbEjectBack : FB_Valve('Clamping back');
|
|
_stValveEjectBackCfg : ST_ValveConfig := (
|
|
xHasClosedFeedback := TRUE,
|
|
xHasOpenFeedback := TRUE,
|
|
timTimeoutOpen := T#5S,
|
|
timTimeoutClose := T#5S);
|
|
|
|
|
|
_rtEjectChuckCmd : R_TRIG;
|
|
_tpEjectChuck : TP;
|
|
|
|
// =======
|
|
// Sensors
|
|
// =======
|
|
|
|
xVacuumOk AT %I* : BOOL;
|
|
|
|
// Spinner vibration sensor
|
|
xVibrationSensor AT %I* : BOOL;
|
|
|
|
// =========
|
|
// Actuators
|
|
// =========
|
|
|
|
_fbRobot : FB_Mecademics;
|
|
|
|
xDisableVacuum AT %Q* : BOOL;
|
|
|
|
// Internals
|
|
_xOpenChuckClamp : BOOL;
|
|
END_VAR
|
|
]]></Declaration>
|
|
<Implementation>
|
|
<ST><![CDATA[// Main door
|
|
_fbValveDoor(
|
|
xAutomaticOpen:= xOpenDoor,
|
|
xReleaseErrors:= xReleaseAlarms,
|
|
stValveConfig:= _stValveDoorCfg,
|
|
xReleaseManualMode:= xReleaseManualMode,
|
|
xConfirmAlarms:= xConfirmAlarms,
|
|
stHMIInterface:= stHMIInterface.stDoorValve);
|
|
|
|
|
|
// Chuck
|
|
_rtEjectChuckCmd(CLK := xEjectChuck);
|
|
IF _rtEjectChuckCmd.Q THEN
|
|
_tpEjectChuck(IN := TRUE, PT := T#500MS);
|
|
ELSE
|
|
_tpEjectChuck(IN := FALSE);
|
|
END_IF
|
|
|
|
// Todo bessere implementierung finden
|
|
_xOpenChuckClamp := xOpenChuckClamp OR stHMIInterface.stChuckUnlockCmd.xRequest;
|
|
|
|
_fbUnlockLeft(
|
|
xAutomaticOpen:= _xOpenChuckClamp,
|
|
xReleaseErrors:= xReleaseAlarms,
|
|
stValveConfig:= _stValveUnlockLeftCfg,
|
|
xReleaseManualMode:= xReleaseManualMode,
|
|
xConfirmAlarms:= xConfirmAlarms,
|
|
stHMIInterface:= stHMIInterface.stChuckUnlockLeft);
|
|
|
|
_fbUnlockRight(
|
|
xAutomaticOpen:= _xOpenChuckClamp,
|
|
xReleaseErrors:= xReleaseAlarms,
|
|
stValveConfig:= _stValveUnlockRightCfg,
|
|
xReleaseManualMode:= xReleaseManualMode,
|
|
xConfirmAlarms:= xConfirmAlarms,
|
|
stHMIInterface:= stHMIInterface.stChuckUnlockRight);
|
|
|
|
_fbEjectFront(
|
|
xAutomaticOpen:= _tpEjectChuck.Q,
|
|
xReleaseErrors:= xReleaseAlarms,
|
|
stValveConfig:= _stValveClampingFrontCfg,
|
|
xReleaseManualMode:= xReleaseManualMode,
|
|
xConfirmAlarms:= xConfirmAlarms,
|
|
stHMIInterface:= stHMIInterface.stChuckEjectFront);
|
|
|
|
_fbEjectBack(
|
|
xAutomaticOpen:= _tpEjectChuck.Q,
|
|
xReleaseErrors:= xReleaseAlarms,
|
|
stValveConfig:= _stValveEjectBackCfg,
|
|
xReleaseManualMode:= xReleaseManualMode,
|
|
xConfirmAlarms:= xConfirmAlarms,
|
|
stHMIInterface:= stHMIInterface.stChuckEjectBack);
|
|
|
|
xDisableVacuum := (NOT xEnableVacuum);
|
|
|
|
_fbRobot(stPackMLHMIInterface := stHMIInterface.stMecaCmds);
|
|
|
|
// Call base sm
|
|
SUPER^(stPackMLHMIInterface := stHMIInterface.stStationCmds);
|
|
|
|
// Copy internal signals to output
|
|
xDoorOpen := _fbValveDoor.IsOpen;
|
|
xChuckClampOpen := _fbUnlockLeft.IsOpen AND _fbUnlockRight.IsOpen;
|
|
xVacuumEnabled := xVacuumOk;]]></ST>
|
|
</Implementation>
|
|
<Method Name="FB_Init" Id="{afcda70c-3e52-4a32-9ca9-670a6b854f24}">
|
|
<Declaration><![CDATA[//FB_Init is always available implicitly and it is used primarily for initialization.
|
|
//The return value is not evaluated. For a specific influence, you can also declare the
|
|
//methods explicitly and provide additional code there with the standard initialization
|
|
//code. You can evaluate the return value.
|
|
METHOD FB_Init: BOOL
|
|
VAR_INPUT
|
|
bInitRetains: BOOL; // TRUE: the retain variables are initialized (reset warm / reset cold)
|
|
bInCopyCode: BOOL; // TRUE: the instance will be copied to the copy code afterward (online change)
|
|
END_VAR
|
|
]]></Declaration>
|
|
<Implementation>
|
|
<ST><![CDATA[_stSMConfig.xStoppingDisabled := TRUE;
|
|
|
|
_stSMConfig.xCompletingDisabled := TRUE;
|
|
_stSMConfig.xCompletedDisabled := TRUE;
|
|
|
|
_stSMConfig.xAbortingDisabled := TRUE;]]></ST>
|
|
</Implementation>
|
|
</Method>
|
|
</POU>
|
|
</TcPlcObject> |