Files
Uniper_PLC/PLC/POUs/MAIN.TcPOU

538 lines
16 KiB
XML

<?xml version="1.0" encoding="utf-8"?>
<TcPlcObject Version="1.1.0.1" ProductVersion="3.1.4024.12">
<POU Name="MAIN" Id="{bbd7302c-91ce-4697-9f4b-743f57ca5819}" SpecialFunc="None">
<Declaration><![CDATA[PROGRAM MAIN
VAR
_xEmergencyStopOk AT %I* : BOOL;
_xReleaseErrors : BOOL := TRUE;
_xReleaseLimitsErrors : BOOL := TRUE;
_xConfirmAlarms : BOOL;
_xEnableString : BOOL;
_xEnableInverter : BOOL;
{attribute 'OPC.UA.DA' := '0'}
_fbString : FB_String('String 1');
_fbInverter : FB_PowerSupplySunspec;
_stInverterData : ST_SUNSPEC_CURRENT_VALUES;
// Variable to detect charge status change
_eLastChargeStatus : E_CHARGE_STATUS;
// Variable to detect battery status change
_eLastBatteryStatus : E_BATTERY_STATUS;
// State machine state
_iState : INT;
// Internal inverter power
_rPowerInverter : REAL;
// Flag for zero power indication
_xNoPowerRequested : BOOL;
// Startup delay for error release during plc startup
_tonStartupDelay : TON := (PT := T#10S);
// Small delay for inverter shutdown
_tonBeginShutdown : TON := (PT := T#30S);
// Not all strings in automatic mode
_fbNoAutomaticModeAlarm : Fb_TcAlarm;
// First cycle tag
_xFirstCycle : BOOL := TRUE;
// ADS reader for modbus server data
_fbADSReader : ADSREAD;
// Timer for ADS read
_timADSReadTimer : TON;
// Release manual mode
_xReleaseManualMode : BOOL;
// Current internal set inverter power value
_diInternalPowerSetpoint : DINT;
_diSetpointActivePower : DINT;
// 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;
// UPS
_fbUPS : FB_S_UPS_BAPI;
// Safety
xSafetyRun AT %Q* : BOOL;
xSafetyErrAck AT %Q* : BOOL;
// DEBUG
_xRestart : BOOL;
END_VAR
]]></Declaration>
<Implementation>
<ST><![CDATA[// ===============================
// DEBUG
IF _xRestart AND (_iState = 1010) THEN
GVL_MODBUS.stModbusEMSComm.stModbusReg12.diSetpointActivePower := 0;
_xConfirmAlarms := TRUE;
END_IF
IF _xRestart AND (_iState = 0) THEN
_xRestart := FALSE;
GVL_MODBUS.stModbusEMSComm.stModbusReg12.diSetpointActivePower := 1000;
END_IF
// DEBUG
// ===============================
// ===============================
// Handle Manual mode release
// ===============================
IF _iState = 0 THEN
_xReleaseManualMode := TRUE;
ELSE
_xReleaseManualMode := FALSE;
END_IF
// ===============================
// Handle UPS events
// ===============================
_fbUPS(
sNetID:= '',
iPLCPort:= 851,
tTimeout:= DEFAULT_ADS_TIMEOUT,
eUpsMode:= eSUPS_WrPersistData_Shutdown,
ePersistentMode:= SPDM_2PASS,
tRecoverTime:= T#10S,
bPowerFailDetect=> ,
eState=> );
IF _xFirstCycle THEN
_xFirstCycle := FALSE;
_fbString.Name := 'String 1';
END_IF
// Dely release of errors during PLC startup phase
_tonStartupDelay(IN := TRUE);
// Ack alarms from HMI
_xConfirmAlarms := GVL_SCADA.stAckAlarmsButton.xRequest;
IF GVL_SCADA.stAckAlarmsButton.xRequest THEN
GVL_SCADA.stAckAlarmsButton.xRequest := FALSE;
END_IF
// Call string 1
_fbString(
xEnable := _xEnableString,
stHMIInterface:= GVL_SCADA.stHMIInterface,
xEmergencyStopOk:= _xEmergencyStopOk,
xReleaseErrors:= _xReleaseErrors AND _tonStartupDelay.Q,
xReleaseLimitErrors:= _xReleaseLimitsErrors AND _tonStartupDelay.Q,
xReleaseManualMode := _xReleaseManualMode,
xConfirmAlarms:= _xConfirmAlarms);
// HMI Feedback
GVL_SCADA.stHMIInterface.rVoltage := _fbString.rCurrentVoltage;
IF _fbString.eStatus = E_COMPONENT_STATUS.ON THEN
IF _iState = 30 AND _rPowerInverter > 0 THEN
GVL_SCADA.stHMIInterface.eStatus := E_COMPONENT_STATUS.DISCHARGING;
ELSIF _iState = 30 AND _rPowerInverter < 0 THEN
GVL_SCADA.stHMIInterface.eStatus := E_COMPONENT_STATUS.CHARGING;
ELSE
GVL_SCADA.stHMIInterface.eStatus :=_fbString.eStatus;
END_IF
ELSE
GVL_SCADA.stHMIInterface.eStatus :=_fbString.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);
// ===============================
// Read modbus request count
// ===============================
_timADSReadTimer(IN := NOT _fbADSReader.BUSY, PT := T#200MS);
_fbADSReader(
NETID:= '',
PORT:= 10500,
IDXGRP:= 16#2000,
IDXOFFS:= 1,
LEN:= 4,
DESTADDR:= ADR(GVL_MODBUS.stModbusEMSComm.stModbusReg11.udiLifeMessage),
READ:= _timADSReadTimer.Q,
TMOUT:= T#1S,
BUSY=> ,
ERR=> ,
ERRID=> );
// ===============================
// State machine
// ===============================
CASE _eBMSControlMode OF
E_BMS_CONTROL_MODE.AUTO_REMOTE:
SM_AUTO_REMOTE();
E_BMS_CONTROL_MODE.AUTO_LOCAL:
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eBatteryStatus := E_BATTERY_STATUS.TESTING;
SM_AUTO_LOCAL();
E_BMS_CONTROL_MODE.MANUAL:
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eBatteryStatus := E_BATTERY_STATUS.MAINTENANCE;
SM_MANUAL();
E_BMS_CONTROL_MODE.SAFETY_CHECK:
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eBatteryStatus := E_BATTERY_STATUS.MAINTENANCE;
SM_SAFETY_CHECK();
E_BMS_CONTROL_MODE.CAPACITY_TEST:
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eBatteryStatus := E_BATTERY_STATUS.TESTING;
SM_CAPACITY_TEST();
END_CASE
// Reset alarm confirmation
IF _xConfirmAlarms 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}">
<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
_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
_xEnableString := TRUE;
_iState := 10;
ELSE
// Set error bitmap flag
GVL_MODBUS.stModbusEMSComm.stModbusReg11.lwErrorBitmap.0 := 1;
// Goto error state
_iState := 1000;
END_IF
10: // Wait for string to be ready
IF _fbString.xReady AND (NOT _fbString.xError) THEN
_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
IF _fbInverter.xActive AND (NOT _fbInverter.xError) THEN
// Set battery status for modbus
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eBatteryStatus := E_BATTERY_STATUS.ACTIVE;
GVL_MODBUS.stModbusEMSComm.stModbusReg10.uiActiveParallelMembers := 1;
_iState := 30;
END_IF
// Check for errors
IF _fbString.xError OR _fbInverter.xError THEN
_iState := 1000;
END_IF
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);
// Check if the battery should still be active
IF (GVL_MODBUS.stModbusEMSComm.stModbusReg12.diSetpointActivePower = 0) THEN
_xNoPowerRequested := TRUE;
ELSE
_xNoPowerRequested := FALSE;
END_IF
// Set battery status
IF GVL_MODBUS.stModbusEMSComm.stModbusReg12.diSetpointActivePower > 0 THEN
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eChargeStatus := E_CHARGE_STATUS.DISCHARGING;
ELSIF GVL_MODBUS.stModbusEMSComm.stModbusReg12.diSetpointActivePower < 0 THEN
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eChargeStatus := E_CHARGE_STATUS.CHARGING;
ELSE
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eChargeStatus := E_CHARGE_STATUS.UNDEFINED;
END_IF
// Add small delay before shutdown by EMS is detected
_tonBeginShutdown(IN := _xNoPowerRequested);
// shutdown triggered from EMS
IF _tonBeginShutdown.Q THEN
_tonBeginShutdown(In := FALSE);
// Set inverter to zero power
_rPowerInverter := 0.0;
// Start string shutdown
_xEnableString := FALSE;
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eChargeStatus := E_CHARGE_STATUS.UNDEFINED;
GVL_MODBUS.stModbusEMSComm.stModbusReg10.uiActiveParallelMembers := 0;
_iState := 35;
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
_tonBeginShutdown(In := FALSE);
// Set inverter to zero power
_rPowerInverter := 0.0;
// Start string shutdown
_xEnableString := FALSE;
// Change battery status
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eChargeStatus := E_CHARGE_STATUS.FULL;
GVL_MODBUS.stModbusEMSComm.stModbusReg10.uiActiveParallelMembers := 0;
_iState := 35;
END_IF
// Shutdown triggered by battery empty
IF GVL_MODBUS.stModbusEMSComm.stModbusReg11.eChargeStatus = E_CHARGE_STATUS.DISCHARGING AND (_fbString.rCurrentVoltage <= GVL_CONFIG.rStringEmptyVoltage) THEN
_tonBeginShutdown(In := FALSE);
// Set inverter to zero power
_rPowerInverter := 0.0;
// Start string shutdown
_xEnableString := FALSE;
// Change battery status
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eChargeStatus := E_CHARGE_STATUS.EMPTY;
GVL_MODBUS.stModbusEMSComm.stModbusReg10.uiActiveParallelMembers := 0;
_iState := 35;
END_IF
// Check for errors
IF _fbString.xError OR _fbInverter.xError THEN
_tonBeginShutdown(In := FALSE);
_iState := 1000;
END_IF
35: // Wait for string to be in shutdown discharge mode
IF _fbString.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;
_iState := 45;
END_IF
END_IF
// Check for errors
IF _fbString.xError OR _fbInverter.xError THEN
_iState := 1000;
END_IF
40: // Wait for inverter discharge done
IF _fbString.xShutdownDischargeAllowed THEN
_rPowerInverter := GVL_CONFIG.rAbsShutdownDischargePower;
ELSE
_rPowerInverter := 0.0;
_xEnableInverter := FALSE;
_iState := 45;
END_IF
// Check for errors
IF _fbString.xError OR _fbInverter.xError THEN
_iState := 1000;
END_IF
45: // Wait for shutdown of string to be done
IF (NOT _fbString.xInShutdownDischargeMode) AND _fbString.xOff THEN
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eBatteryStatus := E_BATTERY_STATUS.OFF;
_iState := 0;
END_IF
// Check for errors
IF _fbString.xError OR _fbInverter.xError THEN
_iState := 1000;
END_IF
1000: // Error state
_xEnableString := FALSE;
_xEnableInverter := FALSE;
_rPowerInverter := 0.0;
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eBatteryStatus := E_BATTERY_STATUS.ERROR;
_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
// Reset modbus error register
GVL_MODBUS.stModbusEMSComm.stModbusReg11.lwErrorBitmap := 0;
// Reset modbus error flag
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eBatteryStatus := E_BATTERY_STATUS.OFF;
// Goto init state
_iState := 0;
END_IF
END_CASE]]></ST>
</Implementation>
</Action>
<Action Name="SM_CAPACITY_TEST" Id="{705978cf-2798-4a38-8f24-148e2ec1d46e}">
<Implementation>
<ST><![CDATA[]]></ST>
</Implementation>
</Action>
<Action Name="SM_MANUAL" Id="{ddef276e-9f4f-4258-b863-d254dd94b701}">
<Implementation>
<ST><![CDATA[]]></ST>
</Implementation>
</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
// on stop: open dc circuit breakers and close valves
// wait for voltage to drop below xx volts
// stop pumps]]></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="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" />
<LineId Id="1" Count="0" />
</LineIds>
<LineIds Name="MAIN.SM_CAPACITY_TEST">
<LineId Id="1" Count="0" />
</LineIds>
<LineIds Name="MAIN.SM_MANUAL">
<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" />
</LineIds>
</POU>
</TcPlcObject>