WIP: Inbetriebnahme vorladen
This commit is contained in:
22
PLC/DUTs/E_BMS_STATE.TcDUT
Normal file
22
PLC/DUTs/E_BMS_STATE.TcDUT
Normal file
@@ -0,0 +1,22 @@
|
||||
<?xml version="1.0" encoding="utf-8"?>
|
||||
<TcPlcObject Version="1.1.0.1" ProductVersion="3.1.4024.12">
|
||||
<DUT Name="E_BMS_STATE" Id="{2a757cce-36a5-4230-a14d-5402102352d5}">
|
||||
<Declaration><![CDATA[{attribute 'qualified_only'}
|
||||
{attribute 'strict'}
|
||||
TYPE E_BMS_STATE :
|
||||
(
|
||||
IDLE := 0,
|
||||
CHECK_POWER_COMMAND := 1,
|
||||
WAIT_FOR_STRING_TO_BE_READY := 2,
|
||||
WAIT_FOR_INVERTER := 3,
|
||||
ENABLED := 4,
|
||||
WAIT_FOR_SHUTDOWN_DISCHARGE_MODE := 5,
|
||||
SEGMENT_DISCHARGE_WITH_INVERTER_DONE := 6,
|
||||
SEGMENT_DISCHARGE_DONE := 7,
|
||||
ERROR := 8,
|
||||
WAIT_FOR_ERROR_RESET := 9
|
||||
);
|
||||
END_TYPE
|
||||
]]></Declaration>
|
||||
</DUT>
|
||||
</TcPlcObject>
|
||||
@@ -71,6 +71,11 @@ STRUCT
|
||||
stEWLVoltageSegment : ST_ANALOG_EW_LEVELS;
|
||||
stEWDVoltageSegment : ST_ANALOG_EW_DELAYS;
|
||||
|
||||
|
||||
// Max pressure difference between posolyt and negolyt segment inlet
|
||||
//====================================
|
||||
rMaxDeltaPSegmentInlet : REAL;
|
||||
|
||||
END_STRUCT
|
||||
END_TYPE
|
||||
]]></Declaration>
|
||||
|
||||
@@ -2,7 +2,7 @@
|
||||
<TcPlcObject Version="1.1.0.1" ProductVersion="3.1.4024.12">
|
||||
<GVL Name="GVL_CONFIG" Id="{0773bf51-0237-454d-a970-cfd896054edb}">
|
||||
<Declaration><![CDATA[{attribute 'qualified_only'}
|
||||
VAR_GLOBAL
|
||||
VAR_GLOBAL PERSISTENT
|
||||
// ===========================
|
||||
// Unit hardware config
|
||||
// ===========================
|
||||
@@ -43,7 +43,7 @@ VAR_GLOBAL
|
||||
stConfigNegolytValve := (timTimeoutOpen := T#10S, timTimeoutClose := T#10S, xHasOpenFeedback := TRUE, xHasClosedFeedback := TRUE),
|
||||
|
||||
// Pressure posolyt segment inlet
|
||||
stConfigPosolytPressureSegmentInlet := (iAIMax := 32767, iAIMin := 0, rPVMax := 1500, rPVMin := -1000, sUnit := 'mbar'),
|
||||
stConfigPosolytPressureSegmentInlet := (iAIMax := 32767, iAIMin := 0, rPVMax := 2000, rPVMin := 0, sUnit := 'mbar'),
|
||||
stEWLPosolytPressureSegmentInlet := (rErrorMin := 170, rWarningMin := 200, rWarningMax := 600, rErrorMax := 700),
|
||||
stEWDPosolytPressureSegmentInlet :=
|
||||
(
|
||||
@@ -60,7 +60,7 @@ VAR_GLOBAL
|
||||
),
|
||||
|
||||
// Pressure negolyt segment inlet
|
||||
stConfigNegolytPressureSegmentInlet := (iAIMax := 32767, iAIMin := 0, rPVMax := 1500, rPVMin := -1000, sUnit := 'mbar'),
|
||||
stConfigNegolytPressureSegmentInlet := (iAIMax := 32767, iAIMin := 0, rPVMax := 2000, rPVMin := 0, sUnit := 'mbar'),
|
||||
stEWLNegolytPressureSegmentInlet := (rErrorMin := 170, rWarningMin := 200, rWarningMax := 600, rErrorMax := 700),
|
||||
stEWDNegolytPressureSegmentInlet :=
|
||||
(
|
||||
@@ -94,7 +94,7 @@ VAR_GLOBAL
|
||||
),
|
||||
|
||||
// Pressure negolyt tank inlet
|
||||
stConfigNegolytPressureTankInlet := (iAIMax := 32767, iAIMin := 0, rPVMax := 1500, rPVMin := -1000, sUnit := 'mbar'),
|
||||
stConfigNegolytPressureTankInlet := (iAIMax := 32767, iAIMin := 0, rPVMax := 2000, rPVMin := 0, sUnit := 'mbar'),
|
||||
stEWLNegolytPressureTankInlet := (rErrorMin := -100, rWarningMin := -50, rWarningMax := 100, rErrorMax := 120),
|
||||
stEWDNegolytPressureTankInlet :=
|
||||
(
|
||||
@@ -162,7 +162,9 @@ VAR_GLOBAL
|
||||
timWarningHighOff := T#5S,
|
||||
timErrorHighOn := T#2S,
|
||||
timErrorHighOff := T#5S
|
||||
)
|
||||
),
|
||||
|
||||
rMaxDeltaPSegmentInlet := 100.0
|
||||
);
|
||||
|
||||
// ===========================
|
||||
|
||||
@@ -8,6 +8,12 @@ VAR_GLOBAL
|
||||
stAckAlarmsButton : ST_HMI_CONTROL_BUTTON := (xRelease := TRUE);
|
||||
|
||||
stAutomaticModeHMI : ST_AUTO_HMI_INTERFACE;
|
||||
|
||||
// Requested control mode by HMI
|
||||
eRequestedControlMode : E_BMS_CONTROL_MODE;
|
||||
|
||||
// Current control mode
|
||||
eCurrentControlMode : E_BMS_CONTROL_MODE;
|
||||
END_VAR]]></Declaration>
|
||||
</GVL>
|
||||
</TcPlcObject>
|
||||
@@ -24,6 +24,9 @@
|
||||
<Compile Include="DUTs\E_BMS_CONTROL_MODE.TcDUT">
|
||||
<SubType>Code</SubType>
|
||||
</Compile>
|
||||
<Compile Include="DUTs\E_BMS_STATE.TcDUT">
|
||||
<SubType>Code</SubType>
|
||||
</Compile>
|
||||
<Compile Include="DUTs\E_CHARGE_STATUS.TcDUT">
|
||||
<SubType>Code</SubType>
|
||||
</Compile>
|
||||
|
||||
225
PLC/PLC.tmc
225
PLC/PLC.tmc
File diff suppressed because one or more lines are too long
@@ -9,6 +9,9 @@ VAR_INPUT
|
||||
// Enable
|
||||
xEnable : BOOL;
|
||||
|
||||
// Module in safety check mode
|
||||
xInSafetyCheckMode : BOOL;
|
||||
|
||||
// Module completely off
|
||||
xOff : BOOL := TRUE;
|
||||
|
||||
@@ -48,6 +51,9 @@ VAR_OUTPUT
|
||||
|
||||
// One unit has a warning
|
||||
xWarning : BOOL;
|
||||
|
||||
// All modules in automatic mode
|
||||
xAllUnitsInAutomatic : BOOL;
|
||||
END_VAR
|
||||
VAR
|
||||
_fbUnit1 : FB_Unit('Unit 1');
|
||||
@@ -73,6 +79,9 @@ END_VAR
|
||||
xError := FALSE;
|
||||
xWarning := FALSE;
|
||||
|
||||
// Reset automatic mode flag
|
||||
xAllUnitsInAutomatic := TRUE;
|
||||
|
||||
// Reset safety interlocks flag
|
||||
xSafetyIntlksOk := TRUE;
|
||||
|
||||
@@ -82,6 +91,7 @@ xSafetyIntlksOk := TRUE;
|
||||
// ===============================
|
||||
_fbUnit1(
|
||||
xEnable := xEnable,
|
||||
xInSafetyCheckMode := xInSafetyCheckMode,
|
||||
stUnitConfig:= GVL_CONFIG.stUnitConfig,
|
||||
stHMIInterface:= stHMIInterface.stHMIInterfaceUnit1,
|
||||
xEmergencyStopOk:= xEmergencyStopOk,
|
||||
@@ -105,12 +115,17 @@ IF NOT _fbUnit1.xSafetyIntlksOk THEN
|
||||
xSafetyIntlksOk := FALSE;
|
||||
END_IF
|
||||
|
||||
IF NOT _fbUnit1.xAllComponentsInAuto THEN
|
||||
xAllUnitsInAutomatic := FALSE;
|
||||
END_IF
|
||||
|
||||
|
||||
// ===============================
|
||||
// Unit 2
|
||||
// ===============================
|
||||
_fbUnit2(
|
||||
xEnable := xEnable,
|
||||
xInSafetyCheckMode := xInSafetyCheckMode,
|
||||
stUnitConfig:= GVL_CONFIG.stUnitConfig,
|
||||
stHMIInterface:= stHMIInterface.stHMIInterfaceUnit2,
|
||||
xEmergencyStopOk:= xEmergencyStopOk,
|
||||
@@ -134,12 +149,17 @@ IF NOT _fbUnit2.xSafetyIntlksOk THEN
|
||||
xSafetyIntlksOk := FALSE;
|
||||
END_IF
|
||||
|
||||
IF NOT _fbUnit2.xAllComponentsInAuto THEN
|
||||
xAllUnitsInAutomatic := FALSE;
|
||||
END_IF
|
||||
|
||||
|
||||
// ===============================
|
||||
// Unit 3
|
||||
// ===============================
|
||||
_fbUnit3(
|
||||
xEnable := xEnable,
|
||||
xInSafetyCheckMode := xInSafetyCheckMode,
|
||||
stUnitConfig:= GVL_CONFIG.stUnitConfig,
|
||||
stHMIInterface:= stHMIInterface.stHMIInterfaceUnit3,
|
||||
xEmergencyStopOk:= xEmergencyStopOk,
|
||||
@@ -163,12 +183,17 @@ IF NOT _fbUnit3.xSafetyIntlksOk THEN
|
||||
xSafetyIntlksOk := FALSE;
|
||||
END_IF
|
||||
|
||||
IF NOT _fbUnit3.xAllComponentsInAuto THEN
|
||||
xAllUnitsInAutomatic := FALSE;
|
||||
END_IF
|
||||
|
||||
|
||||
// ===============================
|
||||
// Unit 4
|
||||
// ===============================
|
||||
_fbUnit4(
|
||||
xEnable := xEnable,
|
||||
xInSafetyCheckMode := xInSafetyCheckMode,
|
||||
stUnitConfig:= GVL_CONFIG.stUnitConfig,
|
||||
stHMIInterface:= stHMIInterface.stHMIInterfaceUnit4,
|
||||
xEmergencyStopOk:= xEmergencyStopOk,
|
||||
@@ -192,6 +217,10 @@ IF NOT _fbUnit4.xSafetyIntlksOk THEN
|
||||
xSafetyIntlksOk := FALSE;
|
||||
END_IF
|
||||
|
||||
IF NOT _fbUnit4.xAllComponentsInAuto THEN
|
||||
xAllUnitsInAutomatic := FALSE;
|
||||
END_IF
|
||||
|
||||
|
||||
// ===============================
|
||||
// Units ready check
|
||||
@@ -357,124 +386,15 @@ _fbUnitsOutOfBalanceAlarm.ipArguments.Clear().AddString(_sName);]]></ST>
|
||||
</Set>
|
||||
</Property>
|
||||
<LineIds Name="FB_Module">
|
||||
<LineId Id="248" Count="2" />
|
||||
<LineId Id="557" Count="1" />
|
||||
<LineId Id="556" Count="0" />
|
||||
<LineId Id="575" Count="0" />
|
||||
<LineId Id="251" Count="4" />
|
||||
<LineId Id="456" Count="0" />
|
||||
<LineId Id="256" Count="7" />
|
||||
<LineId Id="742" Count="0" />
|
||||
<LineId Id="264" Count="8" />
|
||||
<LineId Id="560" Count="0" />
|
||||
<LineId Id="559" Count="0" />
|
||||
<LineId Id="561" Count="1" />
|
||||
<LineId Id="273" Count="5" />
|
||||
<LineId Id="457" Count="0" />
|
||||
<LineId Id="279" Count="7" />
|
||||
<LineId Id="743" Count="0" />
|
||||
<LineId Id="287" Count="8" />
|
||||
<LineId Id="563" Count="2" />
|
||||
<LineId Id="296" Count="0" />
|
||||
<LineId Id="574" Count="0" />
|
||||
<LineId Id="297" Count="4" />
|
||||
<LineId Id="458" Count="0" />
|
||||
<LineId Id="302" Count="7" />
|
||||
<LineId Id="744" Count="0" />
|
||||
<LineId Id="310" Count="8" />
|
||||
<LineId Id="566" Count="2" />
|
||||
<LineId Id="319" Count="0" />
|
||||
<LineId Id="573" Count="0" />
|
||||
<LineId Id="320" Count="4" />
|
||||
<LineId Id="459" Count="0" />
|
||||
<LineId Id="325" Count="7" />
|
||||
<LineId Id="745" Count="0" />
|
||||
<LineId Id="333" Count="7" />
|
||||
<LineId Id="188" Count="0" />
|
||||
<LineId Id="569" Count="2" />
|
||||
<LineId Id="441" Count="0" />
|
||||
<LineId Id="572" Count="0" />
|
||||
<LineId Id="436" Count="0" />
|
||||
<LineId Id="438" Count="1" />
|
||||
<LineId Id="437" Count="0" />
|
||||
<LineId Id="435" Count="0" />
|
||||
<LineId Id="465" Count="0" />
|
||||
<LineId Id="464" Count="0" />
|
||||
<LineId Id="466" Count="1" />
|
||||
<LineId Id="448" Count="0" />
|
||||
<LineId Id="469" Count="0" />
|
||||
<LineId Id="486" Count="0" />
|
||||
<LineId Id="483" Count="2" />
|
||||
<LineId Id="482" Count="0" />
|
||||
<LineId Id="468" Count="0" />
|
||||
<LineId Id="495" Count="0" />
|
||||
<LineId Id="491" Count="1" />
|
||||
<LineId Id="487" Count="0" />
|
||||
<LineId Id="494" Count="0" />
|
||||
<LineId Id="493" Count="0" />
|
||||
<LineId Id="444" Count="0" />
|
||||
<LineId Id="446" Count="1" />
|
||||
<LineId Id="445" Count="0" />
|
||||
<LineId Id="442" Count="0" />
|
||||
<LineId Id="659" Count="0" />
|
||||
<LineId Id="440" Count="0" />
|
||||
<LineId Id="378" Count="3" />
|
||||
<LineId Id="387" Count="0" />
|
||||
<LineId Id="389" Count="0" />
|
||||
<LineId Id="393" Count="0" />
|
||||
<LineId Id="388" Count="0" />
|
||||
<LineId Id="404" Count="2" />
|
||||
<LineId Id="395" Count="0" />
|
||||
<LineId Id="394" Count="0" />
|
||||
<LineId Id="408" Count="1" />
|
||||
<LineId Id="407" Count="0" />
|
||||
<LineId Id="397" Count="0" />
|
||||
<LineId Id="396" Count="0" />
|
||||
<LineId Id="411" Count="1" />
|
||||
<LineId Id="410" Count="0" />
|
||||
<LineId Id="399" Count="0" />
|
||||
<LineId Id="398" Count="0" />
|
||||
<LineId Id="414" Count="1" />
|
||||
<LineId Id="413" Count="0" />
|
||||
<LineId Id="401" Count="0" />
|
||||
<LineId Id="400" Count="0" />
|
||||
<LineId Id="417" Count="1" />
|
||||
<LineId Id="416" Count="0" />
|
||||
<LineId Id="403" Count="0" />
|
||||
<LineId Id="402" Count="0" />
|
||||
<LineId Id="420" Count="1" />
|
||||
<LineId Id="419" Count="0" />
|
||||
<LineId Id="423" Count="0" />
|
||||
<LineId Id="422" Count="0" />
|
||||
<LineId Id="377" Count="0" />
|
||||
<LineId Id="449" Count="1" />
|
||||
<LineId Id="580" Count="0" />
|
||||
<LineId Id="579" Count="0" />
|
||||
<LineId Id="581" Count="0" />
|
||||
<LineId Id="584" Count="0" />
|
||||
<LineId Id="583" Count="0" />
|
||||
<LineId Id="586" Count="0" />
|
||||
<LineId Id="585" Count="0" />
|
||||
<LineId Id="587" Count="2" />
|
||||
<LineId Id="592" Count="0" />
|
||||
<LineId Id="591" Count="0" />
|
||||
<LineId Id="593" Count="2" />
|
||||
<LineId Id="452" Count="0" />
|
||||
<LineId Id="460" Count="1" />
|
||||
<LineId Id="451" Count="0" />
|
||||
<LineId Id="453" Count="1" />
|
||||
<LineId Id="463" Count="0" />
|
||||
<LineId Id="462" Count="0" />
|
||||
<LineId Id="455" Count="0" />
|
||||
<LineId Id="661" Count="0" />
|
||||
<LineId Id="660" Count="0" />
|
||||
<LineId Id="662" Count="4" />
|
||||
<LineId Id="668" Count="0" />
|
||||
<LineId Id="667" Count="0" />
|
||||
<LineId Id="669" Count="1" />
|
||||
<LineId Id="672" Count="0" />
|
||||
<LineId Id="671" Count="0" />
|
||||
<LineId Id="675" Count="0" />
|
||||
<LineId Id="903" Count="15" />
|
||||
<LineId Id="1226" Count="0" />
|
||||
<LineId Id="919" Count="32" />
|
||||
<LineId Id="1227" Count="0" />
|
||||
<LineId Id="952" Count="32" />
|
||||
<LineId Id="1228" Count="0" />
|
||||
<LineId Id="985" Count="32" />
|
||||
<LineId Id="1229" Count="0" />
|
||||
<LineId Id="1018" Count="135" />
|
||||
<LineId Id="674" Count="0" />
|
||||
</LineIds>
|
||||
<LineIds Name="FB_Module.FB_init">
|
||||
|
||||
@@ -4,7 +4,10 @@
|
||||
<Declaration><![CDATA[FUNCTION_BLOCK FB_String
|
||||
VAR_INPUT
|
||||
// Enable
|
||||
xEnable : BOOL;
|
||||
xEnable : BOOL;
|
||||
|
||||
// String in safety check mode
|
||||
xInSafetyCheckMode : BOOL;
|
||||
|
||||
// Module 1 HMI interface
|
||||
stHMIInterface : REFERENCE TO ST_STRING_HMI_INTERFACE;
|
||||
@@ -12,6 +15,9 @@ VAR_INPUT
|
||||
// Emergency stop ok
|
||||
xEmergencyStopOk : BOOL;
|
||||
|
||||
// Reset Safety
|
||||
xResetSafety : BOOL;
|
||||
|
||||
// Release alarms
|
||||
xReleaseErrors : BOOL;
|
||||
|
||||
@@ -40,9 +46,21 @@ VAR_OUTPUT
|
||||
// String completely off
|
||||
xOff : BOOL;
|
||||
|
||||
// Signal to close dc circuit breaker
|
||||
xCloseDCCB AT %Q* : BOOL;
|
||||
|
||||
// Signal that dc circuit breakers are closed
|
||||
xDCCBOpen AT %I* : BOOL;
|
||||
|
||||
// Reset signal for safety dc circuit breaker
|
||||
xResetSafetyDCCB AT %Q* : BOOL;
|
||||
|
||||
// All safetyinterlocks are ok
|
||||
xSafetyIntlksOk : BOOL;
|
||||
|
||||
// All modules in automatic mode
|
||||
xAllModulesInAutoMode : BOOL;
|
||||
|
||||
xError : BOOL;
|
||||
xWarning : BOOL;
|
||||
|
||||
@@ -68,6 +86,15 @@ VAR
|
||||
// Safetyinterlocks pending alarm
|
||||
_fbSafetyInterlocksNotOkAlarm : FB_TcAlarm;
|
||||
|
||||
// State for start and stop
|
||||
_iState : INT := 0;
|
||||
|
||||
// Timer for result pulse to safety
|
||||
_tonResetPulseLength : TON := (PT := T#250MS);
|
||||
|
||||
// Error timer for not closing dc relais
|
||||
_tonErrorDCCBNotClosed : TON := (PT := T#5S);
|
||||
|
||||
// String name
|
||||
_sName : STRING;
|
||||
END_VAR
|
||||
@@ -76,14 +103,21 @@ END_VAR
|
||||
<ST><![CDATA[// Reset error flag
|
||||
xError := FALSE;
|
||||
|
||||
// Reset all modules in automatic mode
|
||||
xAllModulesInAutoMode := TRUE;
|
||||
|
||||
// Reset safety interlocks flag
|
||||
xSafetyIntlksOk := TRUE;
|
||||
|
||||
// Reset Safety
|
||||
xResetSafetyDCCB := xResetSafety;
|
||||
|
||||
// ===============================
|
||||
// Module 1
|
||||
// ===============================
|
||||
_fbModule1(
|
||||
xEnable := xEnable,
|
||||
xInSafetyCheckMode := xInSafetyCheckMode,
|
||||
xEmergencyStopOk:= xEmergencyStopOk,
|
||||
stHMIInterface:= stHMIInterface.stHMIInterfaceModule1,
|
||||
xReleaseErrors:= xReleaseErrors,
|
||||
@@ -103,12 +137,18 @@ IF NOT _fbModule1.xSafetyIntlksOk THEN
|
||||
xSafetyIntlksOk := FALSE;
|
||||
END_IF
|
||||
|
||||
IF NOT _fbModule1.xAllUnitsInAutomatic THEN
|
||||
xAllModulesInAutoMode := FALSE;
|
||||
END_IF
|
||||
|
||||
|
||||
// ===============================
|
||||
// Module 2
|
||||
// ===============================
|
||||
|
||||
_fbModule2(
|
||||
xEnable := xEnable,
|
||||
xInSafetyCheckMode := xInSafetyCheckMode,
|
||||
xEmergencyStopOk:= xEmergencyStopOk,
|
||||
stHMIInterface:= stHMIInterface.stHMIInterfaceModule2,
|
||||
xReleaseErrors:= xReleaseErrors,
|
||||
@@ -128,12 +168,17 @@ IF NOT _fbModule2.xSafetyIntlksOk THEN
|
||||
xSafetyIntlksOk := FALSE;
|
||||
END_IF
|
||||
|
||||
IF NOT _fbModule2.xAllUnitsInAutomatic THEN
|
||||
xAllModulesInAutoMode := FALSE;
|
||||
END_IF
|
||||
|
||||
|
||||
// ===============================
|
||||
// Module 3
|
||||
// ===============================
|
||||
_fbModule3(
|
||||
xEnable := xEnable,
|
||||
xInSafetyCheckMode := xInSafetyCheckMode,
|
||||
xEmergencyStopOk:= xEmergencyStopOk,
|
||||
stHMIInterface:= stHMIInterface.stHMIInterfaceModule3,
|
||||
xReleaseErrors:= xReleaseErrors,
|
||||
@@ -153,6 +198,10 @@ IF NOT _fbModule3.xSafetyIntlksOk THEN
|
||||
xSafetyIntlksOk := FALSE;
|
||||
END_IF
|
||||
|
||||
IF NOT _fbModule3.xAllUnitsInAutomatic THEN
|
||||
xAllModulesInAutoMode := FALSE;
|
||||
END_IF
|
||||
|
||||
|
||||
// ===============================
|
||||
// Handle safety interlock alarm
|
||||
@@ -169,7 +218,7 @@ END_IF
|
||||
// ===============================
|
||||
// Modules ready check
|
||||
// ===============================
|
||||
_xAllModulesReady := _fbModule1.xReady AND _fbModule2.xReady AND _fbModule3.xReady;
|
||||
_xAllModulesReady := _fbModule1.xReady AND _fbModule3.xReady; // _fbModule2.xReady AND
|
||||
|
||||
|
||||
// ===============================
|
||||
@@ -240,7 +289,60 @@ END_IF
|
||||
// ===============================
|
||||
// String ready validation check
|
||||
// ===============================
|
||||
IF _xAllModulesReady AND _xBalanceOk THEN
|
||||
_tonResetPulseLength();
|
||||
_tonErrorDCCBNotClosed();
|
||||
|
||||
CASE _iState OF
|
||||
0: // Idle
|
||||
IF _xAllModulesReady AND _xBalanceOk AND xAllModulesInAutoMode THEN
|
||||
xCloseDCCB := TRUE;
|
||||
xResetSafetyDCCB := TRUE;
|
||||
_tonResetPulseLength.IN := TRUE;
|
||||
_iState := 10;
|
||||
END_IF
|
||||
|
||||
10: // Reset safety from sensors
|
||||
IF _tonResetPulseLength.Q THEN
|
||||
_tonResetPulseLength.IN := FALSE;
|
||||
xResetSafetyDCCB := FALSE;
|
||||
_tonErrorDCCBNotClosed.IN := TRUE;
|
||||
_iState := 20;
|
||||
END_IF
|
||||
|
||||
20: // Check if DC relais closed
|
||||
IF NOT xDCCBOpen THEN
|
||||
xReady := TRUE;
|
||||
_iState := 30;
|
||||
END_IF
|
||||
IF _tonErrorDCCBNotClosed.Q THEN
|
||||
_tonErrorDCCBNotClosed.IN := FALSE;
|
||||
xReady := FALSE;
|
||||
_iState := 1000;
|
||||
END_IF
|
||||
|
||||
30: // All modules ready
|
||||
// !!! ATTENTION !!!
|
||||
// BMS HAS TO SHUT DOWN THE INVERTER BEFORE DISSABLING THE STRING
|
||||
// OTHERWISE THE DC CIRCUIT BREAKERS WILL OPEN WHILE THE INVERTER IS STILL ACTIVE
|
||||
// THIS CAN DAMAGE THE INVERTER
|
||||
IF NOT xEnable THEN
|
||||
xCloseDCCB := FALSE;
|
||||
_iState := 0;
|
||||
ELSIF NOT _xAllModulesReady OR NOT _xBalanceOk THEN
|
||||
xError := TRUE;
|
||||
END_IF
|
||||
|
||||
1000: // Error state
|
||||
// Leave error state only if modules are deactivated
|
||||
IF NOT xEnable THEN
|
||||
_tonResetPulseLength.IN := FALSE;
|
||||
_tonErrorDCCBNotClosed.IN := FALSE;
|
||||
_iState := 0;
|
||||
END_IF
|
||||
END_CASE
|
||||
|
||||
|
||||
IF _xAllModulesReady AND _xBalanceOk AND (_iState = 30) THEN
|
||||
xReady := TRUE;
|
||||
ELSE
|
||||
xReady := FALSE;
|
||||
@@ -318,14 +420,21 @@ _fbSafetyInterlocksNotOkAlarm.ipArguments.Clear().AddString(_sName);]]></ST>
|
||||
<LineIds Name="FB_String">
|
||||
<LineId Id="266" Count="0" />
|
||||
<LineId Id="268" Count="0" />
|
||||
<LineId Id="758" Count="0" />
|
||||
<LineId Id="757" Count="0" />
|
||||
<LineId Id="759" Count="0" />
|
||||
<LineId Id="335" Count="0" />
|
||||
<LineId Id="334" Count="0" />
|
||||
<LineId Id="336" Count="0" />
|
||||
<LineId Id="867" Count="0" />
|
||||
<LineId Id="866" Count="0" />
|
||||
<LineId Id="870" Count="0" />
|
||||
<LineId Id="267" Count="0" />
|
||||
<LineId Id="69" Count="0" />
|
||||
<LineId Id="67" Count="1" />
|
||||
<LineId Id="47" Count="0" />
|
||||
<LineId Id="140" Count="0" />
|
||||
<LineId Id="875" Count="0" />
|
||||
<LineId Id="48" Count="0" />
|
||||
<LineId Id="50" Count="2" />
|
||||
<LineId Id="600" Count="0" />
|
||||
@@ -339,22 +448,33 @@ _fbSafetyInterlocksNotOkAlarm.ipArguments.Clear().AddString(_sName);]]></ST>
|
||||
<LineId Id="338" Count="0" />
|
||||
<LineId Id="337" Count="0" />
|
||||
<LineId Id="339" Count="1" />
|
||||
<LineId Id="71" Count="5" />
|
||||
<LineId Id="761" Count="0" />
|
||||
<LineId Id="760" Count="0" />
|
||||
<LineId Id="762" Count="1" />
|
||||
<LineId Id="71" Count="4" />
|
||||
<LineId Id="871" Count="0" />
|
||||
<LineId Id="76" Count="0" />
|
||||
<LineId Id="141" Count="0" />
|
||||
<LineId Id="876" Count="0" />
|
||||
<LineId Id="77" Count="3" />
|
||||
<LineId Id="601" Count="0" />
|
||||
<LineId Id="81" Count="7" />
|
||||
<LineId Id="70" Count="0" />
|
||||
<LineId Id="342" Count="2" />
|
||||
<LineId Id="341" Count="0" />
|
||||
<LineId Id="765" Count="2" />
|
||||
<LineId Id="764" Count="0" />
|
||||
<LineId Id="90" Count="5" />
|
||||
<LineId Id="142" Count="0" />
|
||||
<LineId Id="877" Count="0" />
|
||||
<LineId Id="96" Count="3" />
|
||||
<LineId Id="602" Count="0" />
|
||||
<LineId Id="100" Count="7" />
|
||||
<LineId Id="89" Count="0" />
|
||||
<LineId Id="346" Count="2" />
|
||||
<LineId Id="345" Count="0" />
|
||||
<LineId Id="769" Count="2" />
|
||||
<LineId Id="768" Count="0" />
|
||||
<LineId Id="433" Count="1" />
|
||||
<LineId Id="432" Count="0" />
|
||||
<LineId Id="435" Count="4" />
|
||||
@@ -386,7 +506,48 @@ _fbSafetyInterlocksNotOkAlarm.ipArguments.Clear().AddString(_sName);]]></ST>
|
||||
<LineId Id="215" Count="5" />
|
||||
<LineId Id="353" Count="13" />
|
||||
<LineId Id="352" Count="0" />
|
||||
<LineId Id="221" Count="5" />
|
||||
<LineId Id="221" Count="3" />
|
||||
<LineId Id="704" Count="0" />
|
||||
<LineId Id="725" Count="1" />
|
||||
<LineId Id="690" Count="0" />
|
||||
<LineId Id="692" Count="0" />
|
||||
<LineId Id="694" Count="1" />
|
||||
<LineId Id="710" Count="0" />
|
||||
<LineId Id="703" Count="0" />
|
||||
<LineId Id="697" Count="0" />
|
||||
<LineId Id="696" Count="0" />
|
||||
<LineId Id="698" Count="2" />
|
||||
<LineId Id="705" Count="0" />
|
||||
<LineId Id="711" Count="0" />
|
||||
<LineId Id="735" Count="0" />
|
||||
<LineId Id="712" Count="0" />
|
||||
<LineId Id="706" Count="0" />
|
||||
<LineId Id="713" Count="0" />
|
||||
<LineId Id="719" Count="0" />
|
||||
<LineId Id="734" Count="0" />
|
||||
<LineId Id="745" Count="0" />
|
||||
<LineId Id="739" Count="1" />
|
||||
<LineId Id="720" Count="0" />
|
||||
<LineId Id="744" Count="0" />
|
||||
<LineId Id="746" Count="0" />
|
||||
<LineId Id="727" Count="1" />
|
||||
<LineId Id="718" Count="0" />
|
||||
<LineId Id="714" Count="0" />
|
||||
<LineId Id="750" Count="3" />
|
||||
<LineId Id="741" Count="0" />
|
||||
<LineId Id="749" Count="0" />
|
||||
<LineId Id="742" Count="1" />
|
||||
<LineId Id="716" Count="1" />
|
||||
<LineId Id="729" Count="1" />
|
||||
<LineId Id="738" Count="0" />
|
||||
<LineId Id="731" Count="0" />
|
||||
<LineId Id="736" Count="1" />
|
||||
<LineId Id="732" Count="1" />
|
||||
<LineId Id="693" Count="0" />
|
||||
<LineId Id="691" Count="0" />
|
||||
<LineId Id="689" Count="0" />
|
||||
<LineId Id="225" Count="0" />
|
||||
<LineId Id="747" Count="0" />
|
||||
<LineId Id="239" Count="1" />
|
||||
<LineId Id="214" Count="0" />
|
||||
<LineId Id="512" Count="0" />
|
||||
|
||||
@@ -12,6 +12,9 @@ VAR_INPUT
|
||||
// Start unit
|
||||
xEnable : BOOL;
|
||||
|
||||
// Unit in safety check mode
|
||||
xInSafetyCheckMode : BOOL;
|
||||
|
||||
// Emergency stop ok
|
||||
xEmergencyStopOk : BOOL;
|
||||
|
||||
@@ -60,6 +63,9 @@ VAR_OUTPUT
|
||||
|
||||
// Current Unit voltage
|
||||
rCurrentVoltage : REAL;
|
||||
|
||||
// All components in automatic mode
|
||||
xAllComponentsInAuto : BOOL;
|
||||
END_VAR
|
||||
VAR
|
||||
// Check unit condition after some time during startup
|
||||
@@ -149,6 +155,11 @@ VAR
|
||||
|
||||
// Manual mode allowed flag
|
||||
_xReleaseManualMode : BOOL;
|
||||
|
||||
_xReleaseSignalDeltaPSegment : FB_ReleaseSignal;
|
||||
_xDeltaPSegmentInletToHigh : BOOL;
|
||||
_xEnableCheckForDeltaPSegmentInlet : BOOL;
|
||||
_xErrorDeltaPSegmentInlet : BOOL;
|
||||
END_VAR
|
||||
]]></Declaration>
|
||||
<Implementation>
|
||||
@@ -475,6 +486,25 @@ IF _fbVoltageSegment.xWarning THEN
|
||||
_xWarningActive := TRUE;
|
||||
END_IF
|
||||
|
||||
// ===============================
|
||||
// Write Voltage to HMI
|
||||
// ===============================
|
||||
stHMIInterface.rVoltage := _fbVoltageSegment.rScaledValue;
|
||||
|
||||
// ===============================
|
||||
// Check for pressure difference
|
||||
// ===============================
|
||||
_xDeltaPSegmentInletToHigh := (ABS(_fbPressurePosolytSegmentInlet.rScaledValue - _fbPressureNegolytSegmentInlet.rScaledValue) > GVL_CONFIG.stUnitConfig.rMaxDeltaPSegmentInlet);
|
||||
_xReleaseSignalDeltaPSegment(
|
||||
xSignal:= _xDeltaPSegmentInletToHigh,
|
||||
xRelease:= _xEnableCheckForDeltaPSegmentInlet,
|
||||
timOnDelay:= T#5S,
|
||||
timOffDelay:= T#2S,
|
||||
xReleaseSignal=> _xErrorDeltaPSegmentInlet);
|
||||
|
||||
IF _xErrorDeltaPSegmentInlet THEN
|
||||
_xErrorActive := TRUE;
|
||||
END_IF
|
||||
|
||||
// ===============================
|
||||
// Check if all components are in automatic
|
||||
@@ -529,6 +559,7 @@ CASE _iState OF
|
||||
20: // Start pumps
|
||||
_fbPosolytPumpInlet.ReqAutomaticStart();
|
||||
_fbNegolytPumpInlet.ReqAutomaticStart();
|
||||
_xEnableCheckForDeltaPSegmentInlet := TRUE;
|
||||
_iState := 25;
|
||||
|
||||
25: // Wait for all pumps to run
|
||||
@@ -548,11 +579,15 @@ CASE _iState OF
|
||||
IF _tonStartupCheck.Q THEN
|
||||
_tonStartupCheck(In := FALSE);
|
||||
// Check for minimum unit voltage
|
||||
IF (_fbVoltageSegment.rScaledValue >= GVL_CONFIG.rMinimumUnitVoltage)
|
||||
AND NOT _xErrorActive
|
||||
AND NOT _xWarningActive THEN
|
||||
// (_fbVoltageSegment.rScaledValue >= GVL_CONFIG.rMinimumUnitVoltage) AND
|
||||
IF NOT _xErrorActive AND NOT _xWarningActive THEN
|
||||
xReady := TRUE;
|
||||
_xEnableVoltageLimitChecks := TRUE;
|
||||
|
||||
// Only enable Voltage Cheks if not in safety check mode
|
||||
IF NOT xInSafetyCheckMode THEN
|
||||
_xEnableVoltageLimitChecks := TRUE;
|
||||
END_IF
|
||||
|
||||
_iState := 35;
|
||||
ELSE
|
||||
_iState := 40;
|
||||
@@ -577,6 +612,7 @@ CASE _iState OF
|
||||
40: // Close all valves
|
||||
_fbNegolytValveTankOutlet.ReqAutomaticClose();
|
||||
_fbPosolytValveTankOutlet.ReqAutomaticClose();
|
||||
_xEnableCheckForDeltaPSegmentInlet := FALSE;
|
||||
_iState := 45;
|
||||
|
||||
45: // Wait for valves to be closed
|
||||
@@ -667,7 +703,12 @@ END_CASE
|
||||
// Output error and warning flags
|
||||
// ===============================
|
||||
xError := _xErrorActive;
|
||||
xWarning := _xWarningActive;]]></ST>
|
||||
xWarning := _xWarningActive;
|
||||
|
||||
// ===============================
|
||||
// Output all components in auto mode
|
||||
// ===============================
|
||||
xAllComponentsInAuto := _xAllComponentsInAutomatic;]]></ST>
|
||||
</Implementation>
|
||||
<Method Name="FB_init" Id="{08f1cd44-6483-4d20-ab45-d1938e8ec885}">
|
||||
<Declaration><![CDATA[METHOD FB_init : BOOL
|
||||
@@ -760,7 +801,18 @@ _fbNotAllAutomaticAlarm.ipArguments.Clear().AddString(_sName);]]></ST>
|
||||
<LineId Id="4937" Count="0" />
|
||||
<LineId Id="4635" Count="8" />
|
||||
<LineId Id="4620" Count="0" />
|
||||
<LineId Id="4644" Count="1" />
|
||||
<LineId Id="6068" Count="1" />
|
||||
<LineId Id="6253" Count="2" />
|
||||
<LineId Id="6070" Count="0" />
|
||||
<LineId Id="4644" Count="0" />
|
||||
<LineId Id="6071" Count="1" />
|
||||
<LineId Id="6079" Count="0" />
|
||||
<LineId Id="6081" Count="4" />
|
||||
<LineId Id="6080" Count="0" />
|
||||
<LineId Id="6088" Count="0" />
|
||||
<LineId Id="6075" Count="0" />
|
||||
<LineId Id="6089" Count="1" />
|
||||
<LineId Id="4645" Count="0" />
|
||||
<LineId Id="4414" Count="0" />
|
||||
<LineId Id="4647" Count="0" />
|
||||
<LineId Id="4646" Count="0" />
|
||||
@@ -775,21 +827,32 @@ _fbNotAllAutomaticAlarm.ipArguments.Clear().AddString(_sName);]]></ST>
|
||||
<LineId Id="5249" Count="0" />
|
||||
<LineId Id="4453" Count="10" />
|
||||
<LineId Id="5076" Count="0" />
|
||||
<LineId Id="4464" Count="6" />
|
||||
<LineId Id="4464" Count="5" />
|
||||
<LineId Id="6091" Count="0" />
|
||||
<LineId Id="4470" Count="0" />
|
||||
<LineId Id="4476" Count="15" />
|
||||
<LineId Id="4790" Count="0" />
|
||||
<LineId Id="4492" Count="1" />
|
||||
<LineId Id="4926" Count="1" />
|
||||
<LineId Id="4492" Count="0" />
|
||||
<LineId Id="5903" Count="0" />
|
||||
<LineId Id="4493" Count="0" />
|
||||
<LineId Id="4496" Count="0" />
|
||||
<LineId Id="5908" Count="0" />
|
||||
<LineId Id="5912" Count="0" />
|
||||
<LineId Id="5910" Count="0" />
|
||||
<LineId Id="4794" Count="0" />
|
||||
<LineId Id="4497" Count="12" />
|
||||
<LineId Id="5909" Count="0" />
|
||||
<LineId Id="4497" Count="0" />
|
||||
<LineId Id="5911" Count="0" />
|
||||
<LineId Id="4498" Count="11" />
|
||||
<LineId Id="4511" Count="1" />
|
||||
<LineId Id="5078" Count="0" />
|
||||
<LineId Id="5083" Count="0" />
|
||||
<LineId Id="5079" Count="0" />
|
||||
<LineId Id="5082" Count="0" />
|
||||
<LineId Id="5081" Count="0" />
|
||||
<LineId Id="4513" Count="7" />
|
||||
<LineId Id="4513" Count="3" />
|
||||
<LineId Id="6092" Count="0" />
|
||||
<LineId Id="4517" Count="3" />
|
||||
<LineId Id="5239" Count="0" />
|
||||
<LineId Id="4521" Count="5" />
|
||||
<LineId Id="5441" Count="0" />
|
||||
@@ -838,6 +901,9 @@ _fbNotAllAutomaticAlarm.ipArguments.Clear().AddString(_sName);]]></ST>
|
||||
<LineId Id="4549" Count="5" />
|
||||
<LineId Id="4556" Count="6" />
|
||||
<LineId Id="2754" Count="0" />
|
||||
<LineId Id="5747" Count="0" />
|
||||
<LineId Id="5746" Count="0" />
|
||||
<LineId Id="5748" Count="2" />
|
||||
</LineIds>
|
||||
<LineIds Name="FB_Unit.FB_init">
|
||||
<LineId Id="11" Count="0" />
|
||||
|
||||
@@ -4,6 +4,7 @@
|
||||
<Declaration><![CDATA[PROGRAM MAIN
|
||||
VAR
|
||||
_xEmergencyStopOk AT %I* : BOOL;
|
||||
_xShowAckEmergencyStop AT %Q* : BOOL;
|
||||
_xReleaseErrors : BOOL := TRUE;
|
||||
_xReleaseLimitsErrors : BOOL := TRUE;
|
||||
_xConfirmAlarms : BOOL;
|
||||
@@ -23,6 +24,13 @@ VAR
|
||||
|
||||
// State machine state
|
||||
_iState : INT;
|
||||
_iStateSafetyCheck : INT;
|
||||
|
||||
// Start safety check mode
|
||||
_xStartSafetyCheck : BOOL;
|
||||
|
||||
// Auto remote and auto local power request
|
||||
_rAutoPowerRequest : REAL;
|
||||
|
||||
// Internal inverter power
|
||||
_rPowerInverter : REAL;
|
||||
@@ -64,8 +72,20 @@ VAR
|
||||
_fbUPS : FB_S_UPS_BAPI;
|
||||
|
||||
// Safety
|
||||
xSafetyRun AT %Q* : BOOL;
|
||||
xSafetyRun AT %Q* : BOOL := TRUE;
|
||||
xSafetyErrAck AT %Q* : BOOL;
|
||||
xSafetyResterTaster AT %I* : BOOL;
|
||||
|
||||
// Hardware reset button
|
||||
_xHarwareResetButton AT %I* : BOOL;
|
||||
_xShowErrorOnButton AT %Q* : BOOL;
|
||||
_tonHardwareResetButton : TON := (PT := T#1S);
|
||||
_rtHardwareResetButton : R_TRIG;
|
||||
|
||||
_xErrorActive : BOOL;
|
||||
|
||||
// Battery in safety check mode
|
||||
_xInSafetyCheckMode : BOOL;
|
||||
|
||||
// DEBUG
|
||||
_xRestart : BOOL;
|
||||
@@ -83,10 +103,22 @@ IF _xRestart AND (_iState = 0) THEN
|
||||
_xRestart := FALSE;
|
||||
GVL_MODBUS.stModbusEMSComm.stModbusReg12.diSetpointActivePower := 1000;
|
||||
END_IF
|
||||
|
||||
// DEBUG
|
||||
// ===============================
|
||||
_xErrorActive := FALSE;
|
||||
|
||||
// ===============================
|
||||
// Safety
|
||||
// ===============================
|
||||
xSafetyErrAck := xSafetyResterTaster;
|
||||
_xShowAckEmergencyStop := NOT _xEmergencyStopOk;
|
||||
|
||||
// ===============================
|
||||
// Hardware reset button part 1
|
||||
// ===============================
|
||||
_tonHardwareResetButton(IN := _xHarwareResetButton);
|
||||
_rtHardwareResetButton(CLK := _tonHardwareResetButton.Q);
|
||||
_xConfirmAlarms := TRUE;
|
||||
|
||||
// ===============================
|
||||
// Handle Manual mode release
|
||||
@@ -129,12 +161,23 @@ END_IF
|
||||
// Call string 1
|
||||
_fbString(
|
||||
xEnable := _xEnableString,
|
||||
xInSafetyCheckMode := _xInSafetyCheckMode,
|
||||
stHMIInterface:= GVL_SCADA.stHMIInterface,
|
||||
xEmergencyStopOk:= _xEmergencyStopOk,
|
||||
xReleaseErrors:= _xReleaseErrors AND _tonStartupDelay.Q,
|
||||
xReleaseLimitErrors:= _xReleaseLimitsErrors AND _tonStartupDelay.Q,
|
||||
xReleaseManualMode := _xReleaseManualMode,
|
||||
xConfirmAlarms:= _xConfirmAlarms);
|
||||
xConfirmAlarms:= _xConfirmAlarms,
|
||||
xResetSafety := xSafetyResterTaster);
|
||||
|
||||
IF _fbString.xError THEN
|
||||
_xErrorActive := TRUE;
|
||||
END_IF
|
||||
|
||||
// ===============================
|
||||
// Hardware reset button part 2
|
||||
// ===============================
|
||||
_xShowErrorOnButton := _xErrorActive;
|
||||
|
||||
// HMI Feedback
|
||||
GVL_SCADA.stHMIInterface.rVoltage := _fbString.rCurrentVoltage;
|
||||
@@ -184,48 +227,50 @@ _fbADSReader(
|
||||
// ===============================
|
||||
CASE _eBMSControlMode OF
|
||||
E_BMS_CONTROL_MODE.AUTO_REMOTE:
|
||||
SM_AUTO_REMOTE();
|
||||
_xInSafetyCheckMode := FALSE;
|
||||
_rAutoPowerRequest := DINT_TO_REAL(GVL_MODBUS.stModbusEMSComm.stModbusReg12.diSetpointActivePower);
|
||||
SM_AUTO();
|
||||
|
||||
E_BMS_CONTROL_MODE.AUTO_LOCAL:
|
||||
_xInSafetyCheckMode := FALSE;
|
||||
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eBatteryStatus := E_BATTERY_STATUS.TESTING;
|
||||
SM_AUTO_LOCAL();
|
||||
_rAutoPowerRequest := DINT_TO_REAL(GVL_SCADA.stAutomaticModeHMI.diSetpointAutomatic);
|
||||
SM_AUTO();
|
||||
|
||||
E_BMS_CONTROL_MODE.MANUAL:
|
||||
_xInSafetyCheckMode := FALSE;
|
||||
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eBatteryStatus := E_BATTERY_STATUS.MAINTENANCE;
|
||||
SM_MANUAL();
|
||||
|
||||
E_BMS_CONTROL_MODE.SAFETY_CHECK:
|
||||
_xInSafetyCheckMode := TRUE;
|
||||
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eBatteryStatus := E_BATTERY_STATUS.MAINTENANCE;
|
||||
SM_SAFETY_CHECK();
|
||||
|
||||
E_BMS_CONTROL_MODE.CAPACITY_TEST:
|
||||
_xInSafetyCheckMode := FALSE;
|
||||
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eBatteryStatus := E_BATTERY_STATUS.TESTING;
|
||||
SM_CAPACITY_TEST();
|
||||
END_CASE
|
||||
|
||||
|
||||
// Reset alarm confirmation
|
||||
IF _xConfirmAlarms THEN
|
||||
IF _xConfirmAlarms OR _rtHardwareResetButton.Q THEN
|
||||
_xConfirmAlarms := FALSE;
|
||||
END_IF]]></ST>
|
||||
</Implementation>
|
||||
<Action Name="SM_AUTO_LOCAL" Id="{def23375-eebc-4fdc-90a2-71266ffc4850}">
|
||||
<Implementation>
|
||||
<ST><![CDATA[]]></ST>
|
||||
</Implementation>
|
||||
</Action>
|
||||
<Action Name="SM_AUTO_REMOTE" Id="{b5166e16-4fea-442b-9560-02c156f9a9ad}">
|
||||
<Action Name="SM_AUTO" Id="{b5166e16-4fea-442b-9560-02c156f9a9ad}">
|
||||
<Implementation>
|
||||
<ST><![CDATA[CASE _iState OF
|
||||
0: // Idle
|
||||
// Wait for power command
|
||||
IF (ABS(GVL_MODBUS.stModbusEMSComm.stModbusReg12.diSetpointActivePower) > GVL_CONFIG.diMinimumAbsPowerForEnable) AND _fbString.xSafetyIntlksOk AND (NOT _fbString.xError) THEN
|
||||
IF (ABS(_rAutoPowerRequest) > DINT_TO_REAL(GVL_CONFIG.diMinimumAbsPowerForEnable)) AND _fbString.xSafetyIntlksOk AND (NOT _fbString.xError) AND _fbString.xAllModulesInAutoMode THEN
|
||||
_iState := 5;
|
||||
END_IF
|
||||
|
||||
5: // Check if power command is within limits
|
||||
IF GVL_MODBUS.stModbusEMSComm.stModbusReg12.diSetpointActivePower < GVL_CONFIG.diMaxStringDischargePower
|
||||
AND GVL_MODBUS.stModbusEMSComm.stModbusReg12.diSetpointActivePower > GVL_CONFIG.diMaxStringChargingPower THEN
|
||||
IF _rAutoPowerRequest < DINT_TO_REAL(GVL_CONFIG.diMaxStringDischargePower)
|
||||
AND _rAutoPowerRequest > DINT_TO_REAL(GVL_CONFIG.diMaxStringChargingPower) THEN
|
||||
_xEnableString := TRUE;
|
||||
_iState := 10;
|
||||
ELSE
|
||||
@@ -238,15 +283,12 @@ END_IF]]></ST>
|
||||
|
||||
10: // Wait for string to be ready
|
||||
IF _fbString.xReady AND (NOT _fbString.xError) THEN
|
||||
_rPowerInverter := 0.0;
|
||||
_xEnableInverter := TRUE;
|
||||
_iState := 20;
|
||||
END_IF
|
||||
|
||||
20: // Start main inverter with zero power
|
||||
_rPowerInverter := 0.0;
|
||||
_xEnableInverter := TRUE;
|
||||
_iState := 25;
|
||||
|
||||
25: // Wait for inverter to be ready
|
||||
20: // Wait for inverter to be ready
|
||||
IF _fbInverter.xActive AND (NOT _fbInverter.xError) THEN
|
||||
// Set battery status for modbus
|
||||
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eBatteryStatus := E_BATTERY_STATUS.ACTIVE;
|
||||
@@ -261,21 +303,20 @@ END_IF]]></ST>
|
||||
|
||||
30: // String and inverter enabled
|
||||
// Set inverter power to modbus requested power
|
||||
_rPowerInverter := DINT_TO_REAL(GVL_MODBUS.stModbusEMSComm.stModbusReg12.diSetpointActivePower);//DINT_TO_REAL(GVL_MODBUS.stModbusEMSComm.stModbusReg12.diSetpointActivePower);
|
||||
_rPowerInverter := _rAutoPowerRequest;//DINT_TO_REAL(GVL_MODBUS.stModbusEMSComm.stModbusReg12.diSetpointActivePower);
|
||||
|
||||
// Check if the battery should still be active
|
||||
IF (GVL_MODBUS.stModbusEMSComm.stModbusReg12.diSetpointActivePower = 0) THEN
|
||||
IF (_rAutoPowerRequest = 0.0) THEN
|
||||
_xNoPowerRequested := TRUE;
|
||||
ELSE
|
||||
_xNoPowerRequested := FALSE;
|
||||
END_IF
|
||||
|
||||
// Set battery status
|
||||
IF GVL_MODBUS.stModbusEMSComm.stModbusReg12.diSetpointActivePower > 0 THEN
|
||||
IF _rAutoPowerRequest > 0 THEN
|
||||
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eChargeStatus := E_CHARGE_STATUS.DISCHARGING;
|
||||
ELSIF GVL_MODBUS.stModbusEMSComm.stModbusReg12.diSetpointActivePower < 0 THEN
|
||||
ELSIF _rAutoPowerRequest < 0 THEN
|
||||
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eChargeStatus := E_CHARGE_STATUS.CHARGING;
|
||||
|
||||
ELSE
|
||||
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eChargeStatus := E_CHARGE_STATUS.UNDEFINED;
|
||||
END_IF
|
||||
@@ -385,7 +426,7 @@ END_IF]]></ST>
|
||||
_iState := 1010;
|
||||
|
||||
1010: // Wait for reset from error state
|
||||
IF (GVL_MODBUS.stModbusEMSComm.stModbusReg12.diSetpointActivePower = 0) AND (NOT _fbString.xError) AND (NOT _fbInverter.xError) THEN
|
||||
IF (_rAutoPowerRequest = 0.0) AND (NOT _fbString.xError) AND (NOT _fbInverter.xError) THEN
|
||||
// Reset modbus error register
|
||||
GVL_MODBUS.stModbusEMSComm.stModbusReg11.lwErrorBitmap := 0;
|
||||
|
||||
@@ -410,106 +451,115 @@ END_CASE]]></ST>
|
||||
</Action>
|
||||
<Action Name="SM_SAFETY_CHECK" Id="{6d8e5993-cf32-4980-9ea3-c1fbfa4b8601}">
|
||||
<Implementation>
|
||||
<ST><![CDATA[// start pumps
|
||||
|
||||
// open valves
|
||||
|
||||
// wait for equilibrium and voltage in range
|
||||
|
||||
// engange dc breakers
|
||||
|
||||
// wait for stop or error
|
||||
<ST><![CDATA[// wait for stop or error
|
||||
|
||||
// on stop: open dc circuit breakers and close valves
|
||||
|
||||
// wait for voltage to drop below xx volts
|
||||
|
||||
// stop pumps]]></ST>
|
||||
// stop pumps
|
||||
CASE _iStateSafetyCheck OF
|
||||
0: // Idle
|
||||
// Wait for power command
|
||||
IF _xStartSafetyCheck THEN
|
||||
_xEnableString := TRUE;
|
||||
_xEnableInverter := FALSE;
|
||||
_iStateSafetyCheck := 10;
|
||||
END_IF
|
||||
|
||||
10: // Wait for string to be ready
|
||||
IF _fbString.xReady AND (NOT _fbString.xError) THEN
|
||||
_iStateSafetyCheck := 30;
|
||||
END_IF
|
||||
|
||||
IF NOT _xStartSafetyCheck THEN
|
||||
_xEnableString := FALSE;
|
||||
_iStateSafetyCheck := 0;
|
||||
END_IF
|
||||
|
||||
30: // String enabled and dc circuit breaker closed
|
||||
// Check if the battery should still be active
|
||||
IF (NOT _xStartSafetyCheck) THEN
|
||||
// Start string shutdown
|
||||
_xEnableString := FALSE;
|
||||
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eChargeStatus := E_CHARGE_STATUS.UNDEFINED;
|
||||
GVL_MODBUS.stModbusEMSComm.stModbusReg10.uiActiveParallelMembers := 0;
|
||||
_iStateSafetyCheck := 45;
|
||||
END_IF
|
||||
|
||||
// Check for errors
|
||||
IF _fbString.xError THEN
|
||||
_iStateSafetyCheck := 1000;
|
||||
END_IF
|
||||
|
||||
45: // Wait for shutdown of string to be done
|
||||
IF _fbString.xOff THEN
|
||||
_iStateSafetyCheck := 0;
|
||||
END_IF
|
||||
|
||||
// Check for errors
|
||||
IF _fbString.xError THEN
|
||||
_iStateSafetyCheck := 1000;
|
||||
END_IF
|
||||
|
||||
1000: // Error state
|
||||
_xEnableString := FALSE;
|
||||
_xEnableInverter := FALSE;
|
||||
_rPowerInverter := 0.0;
|
||||
_iStateSafetyCheck := 1010;
|
||||
|
||||
1010: // Wait for reset from error state
|
||||
IF (NOT _fbString.xError) AND NOT _xStartSafetyCheck THEN
|
||||
// Goto init state
|
||||
_iStateSafetyCheck := 0;
|
||||
END_IF
|
||||
END_CASE]]></ST>
|
||||
</Implementation>
|
||||
</Action>
|
||||
<LineIds Name="MAIN">
|
||||
<LineId Id="405" Count="0" />
|
||||
<LineId Id="395" Count="0" />
|
||||
<LineId Id="400" Count="0" />
|
||||
<LineId Id="402" Count="1" />
|
||||
<LineId Id="399" Count="0" />
|
||||
<LineId Id="407" Count="0" />
|
||||
<LineId Id="406" Count="0" />
|
||||
<LineId Id="408" Count="0" />
|
||||
<LineId Id="410" Count="0" />
|
||||
<LineId Id="409" Count="0" />
|
||||
<LineId Id="534" Count="0" />
|
||||
<LineId Id="398" Count="0" />
|
||||
<LineId Id="404" Count="0" />
|
||||
<LineId Id="1187" Count="0" />
|
||||
<LineId Id="1185" Count="0" />
|
||||
<LineId Id="1179" Count="0" />
|
||||
<LineId Id="1178" Count="0" />
|
||||
<LineId Id="1186" Count="0" />
|
||||
<LineId Id="1180" Count="1" />
|
||||
<LineId Id="1183" Count="1" />
|
||||
<LineId Id="1182" Count="0" />
|
||||
<LineId Id="1188" Count="0" />
|
||||
<LineId Id="1029" Count="0" />
|
||||
<LineId Id="1028" Count="0" />
|
||||
<LineId Id="1030" Count="1" />
|
||||
<LineId Id="1037" Count="2" />
|
||||
<LineId Id="1041" Count="4" />
|
||||
<LineId Id="1033" Count="0" />
|
||||
<LineId Id="1032" Count="0" />
|
||||
<LineId Id="475" Count="0" />
|
||||
<LineId Id="396" Count="0" />
|
||||
<LineId Id="476" Count="0" />
|
||||
<LineId Id="478" Count="0" />
|
||||
<LineId Id="477" Count="0" />
|
||||
<LineId Id="397" Count="0" />
|
||||
<LineId Id="126" Count="1" />
|
||||
<LineId Id="971" Count="1" />
|
||||
<LineId Id="970" Count="0" />
|
||||
<LineId Id="974" Count="0" />
|
||||
<LineId Id="973" Count="0" />
|
||||
<LineId Id="975" Count="0" />
|
||||
<LineId Id="128" Count="7" />
|
||||
<LineId Id="1189" Count="0" />
|
||||
<LineId Id="136" Count="0" />
|
||||
<LineId Id="1101" Count="2" />
|
||||
<LineId Id="1105" Count="0" />
|
||||
<LineId Id="1109" Count="2" />
|
||||
<LineId Id="1114" Count="0" />
|
||||
<LineId Id="1118" Count="1" />
|
||||
<LineId Id="1115" Count="2" />
|
||||
<LineId Id="1108" Count="0" />
|
||||
<LineId Id="137" Count="8" />
|
||||
<LineId Id="147" Count="0" />
|
||||
<LineId Id="784" Count="3" />
|
||||
<LineId Id="598" Count="0" />
|
||||
<LineId Id="808" Count="0" />
|
||||
<LineId Id="793" Count="10" />
|
||||
<LineId Id="789" Count="0" />
|
||||
<LineId Id="958" Count="0" />
|
||||
<LineId Id="152" Count="3" />
|
||||
<LineId Id="1257" Count="1" />
|
||||
<LineId Id="1262" Count="2" />
|
||||
<LineId Id="1341" Count="0" />
|
||||
<LineId Id="1265" Count="0" />
|
||||
<LineId Id="1337" Count="1" />
|
||||
<LineId Id="1342" Count="0" />
|
||||
<LineId Id="1339" Count="0" />
|
||||
<LineId Id="1266" Count="1" />
|
||||
<LineId Id="1343" Count="0" />
|
||||
<LineId Id="1268" Count="2" />
|
||||
<LineId Id="1344" Count="0" />
|
||||
<LineId Id="1271" Count="0" />
|
||||
<LineId Id="1259" Count="0" />
|
||||
<LineId Id="663" Count="0" />
|
||||
<LineId Id="199" Count="3" />
|
||||
<LineId Id="1426" Count="10" />
|
||||
<LineId Id="1438" Count="1" />
|
||||
<LineId Id="1752" Count="0" />
|
||||
<LineId Id="1723" Count="0" />
|
||||
<LineId Id="1722" Count="0" />
|
||||
<LineId Id="1724" Count="1" />
|
||||
<LineId Id="1728" Count="0" />
|
||||
<LineId Id="1726" Count="0" />
|
||||
<LineId Id="1440" Count="0" />
|
||||
<LineId Id="1737" Count="0" />
|
||||
<LineId Id="1741" Count="1" />
|
||||
<LineId Id="1739" Count="0" />
|
||||
<LineId Id="1738" Count="0" />
|
||||
<LineId Id="1740" Count="0" />
|
||||
<LineId Id="1441" Count="41" />
|
||||
<LineId Id="1853" Count="0" />
|
||||
<LineId Id="1483" Count="5" />
|
||||
<LineId Id="1844" Count="0" />
|
||||
<LineId Id="1747" Count="3" />
|
||||
<LineId Id="1754" Count="3" />
|
||||
<LineId Id="1753" Count="0" />
|
||||
<LineId Id="1489" Count="48" />
|
||||
<LineId Id="1848" Count="0" />
|
||||
<LineId Id="1538" Count="3" />
|
||||
<LineId Id="1849" Count="0" />
|
||||
<LineId Id="1542" Count="0" />
|
||||
<LineId Id="1562" Count="0" />
|
||||
<LineId Id="1543" Count="2" />
|
||||
<LineId Id="1850" Count="0" />
|
||||
<LineId Id="1546" Count="3" />
|
||||
<LineId Id="1851" Count="0" />
|
||||
<LineId Id="1550" Count="3" />
|
||||
<LineId Id="1852" Count="0" />
|
||||
<LineId Id="1554" Count="7" />
|
||||
<LineId Id="25" Count="0" />
|
||||
</LineIds>
|
||||
<LineIds Name="MAIN.SM_AUTO_LOCAL">
|
||||
<LineId Id="1" Count="0" />
|
||||
</LineIds>
|
||||
<LineIds Name="MAIN.SM_AUTO_REMOTE">
|
||||
<LineId Id="2" Count="178" />
|
||||
<LineIds Name="MAIN.SM_AUTO">
|
||||
<LineId Id="2" Count="21" />
|
||||
<LineId Id="183" Count="1" />
|
||||
<LineId Id="182" Count="0" />
|
||||
<LineId Id="25" Count="0" />
|
||||
<LineId Id="31" Count="29" />
|
||||
<LineId Id="62" Count="118" />
|
||||
<LineId Id="1" Count="0" />
|
||||
</LineIds>
|
||||
<LineIds Name="MAIN.SM_CAPACITY_TEST">
|
||||
@@ -519,20 +569,31 @@ END_CASE]]></ST>
|
||||
<LineId Id="1" Count="0" />
|
||||
</LineIds>
|
||||
<LineIds Name="MAIN.SM_SAFETY_CHECK">
|
||||
<LineId Id="1" Count="0" />
|
||||
<LineId Id="3" Count="0" />
|
||||
<LineId Id="2" Count="0" />
|
||||
<LineId Id="5" Count="0" />
|
||||
<LineId Id="4" Count="0" />
|
||||
<LineId Id="7" Count="0" />
|
||||
<LineId Id="6" Count="0" />
|
||||
<LineId Id="9" Count="0" />
|
||||
<LineId Id="8" Count="0" />
|
||||
<LineId Id="15" Count="1" />
|
||||
<LineId Id="13" Count="0" />
|
||||
<LineId Id="12" Count="0" />
|
||||
<LineId Id="18" Count="0" />
|
||||
<LineId Id="17" Count="0" />
|
||||
<LineId Id="20" Count="3" />
|
||||
<LineId Id="198" Count="1" />
|
||||
<LineId Id="24" Count="1" />
|
||||
<LineId Id="39" Count="4" />
|
||||
<LineId Id="206" Count="2" />
|
||||
<LineId Id="210" Count="0" />
|
||||
<LineId Id="209" Count="0" />
|
||||
<LineId Id="62" Count="1" />
|
||||
<LineId Id="67" Count="1" />
|
||||
<LineId Id="202" Count="3" />
|
||||
<LineId Id="201" Count="0" />
|
||||
<LineId Id="72" Count="0" />
|
||||
<LineId Id="131" Count="2" />
|
||||
<LineId Id="135" Count="1" />
|
||||
<LineId Id="168" Count="2" />
|
||||
<LineId Id="172" Count="11" />
|
||||
<LineId Id="185" Count="3" />
|
||||
<LineId Id="195" Count="2" />
|
||||
<LineId Id="19" Count="0" />
|
||||
</LineIds>
|
||||
</POU>
|
||||
</TcPlcObject>
|
||||
Reference in New Issue
Block a user