1. 轨迹规划概述：从零开始理解这件事

大家好，欢迎来到《轨迹规划实战》的第一章。

说实话，我刚开始接触机器人时，觉得「轨迹规划」这个词挺唬人的。什么轨迹？什么规划？不就是让机器人动起来吗？

后来踩了不少坑才明白——让机器人动起来容易，让它动得稳、动得快、动得安全，这才是真本事。

1.1 什么是轨迹规划？

先给个最直白的定义：
轨迹规划 = 找出一条从起点到终点的路径 + 告诉机器人每个时刻该以什么速度、加速度走。

你想想看，如果只给机器人一条路径，比如「从A点直线走到B点」，它可能走得很慢，也可能走到一半突然急刹车。这在实际项目中是不行的。

我个人习惯把轨迹规划拆成两个层次：

• 路径规划：只关心「走哪条路」，不关心速度。比如绕过障碍物的几何曲线。
• 轨迹规划：在路径基础上加上时间信息——什么时候加速、什么时候减速、什么时候匀速。

我在项目中遇到过一位刚入行的同事，他写了一段路径规划代码，机器人确实能绕过障碍物。但一跑起来，电机嘎嘎响，末端抖动得像筛子。为什么？因为他没做轨迹规划——速度突变太大，电机根本受不了。

1.2 轨迹规划在机器人系统中的地位

这个问题我问过不少学生，很多人觉得轨迹规划只是「上层应用」，可有可无。

嗯，这里我要泼盆冷水：轨迹规划是机器人系统的「腰部」。

你看整个机器人软件架构：

• 上层：感知、决策、任务规划——告诉机器人「你要干什么」
• 中层：轨迹规划——告诉机器人「你该怎么动」
• 下层：运动控制、伺服驱动——执行「动起来」

如果中层塌了，上层再聪明也没用。感知到障碍物了，轨迹规划算不出避让路径，机器人只能傻站着。或者算出的轨迹有速度跳变，控制层根本跟踪不上。

我曾经在一个AGV项目里吃过这个亏。感知模块做得很好，地图建得漂漂亮亮，但轨迹规划没处理好转弯时的减速策略，结果AGV每次转弯都甩货——货架上的箱子哗啦啦掉下来。后来花了整整两周调轨迹参数才解决。

1.3 常见应用场景

轨迹规划不是纸上谈兵，它在三类机器人上用得最多：

1.3.1 机械臂

机械臂的轨迹规划，说白了就是让末端执行器（比如焊枪、夹爪）沿着一条平滑的曲线运动，同时保证各关节不超限、不碰撞。

我做过一个焊接项目，要求机械臂在焊缝上匀速运动，速度波动不能超过5%。如果只做路径规划不做轨迹规划，焊接出来的焊缝要么烧穿、要么焊不透。后来用S形速度曲线做轨迹规划，问题才解决。

1.3.2 AGV（自动导引车）

AGV的轨迹规划更关注「全局路径 + 局部速度调整」。比如在仓库里，AGV要从A货架到B货架，全局路径规划出一条最短路径，但遇到行人或障碍物时，局部轨迹规划要实时调整速度甚至重新规划路径。

我记得有一次调试AGV，它在一个窄通道里卡住了——全局路径规划没问题，但轨迹规划没考虑通道宽度，导致AGV在转弯时擦墙。后来加了「曲率-速度约束」才搞定。

1.3.3 无人机

无人机轨迹规划最头疼的是三维空间 + 动力学约束。无人机不能像机械臂那样随便急停，它有惯性，有最小转弯半径。

我见过一个航拍项目，无人机要沿着建筑物表面飞行拍摄。如果轨迹规划不考虑无人机的最大倾斜角，飞控根本跟不住轨迹，直接撞墙。嗯，这个项目最后用了「微分平坦」方法做轨迹规划，效果还不错。

应用场景	核心约束	典型问题
机械臂	关节限位、速度/加速度极限	末端抖动、焊接不均匀
AGV	非完整约束、环境障碍	转弯甩货、窄通道卡死
无人机	动力学约束、三维避障	飞控跟踪失败、撞墙

1.4 课程整体框架

这门课我打算这么讲：

1. 基础篇：轨迹的数学表示、插值方法、速度曲线生成。这部分是「手艺活」，必须练扎实。
2. 进阶篇：带约束的轨迹优化、时间最优轨迹、避障轨迹规划。这部分是「真功夫」，项目里天天用。
3. 实战篇：机械臂轨迹规划实战、AGV轨迹规划实战、无人机轨迹规划实战。这部分是「见真章」，我会拿真实项目代码来讲。

每一章我都会给代码示例，而且是我自己跑过的、调过的。不是那种网上抄来的demo。

本章知识体系

下面这张图是我自己画的，把本章的核心逻辑串起来了：

这张图很直白：轨迹规划不是孤立的技术，它连接着「定义」「地位」「应用」三个维度。后面每一章，我都会围绕这个框架展开。

好了，第一章就到这里。记住我说的——轨迹规划是让机器人「优雅地动起来」的艺术。下一章我们开始动手，从最简单的点到点轨迹讲起。