033、陷波滤波器与谐振抑制

033 陷波滤波器与谐振抑制

一、一个让我失眠三天的调试现场

去年做一台六轴工业机器人，末端抖动得像筛糠。位置环增益已经压到0.8，速度环带宽从200Hz砍到80Hz，电机还是在高频段发出刺耳的啸叫。示波器抓电流波形，50Hz的基频上叠着一串120Hz的毛刺——机械谐振，而且不止一个模态。

当时团队里有人提议“把增益再降一降”，我直接否了。降增益治标不治本，机器人干活像喝醉了一样，轨迹精度根本没法看。后来在电流环输出端塞了一个二阶陷波器，谐振峰从12dB直接压到-3dB以下，电机安静得像猫走路。那个晚上我盯着示波器屏幕，第一次觉得数字滤波器这东西，比什么PID调参都性感。

二、谐振的本质：机械系统在跟你唱反调

伺服系统的谐振，说白了就是电机轴和负载之间的弹性连接在某个频率上产生了共振。你给电机一个正弦扭矩，负载在谐振频率附近会放大响应，相位还会突然翻转180度。这在波特图上看得清清楚楚——幅频曲线突然冒出一个尖峰，相频曲线在那个频率点附近急剧下降。

谐振频率通常由机械结构的刚度、惯量比决定。比如一个典型的双惯量系统（电机+联轴器+负载），谐振频率大致是：

[
f_{res} = \frac{1}{2\pi} \sqrt{\frac{K}{J_L \cdot (1 + J_L/J_M)}}
]

K是扭转刚度，J_L是负载惯量，J_M是电机惯量。惯量比越大，谐振频率越低，越难处理。我见过最夸张的案例，惯量比到了30:1，谐振频率只有15Hz，整个系统在低频段就抖得没法用。