4、轨迹规划概论：什么是轨迹规划、轨迹规划在机器人系统中的位置、轨迹规划的评价指标
各位同学，欢迎来到轨迹规划这一章。说实话，我做了这么多年机器人，最怕听到的一句话就是：「这个轨迹怎么这么抖？」。嗯，今天我们就来聊聊轨迹规划到底是个什么东西。
4.1 什么是轨迹规划？
先别急着看公式。轨迹规划，说白了就是——告诉机器人「你该怎么动」。
你想想看，我们给机器人一个目标点，比如「去抓那个螺丝」。但机器人自己不知道该怎么走。是直线冲过去？还是绕个弯？速度是快还是慢？中间要不要停一下？
轨迹规划就是干这个的。它负责生成一条时间序列上的位置、速度、加速度曲线。注意，不是简单的路径（Path），而是带时间信息的轨迹（Trajectory）。
路径 vs 轨迹
- 路径：只描述空间位置，比如「从A点到B点的一条曲线」
- 轨迹：路径 + 时间信息，比如「从A点到B点，3秒内完成，中间速度不超过1m/s」
我个人习惯把轨迹规划比作「给机器人写一份运动说明书」。这份说明书里，每一毫秒该在什么位置、该用多快的速度，都得写得清清楚楚。
4.2 轨迹规划在机器人系统中的位置
很多新手会问：轨迹规划到底属于哪个模块？我画了一张图，你看完就明白了。
从这张图你能看到，轨迹规划处于中间层。上面是任务规划，它告诉你「去抓螺丝」。下面是运动控制，它负责「执行轨迹」。轨迹规划就是中间的翻译官——把任务翻译成具体的运动指令。
我在项目中遇到过不少情况，任务规划写得很好，运动控制也调得很稳，但就是轨迹规划没做好，结果机器人跑起来像抽风一样。嗯，这里要特别注意：轨迹规划的质量，直接决定了机器人运动的最终表现。
4.3 轨迹规划的评价指标
好，既然轨迹规划这么重要，那怎么评价一条轨迹好不好？我总结了三个核心指标。
4.3.1 平滑性（Smoothness）
平滑性，说白了就是「机器人动起来舒不舒服」。你想想看，如果一条轨迹在某个点突然加速度跳变，那机器人就会「咯噔」一下。轻则产品被甩飞，重则关节齿轮打坏。
平滑性通常用加加速度（Jerk）来衡量。Jerk是加速度的变化率。Jerk越小，运动越平滑。
避坑指南
我曾经在一个码垛项目里，为了追求速度，用了梯形速度曲线。结果加速度在拐点处突变，Jerk无穷大。码到第500箱的时候，吸盘把箱子甩出去了。后来换成S形速度曲线，虽然慢了0.2秒，但再也没出过问题。
常见的平滑性评价方法：
- Jerk峰值：最大加加速度值，越小越好
- 加速度连续性：加速度曲线是否连续无跳变
- 频谱分析：高频分量越少，平滑性越好
4.3.2 时间最优（Time Optimal）
做工业机器人的，谁不想快？时间最优就是「在满足约束的前提下，用最短的时间跑完轨迹」。
但这里有个矛盾：越平滑，往往越慢。S形曲线比梯形曲线平滑，但总时间更长。怎么平衡？
我个人的经验是：先保证平滑，再优化时间。因为一旦出了安全事故，省下来的那点时间根本不够赔。
时间最优的约束条件
- 关节速度上限（电机转速限制）
- 关节加速度上限（电机力矩限制）
- 关节Jerk上限（机械结构冲击限制）
- 末端执行器速度/加速度限制（工艺要求）
4.3.3 能耗（Energy Consumption）
这个指标以前大家不太重视，但这两年越来越关键。为什么？因为工厂的电费是实打实的成本。
能耗跟轨迹的关系很大。举个例子：同样的点到点运动，用梯形曲线和S形曲线，能耗能差出15%~20%。
为什么会这样？因为加速度变化越剧烈，电机就需要输出更大的瞬时力矩，而电机在大力矩区间的效率往往更低。
| 轨迹类型 | 平滑性（Jerk） | 时间 | 能耗（相对值） | 适用场景 |
|---|---|---|---|---|
| 梯形速度曲线 | 差（Jerk无穷大） | 快 | 100%（基准） | 对冲击不敏感的搬运 |
| S形速度曲线 | 好（Jerk有限） | 较慢（+10%~20%） | 85%~90% | 精密装配、码垛 |
| 多项式轨迹 | 优秀（Jerk连续） | 可调 | 80%~95% | 高精度加工、焊接 |
| 最优能耗轨迹 | 良好 | 较慢（+30%~50%） | 60%~75% | 电池搬运、节能产线 |
注意
这三个指标往往是互相矛盾的。你想时间最优，平滑性就会下降。你想能耗最低，时间就会变长。实际项目中，要根据工艺要求做权衡。我曾经在一个锂电池产线项目里，客户要求能耗降低20%，最后我们牺牲了15%的速度，换来了22%的能耗下降。客户很满意。
4.4 小结
这一章我们聊了三个事：
- 轨迹规划是什么——给机器人写运动说明书
- 它在系统中的位置——任务规划和运动控制之间的桥梁
- 三个评价指标——平滑性、时间最优、能耗
记住一句话：没有最好的轨迹，只有最合适的轨迹。下一章我们会深入具体的轨迹规划算法，到时候再手把手带大家写代码。