FUNCTION FC501 : VOID

// This function is used for computing of the elongation correction
TITLE = 'Elong_Cor'
VERSION : '0.0'
//KNOW_HOW_PROTECT
AUTHOR : BenBen
NAME : Elon_Cor
FAMILY : Common

VAR_INPUT

BS_En_Speed_Lin : REAL; // Entry Bridle linear speed in mm/s
BS_Ex_Speed_Lin : REAL; // Exit Bridle linear speed in mm/s
Elong_Ref : REAL; // Elongation reference in %
Freeze_Reg : BOOL; // Frreze regulation if input is 1

END_VAR


VAR_TEMP

Tau : REAL; // Tau = 0.5
Long : REAL; // Long = 1000

END_VAR


VAR_OUTPUT

ZB : REAL; // ZB= Ve ( Alpha + 1 ) - Vs (in mm/s)
Da_Dt : REAL; // Elongation variation according time variation (in %/S)

END_VAR


BEGIN

// Parameter Tau and Long
Tau:= 0.5;
Long:= 1000;

// ZB= Ve ( Alpha + 1 ) - Vs (in mm/s) avec Alpha= Elong_Ref/100
ZB:= BS_En_Speed_Lin * ( Elong_Ref/100 +1) - BS_Ex_Speed_Lin ;


// Elongation variation according time variation (in %/S)
IF Freeze_Reg =1
THEN Da_Dt:=0;
ELSE Da_Dt:= ZB / (BS_En_Speed_Lin * Tau + Long);
END_IF;


END_FUNCTION