2、运动控制基础：伺服系统、闭环控制、PID控制原理，以及前馈补偿的引入动机
运动控制系统的核心任务，是让执行机构按照指令轨迹精确运动。无论是数控机床的进给轴、工业机器人的关节，还是半导体设备中的晶圆台，其本质都是通过伺服系统将电信号转化为机械位移，并利用闭环控制消除扰动与误差。在深入前馈补偿技术之前，必须先厘清伺服系统的组成、闭环控制的基本逻辑以及PID调节器的特性——因为前馈并非替代反馈，而是在反馈已经稳定工作的基础上，进一步消除“滞后”与“跟随误差”的手段。本章将围绕这四个层次展开：先建立伺服系统的整体框架，再剖析闭环控制与PID的数学本质，最后通过误差来源分析引出前馈补偿的必要性。
2.1 伺服系统的组成与信号流
伺服系统（Servo System）是运动控制系统的执行核心，其典型结构包含四个环节：控制器（负责轨迹规划与闭环算法）、伺服驱动器（内含电流环与速度环）、执行电机（通常为永磁同步电机或直流无刷电机）以及反馈传感器（增量式编码器、式编码器或光栅尺）。在高端应用中，还会加入直线电机、力矩电机或压电执行器等特殊执行元件。
从信号流角度看，位置指令 P_ref(t) 由运动控制器生成，经过位置环比较器与反馈位置 P_act(t) 做差，得到位置误差 e(t)。该误差进入位置环调节器（通常为P或PD），输出速度指令 v_ref(t)。速度指令再与速度反馈比较，经速度环PI调节器输出电流指令 i_ref(t)，最终由电流环控制电机转矩。整个链路呈现三环嵌套结构：电流环最内层（带宽最高，通常1-2kHz），速度环中间层（带宽200-500Hz），位置环最外层（带宽20-100Hz）。
2.2 闭环控制的核心逻辑与稳定性约束
闭环控制的基本思想是“检测偏差、纠正偏差”。以位置环为例，其开环传递函数通常可简化为：
G_open(s) = Kp · (Kt / (J·s²)) · (1 / (τ·s + 1))其中 Kp 为位置环增益，Kt 为电机转矩常数，J 为负载转动惯量，τ 为速度环等效时间常数。闭环后，系统从指令到输出的传递函数为：
G_close(s) = G_open(s) / (1 + G_open(s))增大 Kp 可以减小稳态误差、提高响应速度，但过大的 Kp 会导致系统阻尼比下降，产生振荡甚至不稳定。根据经典控制理论，位置环的增益上限受限于速度环带宽和机械谐振频率。工程上通常将位置环增益设置为速度环带宽的1/5至1/3，以保证足够的相位裕度（通常要求大于45°）。
闭环控制存在一个本质矛盾：反馈控制只能在误差出现之后才产生修正作用。对于匀速跟踪，稳态时位置误差近似为 v/Kp（v为进给速度）；对于加速段，误差进一步增大。这意味着，只要指令在变化，反馈控制就必然存在“跟随滞后”。
2.3 PID控制原理与参数作用
PID控制器是运动控制中最广泛使用的算法，其输出为：
u(t) = Kp·e(t) + Ki·∫e(t)dt + Kd·de(t)/dt三个环节的作用如下：
| 环节 | 数学表达 | 对系统的影响 | 典型应用场景 |
|---|---|---|---|
| 比例 P | Kp·e(t) | 提高响应速度，减小稳态误差；过大会导致振荡 | 所有运动控制的基础环节 |
| 积分 I | Ki·∫e(t)dt | 消除稳态误差；但会降低相位裕度，引起超调 | 点位运动、恒速段 |
| 微分 D | Kd·de(t)/dt | 增加阻尼，抑制超调；对噪声敏感 | 高速高加速轨迹 |
在位置环中，通常只使用PD控制（不加积分），因为位置指令本身是阶跃或斜坡信号，P环节已能保证稳态精度。速度环则常用PI控制，以消除速度静差。电流环使用高带宽PI控制，确保转矩快速响应。
2.4 前馈补偿的引入动机：反馈控制的固有局限
为了定量说明反馈控制的局限，我们分析一个典型场景：数控机床以 F=6000mm/min（即100mm/s）的速度做匀速直线运动，位置环增益 Kp=30 1/s。则稳态跟随误差为：
e_ss = v / Kp = 100 / 30 ≈ 3.33 mm这个误差在精密加工中是不可接受的。更严重的是，在加减速阶段，误差会进一步增大。例如，若加速度 a=1000mm/s²，则动态误差约为 a/Kp² = 1000/900 ≈ 1.11mm，叠加匀速误差后总误差超过4mm。
反馈控制无法消除这类误差的根本原因在于：误差是产生修正力的前提。要消除误差，必须先有误差；而误差存在时，输出已经偏离指令。这种“事后补偿”的特性决定了反馈控制的滞后性。
前馈补偿的思路是：直接根据指令的变化率（速度、加速度甚至加加速度）预先计算所需的控制量，在误差产生之前就施加修正。其数学基础是系统的逆模型：如果已知被控对象的传递函数 G(s)，则前馈控制器可取 F(s) = 1/G(s)，使得指令到输出的传递函数近似为1。
2.5 前馈补偿的工程实现与案例分析
以某半导体固晶机为例，其XY平台需要完成“取晶→贴装”的往复运动，单次行程20mm，要求运动时间小于80ms，定位精度±2μm。初始方案仅使用PID反馈控制，实测数据如下：
| 指标 | 纯反馈控制 | 加入速度前馈 | 加入加速度前馈 |
|---|---|---|---|
| 最大跟随误差 | 0.85mm | 0.32mm | 0.08mm |
| 定位时间（±2μm） | 95ms | 72ms | 58ms |
| 超调量 | 12% | 5% | 1.5% |
实施步骤：
- 辨识系统模型：通过频率响应测试，得到平台从速度指令到位置的传递函数近似为 G(s) = 1/(s·(0.002s+1))，即一个积分环节加一个2ms惯性环节。
- 设计速度前馈：取 Kvff = 1（因为速度指令到位置是积分关系，前馈系数为1即可消除匀速误差）。
- 设计加速度前馈：取 Kaff = 0.002（对应惯性时间常数），用于补偿加速段的动态误差。
- 调试顺序：先加速度前馈，观察匀速段误差是否趋近于零；再加加速度前馈，观察加减速段误差是否减小。注意前馈系数过大会导致过冲。
最终，系统在保持原有反馈参数不变的情况下，通过前馈将跟随误差降低了90%以上，定位时间缩短了39%。值得注意的是，前馈并未改变系统的稳定性裕度，因此调试风险远低于单纯增大PID增益。