4. 速度前馈原理：前馈补偿的数学基础与实现方式

各位做伺服调优的同行，今天我们来聊聊速度前馈。说实话，很多工程师调了几年伺服，对前馈的理解还停留在「加个系数试试」的阶段。我个人觉得，搞懂前馈的数学本质，比盲目调参数重要得多。

先问个问题：为什么位置跟随误差总是消不掉？

你想想看，PID控制器是「看到误差才动作」的。负载一跑起来，位置指令在变，但控制器要等误差累积到一定程度才开始发力。这就好比开车——你看到弯道才打方向盘，肯定比预判弯道慢半拍。前馈要解决的，就是这个「慢半拍」的问题。

4.1 前馈补偿的数学本质

前馈的核心思想很简单：既然知道指令会怎么变，为什么不提前给个补偿信号？

从传递函数角度看，一个典型的伺服位置环是这样的：

位置指令 → [位置环PID] → [速度环] → [电机] → 实际位置
                ↑
           位置反馈

没有前馈时，位置误差 e(s) = r(s) - y(s)。PID控制器根据这个误差输出。但如果我们知道指令的变化规律，就可以在PID输出上叠加一个前馈量：

前馈量 = K_ff * s * r(s)   （速度前馈）
前馈量 = K_aff * s² * r(s) （加速度前馈）

这里 s 是拉普拉斯算子，s * r(s) 其实就是速度指令。说白了，速度前馈就是把指令速度乘以一个系数，直接加到输出上。

关键公式：

加入速度前馈后，系统的闭环传递函数变为：

G(s) = [C(s) + K_ff * s] * P(s) / [1 + C(s) * P(s)]

其中 C(s) 是PID控制器，P(s) 是被控对象。当 K_ff 取合适值时，系统对速度指令的响应几乎无延迟。

我在项目中遇到过一位同事，他死活想不通：为什么前馈系数设到100%反而会振荡？其实原因很简单——前馈是开环补偿，它不参与反馈校正。给多了，相当于开环增益过大，系统自然不稳定。

4.2 前馈的三种实现方式

实际工程中，速度前馈的实现方式主要有三种。我按推荐程度排个序：

实现方式	原理	优点	缺点	适用场景
基于指令微分	对位置指令求导得到速度	实现简单，无延迟	对指令噪声敏感	指令平滑的场合
基于速度指令直接输入	控制器直接接收速度指令	精度高，无噪声放大	需要上位机提供速度指令	高端运动控制
基于观测器估计	用状态观测器估计速度	抗噪声能力强	算法复杂，调参麻烦	低速或高精度场合

方式一：基于指令微分

这是最常用的方法。位置指令通常是梯形速度曲线或S形曲线，对时间求导就能得到速度。但要注意——如果指令有毛刺，微分会放大噪声。我建议在微分前加一个低通滤波器，截止频率设为速度环带宽的3~5倍。

方式二：基于速度指令直接输入

有些高端驱动器支持直接接收速度指令。这时候前馈就是「原封不动」的速度指令乘以系数。精度最高，但要求上位机运动规划器能同时输出位置和速度指令。嗯，这里要注意：速度指令和位置指令必须同步，否则会出大问题。

方式三：基于观测器估计

当指令噪声大或者传感器分辨率不够时，可以用状态观测器（比如龙伯格观测器）来估计速度。我曾经在一个低速转台项目里用过这种方法——编码器分辨率只有2000线，直接微分噪声太大，用观测器后前馈效果明显改善。

4.3 前馈系数的整定方法

前馈系数怎么调？很多手册上说「从0逐渐增大，直到系统出现振荡，然后回调10%」。这个方法没错，但太粗糙了。我分享一个更系统的做法：

先关掉前馈，调好PID参数，让系统稳定。
给一个梯形速度指令，记录位置跟随误差曲线。
逐步增加速度前馈系数，观察误差曲线的变化。
理想情况：误差曲线的「平顶」部分逐渐降低，直到接近零。
如果出现振荡：说明前馈系数过大，或者指令加速度太大。

我的经验值：

对于大多数伺服系统，速度前馈系数在 60%~80% 之间效果最好。超过 90% 时，系统对参数变化会变得敏感。如果要求更高，可以配合加速度前馈一起使用。

4.4 前馈与反馈的配合策略

前馈不是万能的。它补偿的是「已知扰动」——也就是指令变化引起的误差。但摩擦力、负载变化这些「未知扰动」，还得靠反馈来消除。

我习惯把前馈和反馈的关系比作「预判」和「纠偏」：

前馈负责：让系统在指令变化时快速响应，减少误差峰值。
反馈负责：消除稳态误差和未知扰动。

两者配合得好，系统表现会非常漂亮。配合不好呢？我曾经见过一个案例——工程师把速度前馈设到120%，结果系统在加减速时剧烈振荡。为什么？因为前馈给的信号太大，反馈控制器为了纠正这个「过冲」，反而和它较上劲了。

避坑指南：

我曾经在一个高速贴片机项目里吃过亏——速度前馈系数设到95%，看起来跟随误差很小，但一换负载就振荡。后来发现，前馈系数太高导致系统对负载惯量变化极其敏感。所以我的建议是：前馈系数不要超过90%，留点余量给反馈去处理不确定性。

4.5 速度前馈的完整实现流程

下面这张图总结了速度前馈从原理到实现的完整逻辑：

这张图把整个流程串起来了。你从位置指令出发，经过微分得到速度指令，乘以系数得到前馈量，然后和PID输出叠加，最后驱动电机。反馈回路一直在旁边「盯着」，随时修正偏差。

4.6 实际调试中的注意事项

最后，我总结几个实际调试中容易踩的坑：

指令平滑性：如果位置指令是阶跃式的，微分后会产生脉冲，前馈会瞬间给一个很大的信号。所以前馈一定要配合平滑的指令曲线使用。
采样周期匹配：前馈的计算周期必须和速度环周期一致。我曾经见过一个案例——前馈在1ms周期计算，但速度环是0.5ms周期，结果前馈信号和速度环不同步，反而引入了高频抖动。
饱和处理：前馈量加上PID输出后，如果超过驱动器限幅，会发生积分饱和。我建议在叠加前对前馈量做限幅处理，或者使用抗饱和积分算法。

一个小技巧：

调试时可以先让系统跑一个简单的梯形速度曲线，把前馈系数从0开始慢慢加。观察误差曲线的「平顶」部分——它应该随着系数增加而降低。当平顶部分不再降低时，说明前馈已经饱和了，再加大系数只会带来副作用。

好了，速度前馈的原理和实现就聊到这里。记住一句话：前馈是「预判」，反馈是「纠偏」，两者各司其职，才能让伺服系统跑得又快又稳。