Heisig_GmbH/Uniper_PLC
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

First string implemented

Browse Source
This commit is contained in:
Matthias Heisig
2024-04-18 08:32:21 +02:00
parent 9ce3522a70
commit b95033a155
64 changed files with 14526 additions and 6024 deletions
Download Patch File Download Diff File Expand all files Collapse all files

239
PLC/POUs/MAIN.TcPOU
View File

@@ -5,14 +5,17 @@
VAR
_xEmergencyStopOk AT %I* : BOOL;
_xShowAckEmergencyStop AT %Q* : BOOL;
_xString1DCSafetyOk AT %I* : BOOL;
_xReleaseErrors : BOOL := TRUE;
_xReleaseLimitsErrors : BOOL := TRUE;
_xConfirmAlarms : BOOL;
_xEnableString : BOOL;
_xEnableInverter : BOOL;
_xCanChangeMode : BOOL := TRUE;
{attribute 'OPC.UA.DA' := '0'}
_fbString : FB_String('String 1');
_afbStrings : ARRAY[0..1] OF FB_String[('String 1'), ('String 2')];
_fbInverter : FB_PowerSupplySunspec;
_stInverterData : ST_SUNSPEC_CURRENT_VALUES;
@@ -66,7 +69,7 @@ VAR
// Current BMS control mode (Auto local, Auto remote, etc...)
// On restart star in manual mode (so the ems can not directly start the bms)
_eBMSControlMode : E_BMS_CONTROL_MODE := E_BMS_CONTROL_MODE.MANUAL;
_eBMSControlMode : E_BMS_CONTROL_MODE := E_BMS_CONTROL_MODE.AUTO_LOCAL;
// UPS
_fbUPS : FB_S_UPS_BAPI;
@@ -87,6 +90,9 @@ VAR
// Battery in safety check mode
_xInSafetyCheckMode : BOOL;
// Safety
_fbSafety : FB_Safety;
// DEBUG
_xRestart : BOOL;
END_VAR
@@ -146,7 +152,8 @@ _fbUPS(
IF _xFirstCycle THEN
_xFirstCycle := FALSE;
_fbString.Name := 'String 1';
_afbStrings[0].Name := 'String 1';
_afbStrings[1].Name := 'String 2';
END_IF
// Dely release of errors during PLC startup phase
@@ -159,10 +166,11 @@ IF GVL_SCADA.stAckAlarmsButton.xRequest THEN
END_IF
// Call string 1
_fbString(
_afbStrings[0](
stStringModuleVoltageConfig := GVL_CONFIG.stString1VoltageConfig,
xEnable := _xEnableString,
xInSafetyCheckMode := _xInSafetyCheckMode,
stHMIInterface:= GVL_SCADA.stHMIInterface,
stHMIInterface:= GVL_SCADA.stHMIInterface[0],
xEmergencyStopOk:= _xEmergencyStopOk,
xReleaseErrors:= _xReleaseErrors AND _tonStartupDelay.Q,
xReleaseLimitErrors:= _xReleaseLimitsErrors AND _tonStartupDelay.Q,
@@ -170,7 +178,7 @@ _fbString(
xConfirmAlarms:= _xConfirmAlarms,
xResetSafety := xSafetyResterTaster);
IF _fbString.xError THEN
IF _afbStrings[0].xError THEN
_xErrorActive := TRUE;
END_IF
@@ -180,28 +188,28 @@ END_IF
_xShowErrorOnButton := _xErrorActive;
// HMI Feedback
GVL_SCADA.stHMIInterface.rVoltage := _fbString.rCurrentVoltage;
IF _fbString.eStatus = E_COMPONENT_STATUS.ON THEN
GVL_SCADA.stHMIInterface[0].rVoltage := _afbStrings[0].rCurrentVoltage;
IF _afbStrings[0].eStatus = E_COMPONENT_STATUS.ON THEN
IF _iState = 30 AND _rPowerInverter > 0 THEN
GVL_SCADA.stHMIInterface.eStatus := E_COMPONENT_STATUS.DISCHARGING;
GVL_SCADA.stHMIInterface[0].eStatus := E_COMPONENT_STATUS.DISCHARGING;
ELSIF _iState = 30 AND _rPowerInverter < 0 THEN
GVL_SCADA.stHMIInterface.eStatus := E_COMPONENT_STATUS.CHARGING;
GVL_SCADA.stHMIInterface[0].eStatus := E_COMPONENT_STATUS.CHARGING;
ELSE
GVL_SCADA.stHMIInterface.eStatus :=_fbString.eStatus;
GVL_SCADA.stHMIInterface[0].eStatus :=_afbStrings[0].eStatus;
END_IF
ELSE
GVL_SCADA.stHMIInterface.eStatus :=_fbString.eStatus;
GVL_SCADA.stHMIInterface[0].eStatus :=_afbStrings[0].eStatus;
END_IF
// DEACTIVATED FOR DEBUG REASONS !!!
// Call inverter
//_fbInverter(
// sInverterIPAddr:= GVL_CONFIG.sInverterIp,
// xEnable:= _xEnableInverter,
// rPower:= _rPowerInverter,
// xReset:= _xConfirmAlarms,
// rMaxBattPower:= DINT_TO_REAL(GVL_CONFIG.diMaxStringDischargePower),
// stCurrentValues => _stInverterData);
_fbInverter(
sInverterIPAddr:= GVL_CONFIG.sInverterIp,
xEnable:= _xEnableInverter,
rPower:= _rPowerInverter,
xReset:= _xConfirmAlarms,
rMaxBattPower:= DINT_TO_REAL(GVL_CONFIG.diMaxStringDischargePower),
stCurrentValues => _stInverterData);
// ===============================
@@ -253,6 +261,9 @@ CASE _eBMSControlMode OF
SM_CAPACITY_TEST();
END_CASE
GVL_SCADA.xCanChangeControlMode := _xCanChangeMode;
_fbSafety();
// Reset alarm confirmation
IF _xConfirmAlarms OR _rtHardwareResetButton.Q THEN
@@ -264,8 +275,9 @@ END_IF]]></ST>
<ST><![CDATA[CASE _iState OF
0: // Idle
// Wait for power command
IF (ABS(_rAutoPowerRequest) > DINT_TO_REAL(GVL_CONFIG.diMinimumAbsPowerForEnable)) AND _fbString.xSafetyIntlksOk AND (NOT _fbString.xError) AND _fbString.xAllModulesInAutoMode THEN
IF (ABS(_rAutoPowerRequest) > DINT_TO_REAL(GVL_CONFIG.diMinimumAbsPowerForEnable)) AND _afbStrings[0].xSafetyIntlksOk AND (NOT _afbStrings[0].xError) AND _afbStrings[0].xAllModulesInAutoMode THEN
_iState := 5;
_xCanChangeMode := FALSE;
END_IF
5: // Check if power command is within limits
@@ -282,11 +294,23 @@ END_IF]]></ST>
END_IF
10: // Wait for string to be ready
IF _fbString.xReady AND (NOT _fbString.xError) THEN
IF _afbStrings[0].xReady AND (NOT _afbStrings[0].xError) THEN
_rPowerInverter := 0.0;
_xEnableInverter := TRUE;
_iState := 20;
END_IF
IF _afbStrings[0].xError THEN
_xEnableInverter := FALSE;
_xEnableString := FALSE;
GVL_SCADA.stAutomaticModeHMI.diSetpointAutomatic := 0;
_iState := 45;
END_IF
IF (ABS(_rAutoPowerRequest) < DINT_TO_REAL(GVL_CONFIG.diMinimumAbsPowerForEnable)) THEN
_xEnableString := FALSE;
_iState := 45;
END_IF
20: // Wait for inverter to be ready
IF _fbInverter.xActive AND (NOT _fbInverter.xError) THEN
@@ -297,7 +321,10 @@ END_IF]]></ST>
END_IF
// Check for errors
IF _fbString.xError OR _fbInverter.xError THEN
IF _afbStrings[0].xError OR _fbInverter.xError THEN
_xEnableInverter := FALSE;
_xEnableString := FALSE;
GVL_SCADA.stAutomaticModeHMI.diSetpointAutomatic := 0;
_iState := 1000;
END_IF
@@ -339,7 +366,7 @@ END_IF]]></ST>
END_IF
// Shutdown triggered by battery fully charged
IF GVL_MODBUS.stModbusEMSComm.stModbusReg11.eChargeStatus = E_CHARGE_STATUS.CHARGING AND (_fbString.rCurrentVoltage >= GVL_CONFIG.rStringFullyChargedVoltage) THEN
IF GVL_MODBUS.stModbusEMSComm.stModbusReg11.eChargeStatus = E_CHARGE_STATUS.CHARGING AND (_afbStrings[0].rCurrentVoltage >= GVL_CONFIG.rStringFullyChargedVoltage) THEN
_tonBeginShutdown(In := FALSE);
// Set inverter to zero power
@@ -355,7 +382,7 @@ END_IF]]></ST>
END_IF
// Shutdown triggered by battery empty
IF GVL_MODBUS.stModbusEMSComm.stModbusReg11.eChargeStatus = E_CHARGE_STATUS.DISCHARGING AND (_fbString.rCurrentVoltage <= GVL_CONFIG.rStringEmptyVoltage) THEN
IF GVL_MODBUS.stModbusEMSComm.stModbusReg11.eChargeStatus = E_CHARGE_STATUS.DISCHARGING AND (_afbStrings[0].rCurrentVoltage <= GVL_CONFIG.rStringEmptyVoltage) THEN
_tonBeginShutdown(In := FALSE);
// Set inverter to zero power
@@ -371,52 +398,68 @@ END_IF]]></ST>
END_IF
// Check for errors
IF _fbString.xError OR _fbInverter.xError THEN
IF _afbStrings[0].xError OR (NOT _xString1DCSafetyOk) OR _fbInverter.xError THEN
_xEnableInverter := FALSE;
_xEnableString := FALSE;
_tonBeginShutdown(In := FALSE);
_iState := 1000;
GVL_SCADA.stAutomaticModeHMI.diSetpointAutomatic := 0;
_iState := 45;
END_IF
35: // Wait for string to be in shutdown discharge mode
IF _fbString.xInShutdownDischargeMode THEN
IF _afbStrings[0].xInShutdownDischargeMode THEN
// Check if we are allowed to discharge during shutdown with inverter
IF GVL_CONFIG.xShutdownDischargeWithInverter THEN
_iState := 40;
ELSE
_rPowerInverter := 0.0;
_xEnableInverter := FALSE;
_xEnableString := FALSE;
GVL_SCADA.stAutomaticModeHMI.diSetpointAutomatic := 0;
_iState := 45;
END_IF
END_IF
// Check for errors
IF _fbString.xError OR _fbInverter.xError THEN
IF _afbStrings[0].xError OR _fbInverter.xError THEN
_xEnableInverter := FALSE;
_iState := 1000;
END_IF
40: // Wait for inverter discharge done
IF _fbString.xShutdownDischargeAllowed THEN
IF _afbStrings[0].xShutdownDischargeAllowed THEN
_rPowerInverter := GVL_CONFIG.rAbsShutdownDischargePower;
ELSE
_rPowerInverter := 0.0;
GVL_SCADA.stAutomaticModeHMI.diSetpointAutomatic := 0;
_xEnableInverter := FALSE;
_xEnableString := FALSE;
_xCanChangeMode := TRUE;
_iState := 45;
END_IF
// Check for errors
IF _fbString.xError OR _fbInverter.xError THEN
IF _afbStrings[0].xError OR _fbInverter.xError THEN
_xEnableInverter := FALSE;
_iState := 1000;
END_IF
45: // Wait for shutdown of string to be done
IF (NOT _fbString.xInShutdownDischargeMode) AND _fbString.xOff THEN
IF (NOT _afbStrings[0].xInShutdownDischargeMode) AND _afbStrings[0].xOff THEN
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eBatteryStatus := E_BATTERY_STATUS.OFF;
_iState := 0;
END_IF
// Restart if possible
IF (ABS(_rAutoPowerRequest) > DINT_TO_REAL(GVL_CONFIG.diMinimumAbsPowerForEnable)) AND _afbStrings[0].xSafetyIntlksOk AND (NOT _afbStrings[0].xError) AND _afbStrings[0].xAllModulesInAutoMode THEN
_iState := 5;
END_IF
// Check for errors
IF _fbString.xError OR _fbInverter.xError THEN
_iState := 1000;
END_IF
// IF _afbStrings[0].xError OR _fbInverter.xError THEN
// _xEnableInverter := FALSE;
// _iState := 1000;
//END_IF
1000: // Error state
_xEnableString := FALSE;
@@ -426,7 +469,7 @@ END_IF]]></ST>
_iState := 1010;
1010: // Wait for reset from error state
IF (_rAutoPowerRequest = 0.0) AND (NOT _fbString.xError) AND (NOT _fbInverter.xError) THEN
IF (_rAutoPowerRequest = 0.0) AND (NOT _afbStrings[0].xError) AND (NOT _fbInverter.xError) THEN
// Reset modbus error register
GVL_MODBUS.stModbusEMSComm.stModbusReg11.lwErrorBitmap := 0;
@@ -435,6 +478,8 @@ END_IF]]></ST>
// Goto init state
_iState := 0;
_xCanChangeMode := TRUE;
END_IF
END_CASE]]></ST>
</Implementation>
@@ -446,7 +491,7 @@ END_CASE]]></ST>
</Action>
<Action Name="SM_MANUAL" Id="{ddef276e-9f4f-4258-b863-d254dd94b701}">
<Implementation>
<ST><![CDATA[]]></ST>
<ST><![CDATA[_xCanChangeMode := _afbStrings[0].xAllModulesInAutoMode;]]></ST>
</Implementation>
</Action>
<Action Name="SM_SAFETY_CHECK" Id="{6d8e5993-cf32-4980-9ea3-c1fbfa4b8601}">
@@ -461,14 +506,15 @@ END_CASE]]></ST>
CASE _iStateSafetyCheck OF
0: // Idle
// Wait for power command
IF _xStartSafetyCheck THEN
IF _xStartSafetyCheck AND _afbStrings[0].xAllModulesInAutoMode THEN
_xEnableString := TRUE;
_xEnableInverter := FALSE;
_iStateSafetyCheck := 10;
_xCanChangeMode := FALSE;
END_IF
10: // Wait for string to be ready
IF _fbString.xReady AND (NOT _fbString.xError) THEN
IF _afbStrings[0].xReady AND (NOT _afbStrings[0].xError) THEN
_iStateSafetyCheck := 30;
END_IF
@@ -477,6 +523,11 @@ CASE _iStateSafetyCheck OF
_iStateSafetyCheck := 0;
END_IF
// Check for errors
IF _afbStrings[0].xError THEN
_iStateSafetyCheck := 1000;
END_IF
30: // String enabled and dc circuit breaker closed
// Check if the battery should still be active
IF (NOT _xStartSafetyCheck) THEN
@@ -485,20 +536,21 @@ CASE _iStateSafetyCheck OF
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eChargeStatus := E_CHARGE_STATUS.UNDEFINED;
GVL_MODBUS.stModbusEMSComm.stModbusReg10.uiActiveParallelMembers := 0;
_iStateSafetyCheck := 45;
_xCanChangeMode := TRUE;
END_IF
// Check for errors
IF _fbString.xError THEN
IF _afbStrings[0].xError THEN
_iStateSafetyCheck := 1000;
END_IF
45: // Wait for shutdown of string to be done
IF _fbString.xOff THEN
IF _afbStrings[0].xOff THEN
_iStateSafetyCheck := 0;
END_IF
// Check for errors
IF _fbString.xError THEN
IF _afbStrings[0].xError THEN
_iStateSafetyCheck := 1000;
END_IF
@@ -509,57 +561,74 @@ CASE _iStateSafetyCheck OF
_iStateSafetyCheck := 1010;
1010: // Wait for reset from error state
IF (NOT _fbString.xError) AND NOT _xStartSafetyCheck THEN
IF (NOT _afbStrings[0].xError) AND NOT _xStartSafetyCheck THEN
// Goto init state
_iStateSafetyCheck := 0;
_xCanChangeMode := TRUE;
END_IF
END_CASE]]></ST>
</Implementation>
</Action>
<LineIds Name="MAIN">
<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="2032" Count="54" />
<LineId Id="2197" Count="0" />
<LineId Id="2087" Count="12" />
<LineId Id="2287" Count="0" />
<LineId Id="2100" Count="91" />
<LineId Id="2383" Count="0" />
<LineId Id="2192" Count="0" />
<LineId Id="2388" Count="0" />
<LineId Id="2387" Count="0" />
<LineId Id="2193" Count="3" />
<LineId Id="25" Count="0" />
</LineIds>
<LineIds Name="MAIN.SM_AUTO">
<LineId Id="2" Count="21" />
<LineId Id="2" Count="4" />
<LineId Id="195" Count="0" />
<LineId Id="7" Count="16" />
<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="185" Count="1" />
<LineId Id="189" Count="0" />
<LineId Id="205" Count="0" />
<LineId Id="214" Count="0" />
<LineId Id="187" Count="1" />
<LineId Id="200" Count="1" />
<LineId Id="203" Count="1" />
<LineId Id="202" Count="0" />
<LineId Id="31" Count="10" />
<LineId Id="190" Count="0" />
<LineId Id="216" Count="0" />
<LineId Id="215" Count="0" />
<LineId Id="42" Count="18" />
<LineId Id="62" Count="54" />
<LineId Id="191" Count="0" />
<LineId Id="206" Count="0" />
<LineId Id="117" Count="0" />
<LineId Id="217" Count="0" />
<LineId Id="118" Count="10" />
<LineId Id="207" Count="0" />
<LineId Id="218" Count="0" />
<LineId Id="129" Count="5" />
<LineId Id="192" Count="0" />
<LineId Id="135" Count="7" />
<LineId Id="219" Count="0" />
<LineId Id="143" Count="0" />
<LineId Id="208" Count="0" />
<LineId Id="196" Count="0" />
<LineId Id="144" Count="4" />
<LineId Id="193" Count="0" />
<LineId Id="149" Count="7" />
<LineId Id="209" Count="0" />
<LineId Id="213" Count="0" />
<LineId Id="210" Count="2" />
<LineId Id="157" Count="2" />
<LineId Id="194" Count="0" />
<LineId Id="160" Count="19" />
<LineId Id="198" Count="1" />
<LineId Id="180" Count="0" />
<LineId Id="1" Count="0" />
</LineIds>
<LineIds Name="MAIN.SM_CAPACITY_TEST">
@@ -577,22 +646,30 @@ END_CASE]]></ST>
<LineId Id="17" Count="0" />
<LineId Id="20" Count="3" />
<LineId Id="198" Count="1" />
<LineId Id="24" Count="1" />
<LineId Id="24" Count="0" />
<LineId Id="216" Count="0" />
<LineId Id="25" Count="0" />
<LineId Id="39" Count="4" />
<LineId Id="206" Count="2" />
<LineId Id="210" Count="0" />
<LineId Id="209" Count="0" />
<LineId Id="211" Count="0" />
<LineId Id="213" Count="2" />
<LineId Id="212" Count="0" />
<LineId Id="62" Count="1" />
<LineId Id="67" Count="1" />
<LineId Id="202" Count="3" />
<LineId Id="201" Count="0" />
<LineId Id="217" 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="195" Count="1" />
<LineId Id="218" Count="1" />
<LineId Id="197" Count="0" />
<LineId Id="19" Count="0" />
</LineIds>
</POU>