双惯量伺服系统谐振抑制与陷波滤波器应用

1. 项目背景与核心问题

双惯量伺服系统在工业自动化领域应用广泛，从数控机床到机器人关节都能见到其身影。这类系统本质上由电机（第一惯量）通过弹性联轴器或传动轴（表现为扭转弹簧）连接负载（第二惯量）构成。我在调试某型号工业机械臂时，曾遇到一个典型现象：当执行快速定位指令时，末端执行器会出现持续的高频抖动，同时伴随刺耳的共振噪声。这种机械谐振现象轻则影响定位精度，重则导致机械部件疲劳损坏。

通过频域分析发现，系统在87Hz处存在明显的谐振峰，这正是弹性传动部件与负载惯量耦合产生的结构谐振频率。传统PID控制在这种场景下表现乏力——若提高增益来增强刚度，会激发更强烈的谐振；若降低增益则导致系统响应迟缓。此时就需要引入陷波滤波器（Notch Filter）这种"频率外科手术刀"，专门针对特定频段进行精准衰减。

2. 陷波滤波器原理深度解析

2.1 数学本质与传递函数

陷波滤波器的核心是一个在特定频率处产生极深衰减的带阻滤波器。其标准二阶传递函数为：

code复制G_notch(s) = (s² + ωₙ²) / (s² + 2ζωₙs + ωₙ²)

其中ωₙ=2πfₙ为谐振角频率，ζ控制带宽。在Matlab中可通过notch函数快速生成：

matlab复制wn = 87*2*pi;  % 谐振频率87Hz转rad/s
zeta = 0.1;    % 阻尼系数
G_notch = tf([1 0 wn^2], [1 2*zeta*wn wn^2]);

注意：ζ取值需权衡——过小会导致相位突变剧烈，过大则衰减不足。建议初始取0.1~0.3，通过波特图观察效果。

2.2 参数整定实践经验

在实际项目中，谐振频率往往不会精确等于理论值。我总结的调试步骤是：

1. 通过扫频实验或FFT分析确定谐振频带
2. 设置初始ζ=0.2，在±5%范围内微调ωₙ
3. 观察时域响应，若出现相位滞后导致的震荡，适当增大ζ
4. 最终验证各频率点的开环特性

某次现场调试记录显示：当传动皮带老化后，谐振频率从87Hz漂移至83Hz。此时需要重新辨识参数，这也引出了自适应陷波滤波器的需求。

3. Simulink建模与联合仿真

3.1 双惯量系统建模要点

建立精确的双惯量模型需要注意几个关键参数：

ma复制