滤波1

Out_Flt1 := WORD_TO_INT(INPUT_1) * T_1 + Mid_1 * (1.0 - T_1);   //T_1 滤波系数

Mid_1     := Out_Flt1;

Out_Flt2 := WORD_TO_INT(INPUT_2) * T_2 + Mid_2 * (1.0 - T_2);

Mid_2     := Out_Flt2;

Out_Flt3 := WORD_TO_INT(INPUT_3) * T_3 + Mid_3 * (1.0 - T_3);

Mid_3     := Out_Flt3;

Out_Flt4 := WORD_TO_INT(INPUT_4) * T_4 + Mid_4 * (1.0 - T_4);

Mid_4     := Out_Flt4;

Out_Flt5 := WORD_TO_INT(INPUT_5) * T_5 + Mid_5 * (1.0 - T_5);

Mid_5     := Out_Flt5;

flt1:=REAL_TO_INT(Out_Flt1);

flt2:=REAL_TO_INT(Out_Flt2);

flt3:=REAL_TO_INT(Out_Flt3);

flt4:=REAL_TO_INT(Out_Flt4);

flt5:=REAL_TO_INT(Out_Flt5);

滤波2

VAR_INPUT

AD_IN :WORD;//INT;  //输入信号

K_NOW:REAL;         //当前系数

K_LAST:REAL;       //上个周期系数

END_VAR  

VAR_IN_OUT

AD_VALUE:INT;      //滤波后输出

END_VAR

BEGIN

AD_VALUE:=REAL_TO_INT(INT_TO_REAL(WORD_TO_INT(AD_IN))*K_NOW+INT_TO_REAL(AD_VALUE)*K_LAST);

END_FUNCTION