4、前馈补偿的典型结构：速度前馈、加速度前馈、力矩前馈、位置前馈的适用场景与设计方法
在运动控制系统中，反馈控制（PID 类）本质上是一种“事后纠偏”机制——只有当误差已经产生，控制器才会调整输出。对于高速、高加速或变负载的工况，这种滞后往往导致跟随误差大、轮廓精度差。前馈补偿的核心思想是：根据指令信号和系统模型，提前计算并注入控制量，使被控对象“主动”跟随指令，从而将反馈回路的工作量降到最低。本章将系统剖析四种典型前馈结构——速度前馈、加速度前馈、力矩前馈和位置前馈——的数学本质、适用场景、设计方法及工程陷阱。
上图展示了前馈补偿在运动控制系统中的位置与信号关系。前馈通道与反馈通道并行，前馈量直接叠加到控制输出端，而反馈回路仅需处理前馈未能完全补偿的残余误差和外部扰动。这种“前馈粗调、反馈精调”的架构，是高性能伺服系统的标准范式。
4.1 速度前馈：消除匀速段跟随误差的第一道利器
核心原理
速度前馈的数学表达式为：U_ffv = Kffv × V*(t)，其中 V*(t) 为指令速度，Kffv 为速度前馈增益。在纯比例位置环（P 控制）系统中，稳态跟随误差与指令速度成正比：e_ss = V* / Kp。速度前馈的作用是直接注入与速度成比例的控制量，理论上可将匀速段的跟随误差降为零。其本质是对位置环开环增益不足的补偿，而非对动力学特性的补偿。
判断方法与设计流程
- 适用场景判断：当系统存在明显的匀速段跟随误差（如梯形速度规划中的恒速段），且误差大小与速度呈线性关系时，优先考虑速度前馈。
- 增益整定步骤：先关闭前馈，记录匀速段误差 e0；然后逐步增大 Kffv，观察误差变化；当误差趋近于零时，Kffv 即为最优值。理论最优值为 Kffv = 1/Kp（Kp 为位置环增益）。
- 工程修正：实际系统中，由于摩擦、死区等非线性因素，Kffv 通常需要略大于理论值，以补偿额外的压降。
案例拆解：半导体固晶机 X 轴跟随误差优化
某半导体固晶机 X 轴采用线性电机驱动，行程 300mm，最大速度 0.8m/s，加速度 2g。初始调试时，位置环增益 Kp=40 1/s，匀速段跟随误差实测为 18μm，超出工艺要求（±5μm）。
- 数据分析：在 0.5m/s 匀速段，误差稳定在 18μm；在加减速段，误差峰值达 45μm。误差与速度呈明显线性关系，确认主要成分为速度前馈缺失。
- 参数计算：理论 Kffv = 1/40 = 0.025。实际从 0.02 开始逐步增加。
- 调试过程：Kffv=0.022 时，匀速段误差降至 3μm；继续增大至 0.026，误差出现反向（-2μm），说明过补偿。最终设定 Kffv=0.024，匀速段误差稳定在 ±1.5μm。
- 结果对比：加减速段误差峰值从 45μm 降至 12μm（残余部分由加速度前馈处理）。
- 复盘：速度前馈只解决了匀速段问题，加减速段的动态误差需要加速度前馈介入。此外，线性电机的齿槽力在低速时引起周期性误差，速度前馈无法消除，需配合力矩前馈。
常见误区
- 误区一：认为速度前馈可以替代加速度前馈。实际上两者补偿的物理量不同，速度前馈补偿速度相关误差，加速度前馈补偿惯性力。
- 误区二：Kffv 越大越好。过大的前馈增益会导致系统对指令噪声敏感，甚至引起机械共振。
- 误区三：忽略前馈通道的采样延迟。数字控制中，前馈量通常滞后一个采样周期，高速时需引入超前补偿。
4.2 加速度前馈：攻克加减速段动态误差的关键
核心原理
加速度前馈的表达式为：U_ffa = Kffa × A*(t)，其中 A*(t) 为指令加速度。其物理意义是直接补偿负载的惯性力：F = m × a。在轨迹插补（如 S 曲线、正弦曲线）中，加减速段的跟随误差主要由惯性力引起，加速度前馈可显著降低动态跟踪误差。对于刚性系统，理论最优 Kffa = J_total / Kt（J_total 为负载惯量折算到电机轴的等效惯量，Kt 为电机力矩常数）。
判断方法与设计流程
| 特征 | 速度前馈 | 加速度前馈 |
|---|---|---|
| 补偿对象 | 速度相关误差（阻尼、反电动势） | 加速度相关误差（惯性力） |
| 典型误差形态 | 匀速段恒定偏移 | 加减速段抛物线形误差 |
| 增益整定依据 | 位置环增益 Kp | 惯量比 J_total / Kt |
| 对指令平滑度要求 | 中等 | 高（加速度突变会直接冲击） |
设计加速度前馈时，首先需要辨识负载惯量。常用方法包括：加减速测试法（记录不同加速度下的稳态力矩差）、模型参考自适应法（MRAS）或离线频域辨识。获得惯量后，Kffa 的初值设为 J_total / Kt，然后通过阶跃响应微调。
案例拆解：贴片机 Z 轴加速度前馈调优
某高速贴片机 Z 轴采用滚珠丝杠传动，负载惯量 J_load=2.4×10⁻⁴ kg·m²，电机转子惯量 J_m=0.6×10⁻⁴ kg·m²，电机力矩常数 Kt=0.58 Nm/A。贴装过程中 Z 轴执行 5mm 行程的往复运动，加速度设定为 3g（约 29.4 m/s²）。
- 初始现象：无加速度前馈时，Z 轴在加速段跟随误差峰值达 0.32mm，导致贴装高度偏差，良率下降 2.3%。
- 惯量辨识：通过加减速测试，测得总惯量 J_total = 3.1×10⁻⁴ kg·m²（含丝杠折算）。
- 理论计算：Kffa = 3.1×10⁻⁴ / 0.58 ≈ 5.34×10⁻⁴ (A/(m/s²))。实际控制器中，加速度前馈增益通常以百分比表示，100% 对应理论值。
- 逐步调试：从 60% 开始，每步增加 10%。在 80% 时，误差峰值降至 0.08mm；在 90% 时，误差降至 0.04mm；继续增加至 100%，出现轻微振荡（频率约 1.2kHz），判断为丝杠扭转谐振。
- 最终方案：Kffa 设定为 92%，并启用 1.2kHz 陷波滤波器（深度 -20dB，带宽 100Hz）。最终误差峰值 0.035mm，良率恢复至 99.6%。
- 复盘：加速度前馈的极限受限于机械刚度，而非电气性能。在调试中应同时关注误差曲线和电流频谱，避免盲目追求 100% 补偿。
常见误区
- 误区一：忽略惯量变化。对于变负载系统（如机械手抓取不同重量工件），固定 Kffa 无法适应，需采用惯量前馈自适应或力矩观测器。
- 误区二：将加速度前馈与速度前馈混在一起整定。应先整定速度前馈消除匀速段误差，再整定加速度前馈，否则两者相互耦合，难以收敛。
- 误区三：在加速度指令不平滑的系统（如梯形速度规划）中使用高 Kffa，会导致加速度突变处产生冲击。应使用 S 曲线或 FIR 滤波平滑指令。
4.3 力矩前馈：应对变负载与非线性扰动的主动补偿
核心原理
力矩前馈的表达式为：U_fft = Kfft × T*(t)，其中 T*(t) 为期望力矩指令。与前两种前馈不同，力矩前馈直接以力矩为补偿量，适用于以下场景：
- 重力负载：垂直轴在静止时需要持续输出力矩克服重力，力矩前馈可消除稳态静差。
- 摩擦力补偿：库仑摩擦 + 粘性摩擦模型 T_f = Fc·sign(v) + B·v，可通过力矩前馈进行前馈补偿。
- 变负载扰动：如卷绕控制中的张力变化、机械手抓取不同重量物体。
设计方法与实现路径
- 建立力矩模型：T* = J·A* + T_gravity + T_friction + T_cutting。其中 J·A* 部分可由加速度前馈覆盖，力矩前馈重点补偿后三项。
- 模型辨识：通过恒速运行记录稳态电流，拟合摩擦曲线；通过静止保持记录重力矩。
- 前馈实现：在控制器中建立查表或多项式模型，根据当前指令位置、速度、加速度实时计算前馈力矩。
- 与电流环的关系：力矩前馈直接叠加到电流指令端，等效于提高电流环的指令响应速度。
案例拆解：数控机床垂直轴重力补偿
某立式加工中心 Z 轴（垂直方向）采用双伺服电机驱动，带抱闸。未补偿时，Z 轴在停止时因重力下滑，定位误差达 0.05mm；在向下运动时，因重力加速导致超调。
- 问题分析：Z 轴总重量约 1200kg，折算到电机轴的等效重力矩 T_g = 8.5 Nm。该力矩在静止时由抱闸承担，运动时由伺服电机承担。
- 补偿方案：在速度环输出端叠加恒定力矩前馈 T_ff = 8.5 Nm（对应电流指令约 2.1A）。同时，针对向下运动时的重力加速效应，增加与速度相关的阻尼前馈。
- 实施效果：静止定位误差从 0.05mm 降至 0.003mm；向下运动时的跟随误差峰值从 0.12mm 降至 0.02mm。
- 风险控制：若抱闸释放瞬间前馈力矩尚未建立，会出现“溜车”现象。因此，在抱闸释放前 50ms 提前建立前馈力矩，并在释放后 100ms 内保持力矩闭环。
- 复盘：力矩前馈的难点不在算法，而在安全逻辑。必须确保前馈力矩与抱闸动作严格时序配合，否则可能造成机械冲击。
常见误区
- 误区一：将力矩前馈等同于加速度前馈。加速度前馈只补偿惯性力，力矩前馈可补偿任意已知力矩（重力、摩擦、切削力）。
- 误区二：忽略温度对摩擦的影响。设备冷机与热机时，摩擦系数变化可达 20%~30%，固定前馈模型会失效。建议增加温度补偿或自适应前馈。
- 误区三：在力矩前馈中加入积分项。前馈通道应保持“无记忆”特性，积分操作应留给反馈回路。
4.4 位置前馈：改善相位滞后的特殊手段
核心原理
位置前馈的表达式为：U_ffp = Kffp × P*(t)，其中 P*(t) 为指令位置。与前三种前馈不同，位置前馈并不直接补偿物理力或速度，而是在位置环中引入指令位置的直接通道，以改善系统的相位滞后。其本质是增加一个零点，等效于提高位置环的阻尼比。在纯 P 控制的位置环中，系统相位滞后随频率增加而增大，位置前馈可部分抵消这种滞后。
适用场景与设计方法
| 场景 | 位置前馈效果 | 注意事项 |
|---|---|---|
| 高刚性、低阻尼系统（如直线电机） | 显著改善相位裕度，允许提高位置环增益 | 增益过大易引起超调 |
| 低刚性系统（如皮带传动） | 效果有限，可能激励机械谐振 | 慎用，优先考虑速度/加速度前馈 |
| 轨迹跟踪（圆弧、样条） | 减小轮廓误差中的切向滞后分量 | 需与速度/加速度前馈配合 |
位置前馈的增益整定通常采用“临界增益法”：逐步增大 Kffp，观察阶跃响应的超调量。当超调量达到 10% 时，Kffp 即为上限值，实际取上限的 60%~80%。
案例拆解：五轴转台 A 轴低速轮廓误差优化
某五轴加工中心的 A 轴（旋转轴）采用蜗轮蜗杆传动，减速比 1:90。在加工大型叶轮时，A 轴以 5°/s 的低速匀速旋转，但轮廓误差达 0.02mm，超出公差。
- 现象分析：低速时，速度前馈和加速度前馈几乎不起作用（速度、加速度都很小）。误差主要来源于蜗轮蜗杆的传动误差和位置环的相位滞后。
- 方案选择：尝试位置前馈。由于 A 轴刚性较高（蜗轮蜗杆传动刚度大），适合使用位置前馈。
- 调试过程：Kffp 从 0 开始，每步增加 0.05。当 Kffp=0.15 时，轮廓误差降至 0.008mm；继续增加至 0.2，出现轻微振荡（频率约 8Hz），判断为蜗轮副的弹性变形激励。
- 最终设定：Kffp=0.18，轮廓误差稳定在 0.006mm，满足公差要求。
- 复盘：位置前馈在低速大传动比系统中效果显著，但必须注意传动链的弹性变形。建议同时监测电机端和负载端的位置反馈，评估传动间隙的影响。
常见误区
- 误区一：认为位置前馈可以替代速度前馈。实际上，位置前馈改善的是相位，速度前馈改善的是稳态增益，两者作用维度不同。
- 误区二：在低刚性系统中盲目使用位置前馈。低刚性系统的弹性变形会放大位置前馈的激励，导致振荡。
- 误区三：忽略位置前馈对指令噪声的放大。位置指令中的量化噪声经前馈通道直接进入控制输出，需对指令进行平滑处理。
4.5 四种前馈结构的综合对比与选型决策
| 前馈类型 | 补偿物理量 | 典型应用 | 整定依据 | 主要风险 |
|---|---|---|---|---|
| 速度前馈 | 速度相关误差 | 点位运动、匀速段 | 位置环增益 Kp | 指令噪声放大 |
| 加速度前馈 | 惯性力 | 轨迹插补、高速加减速 | 惯量比 J/Kt | 机械谐振激励 |
| 力矩前馈 | 已知外力矩 | 垂直轴、变负载、摩擦 | 力矩模型辨识 | 模型失配、安全时序 |
| 位置前馈 | 相位滞后 | 高刚性低速系统 | 临界增益法 | 超调、低刚性振荡 |
在实际工程中，四种前馈往往需要组合使用。推荐的调试顺序为：先速度前馈 → 再加速度前馈 → 然后力矩前馈（如有需要）→ 最后考虑位置前馈。每一步调试都应基于前一步的结果，避免参数耦合。
总结而言，前馈补偿技术的选型应基于对误差来源的深入分析：匀速段误差找速度前馈，加减速段误差找加速度前馈，已知外力找力矩前馈，相位滞后找位置前馈。掌握这四种结构的原理与调试方法，是运动控制工程师从“能用”走向“精通”的关键一步。