1. 一段四十行的 SCL 和一个功能库:把一阶低通滤波固定下来
前几年做温度采集,热电偶通道上的高频抖动一直压不住,我在主循环里随手写了两行滤波,项目验收后那段代码跟着程序一起进了归档。第二年换了个平台,同样的抖动又出现,我又从头写了一遍,系数还是凭手感试的。到第三次,我决定不再重复:把滤波逻辑连同调用约定一起封进功能库,做成一个功能块(FB),谁要用就拖出来填参数。功能库听着很重,实际做法很轻——一个 FB、一份接口约定、一个版本号,就足够把"一阶低通"这件事固定下来。
这篇写的就是这个 FB:用 Tustin(双线性变换)把一阶 RC 低通映射到离散域,SCL 主体只有一行差分方程。难点不在公式,在三个周期参数怎么对齐、Alpha 怎么整定、以及进了功能库之后怎么不被后来的自己改坏。手上有模拟量通道、信号噪声明显、又不想每个项目重写一遍滤波的人,可以照着做一遍。
需要模型API调用? 免费领10W Token,多模型网关一键接入 Claude、DeepSeek 等主流模型。
2. 拆开 FB_Tustin_LPT:功能库里的 Tustin 变换与状态更新
2.1 从双线性变换到一行差分方程
一阶低通的连续形式是 $H(s)=\frac{1}{\tau s+1}$,$\tau=RC$ 是时间常数。Tustin 变换的做法是用 $s=\frac{2}{T}\cdot\frac{1-z^{-1}}{1+z^{-1}}$ 做代换,把 s 域映射到 z 域,$T$ 就是采样周期。代进去整理,令 $a=\frac{2\tau}{T}$,传递函数变成:
$$H(z)=\frac{1+z^{-1}}{(1+a)+(1-a)z^{-1}}$$
交叉相乘写回时域,得到 $y[n]=\frac{x[n]+x[n-1]-(1-a),y[n-1]}{1+a}$。再令 $\alpha=\frac{1}{1+a}=\frac{T}{T+2\tau}$,式子可以整理成功能库里那一行的样子:
$$y[n]=y[n-1]+\alpha\big(x[n]+x[n-1]-2y[n-1]\big)$$
这一步非常重要,因为它把"时间常数"翻译成了"一个 0 到 1 之间的系数"。$\tau$ 越大,$\alpha$ 越小,滤波越重。反过来,只要知道采样周期 $T$ 和想要的 $\tau$,就能直接算出 $\alpha$,不用在现场试凑。
顺带说一个必须记住的性质:这个滤波器的直流增益是 1。稳态时 $x[n]=x[n-1]=x$、$y[n]=y[n-1]=y$,代进差分方程得 $y=x$,没有静差。所以你完全可以拿"输入加阶跃、输出稳态值是否等于输入"当作功能库上线前的第一条验收判据。
极点位置决定了它能不能用。差分方程里 $y[n-1]$ 的系数是 $1-2\alpha$,这就是 z 域极点 $p$。$\alpha$ 取 0.5 时 $p=0$,一拍到位;$\alpha$ 小于 0.5 时 $p$ 为正,响应单调衰减;一旦 $\alpha$ 超过 0.5,$p$ 变负,阶跃响应会出现上下交替的锯齿。下面是按 $\alpha=\frac{T}{T+2\tau}$ 换算出来的对照,选参数时可以当前置参考:
| Alpha | 极点 p = 1-2α | 等效 τ/T | 响应特征 |
|---|---|---|---|
| 0.05 | 0.90 | 9.5 | 很平滑,滞后明显 |
| 0.10 | 0.80 | 4.5 | 平滑,适合温度、压力 |
| 0.20 | 0.60 | 2.0 | 折中,通用场景 |
| 0.30 | 0.40 | 1.17 | 跟随快,平滑弱 |
| 0.50 | 0.00 | 0.5 | 临界,一拍到位 |
| 0.80 | -0.60 | 0.125 | 交替振荡,不要用 |
表里 $\tau/T$ 那一列,实际含义是"滤波滞后相当于几个采样周期"。如果你希望输出大约 4 个采样周期后跟上输入的 63%,$\alpha$ 就落在 0.1 附近,这个换算比反复试凑靠谱得多。
2.2 逐行读 SCL:计数器、状态量和执行顺序
功能块的主体就这么长,每一行都有它的位置:
scl复制FUNCTION_BLOCK "FB_Tustin_LPT"
{ S7_Optimized_Access := 'TRUE' }
VERSION : 0.1
VAR_INPUT
xn : Real; // 本拍输入采样值
Alpha : Real; // 滤波系数,标称 0.0~1.0
diCycle : DInt := 10; // 期望的滤波执行周期 Ts,单位 ms
diIntTime : DInt := 10; // 调用本 FB 的定时中断周期,单位 ms
END_VAR
VAR_OUTPUT
yn : Real; // 滤波输出
END_VAR
VAR
xn_1 : Real; // 上一拍输入
yn_1 : Real; // 上一拍输出
Cnt : DInt; // 毫秒计数器
END_VAR
BEGIN
// 一阶低通,双线性变换(Tustin)
IF #Cnt >= #diCycle THEN
#yn := #yn_1 + #Alpha * (#xn + #xn_1 - 2.0 * #yn_1);
#yn_1 := #yn;
#xn_1 := #xn;
#Cnt := 0;
END_IF;
#Cnt := #Cnt + #diIntTime;
END_FUNCTION_BLOCK
先看四个输入。xn 是这一拍的采样值,来自模拟量通道处理后的实数;Alpha 是 2.1 里推出来的系数;diCycle 是你希望滤波器多久算一次,单位毫秒;diIntTime 是调用它的那个定时中断的真实周期,同样是毫秒。这两个参数名字很像,作用完全不同——diCycle 决定采样周期 $T$,diIntTime 只负责让计数器走对时间。把它们填成同一个值只是常见特例,不是语法要求。
再看三个静态变量。xn_1、yn_1 是滤波器跨拍保存的状态,Cnt 是毫秒累计器。它们声明在 VAR 段而不是 VAR_INPUT,意味着它们存在背景数据块里,每次调用自动保留上一次的值,这正是功能块能"记住历史"的原因。也正因为如此,同一个背景 DB 被两处调用时状态会互相污染,后面避坑章节会专门讲。
执行顺序值得多说一句。判断 IF #Cnt >= #diCycle 在累加之前,累加在 IF 之后无条件执行。所以第一次调用时 Cnt 是 0,条件不成立,Cnt 变成 diIntTime;第二次调用才开始判断。如果 diCycle 是 diIntTime 的 10 倍,那么从冷启动到第一拍滤波输出要等 10 个调用周期,这段时间 yn 一直是 0。这个启动延迟不是 bug,但如果你把它接到一个调节回路上,投运瞬间会被当成"测量值掉到零"。
条件成立时做四件事:算新输出、把输出存进 yn_1、把输入存进 xn_1、清零计数器。注意清零之后紧接着又加了一次 diIntTime,所以计数器不是从 0 重新开始,而是从 diIntTime 开始。这个细节让"diCycle 是 diIntTime 整数倍"的配置能够稳定地按倍数降频,但也意味着 diCycle 不能随便填一个不是整数倍的值,否则实际执行周期会在两个相邻值之间来回跳。
最后一行 #Cnt := #Cnt + #diIntTime; 是整个块的时基来源。它假设"FB 被调用的真实间隔等于 diIntTime"。这个假设一旦不成立,滤波器的时间尺度就整体跑偏——这也是现场翻车最多的地方。
3. 把滤波器做成功能库:建 FB、贴 SCL、挂中断、出版本
3.1 建块与接口声明:四个输入、一个输出、三个静态量
在项目树里添加新块,类型选函数块(FB),编程语言选 SCL,名字就用 FB_Tustin_LPT。块属性里把"优化的块访问"打勾,这样静态变量按符号访问,在线修改单个参数时不用整体下载。版本号先写 0.1,等库发布时再往上加。
接口按 2.2 里的清单逐个敲进去,别改名字。参数名是功能库的契约,改了名字,之前项目里已经调用的实例全部要重连。下面这张表建议直接抄进块的注释区,接手的人看一眼就知道每个脚该接什么:
| 名称 | 类型 | 默认值 | 含义 | 填写依据 |
|---|---|---|---|---|
| xn | Real | 无 | 本拍输入 | 接模拟量通道处理后的工程量 |
| Alpha | Real | 无 | 滤波系数 | 按 τ 和 Ts 换算,建议 0.01~0.5 |
| diCycle | DInt | 10 | 滤波执行周期 Ts(ms) | 期望的采样间隔 |
| diIntTime | DInt | 10 | 调用侧中断周期(ms) | 必须等于实际调用间隔 |
| yn | Real | 无 | 滤波输出 | 接显示、报警或调节回路 |
Alpha 不要给默认值。给了默认值,别人拖出来直接用,参数就悄悄生效了,出了问题很难追。空着不填,编译虽然能过,但第一次扫描输出就是初值,等于强制使用者去确认一次。
3.2 贴入 SCL 并处理两个编译细节
把 2.2 的代码整段贴进代码区。编译前有两处容易卡住。第一处是局部变量前缀:SCL 里访问块内变量必须带 #,#Cnt、#Alpha 一个都不能漏,漏了会被当成全局变量去找,报"未定义的变量"。第二处是 2.0*#yn_1 里的 2.0,写成整数 2 在某些编译器版本里会因为 Real 与 Int 混合运算给出类型提示,写 2.0 最省事。
贴完之后先做一次不下载的编译。编译通过只说明语法对,还要看块属性里的"优化的块访问"是否真的打开了。没打开的话,静态变量会按绝对地址偏移存放,以后往 VAR 段里加一个新变量,后面所有变量的偏移全变,正在运行的程序读到的是错位的数据。
这一步做完,建议立刻做一次冷启动自检:手动把 xn 强制成 100.0,Alpha 填 0.1,diCycle 和 diIntTime 都填 10,在线看 yn 是不是从 0 开始单调爬升、最后稳定在 100.0 附近。稳定值不等于 100.0 说明公式或类型有问题,先别往下走。
3.3 挂到循环中断并让 diIntTime 对上真实周期
功能块本身不知道时间,它靠调用它的地方给节奏。正确做法是建一个循环中断 OB,把循环时间设成你想要的采样周期,比如 10ms,然后在 OB 里调用:
scl复制// 循环中断 OB 中调用,一个通道配一个独立背景 DB
"FB_Tustin_LPT_DB_Ch1"(xn := "AI_Temp_Raw",
Alpha := "Alpha_Temp",
diCycle := 10,
diIntTime := 10,
yn => "Temp_Filtered");
调用时 diCycle 填 10,表示采样周期 10ms;diIntTime 也填 10,因为这个 OB 的循环时间就是 10ms。两者相等时,滤波器每个中断执行一次,Alpha 直接对应 10ms 的采样周期。如果你想让滤波 20ms 算一次省点运算量,把 diCycle 改成 20,diIntTime 保持 10,实际执行周期就是 20ms,此时 Alpha 要按 20ms 的 $T$ 重新换算——系数和周期是绑定的,改一个必须重算另一个。
循环中断的相位也要留意。如果同一个 OB 里还挂了别的调节功能,滤波放在调节之前,保证调节回路拿到的是本周期已经更新过的值。顺序反了不会报错,但你会看到输出总是慢一拍,排查起来很费时间。
3.4 存进全局库:版本、更新和实例同步
功能库的价值在于跨项目复用,所以块调通之后要做的是把它从项目里拿出来。新建一个全局库,把 FB_Tustin_LPT 拖进库的"类型"目录,右键生成新版本,版本号写 0.1,再补一段库描述,写清楚四个输入的含义和 Alpha 的推荐范围。
发布之后,别的项目从库里拖出来的就是这个 FB 的副本,背景 DB 由使用方自己生成。这里有个必须提前知道的机制:库里的块升级到 0.2 之后,老项目不会自动跟着变,需要手动打开库更新对话框,逐个确认哪些实例要同步。确认之前先看一眼 0.2 改了什么——如果改的是接口,同步之后老项目的调用点会全部报错,那还不如先不同步,等下次停机窗口再处理。
我的习惯是每次改库之前先导出一份源文件,和版本号一起归档。SCL 源文件是纯文本,能 diff,能看出到底改了一行公式还是改了接口,比在图形界面里比对块可靠得多。
4. 功能库避坑与排查:五个会让你返工的细节
4.1 滤波效果和仿真对不上,实际采样周期跑了
现象:离线按 10ms 算好的 Alpha,投运后输出抖动一点没压住,阶跃响应比预期快了好几倍,看起来像滤波几乎没起作用。
原因:FB 挂在了主循环 OB 上,主循环扫描周期是 2ms,而 diIntTime 还填着 10。计数器每 2ms 只加 10,攒够 diCycle=10 只需要一次调用,实际滤波周期变成 2ms 而不是 10ms。真实采样周期 $T$ 缩小到原来的五分之一,同一个 Alpha 对应的 $\tau$ 也跟着缩小五分之二,滤波自然形同虚设。反过来,如果 diIntTime 填得比调用间隔小,计数器走得慢,滤波周期被拉长,滞后会大得离谱。
解决:先确认 FB 到底挂在哪个 OB、那个 OB 的真实循环时间是多少,把 diIntTime 改成这个真实值。最稳的做法是固定挂在循环中断里,中断周期和 diIntTime 用同一个常量,改的时候一起改。
4.2 Alpha 填 0 或超过 0.5,输出卡死或来回抖
现象:输出一直停在某个值不动,输入怎么变都不跟;或者阶跃上来之后输出在目标值上下交替跳,像在振荡。
原因:Alpha 填了 0。代进差分方程,yn = yn_1 + 0,输出永远等于初值,等于把滤波器变成了一个常量。Alpha 超过 0.5 时极点变负,响应开始一拍正一拍负地交替衰减,看起来就是抖。这两个值都不算非法输入,编译和下载都不会拦你,所以特别容易被 HMI 上一个手滑的写操作带进去。
解决:在 HMI 侧给 Alpha 加输入限制,下限 0.01、上限 0.5,越界直接拒绝写入。程序里再加一层保护,检测到 Alpha <= 0.0 或 Alpha >= 0.5 时把输出直接跟随输入,同时置一个诊断位,让人知道参数被写坏了。
4.3 两个通道共用一个背景 DB,状态互相污染
现象:温度和压力两个通道用同一个 FB 实例,明明只动了温度那一路,压力通道的滤波输出也跟着跳一下。
原因:xn_1、yn_1、Cnt 都是静态变量,存在背景 DB 里。两处调用指向同一个 DB,就是同一组状态量被两个数据源轮流覆盖。每次调用都把 xn_1 换成自己那一路的输入,下一拍再被另一路覆盖,差分方程算出来的东西自然什么都不是。
解决:一个通道一个实例。可以在调用它的 OB 里做多重背景,也可以每个通道生成独立的背景 DB。命名上带通道号,比如 FB_Tustin_LPT_DB_Ch1、_Ch2,看一眼就知道不能混用。
4.4 冷启动第一拍输出是 0,投运被当成测量故障
现象:设备刚上电,输入已经是满量程,滤波输出却从 0 慢慢往上爬,接在后面的调节回路或者报警逻辑直接判成断线。
原因:两件事叠在一起。一是 yn_1 初值是 0,滤波器从零状态开始追一个非零输入,追的速度由 $\tau$ 决定;二是 2.2 里说的启动延迟,Cnt 要先攒够 diCycle 才执行第一拍,这段时间 yn 一直是 0。
解决:投运前做一次无扰预置,把 yn_1 和 xn_1 直接写成当前输入值,让滤波器从稳态起步。可以在 FB 里加一个 Init 输入,上升沿时执行预置;也可以在启动 OB 里对背景 DB 的静态量直接赋值。我倾向前者,逻辑留在功能库内部,使用者不用记着每次上电都要多做一步。
4.5 同一个实例在多处调用,计数器被加了两次
现象:滤波周期莫名其妙变成设定值的一半,Alpha 明明没动,效果却比离线算的弱。
原因:Cnt := Cnt + diIntTime 这一行是每次调用都执行的。同一个背景 DB 如果在主循环里调一次、又在某个中断里调一次,计数器一次扫描被加了两遍,攒够 diCycle 的速度翻倍,实际采样周期减半。
解决:一个实例只在一个 OB 里调用一次。如果确实需要在不同地方读滤波结果,读输出引脚就行,不要为了"方便"在多处重复调用。查这个问题有个笨办法但很有效:在线监控 Cnt,看它在一个扫描周期里是不是跳了两格,跳了就是重复调用。
5. 功能库整定与验证:Alpha 扫描、阶跃对照和验收习惯
5.1 用阶跃把参数扫一遍
整定不要凭手感。做一个测试用的阶跃源,在测试 OB 里每 5 秒给一次 0 到 100 的跳变,接到 xn 上,然后用变量趋势记录同时抓 xn 和 yn。Alpha 从 0.05 开始,按 0.05、0.1、0.2、0.3 四档依次试,每档至少抓两个完整阶跃周期再换下一档。
scl复制// 测试 OB 中用:每 5 秒一个阶跃,只用于整定,不随设备交付
IF "TestStep_En" THEN
#t := #t + 10; // 与 OB 循环时间一致
IF #t >= 5000 THEN
#t := 0;
END_IF;
"xn_Test" := 0.0;
IF #t >= 2500 THEN
"xn_Test" := 100.0;
END_IF;
END_IF;
这段只负责造激励,不参与正式逻辑,整定完记得把 TestStep_En 关掉,别留在交付程序里。
看曲线时盯三个点:输出有没有越过 100.0(一阶系统不该超调,超了就是 Alpha 太大或极点已经变负);稳态值是不是稳稳落在 100.0(不等就是增益有问题);从 0 到 63 用了几个采样周期,和 2.1 表里的 $\tau/T$ 对不对得上。对不上,先回去查 4.1 的周期问题,别急着改 Alpha。
5.2 验收清单和我的固定习惯
功能库发布前,我会把下面几项逐条走完,任何一项不过就不出版本:
| 验收项 | 判据 | 怎么看 |
|---|---|---|
| 稳态增益 | 输出稳态值等于输入 | 阶跃稳定后读 yn |
| 无超调 | 输出不越过阶跃目标 | 趋势图放大看峰值 |
| 周期一致 | 实际执行间隔等于 diCycle |
在线监控 Cnt 的跳变节奏 |
| 冷启动 | 预置后第一拍不跳变 | 重新下载后观察首扫描 |
| 实例隔离 | 改一路不影响另一路 | 两通道同时给不同输入 |
最后一条习惯是从一次返工里换来的:那次我把 Alpha 在线从 0.2 改成 0.5,输出当场跳了一下,下游调节回路跟着动作,查了半天才想明白是改参数的瞬间 yn_1 还停在旧系数算出来的状态,差分方程在参数突变点上不连续。从那以后,我每次把这个滤波器 FB 拖进新项目,都强制走一遍固定顺序:先确认挂载的 OB 和真实循环时间,再填 diIntTime,然后按 $\tau$ 换算 Alpha,最后才做阶跃验证;要改 Alpha,先把 yn_1 同步写回当前输出,绝不在线硬改。顺序颠倒一次,代价往往是一整个下午的排查。希望帮到你。
