From ecc0fa93237f66647345106bc2048da15bd76ff6 Mon Sep 17 00:00:00 2001
From: Federico Rojas <federico.rojas@ess.eu>
Date: Fri, 11 Apr 2025 15:02:24 +0200
Subject: [PATCH] Add new programs and templates for penaumtics

Add a template for safety shutter, wher ethe PSS permit signals are created.
Add a program for the Pneumatic_Box, where all the signals for pressure sensors
and pressure calcualtions are implemented.
Correct the Pneumatics_Template TaskInfo was missing a _, delete the pressurelimtis,
and add the pressure group selection.
Call the new programs from PROG() MAIN.
---
 .../Applications/Pneumatic_Box.TcPOU          | 104 ++++++++++++++++++
 .../Axes/Pneumatics_Template.TcPOU            |  14 +--
 .../Axes/Safety_Shutter.TcPOU                 |  31 ++++++
 solution/tc_project_app/POUs/MAIN.TcPOU       |   6 +-
 4 files changed, 143 insertions(+), 12 deletions(-)
 create mode 100644 solution/tc_project_app/POUs/Application_Specific/Applications/Pneumatic_Box.TcPOU
 create mode 100644 solution/tc_project_app/POUs/Application_Specific/Axes/Safety_Shutter.TcPOU

diff --git a/solution/tc_project_app/POUs/Application_Specific/Applications/Pneumatic_Box.TcPOU b/solution/tc_project_app/POUs/Application_Specific/Applications/Pneumatic_Box.TcPOU
new file mode 100644
index 0000000..85c18c8
--- /dev/null
+++ b/solution/tc_project_app/POUs/Application_Specific/Applications/Pneumatic_Box.TcPOU
@@ -0,0 +1,104 @@
+<?xml version="1.0" encoding="utf-8"?>
+<TcPlcObject Version="1.1.0.1">
+  <POU Name="Pneumatic_Box" Id="{6f77a7af-7f82-065a-2434-407aca22087a}" SpecialFunc="None">
+    <Declaration><![CDATA[PROGRAM Pneumatic_Box
+VAR
+    //Define all necessary variables for your application
+       bPowerPressureSensors AT %Q*: BOOL:= TRUE; //Variable to power the air pressure senosrs in the pneuatmic box
+    fScaledAirPressureGroup1: REAL;
+    fScaledAirPressureGroup2: REAL;
+
+
+    //Variable for the PSS box air feeding pressure
+    //fScaledAirPressurePSS: REAL;
+    //nRawAirPressurePSS AT %I*: INT;
+
+    //Variables for air pressure status
+    bAirPressureLowGrp1: BOOL;
+    bAirPressureHighGrp1: BOOL;
+    bAirPressureLowGrp2: BOOL;
+    bAirPressureHighGrp2: BOOL;
+
+    //Timers for air pressur out of range
+    fbOutOfRangeLowTimer1: TON;
+    fbOutOfRangeHighTimer1: TON;
+    fbOutOfRangeLowTimer2: TON;
+    fbOutOfRangeHighTimer2: TON;
+END_VAR
+]]></Declaration>
+    <Implementation>
+      <ST><![CDATA[//Scale pressure sensor group 1 and 2
+fScaledAirPressureGroup1 := mScaledPressureValue(nRawValue:=GVL.nAirPressureSensorGroup1);
+fScaledAirPressureGroup2 := mScaledPressureValue(nRawValue:=GVL.nAirPressureSensorGroup2);
+//fScaledAirPressurePSS := mScaledPressureValue(nRawValue:=nRawAirPressurePSS);
+
+mAirPressureLimits();
+]]></ST>
+    </Implementation>
+    <Method Name="mAirPressureLimits" Id="{e89d1593-a8ca-0d0d-2454-1b7741864d9f}">
+      <Declaration><![CDATA[METHOD mAirPressureLimits
+VAR_INPUT
+END_VAR
+]]></Declaration>
+      <Implementation>
+        <ST><![CDATA[fbOutOfRangeLowTimer1(IN := fScaledAirPressureGroup1 < GVL_APP.fLOW_LIMIT_AIR_PRESSURE1,PT:=GVL_APP.tTIME_PRESSURE_OUT_OF_RANGE);
+fbOutOfRangeHighTimer1(IN := fScaledAirPressureGroup1 > GVL_APP.fHigh_LIMIT_AIR_PRESSURE1,PT:=GVL_APP.tTIME_PRESSURE_OUT_OF_RANGE);
+
+fbOutOfRangeLowTimer2(IN := fScaledAirPressureGroup2 < GVL_APP.fLOW_LIMIT_AIR_PRESSURE2,PT:=GVL_APP.tTIME_PRESSURE_OUT_OF_RANGE);
+fbOutOfRangeHighTimer2(IN := fScaledAirPressureGroup2 > GVL_APP.fHigh_LIMIT_AIR_PRESSURE2,PT:=GVL_APP.tTIME_PRESSURE_OUT_OF_RANGE);
+
+//Check if the air pressure value is too low for longer than defined time
+IF fbOutOfRangeLowTimer1.Q THEN
+    bAirPressureLowGrp1 := TRUE;
+ELSE
+    bAirPressureLowGrp1 := FALSE;
+END_IF
+
+IF fbOutOfRangeLowTimer2.Q THEN
+    bAirPressureLowGrp2 := TRUE;
+ELSE
+    bAirPressureLowGrp2 := FALSE;
+END_IF
+
+
+//Check if the air pressure value is too high for longer than defined time
+IF fbOutOfRangeHighTimer1.Q THEN
+    bAirPressureHighGrp1 := TRUE;
+ELSE
+    bAirPressureHighGrp1 := FALSE;
+END_IF
+
+IF fbOutOfRangeHighTimer2.Q THEN
+    bAirPressureHighGrp2 := TRUE;
+ELSE
+    bAirPressureHighGrp2 := FALSE;
+END_IF
+]]></ST>
+      </Implementation>
+    </Method>
+    <Method Name="mScaledPressureValue" Id="{0a1832fc-ef94-036a-37c0-f6a54ad9133a}">
+      <Declaration><![CDATA[METHOD PUBLIC mScaledPressureValue : REAL
+VAR_INPUT
+    nRawValue: INT; //Raw value from the Terminal
+END_VAR
+VAR
+    rGradient: REAL; //Internal variable to calculate gradient of the slope
+    rOffset: REAL; //Internal variable to calculate the offset value
+
+    fRawHigh: REAL := 30518.0; //Highest value for the Raw value
+    fRawLow: REAL := 0.0; //Lowest value for the Raw value
+    fScaledHigh: REAL := 10.0; //Highest value for the Scaled value 10 bar
+    fScaledLow: REAL := 0.0; //Lowest value for the Scaled value 0 bar
+END_VAR
+]]></Declaration>
+      <Implementation>
+        <ST><![CDATA[rGradient:= (fScaledHigh - fScaledLow)/(fRawHigh - fRawLow);
+rOffset:= fScaledHigh - rGradient * fRawHigh;
+mScaledPressureValue:= rGradient * nRawValue + rOffset;
+
+
+]]></ST>
+      </Implementation>
+    </Method>
+  </POU>
+</TcPlcObject>
\ No newline at end of file
diff --git a/solution/tc_project_app/POUs/Application_Specific/Axes/Pneumatics_Template.TcPOU b/solution/tc_project_app/POUs/Application_Specific/Axes/Pneumatics_Template.TcPOU
index dfbdcec..dda5fb1 100644
--- a/solution/tc_project_app/POUs/Application_Specific/Axes/Pneumatics_Template.TcPOU
+++ b/solution/tc_project_app/POUs/Application_Specific/Axes/Pneumatics_Template.TcPOU
@@ -10,21 +10,15 @@ END_VAR
       <ST><![CDATA[//Initial parameters of an Pneumatic Axis
 //Uncomment the next IF statement to configure and activate the intial parameters of the axis
 (*
-IF TaskInfo[fbGetCurTaskIndex.index].FirstCycle THEN
-    GVL.astPneumaticAxes[x].stPneumaticAxisConfig.sPneumaticAxisName := 'Shutter';
-    GVL.astPneumaticAxes[x].stPneumaticAxisConfig.bSafetyShutter := TRUE;
+IF _TaskInfo[fbGetCurTaskIndex.index].FirstCycle THEN
+    GVL.astPneumaticAxes[x].stPneumaticAxisConfig.sPneumaticAxisName := 'P1PneuAxis';
+    GVL.astPneumaticAxes[x].stPneumaticAxisConfig.bSafetyShutter := FALSE;
     GVL.astPneumaticAxes[x].stPneumaticAxisConfig.nTimeToExtend := 10;
     GVL.astPneumaticAxes[x].stPneumaticAxisConfig.nTimeToRetract := 10;
     GVL.astPneumaticAxes[x].stPneumaticAxisConfig.nAllowTimePressureOutOfRange := 5;
+    GVL.astPneumaticAxes[x].stPneumaticAxisConfig.eSelectPneumaticAxisGroup := E_PneumaticAxisGroup.ePneumaticAxisGroup#;
 END_IF
 *)
-
-
-
-
-
-
-
 ]]></ST>
     </Implementation>
   </POU>
diff --git a/solution/tc_project_app/POUs/Application_Specific/Axes/Safety_Shutter.TcPOU b/solution/tc_project_app/POUs/Application_Specific/Axes/Safety_Shutter.TcPOU
new file mode 100644
index 0000000..4481776
--- /dev/null
+++ b/solution/tc_project_app/POUs/Application_Specific/Axes/Safety_Shutter.TcPOU
@@ -0,0 +1,31 @@
+<?xml version="1.0" encoding="utf-8"?>
+<TcPlcObject Version="1.1.0.1">
+  <POU Name="Safety_Shutter" Id="{6edcef4b-0039-01e0-14cb-28763a1c98aa}" SpecialFunc="None">
+    <Declaration><![CDATA[PROGRAM Safety_Shutter
+VAR
+    //Define all necessary variables for your application
+    bPSSPermitPower AT %Q*: BOOL := TRUE;
+    bPSSPermit1 AT %I*: BOOL;
+    bPSSPermit2 at %I*: BOOL;
+END_VAR
+]]></Declaration>
+    <Implementation>
+      <ST><![CDATA[//Initial parameters of an Pneumatic Axis
+//Uncomment the next IF statement to configure and activate the intial parameters of the axis
+(*
+IF _TaskInfo[fbGetCurTaskIndex.index].FirstCycle THEN
+    GVL.astPneumaticAxes[x].stPneumaticAxisConfig.sPneumaticAxisName := 'SafetyShutter';
+    GVL.astPneumaticAxes[x].stPneumaticAxisConfig.bSafetyShutter := TRUE;
+    GVL.astPneumaticAxes[x].stPneumaticAxisConfig.nTimeToExtend := 10;
+    GVL.astPneumaticAxes[x].stPneumaticAxisConfig.nTimeToRetract := 10;
+    GVL.astPneumaticAxes[x].stPneumaticAxisConfig.nAllowTimePressureOutOfRange := 5;
+    GVL.astPneumaticAxes[x].stPneumaticAxisConfig.eSelectPneumaticAxisGroup := E_PneumaticAxisGroup.ePneumaticAxisGroup1;
+END_IF
+*)
+
+//PSS Permit signal
+//GVL.astPneumaticAxes[1].stPneumaticAxisStatus.bPSSPermit := bPSSPermit1 AND bPSSPermit2
+]]></ST>
+    </Implementation>
+  </POU>
+</TcPlcObject>
\ No newline at end of file
diff --git a/solution/tc_project_app/POUs/MAIN.TcPOU b/solution/tc_project_app/POUs/MAIN.TcPOU
index 98821bc..e183ea3 100644
--- a/solution/tc_project_app/POUs/MAIN.TcPOU
+++ b/solution/tc_project_app/POUs/MAIN.TcPOU
@@ -129,11 +129,13 @@ GVL.fbGetCurTaskIndex();
 
 //Axes initial parameters and program
 Axis_Template();
+Safety_Shutter();
 //Pneumatics_Template();
 
 //Application program calls
-Cabinet_Configuration();
-Application_Template();
+Cabinet_Monitoring();
+Pneumatic_Box();
+//Application_Template();
 ]]></ST>
       </Implementation>
     </Action>