2、运动控制基础：伺服系统、电机模型、机械传动、速度环/位置环控制架构及性能指标

运动控制系统的设计，无论是面向精密数控机床、半导体设备还是机器人关节，其底层逻辑都建立在“对象建模—控制架构—性能评估”这一闭环之上。扰动观测器（DOB）并非孤立存在的算法模块，它必须嵌入到由伺服驱动器、电机、机械传动链和上位控制器构成的完整系统中。理解伺服系统的组成、电机与机械负载的数学模型、双闭环（甚至三闭环）的控制架构，以及衡量控制品质的性能指标体系，是设计有效扰动观测器的前提。本章将系统梳理这些基础要素，并重点剖析它们与扰动观测器设计之间的内在关联。

上图展示了运动控制系统的基本信号流与扰动观测器的典型嵌入位置。从工程视角看，DOB并非独立于控制环路的“外挂”，而是与速度环、电流环深度耦合的补偿机制。下面我们将从伺服系统的组成开始，逐步深入。

2.1 伺服系统的组成与分类

伺服系统（Servo System）的本质是“跟随指令的闭环控制系统”，其核心任务是对位置、速度或力矩指令进行高精度、高动态的跟踪。一个完整的伺服系统通常由四大部分构成：控制器（上位机或运动控制卡）、驱动器（伺服驱动器）、执行电机（永磁同步电机PMSM或直流无刷电机BLDC）以及反馈传感器（编码器、旋转变压器或光栅尺）。

从控制对象划分，伺服系统可分为三类：

• 位置伺服系统：以位置为最终控制目标，常见于数控机床进给轴、贴片机XY平台。
• 速度伺服系统：以转速为控制目标，常见于主轴驱动、卷绕控制。
• 力矩伺服系统：以输出力矩为控制目标，常见于机器人关节、张力控制。

在工程实践中，绝大多数位置伺服系统内部嵌套了速度环和电流环，形成“三环”结构。DOB通常设计在速度环内部，因为速度环是抑制负载扰动和机械谐振的关键层级。

2.2 电机模型与机械传动建模

DOB设计的基础是标称模型 Pn(s)。对于永磁同步电机（PMSM），在d-q坐标系下，其电气动态可简化为：

电压方程：Vq = R·Iq + Lq·(dIq/dt) + ωe·(λpm + Ld·Id)
力矩方程：Te = 1.5·p·[λpm·Iq + (Ld - Lq)·Id·Iq]
机械方程：J·(dωm/dt) = Te - B·ωm - TL

其中，J为转动惯量，B为粘滞摩擦系数，TL为负载力矩（包含切削力、重力矩、摩擦力矩等）。在电流环带宽足够高（通常>1kHz）的前提下，电气动态可忽略，电机模型简化为：

P(s) = Kt / (J·s + B) ≈ Kt / (J·s)   （当B很小时）

机械传动链的建模则更为复杂。常见的传动形式包括：

• 刚性联轴器+滚珠丝杠：可简化为双惯量系统（电机惯量Jm + 负载惯量JL），存在扭转刚度K和阻尼C。
• 同步带传动：引入皮带柔性和张紧力变化，模型阶次更高。
• 齿轮减速箱：引入齿隙（Backlash）和传动误差。

对于双惯量系统，其传递函数为：

P(s) = (JL·s² + C·s + K) / [s·(Jm·JL·s³ + (Jm+JL)·C·s² + (Jm+JL)·K·s)]

该模型存在一对共轭零点和一对共轭极点，对应着机械谐振频率和反谐振频率。DOB设计时，若标称模型Pn(s)忽略了谐振，则扰动观测误差会在谐振频率附近显著放大。

2.3 速度环/位置环控制架构

标准运动控制架构采用“位置环-速度环-电流环”三环嵌套结构，从外到内带宽依次提高（典型比例：位置环带宽:速度环带宽:电流环带宽 ≈ 1:5:20）。

电流环：最内层，控制电机力矩。采用PI控制器，带宽最高（1~2 kHz），主要抑制反电动势和电流纹波。

速度环：中间层，控制电机转速。采用PI控制器，带宽通常为50~300 Hz。速度环是DOB的主要嵌入位置，因为：

1. 速度信号可由编码器差分获得，无需额外传感器。
2. 负载扰动（如切削力突变）首先表现为速度波动，DOB在此处补偿最直接。
3. 速度环带宽适中，Q滤波器的设计自由度较大。

位置环：最外层，控制机械位置。通常采用P控制器（比例），甚至加入速度前馈以提高跟踪性能。位置环带宽较低（5~50 Hz），对DOB的快速性要求不高，但DOB的稳态补偿精度直接影响定位精度。

2.4 性能指标体系与DOB设计目标

衡量运动控制系统性能的指标可分为时域指标、频域指标和扰动抑制指标三类。DOB的设计目标就是改善后两类指标。

2.5 案例拆解：双惯量系统DOB设计中的模型失配问题

背景与约束：某精密转台采用直驱电机（无减速器），负载为一个直径300mm的铝合金圆盘，电机转子惯量 Jm=0.002 kg·m²，负载惯量 JL=0.008 kg·m²，通过一个柔性联轴器连接，扭转刚度 K=500 N·m/rad，阻尼 C=0.1 N·m·s/rad。系统要求速度环带宽 150 Hz，突加 5 N·m 负载力矩时速度跌落不超过 3% 额定转速（额定转速 500 rpm）。

初始现象：采用传统PI速度环（Kvp=2.5, Kvi=150）时，实测带宽仅 90 Hz，突加负载后速度跌落达 8%，且伴随 280 Hz 的振荡（对应机械谐振频率）。

分析过程：

1. 计算双惯量系统谐振频率：fn = (1/2π)·√(K·(Jm+JL)/(Jm·JL)) = (1/2π)·√(500·0.01/0.000016) ≈ 281 Hz。
2. 传统PI速度环在谐振频率附近相位滞后严重，导致系统接近不稳定。
3. 设计DOB时，若标称模型取 Pn(s) = 1/(J·s)（忽略谐振），则DOB在281Hz附近会产生错误的补偿信号，反而加剧振荡。

实际操作步骤：

1. 辨识实际对象频率响应（使用扫频信号或伪随机序列激励）。
2. 建立标称模型 Pn(s) = (JL·s² + C·s + K) / [s·(Jm·JL·s³ + (Jm+JL)·C·s² + (Jm+JL)·K·s)]
   代入参数：Jm=0.002, JL=0.008, K=500, C=0.1。
3. 设计Q滤波器：选择二阶低通 Q(s) = 1/(τ·s+1)²，取 τ=0.001 s（截止频率约160 Hz），
   低于反谐振频率（约140 Hz）但高于速度环带宽（150 Hz）。
4. 在速度环PI控制器输出端叠加DOB补偿量。
5. 仿真验证：在Simulink中搭建双惯量模型，对比有无DOB的阶跃响应和扰动响应。

结果对比：加入DOB后，速度环带宽提升至 180 Hz，突加负载速度跌落从 8% 降至 2.5%，且 280 Hz 振荡被有效抑制。代价是DOB在160 Hz以上引入了约 10 dB 的噪声放大，需在编码器信号处理中增加低通滤波。

风险与复盘：DOB的Q滤波器截止频率不能无限提高。若将τ减小至0.0005 s（截止频率320 Hz），虽然扰动抑制更好，但系统在谐振频率附近的鲁棒性急剧下降，模型失配（如温度变化导致K漂移）时可能失稳。工程上建议Q滤波器截止频率不超过反谐振频率的0.7倍。

2.6 常见误区与总结复盘

在运动控制基础与DOB结合的设计中，工程师常犯以下错误：

• 误区一：标称模型过于简化。将双惯量系统简化为单惯量，导致DOB在谐振频率附近输出错误补偿。正确做法是至少保留到双惯量模型，或通过频域辨识获取实际频率响应。
• 误区二：Q滤波器截止频率设置过高。追求全频段扰动抑制，忽略了测量噪声放大和鲁棒性下降。经验法则：Q滤波器截止频率 ≤ 速度环带宽的1.5倍，且 ≤ 反谐振频率的0.7倍。
• 误区三：忽视编码器量化噪声。速度信号由位置差分获得，量化噪声在高速时尤为明显。DOB对噪声敏感，需在速度反馈路径中加入合适的低通滤波（如二阶Butterworth，截止频率为速度环带宽的5倍）。
• 误区四：DOB与陷波器冲突。当机械谐振严重时，工程师常先加陷波器再设计DOB。但陷波器会改变对象相位特性，导致DOB的标称模型与实际对象失配。正确顺序是：先辨识对象→设计DOB→若仍有谐振残留，再在DOB外部加陷波器。

总结复盘：运动控制基础是DOB设计的土壤。伺服系统的类型决定了DOB的嵌入层级；电机与机械传动的精确建模决定了标称模型Pn(s)的准确性；速度环/位置环的架构决定了DOB的带宽约束；性能指标体系则量化了DOB的补偿效果。在实际项目中，建议按以下流程推进：

1. 明确系统类型与性能目标（定位精度、速度平稳性、扰动抑制比）。
2. 进行对象辨识（至少获取频率响应数据，辨识惯量、谐振频率、阻尼比）。
3. 建立包含机械谐振的标称模型，而非理想积分模型。
4. 设计速度环PI参数（基于带宽和相位裕度要求）。
5. 设计DOB的Q滤波器，仿真验证灵敏度函数S(s)的改善。
6. 硬件在环测试，逐步提高Q滤波器截止频率，观察噪声与鲁棒性。