运动控制算法基础：梯形加减速、S形加减速、PID控制原理、前馈控制
各位同学，今天我们来聊聊运动控制里最核心的几个算法。说实话，我刚入行那会儿，觉得控制算法就是调调参数，后来踩了不少坑才明白——算法选型和参数整定，直接决定了你的设备能不能跑得稳、停得准。
这一章我们聚焦四个基础但极其重要的内容：梯形加减速、S形加减速、PID控制原理、前馈控制。我会结合自己实际项目中的经验，把每个算法的适用场景和坑点讲清楚。
梯形加减速：简单粗暴，但小心冲击
梯形加减速，说白了就是速度按照固定的加速度上升，匀速跑一段，再按固定减速度下降。它的速度曲线像个梯形，所以叫这个名字。
优点很明显：实现简单，计算量小，适合对启停冲击不敏感的场合。比如一些低速传送带、步进电机开环控制，我经常用这个。
但缺点也很致命：加速度在起点和终点处突变，会产生无穷大的加加速度（Jerk）。你想想看，加速度从0瞬间跳到某个值，机械结构会承受一个冲击。我在做一台高速贴片机时，用梯形加减速，结果机器在启停时抖动得厉害，后来换成S形才解决。
加速段：v(t) = v₀ + a·t
匀速段：v(t) = v_max
减速段：v(t) = v_max - a·(t - t₁)
嗯，这里要注意：梯形加减速的速度规划必须保证加速段和减速段对称，否则会出现速度超调。我曾经在调试一个龙门架时，因为加减速时间设得不一致，导致电机在减速末端出现明显的过冲，差点撞到限位。
S形加减速：平滑至上，但计算量大
S形加减速，本质上是让加速度也平滑变化。它的速度曲线呈S形，加加速度（Jerk）是有限值。说白了，就是让机器启动和停止时更“温柔”。
我个人的习惯是：凡是要求高精度、低振动的场合，优先考虑S形。比如数控机床、机器人关节、高精度XY平台。
S形加减速通常分为七段：加加速、匀加速、减加速、匀速、加减速、匀减速、减减速。听着复杂，但实际实现时可以用查表法或多项式插值。
为什么S形更好？因为加速度连续变化，不会产生冲击力。你想想看，电梯启动时如果突然加速，人会觉得不舒服；但如果慢慢加速，就感觉平稳。S形加减速就是这个道理。
不过，S形也有代价：同样的最大速度下，S形加减速的总时间比梯形长。因为它在加速初期和末期加速度较小，需要更长的加速距离。所以，对节拍要求极高的场合，需要权衡。
PID控制原理：运动控制的“万能钥匙”
PID控制，我相信大家都不陌生。比例、积分、微分三个环节，各司其职。但说实话，很多人调PID就是“试”，调出来能用就行，根本不理解每个参数的意义。
比例（P）：当前误差的放大倍数。P越大，响应越快，但容易超调甚至震荡。我见过有人把P调到100，结果电机直接啸叫。
积分（I）：消除稳态误差。但I太大会导致积分饱和，系统响应变慢。我曾经在调试一个温控系统时，I设得太大，结果温度一直过冲，来回震荡了十几分钟才稳定。
微分（D）：预测误差变化趋势，抑制超调。但D对噪声敏感，如果编码器信号有毛刺，D项会放大噪声，导致电机抖动。
PID参数的整定方法，我推荐齐格勒-尼科尔斯法：先只加P，让系统临界震荡，记录震荡周期和增益，然后按公式算出P、I、D。这个方法虽然粗糙，但能给你一个不错的起点。
当然，实际项目中我很少直接用纯PID。因为运动控制系统的惯性和延迟，纯PID往往不够。这时候就需要引入前馈控制。
前馈控制：让系统“预判”你的需求
前馈控制，说白了就是在误差还没产生之前，提前给一个补偿量。它不依赖反馈，而是根据目标轨迹直接计算控制量。
举个例子：你开车上坡，如果只靠油门（PID）来维持速度，等速度掉下来再加油，会有延迟。但如果你提前看到坡，提前加大油门，速度就不会掉。这就是前馈。
在运动控制中，前馈通常分为速度前馈和加速度前馈。速度前馈补偿摩擦力，加速度前馈补偿惯性力。
u(t) = u_PID(t) + K_v · v_ref(t) + K_a · a_ref(t)
其中，K_v是速度前馈系数，K_a是加速度前馈系数。这两个系数可以通过系统辨识得到，也可以手动整定。
我个人的经验是：前馈可以大幅降低PID的负担。比如一个高精度定位平台，纯PID可能需要P=50才能跟上轨迹，但加上前馈后，P可以降到10，系统更稳定，超调更小。
但前馈也有坑：前馈系数不准，反而会引入误差。我曾经在一个项目中，加速度前馈系数设大了，结果电机在加速时出现明显的过冲，比不加前馈还差。后来通过系统辨识才找到准确的系数。
四种算法的对比与选型
好了，四种算法都讲完了。我整理了一个表格，方便大家对比：
| 算法 | 平滑性 | 计算量 | 适用场景 | 典型问题 |
|---|---|---|---|---|
| 梯形加减速 | 低 | 低 | 低速、低精度、步进电机 | 启停冲击大 |
| S形加减速 | 高 | 中 | 高速、高精度、伺服电机 | 总时间略长 |
| PID控制 | 中 | 低 | 通用闭环控制 | 参数整定困难 |
| 前馈控制 | 高 | 中 | 高动态响应、高精度跟踪 | 需要系统辨识 |
实际项目中，我通常的做法是：S形加减速做轨迹规划 + PID做闭环控制 + 前馈做补偿。三者配合，基本能覆盖90%的运动控制场景。
下面这张图展示了这四种算法在运动控制架构中的位置和关系：
最后说一句：算法是死的，但应用是活的。不要死记硬背公式，要理解每个算法背后的物理意义。你想想看，当你真正理解了加速度、加加速度对机械结构的影响，你就能在项目中做出最优的选择。
公众号:蓝海资料掘金营，微信deep3321