伺服系统机械谐振抑制与自适应陷波滤波器设计

1. 项目背景与核心问题

在工业自动化领域，伺服系统的机械谐振问题一直是困扰工程师的典型难题。当系统运行在特定频率区间时，机械传动部件（如联轴器、减速机）的弹性变形与负载惯量相互作用，会产生明显的振动现象。这种现象轻则影响定位精度，重则导致机械部件疲劳损坏。

我曾在某半导体设备项目中亲历过这类问题——当执行器以200Hz左右频率运动时，末端执行器出现肉眼可见的高频抖动，导致晶圆定位偏差达到±5μm，远超工艺要求的±1μm。经过频谱分析，我们确认这是典型的双惯量系统谐振现象。

2. 双惯量系统建模原理

2.1 物理模型构建

双惯量系统本质上是将伺服电机转子惯量Jm与负载惯量Jl通过弹性联轴器（刚度系数K）连接的系统。其运动方程可表示为：

code复制Jm·θ̈m + Bm·θ̇m + K(θm - θl) = Tm
Jl·θ̈l + Bl·θ̇l - K(θm - θl) = 0

其中θm和θl分别表示电机侧和负载侧的角位移，B为阻尼系数。通过拉普拉斯变换，可以得到从电机转矩Tm到负载转速ωl的传递函数：

code复制ωl(s)       K
----- = ---------------
Tm(s)  JmJl·s² + (Jm+Jl)K

2.2 谐振频率计算

系统谐振频率由下式决定：

code复制        /K(Jm + Jl)
ωn =   / ----------
     √     Jm·Jl

例如当Jm=0.001 kg·m²，Jl=0.005 kg·m²，K=500 N·m/rad时：

code复制ωn = √[500×(0.001+0.005)/(0.001×0.005)] ≈ 245 rad/s → 39Hz

这个计算值与我们实际测量的38.7Hz谐振点高度吻合，验证了模型的准确性。

3. 陷波滤波器设计方法

3.1 传统陷波器结构

标准陷波滤波器的传递函数形式为：

code复制       s² + ωz²
G(s) = --------
       s² + ωp·s + ωp²

其中ωz为陷波中心频率，ωp=ωz/Q决定带宽，Q值越大带宽越窄。但在实际应用中，这种结构存在两个问题：

1. 直接使用会导致相位突变
2. 对参数变化敏感