数字滤波合集——CODESYS(ST语言)

显示全部楼层 · 5 天前

二、应用场合

三、滑动+最值滤波

//数据采集

FOR 指针:=1 TO 滤波长度 BY 1 DO

data_1[指针]:=滤波前输入;

END_FOR

//最大值滤波

data_max:=0;

FOR 指针:=1 TO 滤波长度  BY 1 DO

IF data_max<data_1[指针]  THEN

data_max:=data_1[指针];

END_IF

END_FOR

//最小值滤波

data_min:=data_max;

FOR 指针:=1 TO 滤波长度  BY 1 DO

IF data_min>data_1[指针]  THEN

data_min:=data_1[指针];

END_IF

END_FOR

//求平均值输出

数据和:=0;

FOR 指针:=1 TO 滤波长度  BY 1 DO

数据和:=data_1[指针]+数据和;

END_FOR

滤波后输出:= (数据和-data_max-data_min)/(滤波长度-2);

//滑动滤波数据交换

FOR 指针:=1 TO (滤波长度-滤波强度)  BY 1 DO

data_2[指针]:=data_1[指针];

END_FOR

FOR 指针:=1 TO (滤波长度-滤波强度)  BY 1 DO

data_1[指针+滤波强度]:=data_2[指针];

END_FOR

//数字滤波强度计算

IF 滤波长度>=10 THEN

   IF 滤波强度设定值0_3>3 THEN

  滤波强度设定值0_3:=3;

   END_IF;

滤波强度:=(滤波长度/10)*2*滤波强度设定值0_3;

END_IF

IF 滤波长度<10 THEN

IF 滤波强度设定值0_3>2 THEN

  滤波强度设定值0_3:=2;

   END_IF;

滤波强度:=2*滤波强度设定值0_3；

END_IF
四、简易卡尔曼滤波

KM_X_1:=KM_A*KM_X+KM_B;

KM_P_1:=KM_A*KM_P*KM_A+KM_Q;

KM_K:=KM_P_1*KM_C/(KM_C*KM_P_1*KM_C*KM_R);

KM_X:=KM_X_1+KM_K*(DATA_Slide_NUM-KM_C*KM_X_1);

KM_P:=(1-KM_K*KM_C)*KM_P_1;

IF IIR_A <> DATA_val[1] THEN

IIR_B:=1-IIR_A;

DATA_val[1]:=IIR_A ;

DATA_val[2]:=IIR_B;

END_IF

IF IIR_B <> DATA_val[2] THEN

IIR_A:=1-IIR_B;

DATA_val[1]:=IIR_A;

DATA_val[2]:=IIR_B;

END_IF

DATA_OUT_IIR:=LREAL_TO_REAL(IIR_A*DATA_Slide_NUM+IIR_B*DATA_val[3]);

      DATA_val[3]:=DATA_OUT_IIR;

FILTER_Coeffs[1]:=0.25;

FILTER_Coeffs[2]:=0.5;

FILTER_Coeffs[3]:=0.25;

FOR i:=1 TO BUFFER_SIZE BY 1 DO

Buffer_temp:=Buffer_temp[i+1];

END_FOR;

Buffer_temp[1]:=DATA_OUT_IIR;

DATA_OUT_PUT :=FIR_OUT_PUT;

FOR i:=1 TO FILTER_LENGTH BY 1 DO

FIR_OUT_PUT:=FILTER_Coeffs*Buffer_temp+FIR_OUT_PUT;

END_FOR;

FOR i:=1 TO FILTER_LENGTH BY 1 DO

Buffer:=Buffer_temp;

END_FOR;

五、IIR滤波

IF IIR_A <> DATA_val[1] THEN IIR_B:=1-IIR_A; DATA_val[1]:=IIR_A ; DATA_val[2]:=IIR_B;END_IF
IF IIR_B <> DATA_val[2] THEN IIR_A:=1-IIR_B; DATA_val[1]:=IIR_A; DATA_val[2]:=IIR_B;END_IF       DATA_OUT_PUT:=IIR_A*DATA_IN_PUT+IIR_B*DATA_val[3];       DATA_val[3]:=DATA_OUT_PUT; 六、FIR滤波

IF  REAL_20 = 0 THEN       //初始化数组

FOR i:=1 TO DATA_NUM BY 1 DO

DATA_10:=0.0;

END_FOR;
REAL_20:=1;END_IF; FOR i:=1 TO DATA_NUM BY 1 DODATA_11:=DATA_30;END_FOR;FOR i:=1 TO DATA_NUM BY 1 DO    DATA_12:=DATA_10;END_FORFOR i:=1 TO DATA_NUM-1 BY 1 DO    DATA_10[i+1]:=DATA_12;END_FORDATA_10[1]:=DATA_IN_PUT;DATA_OUT_PUT:=0;FOR i:=1 TO DATA_NUM BY 1 DO

DATA_OUT_PUT:=DATA_10*DATA_11+DATA_OUT_PUT;

END_FOR

[CodeSys] 数字滤波合集——CODESYS(ST语言)

本帖子中包含更多资源