双惯量系统谐振抑制：输入整形技术在运动控制中的应用

1. 项目背景与核心问题

双惯量系统在工业自动化领域极为常见，比如机械臂关节、数控机床主轴、伺服驱动系统等。这类系统本质上由电机（第一惯量）通过弹性传动部件（如谐波减速器、联轴器）连接负载（第二惯量）构成。我在调试某型号SCARA机械臂时，就遇到过末端执行器在加减速阶段出现持续低频抖动的棘手问题——这正是典型的机械谐振现象。

这种谐振的本质在于：当电机施加的扭矩频率接近系统固有频率时，弹性元件储存的势能与惯量元件的动能相互转化，形成持续振荡。传统PID控制虽然能保证稳态精度，但对这种特定频率的扰动抑制效果有限。而输入整形技术（Input Shaping）提供了一种前馈补偿思路——通过精心设计输入信号的时序和幅值，让后续产生的振动相互抵消。

2. 系统建模与谐振分析

2.1 双惯量系统传递函数推导

建立如图所示的Simulink模型，其传递函数可表示为：

code复制J1*J2*s^4 + (J1*b2+J2*b1)*s^3 + (J1*K+J2*K+b1*b2)*s^2 + (b1*K+b2*K)*s

其中J1=0.02 kg·m²（电机惯量）、J2=0.5 kg·m²（负载惯量）、K=100 N·m/rad（轴刚度）、b1=b2=0.1 N·m·s/rad（阻尼系数）。通过roots()函数计算极点，发现系统存在一对共轭复极点对应谐振频率ωn=√(K(J1+J2)/(J1*J2))≈34.6 rad/s（5.5Hz）。

注意：实际项目中需通过频响测试验证模型准确性。我曾用B&K加速度传感器实测某伺服系统，发现模型误差主要来自非线性阻尼，此时需在Simulink中加入LuGre摩擦模型。

2.2 谐振对运动控制的影响

在阶跃响应仿真中可见明显超调（约25%）和持续振荡。更严重的是在梯形速度曲线跟踪时，加速度阶段激发的谐振会持续到匀速段，导致末端定位误差达±0.15mm——这对精密装配来说是灾难性的。通过FFT分析误差信号，可清晰观察到5.5Hz处的能量峰值。

3. 输入整形器设计与实现

3.1 基本原理与零振动（ZV）整形器

输入整形的核心思想是将单一脉冲输入分解为多个幅值和时间间隔优化的脉冲序列。对于已知谐振频率ωn和阻尼比ζ的系统，ZV整形器的脉冲时刻和幅值由：

code复制A_i = [1/(