PLC Twincat3 对传感器数据滑动平均滤波

PLC Twincat3 对传感器数据滑动平均滤波

下面代码定义了一个名为FB_Filter的功能块（Function Block），用于对四个输入值进行滤波处理，以消除或减少噪声和波动。这里使用的是滑动平均滤波器（Moving Average Filter）的方法。下面是代码的详细解释：

输入变量（VAR_INPUT）

• filterInputs：一个包含4个元素的实型数组，用于存储待滤波的输入扭矩值。
• filterCount：整型变量，定义了滑动平均滤波器中考虑的采样点数量，即滤波次数。在这个例子中，它被初始化为15。
• tSamplingPeriod：时间类型变量，定义了采样周期，这里设置为1毫秒（T#1MS）。

内部变量（VAR）

• sampleBuffer：一个二维实型数组，用于存储采样值。它有4行（对应4个输入扭矩值）和1000列。
• sampleIndex：整型变量，用于跟踪