429 lines
12 KiB
XML
429 lines
12 KiB
XML
<?xml version="1.0" encoding="utf-8"?>
|
|
<TcPlcObject Version="1.1.0.1" ProductVersion="3.1.4024.12">
|
|
<POU Name="FB_String" Id="{46501225-f446-4674-bfed-3be64273e576}" SpecialFunc="None">
|
|
<Declaration><![CDATA[FUNCTION_BLOCK FB_String
|
|
VAR_INPUT
|
|
// Enable
|
|
xEnable : BOOL;
|
|
|
|
// Module 1 HMI interface
|
|
stHMIInterface : REFERENCE TO ST_STRING_HMI_INTERFACE;
|
|
|
|
// Emergency stop ok
|
|
xEmergencyStopOk : BOOL;
|
|
|
|
// Release alarms
|
|
xReleaseErrors : BOOL;
|
|
|
|
// Release analog io limit errors
|
|
xReleaseLimitErrors : BOOL;
|
|
|
|
// Release manual mode
|
|
xReleaseManualMode : BOOL;
|
|
|
|
// Input to confirm all errors
|
|
xConfirmAlarms : BOOL;
|
|
END_VAR
|
|
VAR_OUTPUT
|
|
// Current string voltage
|
|
rCurrentVoltage : REAL;
|
|
|
|
// Module in shutdown segment discharge mode
|
|
xInShutdownDischargeMode : BOOL;
|
|
|
|
// Module can be discharged during shutdown sequence
|
|
xShutdownDischargeAllowed : BOOL;
|
|
|
|
// String ready
|
|
xReady : BOOL;
|
|
|
|
// String completely off
|
|
xOff : BOOL;
|
|
|
|
// All safetyinterlocks are ok
|
|
xSafetyIntlksOk : BOOL;
|
|
|
|
xError : BOOL;
|
|
xWarning : BOOL;
|
|
|
|
eStatus : E_COMPONENT_STATUS;
|
|
END_VAR
|
|
VAR
|
|
_fbModule1 : FB_Module('Module 1');
|
|
_fbModule2 : FB_Module('Module 2');
|
|
_fbModule3 : FB_Module('Module 3');
|
|
|
|
// All modules are ready
|
|
_xAllModulesReady : BOOL;
|
|
|
|
// All modules in shutdown discharge mode
|
|
_xAllModulesInShutdownDischargeMode : BOOL;
|
|
|
|
// Flag for module balance checking
|
|
_xBalanceOk : BOOL;
|
|
|
|
// Modules out of balance alarm message
|
|
_fbModulesOutOfBalanceAlarm : Fb_TcAlarm;
|
|
|
|
// Safetyinterlocks pending alarm
|
|
_fbSafetyInterlocksNotOkAlarm : FB_TcAlarm;
|
|
|
|
// String name
|
|
_sName : STRING;
|
|
END_VAR
|
|
]]></Declaration>
|
|
<Implementation>
|
|
<ST><![CDATA[// Reset error flag
|
|
xError := FALSE;
|
|
|
|
// Reset safety interlocks flag
|
|
xSafetyIntlksOk := TRUE;
|
|
|
|
// ===============================
|
|
// Module 1
|
|
// ===============================
|
|
_fbModule1(
|
|
xEnable := xEnable,
|
|
xEmergencyStopOk:= xEmergencyStopOk,
|
|
stHMIInterface:= stHMIInterface.stHMIInterfaceModule1,
|
|
xReleaseErrors:= xReleaseErrors,
|
|
xReleaseLimitErrors:= xReleaseLimitErrors,
|
|
xReleaseManualMode := xReleaseManualMode,
|
|
xConfirmAlarms:= xConfirmAlarms);
|
|
|
|
IF _fbModule1.xWarning THEN
|
|
xWarning := TRUE;
|
|
END_IF
|
|
|
|
IF _fbModule1.xError THEN
|
|
xError := TRUE;
|
|
END_IF
|
|
|
|
IF NOT _fbModule1.xSafetyIntlksOk THEN
|
|
xSafetyIntlksOk := FALSE;
|
|
END_IF
|
|
|
|
|
|
// ===============================
|
|
// Module 2
|
|
// ===============================
|
|
_fbModule2(
|
|
xEnable := xEnable,
|
|
xEmergencyStopOk:= xEmergencyStopOk,
|
|
stHMIInterface:= stHMIInterface.stHMIInterfaceModule2,
|
|
xReleaseErrors:= xReleaseErrors,
|
|
xReleaseLimitErrors:= xReleaseLimitErrors,
|
|
xReleaseManualMode := xReleaseManualMode,
|
|
xConfirmAlarms:= xConfirmAlarms);
|
|
|
|
IF _fbModule2.xWarning THEN
|
|
xWarning := TRUE;
|
|
END_IF
|
|
|
|
IF _fbModule2.xError THEN
|
|
xError := TRUE;
|
|
END_IF
|
|
|
|
IF NOT _fbModule2.xSafetyIntlksOk THEN
|
|
xSafetyIntlksOk := FALSE;
|
|
END_IF
|
|
|
|
|
|
// ===============================
|
|
// Module 3
|
|
// ===============================
|
|
_fbModule3(
|
|
xEnable := xEnable,
|
|
xEmergencyStopOk:= xEmergencyStopOk,
|
|
stHMIInterface:= stHMIInterface.stHMIInterfaceModule3,
|
|
xReleaseErrors:= xReleaseErrors,
|
|
xReleaseLimitErrors:= xReleaseLimitErrors,
|
|
xReleaseManualMode := xReleaseManualMode,
|
|
xConfirmAlarms:= xConfirmAlarms);
|
|
|
|
IF _fbModule3.xWarning THEN
|
|
xWarning := TRUE;
|
|
END_IF
|
|
|
|
IF _fbModule3.xError THEN
|
|
xError := TRUE;
|
|
END_IF
|
|
|
|
IF NOT _fbModule3.xSafetyIntlksOk THEN
|
|
xSafetyIntlksOk := FALSE;
|
|
END_IF
|
|
|
|
|
|
// ===============================
|
|
// Handle safety interlock alarm
|
|
// ===============================
|
|
IF NOT xSafetyIntlksOk AND NOT _fbSafetyInterlocksNotOkAlarm.bRaised THEN
|
|
_fbSafetyInterlocksNotOkAlarm.Raise(0);
|
|
END_IF
|
|
|
|
IF xSafetyIntlksOk AND _fbSafetyInterlocksNotOkAlarm.bRaised THEN
|
|
_fbSafetyInterlocksNotOkAlarm.Clear(0, TRUE);
|
|
END_IF
|
|
|
|
|
|
// ===============================
|
|
// Modules ready check
|
|
// ===============================
|
|
_xAllModulesReady := _fbModule1.xReady AND _fbModule2.xReady AND _fbModule3.xReady;
|
|
|
|
|
|
// ===============================
|
|
// Modules in shutdown discharge mode
|
|
// ===============================
|
|
xInShutdownDischargeMode := _fbModule1.xInShutdownDischargeMode AND _fbModule2.xInShutdownDischargeMode AND _fbModule3.xInShutdownDischargeMode;
|
|
|
|
|
|
// ===============================
|
|
// Units shutdown discharge allowed
|
|
// ===============================
|
|
xShutdownDischargeAllowed := _fbModule1.xShutdownDischargeAllowed AND _fbModule2.xShutdownDischargeAllowed AND _fbModule3.xShutdownDischargeAllowed;
|
|
|
|
|
|
// ===============================
|
|
// All modules off
|
|
// ===============================
|
|
xOff := _fbModule1.xOff AND _fbModule2.xOff AND _fbModule3.xOff;
|
|
|
|
// ===============================
|
|
// Calculate string voltage
|
|
// ===============================
|
|
rCurrentVoltage := _fbModule1.rCurrentVoltage + _fbModule2.rCurrentVoltage + _fbModule3.rCurrentVoltage;
|
|
stHMIInterface.rVoltage := rCurrentVoltage;
|
|
|
|
// ===============================
|
|
// String balance check
|
|
// ===============================
|
|
// Reset balance ok flag
|
|
_xBalanceOk := TRUE;
|
|
|
|
// Test module 1 with module 2
|
|
IF ABS(_fbModule1.rCurrentVoltage - _fbModule2.rCurrentVoltage) > GVL_CONFIG.rMaxAbsDiffVoltageModulesInString THEN
|
|
_xBalanceOk := FALSE;
|
|
END_IF
|
|
|
|
// Test module 1 with module 3
|
|
IF ABS(_fbModule1.rCurrentVoltage - _fbModule3.rCurrentVoltage) > GVL_CONFIG.rMaxAbsDiffVoltageModulesInString THEN
|
|
_xBalanceOk := FALSE;
|
|
END_IF
|
|
|
|
// Test module 2 with module 3
|
|
IF ABS(_fbModule2.rCurrentVoltage - _fbModule3.rCurrentVoltage) > GVL_CONFIG.rMaxAbsDiffVoltageModulesInString THEN
|
|
_xBalanceOk := FALSE;
|
|
END_IF
|
|
|
|
|
|
// Signal an error if all units are ready and module is out of balance
|
|
IF _xAllModulesReady AND (NOT _xBalanceOk) THEN
|
|
xError := TRUE;
|
|
END_IF
|
|
|
|
// Raise error
|
|
IF (NOT _xBalanceOk) AND (NOT _fbModulesOutOfBalanceAlarm.bRaised) THEN
|
|
_fbModulesOutOfBalanceAlarm.Raise(0);
|
|
END_IF
|
|
|
|
// Clear error
|
|
IF _xBalanceOk AND _fbModulesOutOfBalanceAlarm.bRaised THEN
|
|
_fbModulesOutOfBalanceAlarm.Clear(0, FALSE);
|
|
END_IF
|
|
|
|
// Confirm error
|
|
IF _fbModulesOutOfBalanceAlarm.eConfirmationState = TcEventConfirmationState.WaitForConfirmation AND xConfirmAlarms THEN
|
|
_fbModulesOutOfBalanceAlarm.Confirm(0);
|
|
END_IF
|
|
|
|
// ===============================
|
|
// String ready validation check
|
|
// ===============================
|
|
IF _xAllModulesReady AND _xBalanceOk THEN
|
|
xReady := TRUE;
|
|
ELSE
|
|
xReady := FALSE;
|
|
END_IF
|
|
|
|
// ===============================
|
|
// String status sum
|
|
// ===============================
|
|
IF xOff THEN
|
|
eStatus := E_COMPONENT_STATUS.OFF;
|
|
END_IF
|
|
|
|
IF xReady THEN
|
|
eStatus := E_COMPONENT_STATUS.ON;
|
|
END_IF
|
|
|
|
IF xError THEN
|
|
eStatus := E_COMPONENT_STATUS.ERROR;
|
|
END_IF]]></ST>
|
|
</Implementation>
|
|
<Method Name="FB_init" Id="{9e8494eb-1b40-4be9-91c8-810ecbdf7f0c}">
|
|
<Declaration><![CDATA[METHOD FB_init : BOOL
|
|
VAR_INPUT
|
|
bInitRetains : BOOL; // if TRUE, the retain variables are initialized (warm start / cold start)
|
|
bInCopyCode : BOOL; // if TRUE, the instance afterwards gets moved into the copy code (online change)
|
|
|
|
sName : STRING;
|
|
END_VAR
|
|
]]></Declaration>
|
|
<Implementation>
|
|
<ST><![CDATA[_sName := sName;
|
|
|
|
// Set names for modules
|
|
_fbModule1.Name := Concat(_sName, ' - Module 1');
|
|
_fbModule2.Name := Concat(_sName, ' - Module 2');
|
|
_fbModule3.Name := Concat(_sName, ' - Module 3');
|
|
|
|
// Create out of balance alarm
|
|
_fbModulesOutOfBalanceAlarm.CreateEx(stEventEntry := TC_EVENTS.BMSEvents.StringImbalance, bWithConfirmation := TRUE, 0);
|
|
_fbModulesOutOfBalanceAlarm.ipArguments.Clear().AddString(_sName);
|
|
|
|
// Create safetyinterlocks active alarm
|
|
_fbSafetyInterlocksNotOkAlarm.CreateEx(stEventEntry := TC_EVENTS.BMSEvents.SafetyIntlksActive, bWithConfirmation := FALSE, 0);
|
|
_fbSafetyInterlocksNotOkAlarm.ipArguments.Clear().AddString(_sName);]]></ST>
|
|
</Implementation>
|
|
</Method>
|
|
<Property Name="Name" Id="{19fcb6d4-fd4b-49f9-9791-1e4c931b9e69}">
|
|
<Declaration><![CDATA[PROPERTY Name : String]]></Declaration>
|
|
<Get Name="Get" Id="{a4b6ba34-8ad9-46b1-939c-45cef957fd9a}">
|
|
<Declaration><![CDATA[VAR
|
|
END_VAR
|
|
]]></Declaration>
|
|
<Implementation>
|
|
<ST><![CDATA[Name := _sName;]]></ST>
|
|
</Implementation>
|
|
</Get>
|
|
<Set Name="Set" Id="{c32997c5-bac4-4ef0-bc87-edcbbb2e542f}">
|
|
<Declaration><![CDATA[VAR
|
|
END_VAR
|
|
]]></Declaration>
|
|
<Implementation>
|
|
<ST><![CDATA[_sName := Name;
|
|
|
|
// Set modules names
|
|
_fbModule1.Name := CONCAT(_sName, ' - Module 1');
|
|
_fbModule2.Name := CONCAT(_sName, ' - Module 2');
|
|
_fbModule3.Name := CONCAT(_sName, ' - Module 3');
|
|
|
|
// Create alarm messages
|
|
_fbModulesOutOfBalanceAlarm.ipArguments.Clear().AddString(_sName);
|
|
_fbSafetyInterlocksNotOkAlarm.ipArguments.Clear().AddString(_sName);]]></ST>
|
|
</Implementation>
|
|
</Set>
|
|
</Property>
|
|
<LineIds Name="FB_String">
|
|
<LineId Id="266" Count="0" />
|
|
<LineId Id="268" Count="0" />
|
|
<LineId Id="335" Count="0" />
|
|
<LineId Id="334" Count="0" />
|
|
<LineId Id="336" 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="48" Count="0" />
|
|
<LineId Id="50" Count="2" />
|
|
<LineId Id="600" Count="0" />
|
|
<LineId Id="53" Count="0" />
|
|
<LineId Id="58" Count="0" />
|
|
<LineId Id="62" Count="0" />
|
|
<LineId Id="64" Count="0" />
|
|
<LineId Id="66" Count="0" />
|
|
<LineId Id="63" Count="0" />
|
|
<LineId Id="59" Count="2" />
|
|
<LineId Id="338" Count="0" />
|
|
<LineId Id="337" Count="0" />
|
|
<LineId Id="339" Count="1" />
|
|
<LineId Id="71" Count="5" />
|
|
<LineId Id="141" 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="90" Count="5" />
|
|
<LineId Id="142" 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="433" Count="1" />
|
|
<LineId Id="432" Count="0" />
|
|
<LineId Id="435" Count="4" />
|
|
<LineId Id="441" Count="2" />
|
|
<LineId Id="440" Count="0" />
|
|
<LineId Id="183" Count="5" />
|
|
<LineId Id="245" Count="4" />
|
|
<LineId Id="244" Count="0" />
|
|
<LineId Id="261" Count="4" />
|
|
<LineId Id="260" Count="0" />
|
|
<LineId Id="270" Count="4" />
|
|
<LineId Id="269" Count="0" />
|
|
<LineId Id="190" Count="3" />
|
|
<LineId Id="182" Count="0" />
|
|
<LineId Id="199" Count="5" />
|
|
<LineId Id="198" Count="0" />
|
|
<LineId Id="209" Count="0" />
|
|
<LineId Id="208" Count="0" />
|
|
<LineId Id="230" Count="1" />
|
|
<LineId Id="211" Count="0" />
|
|
<LineId Id="232" Count="0" />
|
|
<LineId Id="210" Count="0" />
|
|
<LineId Id="234" Count="1" />
|
|
<LineId Id="233" Count="0" />
|
|
<LineId Id="213" Count="0" />
|
|
<LineId Id="212" Count="0" />
|
|
<LineId Id="237" Count="1" />
|
|
<LineId Id="236" Count="0" />
|
|
<LineId Id="215" Count="5" />
|
|
<LineId Id="353" Count="13" />
|
|
<LineId Id="352" Count="0" />
|
|
<LineId Id="221" Count="5" />
|
|
<LineId Id="239" Count="1" />
|
|
<LineId Id="214" Count="0" />
|
|
<LineId Id="512" Count="0" />
|
|
<LineId Id="511" Count="0" />
|
|
<LineId Id="513" Count="4" />
|
|
<LineId Id="521" Count="0" />
|
|
<LineId Id="520" Count="0" />
|
|
<LineId Id="522" Count="1" />
|
|
<LineId Id="525" Count="0" />
|
|
<LineId Id="524" Count="0" />
|
|
<LineId Id="526" Count="1" />
|
|
</LineIds>
|
|
<LineIds Name="FB_String.FB_init">
|
|
<LineId Id="7" Count="0" />
|
|
<LineId Id="33" Count="0" />
|
|
<LineId Id="32" Count="0" />
|
|
<LineId Id="34" Count="2" />
|
|
<LineId Id="16" Count="0" />
|
|
<LineId Id="15" Count="0" />
|
|
<LineId Id="17" Count="0" />
|
|
<LineId Id="20" Count="0" />
|
|
<LineId Id="31" Count="0" />
|
|
<LineId Id="29" Count="1" />
|
|
<LineId Id="28" Count="0" />
|
|
</LineIds>
|
|
<LineIds Name="FB_String.Name.Get">
|
|
<LineId Id="2" Count="0" />
|
|
</LineIds>
|
|
<LineIds Name="FB_String.Name.Set">
|
|
<LineId Id="2" Count="0" />
|
|
<LineId Id="9" Count="0" />
|
|
<LineId Id="6" Count="2" />
|
|
<LineId Id="5" Count="0" />
|
|
<LineId Id="13" Count="0" />
|
|
<LineId Id="11" Count="0" />
|
|
<LineId Id="10" Count="0" />
|
|
<LineId Id="12" Count="0" />
|
|
</LineIds>
|
|
</POU>
|
|
</TcPlcObject> |