死区过滤器可以滤除在平衡点或者目标值附近的微小波动,PID算法优化时也可以用到此指令,在进行一些关节角度测量的场合,为了滤除在特定角度的微小波动,也可以加入死区滤波器,下面我们看下CODESYS环境下如何实现这一功能。
1、死区滤波器
2、FC接口定义
FUNCTION DeadZone : REAL
VAR_INPUT
x:REAL;//输入值;
DeadValue:REAL;//死区值;
END_VAR
VAR
END_VAR
3、FC ST代码
//死区过滤器
//RXXW_Dor
IF ABS(x)<DeadValue THEN
DeadZone:=0.0;
ELSE
DeadZone:=x;
END_IF