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：整型变量，用于跟踪当前采样值在sampleBuffer中的位置。它初始化为1，并在每次采样后递增。
• sum：实型变量，用于计算每个输入扭矩值的滑动平均值之和。
• i和j：整型循环变量，用于遍历数组。
• tCycleT