限幅滤波

winzhi

//
// 限幅滤波 Limiting Filter
// 连续两次采样值之差如果超过了限幅，则取上次采样值，否则取本次采样值
// 适用：脉冲干扰
//

#T_On(IN := NOT #T_Off.Q,
      PT := #Period / 2);
#T_Off(IN := #T_On.Q,
       PT := #Period / 2);
#Trigger(CLK := #T_On.Q);  // 采样触发，周期 = Period

IF #Trigger.Q THEN
    IF ABS(#Sample_In - #Sample_Old) < #Delta THEN  
        #Filter_Out := #Sample_In;      // 小于限幅，本次采样值有效
        #Sample_Old := #Sample_In;
    ELSE
        #Filter_Out := #Sample_Old;     // 大于限幅，本次采样值无效，取上次采样值
    END_IF;
END_IF;