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

Fixed some bugs and added inverter status to modbus register

Browse Source 
- Safety now has a tof of 0,5s for Temp, Voltage and Pressure
- Doppelhöcker now switches powercommand during second phase
This commit is contained in:
Matthias Heisig
2025-09-24 10:10:37 +02:00
parent d882effb35
commit dd82744356
12 changed files with 343 additions and 260 deletions
Download Patch File Download Diff File Expand all files Collapse all files

26
PLC/DUTs/Modbus/HoldingRegisters/ST_MODBUS_REG_11.TcDUT
View File

@@ -1,5 +1,5 @@
<?xml version="1.0" encoding="utf-8"?>
<TcPlcObject Version="1.1.0.1" ProductVersion="3.1.4026.8">
<TcPlcObject Version="1.1.0.1" ProductVersion="3.1.4026.12">
<DUT Name="ST_MODBUS_REG_11" Id="{7e772293-d4e3-4809-9da8-3d4e0412ede6}">
<Declaration><![CDATA[{attribute 'analysis' := '-33'}
{attribute 'pack_mode' := '1'}
@@ -102,6 +102,30 @@ STRUCT
// Addr: 11.044
lwErrorBitmap : LWORD;
// Addr: 11.048
eInverter1RequestedState : E_KACO_PCU_REQUESTED_STATE;
// Addr: 11.049
eInverter1CurrentState : E_KACO_CURRENT_STATE;
// Addr: 11.050
eInverter1PCUState : E_KACO_PCU_STATE;
// Addr: 11.051
eInverter1PCUError : E_KACO_PCU_ERROR;
// Addr: 11.052
eInverter2RequestedState : E_KACO_PCU_REQUESTED_STATE;
// Addr: 11.053
eInverter2CurrentState : E_KACO_CURRENT_STATE;
// Addr: 11.054
eInverter2PCUState : E_KACO_PCU_STATE;
// Addr: 11.055
eInverter2PCUError : E_KACO_PCU_ERROR;
END_STRUCT
END_TYPE
]]></Declaration>

27
PLC/PLC.plcproj
View File

@@ -183,6 +183,9 @@
<Compile Include="POUs\Sunspec\Kaco\FB_PowerSupplyKaco.TcPOU">
<SubType>Code</SubType>
</Compile>
<Compile Include="POUs\Sunspec\Kaco\ST_KACO_INFOS.TcDUT">
<SubType>Code</SubType>
</Compile>
<Compile Include="POUs\Sunspec\Kaco\ST_KACU_PCU.TcDUT">
<SubType>Code</SubType>
</Compile>
@@ -270,8 +273,8 @@
<ProjectExtensions>
<PlcProjectOptions>
<XmlArchive>
<Data>
<o xml:space="preserve" t="OptionKey">
<Data>
<o xml:space="preserve" t="OptionKey">
<v n="Name">"&lt;ProjectRoot&gt;"</v>
<d n="SubKeys" t="Hashtable" ckt="String" cvt="OptionKey">
<v>{192FAD59-8248-4824-A8DE-9177C94C195A}</v>
@@ -2653,16 +2656,16 @@
</d>
<d n="Values" t="Hashtable" />
</o>
</Data>
<TypeList>
<Type n="Boolean">System.Boolean</Type>
<Type n="Hashtable">System.Collections.Hashtable</Type>
<Type n="Int32">System.Int32</Type>
<Type n="OptionKey">{54dd0eac-a6d8-46f2-8c27-2f43c7e49861}</Type>
<Type n="String">System.String</Type>
<Type n="UInt32">System.UInt32</Type>
</TypeList>
</XmlArchive>
</Data>
<TypeList>
<Type n="Boolean">System.Boolean</Type>
<Type n="Hashtable">System.Collections.Hashtable</Type>
<Type n="Int32">System.Int32</Type>
<Type n="OptionKey">{54dd0eac-a6d8-46f2-8c27-2f43c7e49861}</Type>
<Type n="String">System.String</Type>
<Type n="UInt32">System.UInt32</Type>
</TypeList>
</XmlArchive>
</PlcProjectOptions>
</ProjectExtensions>
</Project>

452
PLC/PLC.tmc
View File

File diff suppressed because one or more lines are too long

4
PLC/POUs/FB_Module.TcPOU
View File

@@ -496,7 +496,7 @@ END_IF
_fbBalanceNotOkSignal(
xSignal:= NOT _xBalanceOk,
xRelease:= xEnable AND _xAllUnitsReady,
timOnDelay:= T#10S,
timOnDelay:= T#5S,
timOffDelay:= T#5S,
xReleaseSignal=> );
@@ -523,7 +523,7 @@ END_IF
// ===============================
// Module ready validation check
// ===============================
IF _xAllUnitsReady AND _xBalanceOk THEN
IF _xAllUnitsReady AND (NOT _fbBalanceNotOkSignal.xReleaseSignal) THEN
xReady := TRUE;
ELSE
xReady := FALSE;

12
PLC/POUs/FB_String.TcPOU
View File

@@ -129,6 +129,9 @@ VAR_OUTPUT
// Balancing done
xBalancingDone : BOOL;
// Inverter infos for EMS display
stInverterInfos : ST_KACO_INFOS;
END_VAR
VAR
_fbModule1 : FB_Module(CONCAT(Name,' - Module 1'));
@@ -390,7 +393,8 @@ _fbInverter(
rPower:= _rPowerInverterInternal,
xReset:= xConfirmAlarms,
rMaxBattPower:= DINT_TO_REAL(GVL_CONFIG.diMaxStringDischargePower),
stCurrentValues => stInverterData);
stCurrentValues => stInverterData,
stInverterInfos => stInverterInfos);
refuStringErrorsModbus.stBitmap.bInverterError := _fbInverter.xError;
@@ -679,7 +683,7 @@ CASE _iState OF
_iState := 40;
END_IF
ELSIF (NOT _xAllModulesReady) OR (NOT _xBalanceOk) OR (NOT xSafetyIntlksOk) OR (NOT xRepairSwitchOk) OR (_xErrorInternal) THEN
ELSIF (NOT _xAllModulesReady) OR (_fbBalanceNotOkSignal.xReleaseSignal) OR (NOT xSafetyIntlksOk) OR (NOT xRepairSwitchOk) OR (_xErrorInternal) THEN
xError := TRUE;
_xEnable := FALSE;
_rPowerInverterInternal := 0.0;
@@ -1079,8 +1083,8 @@ END_IF
_fbBalanceNotOkSignal(
xSignal:= NOT _xBalanceOk,
xRelease:= xEnable AND _xAllModulesReady,
timOnDelay:= T#10S,
timOffDelay:= T#10S,
timOnDelay:= T#5S,
timOffDelay:= T#5S,
xReleaseSignal=> );
// Signal an error if all units are ready and module is out of balance

41
PLC/POUs/MAIN.TcPOU
View File

@@ -207,6 +207,7 @@ VAR
_xGetPowerMeterData : BOOL;
_rPowerDH : REAL;
_xDHActive : BOOL;
_fbTONDHCycleTime : TON := (PT := T#15M);
// tower light
@@ -486,6 +487,11 @@ GVL_MODBUS.stBMSErrorReg.wBMSWarningActive.stBitmap.bTCabinetString1Module2High
GVL_MODBUS.stBMSErrorReg.wBMSWarningActive.stBitmap.bTCabinetString1Module3High := _afbStrings[0].xTempCabinetModule3Warning;
GVL_MODBUS.stBMSErrorReg.wBMSWarningActive.stBitmap.bTCabinetSCSString1High := _fbTempCabinetSCSString1.xWarningHigh;
// Copy inverter data to Modbus registers
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eInverter1CurrentState := _afbStrings[0].stInverterInfos.eCurrentState;
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eInverter1RequestedState := _afbStrings[0].stInverterInfos.eRequestedState;
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eInverter1PCUState := _afbStrings[0].stInverterInfos.ePCUState;
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eInverter1PCUError := _afbStrings[0].stInverterInfos.ePCUError;
// Call string 2
_afbStrings[1](
@@ -548,6 +554,12 @@ GVL_MODBUS.stBMSErrorReg.wBMSWarningActive.stBitmap.bTCabinetString2Module2High
GVL_MODBUS.stBMSErrorReg.wBMSWarningActive.stBitmap.bTCabinetString2Module3High := _afbStrings[1].xTempCabinetModule3Warning;
GVL_MODBUS.stBMSErrorReg.wBMSWarningActive.stBitmap.bTCabinetSCSString2High := _fbTempCabinetSCSString2.xWarningHigh;
// Copy inverter data to Modbus registers
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eInverter2CurrentState := _afbStrings[1].stInverterInfos.eCurrentState;
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eInverter2RequestedState := _afbStrings[1].stInverterInfos.eRequestedState;
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eInverter2PCUState := _afbStrings[1].stInverterInfos.ePCUState;
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eInverter2PCUError := _afbStrings[1].stInverterInfos.ePCUError;
// ===============================
// Get global string status information
@@ -880,14 +892,21 @@ CASE _eBMSControlMode OF
// Goto error state if a string has an error
IF _xStringsErrorActive THEN
_xDHActive := FALSE;
_iStateDH := 1000;
END_IF
CASE _iStateDH OF
0: // Idle, wait for command
_rAutoPowerRequest := DINT_TO_REAL(GVL_SCADA.stAutomaticModeHMI.diSetpointAutomatic);
IF (ABS(_rAutoPowerRequest) > 100.0) THEN
_rPowerDH := _rAutoPowerRequest;
_rPowerDH := DINT_TO_REAL(GVL_SCADA.stAutomaticModeHMI.diSetpointAutomatic);
IF (ABS(_rPowerDH) > 100.0) THEN
_xDHActive := TRUE;
_iStateDH := 5;
END_IF
5: // Wait for pre startup
IF _xBatteryActive THEN
_rAutoPowerRequest := _rPowerDH;
_fbTONDHCycleTime(IN := TRUE);
_iStateDH := 10;
END_IF
@@ -904,7 +923,7 @@ CASE _eBMSControlMode OF
20: // First pause
_fbTONDHCycleTime(IN := TRUE);
IF _fbTONDHCycleTime.Q THEN
_rAutoPowerRequest := _rPowerDH;
_rAutoPowerRequest := _rPowerDH * -1;
GVL_SCADA.stAutomaticModeHMI.diSetpointAutomatic := REAL_TO_DINT(_rAutoPowerRequest);
_fbTONDHCycleTime(IN := FALSE);
_iStateDH := 30;
@@ -916,6 +935,7 @@ CASE _eBMSControlMode OF
_rAutoPowerRequest := 0;
GVL_SCADA.stAutomaticModeHMI.diSetpointAutomatic := 0;
_fbTONDHCycleTime(IN := FALSE);
_xDHActive := FALSE;
_iStateDH := 0;
END_IF
@@ -1019,7 +1039,7 @@ _fbTowerLight(
END_IF
// Wait for power command
IF ((ABS(_rAutoPowerRequest) > DINT_TO_REAL(GVL_CONFIG.diMinimumAbsPowerForEnable)) OR GVL_MODBUS.stModbusEMSComm.stModbusReg12.wBMSControlsRegister.stBitmap.bScheduleActive)
IF ((ABS(_rAutoPowerRequest) > DINT_TO_REAL(GVL_CONFIG.diMinimumAbsPowerForEnable)) OR GVL_MODBUS.stModbusEMSComm.stModbusReg12.wBMSControlsRegister.stBitmap.bScheduleActive OR _xDHActive)
AND (NOT _xStringsErrorActive) AND _xStringsAllInAutomaticMode AND (NOT _xEMSHeartbeatNotOK) THEN
_iState := 5;
_xReleaseInverterPower := FALSE;
@@ -1065,7 +1085,7 @@ _fbTowerLight(
END_IF
IF ((ABS(_rAutoPowerRequest) < DINT_TO_REAL(GVL_CONFIG.diMinimumAbsPowerForEnable)) OR _xEMSHeartbeatNotOK) AND (NOT GVL_MODBUS.stModbusEMSComm.stModbusReg12.wBMSControlsRegister.stBitmap.bScheduleActive) THEN
IF ((ABS(_rAutoPowerRequest) < DINT_TO_REAL(GVL_CONFIG.diMinimumAbsPowerForEnable)) OR _xEMSHeartbeatNotOK) AND (NOT GVL_MODBUS.stModbusEMSComm.stModbusReg12.wBMSControlsRegister.stBitmap.bScheduleActive) AND (NOT _xDHActive) THEN
_fbStringReadyTimeout(IN := FALSE);
_xEnableString := FALSE;
_xCanChangeMode := TRUE;
@@ -1080,7 +1100,7 @@ _fbTowerLight(
_xBatteryActive := TRUE;
// Check if the battery should still be active
IF (_rAutoPowerRequest = 0.0) AND NOT GVL_MODBUS.stModbusEMSComm.stModbusReg12.wBMSControlsRegister.stBitmap.bScheduleActive THEN
IF (_rAutoPowerRequest = 0.0) AND ((NOT GVL_MODBUS.stModbusEMSComm.stModbusReg12.wBMSControlsRegister.stBitmap.bScheduleActive) OR (NOT _xDHActive)) THEN
_xNoPowerRequested := TRUE;
ELSE
_xNoPowerRequested := FALSE;
@@ -1248,6 +1268,7 @@ _fbTowerLight(
END_IF
45: // Wait for shutdown of string to be done
_xCanChangeMode := TRUE;
IF (NOT _xStringsInSchutdownDischargeMode) AND _xStringsOff THEN
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eBatteryStatus := E_BATTERY_STATUS.OFF;
GVL_MODBUS.stModbusEMSComm.stModbusReg11.eChargeStatus := E_CHARGE_STATUS.UNDEFINED;
@@ -1256,7 +1277,7 @@ _fbTowerLight(
END_IF
// Restart if possible
IF ((ABS(_rAutoPowerRequest) > DINT_TO_REAL(GVL_CONFIG.diMinimumAbsPowerForEnable)) OR GVL_MODBUS.stModbusEMSComm.stModbusReg12.wBMSControlsRegister.stBitmap.bScheduleActive)
IF ((ABS(_rAutoPowerRequest) > DINT_TO_REAL(GVL_CONFIG.diMinimumAbsPowerForEnable)) OR GVL_MODBUS.stModbusEMSComm.stModbusReg12.wBMSControlsRegister.stBitmap.bScheduleActive OR _xDHActive)
AND (NOT _xStringsErrorActive) AND _xStringsAllInAutomaticMode THEN
_xCanChangeMode := FALSE;
IF (_rAutoPowerRequest < 0 OR GVL_MODBUS.stModbusEMSComm.stModbusReg12.wBMSControlsRegister.stBitmap.bScheduleActive) AND GVL_MODBUS.stModbusEMSComm.stModbusReg11.eChargeStatus <> E_CHARGE_STATUS.FULL THEN
@@ -1267,6 +1288,10 @@ _fbTowerLight(
_iState := 0;
END_IF
IF _xDHActive THEN
_iState := 0;
END_IF
IF (_rAutoPowerRequest <> 0 OR GVL_MODBUS.stModbusEMSComm.stModbusReg12.wBMSControlsRegister.stBitmap.bScheduleActive) THEN
IF (_rAutoPowerRequest <= 0 AND (GVL_MODBUS.stModbusEMSComm.stModbusReg11.eChargeStatus <> E_CHARGE_STATUS.FULL))
OR (_rAutoPowerRequest >= 0) AND (GVL_MODBUS.stModbusEMSComm.stModbusReg11.eChargeStatus <> E_CHARGE_STATUS.EMPTY) THEN

10
PLC/POUs/Sunspec/Kaco/FB_PowerSupplyKaco.TcPOU
View File

@@ -22,6 +22,9 @@ VAR_OUTPUT
// Current inverter values
stCurrentValues : ST_SUNSPEC_CURRENT_VALUES;
// Inverter infos for EMS display
stInverterInfos : ST_KACO_INFOS;
END_VAR
VAR
// Battery limits
@@ -247,6 +250,13 @@ END_IF
HandleCyclicData();
// Copy inverter states to output
stInverterInfos.eRequestedState := _eRequestedState;
stInverterInfos.eCurrentState := _eCurrentState;
stInverterInfos.ePCUState := _stPCUState.ePCUState;
stInverterInfos.ePCUError := _stPCUState.ePCUError;
// Run state machine
CASE _iState OF
0: // Pre-init phase (no battery limits set)
_fbTONSetBatteryLimits(IN := TRUE);

14
PLC/POUs/Sunspec/Kaco/ST_KACO_INFOS.TcDUT Normal file
View File

@@ -0,0 +1,14 @@
<?xml version="1.0" encoding="utf-8"?>
<TcPlcObject Version="1.1.0.1" ProductVersion="3.1.4026.12">
<DUT Name="ST_KACO_INFOS" Id="{8a89bb74-fd34-4e8d-a03d-9fc814aadf52}">
<Declaration><![CDATA[TYPE ST_KACO_INFOS :
STRUCT
eRequestedState : E_KACO_PCU_REQUESTED_STATE;
eCurrentState : E_KACO_CURRENT_STATE;
ePCUState : E_KACO_PCU_STATE;
ePCUError : E_KACO_PCU_ERROR;
END_STRUCT
END_TYPE
]]></Declaration>
</DUT>
</TcPlcObject>