一、轨迹规划基础：从“怎么走”到“走得好”
大家好，欢迎来到《轨迹规划与抖动消除技巧实战》的第一章。
我是你们这门课的主讲。在机器人这行摸爬滚打了十几年，我见过太多项目——硬件选型顶级，电机也是最新款，但跑起来就是一顿一顿的，或者路径绕得让人抓狂。问题出在哪？十有八九，是轨迹规划没做好。
今天，我们就来聊聊这个最基础、也最容易被忽视的话题：轨迹规划到底是什么？为什么它如此重要？
1.1 什么是轨迹规划？
说白了，轨迹规划就是回答机器人三个问题：
- 去哪儿？——目标位置和姿态。
- 怎么去？——经过哪些中间点，走什么形状的路径。
- 什么时候到？——每个时刻的速度、加速度是多少。
你想想看，如果只告诉电机“转到90度”，电机“啪”一下直接甩过去——那叫点位运动，不是轨迹规划。真正的轨迹规划，要给出一条连续的、平滑的、时间参数化的曲线。
核心定义：轨迹规划 = 路径规划（几何路径）+ 速度规划（时间分配）。
路径告诉你“走哪条路”，轨迹告诉你“每时每刻走到哪、走多快”。
举个例子。我早期做一个码垛项目，机械臂从A点抓取，放到B点。如果只做路径规划，臂端走直线，中间可能撞到旁边的料箱。如果只做速度规划，没有路径约束，电机直接急停急启，末端抖得像筛子。只有把两者结合起来，才能既安全又平稳。
1.2 为什么需要轨迹规划？
这个问题，我问过不少刚入行的工程师。很多人回答：“为了让机器人动起来。” 嗯，只对了一半。
让机器人动起来，给个位置指令就行。但要让机器人动得好、动得稳、动得持久，就必须做轨迹规划。原因有三：
- 避免冲击与抖动
没有轨迹规划，电机的位置指令是阶跃的。速度瞬间从0跳到最大，加速度理论上无穷大。结果就是：机械结构冲击、齿轮磨损、末端抖动。我在一个焊接项目里遇到过，没做S形速度规划，焊枪每到一个拐点就“咯噔”一下，焊缝全是疙瘩。 - 满足运动学/动力学约束
每个机器人都有极限：最大速度、最大加速度、最大力矩。轨迹规划就是把这些硬约束考虑进去，生成一个“机器人能跑得动”的指令序列。否则，你给一个超出能力的轨迹，电机要么报警，要么丢步。 - 提高效率与精度
好的轨迹规划，能在不违反约束的前提下，让运动时间最短。同时，平滑的轨迹能减少跟踪误差，提高终点定位精度。我见过有人用梯形速度规划，加减速时间没算好，结果在高速段过冲了5毫米——这在精密装配里是致命的。
我的经验： 判断一个机器人系统好不好，别只看它跑得快不快。让它走一个“门”字形路径，看拐角处抖不抖、停得准不准。这才是轨迹规划的功力所在。
1.3 轨迹规划在机器人领域的应用场景
轨迹规划不是实验室里的理论，它几乎覆盖了所有机器人应用。我按场景给大家梳理一下：
| 应用领域 | 典型场景 | 轨迹规划要点 |
|---|---|---|
| 工业机器人 | 焊接、喷涂、搬运、装配 | 高精度、平滑过渡、避免奇异性 |
| 移动机器人 | AGV/AMR、扫地机器人、自动驾驶 | 避障、全局路径+局部速度、曲率约束 |
| 协作机器人 | 人机协作、力控装配 | 柔顺性、安全停止、力矩限制 |
| 医疗机器人 | 手术导航、康复训练 | 极低抖动、高安全性、实时性 |
| 服务机器人 | 送餐、导览、家庭助手 | 平滑自然、能耗优化、动态避障 |
你看，从工厂里的重型机械臂，到你家里的小米扫地机，底层都在做同一件事：把“想去哪”翻译成“怎么去”的平滑指令。
我记得有一次给一家汽车厂做焊装线改造。原来的轨迹是示教器一点一点录的，拐角处速度突变，焊渣飞溅。我们重新做了轨迹规划，在拐角前自动减速、平滑过渡，焊接质量直接提升了一个等级。厂长当时说了一句话我印象很深：“原来不是机器人不行，是没给它一条好路走。”
1.4 本章知识体系总览
为了让大家对轨迹规划有一个整体的认知，我画了一张框架图。你可以把它当作这门课的“地图”。
这张图把轨迹规划拆成了三个核心模块。后面的课程，我们会逐一深入每个模块。你会发现，很多所谓的“抖动问题”，其实就出在速度规划或者约束处理上。
1.5 一个简单的例子：从A到B
光说不练假把式。我们来看一个最基础的例子：让机器人末端从点A(0,0)运动到点B(10,10)。
不做轨迹规划：
// 伪代码：直接跳转
move_to(10, 10); // 电机瞬间从0转到目标位置
// 结果：速度无穷大，冲击剧烈，机器人报警做最简单的轨迹规划（梯形速度）：
// 伪代码：梯形速度规划
total_distance = 14.14; // A到B的直线距离
max_velocity = 2.0; // 最大速度
acceleration = 1.0; // 加速度
// 计算加速段、匀速段、减速段
t_acc = max_velocity / acceleration; // 加速时间
d_acc = 0.5 * acceleration * t_acc^2; // 加速距离
// 如果d_acc * 2 < total_distance，则有匀速段
// 否则为三角形速度曲线
// 在每个控制周期插值位置
for t = 0 to total_time:
if t < t_acc:
v = acceleration * t;
else if t < (total_time - t_acc):
v = max_velocity;
else:
v = max_velocity - acceleration * (t - (total_time - t_acc));
pos = pos + v * dt;
send_position_to_robot(pos);注意： 上面的梯形规划虽然简单，但加速度在拐点处有突变（从0跳到最大，再跳回0）。这会导致加加速度（Jerk）无穷大，是抖动的根源之一。后面我们会专门讲S形速度规划来解决这个问题。
这个例子虽然简单，但它揭示了轨迹规划的本质：把离散的目标点，变成连续的、平滑的、可执行的时变指令。
1.6 本章小结
好，我们来收一下。第一章我们讲了三个核心问题：
- 轨迹规划是什么——路径+速度，缺一不可。
- 为什么需要它——避免冲击、满足约束、提高效率精度。
- 用在哪——从工业到服务，从焊接扫地，无处不在。
我个人觉得，轨迹规划是机器人控制里“性价比”最高的环节。你不需要换硬件，不需要改电机，只要把轨迹算好了，整个系统的表现就能上一个台阶。我见过太多项目，花大价钱买高精度减速器，结果轨迹规划一塌糊涂，最后精度还不如人家用普通电机但轨迹算得好的。嗯，方向比努力更重要。