1. MoveIt与规划器概述

大家好，欢迎来到这门课。我是你们的老朋友，一个在机器人运动规划领域摸爬滚打了十来年的工程师。今天咱们聊聊MoveIt和它的规划器。

说实话，我刚入行那会儿，MoveIt还没现在这么普及。那时候调机械臂，得自己手写RRT、手撸碰撞检测，一个bug能调三天。后来MoveIt出来了，我才算真正解放了生产力。但工具再好，不懂原理也白搭——这就像给你一把好枪，你不会瞄准，照样打不中靶心。

MoveIt是什么？说白了，它是一个面向移动操作机器人的软件框架。它把运动学、规划、控制、感知这些模块整合到一起，让你能快速搭建一个机器人系统。

我个人习惯把MoveIt比作一个「调度中心」。你告诉它「我要抓那个杯子」，它就会调用运动学算逆解、调用规划器找路径、调用控制器发指令。整个过程你不需要关心底层细节——当然，如果你想调优，那就得深入了解了。

核心要点：MoveIt不是规划器本身，而是规划器的「管家」。它管理规划请求、规划场景、规划时间，但真正的路径搜索工作，交给背后的规划器插件。

规划器到底干吗的？我举个例子你就明白了。

想象你让一个机械臂从A点走到B点。中间有桌子、有障碍物、有关节限位。规划器的任务就是：找一条无碰撞、满足运动学约束、尽可能平滑的路径。

嗯，这里要注意——规划器不负责控制。它只负责「想」，不负责「做」。它输出一串关节角度序列，控制器再去执行。所以规划器的质量，直接决定了机器人能不能安全、高效地完成任务。

我在项目里遇到过一件事：有一次规划器找的路径明明无碰撞，但执行起来机器人抖得跟筛子似的。后来发现是路径点太稀疏，加速度突变太大。从那以后，我每次调规划器都会检查路径平滑度。

MoveIt支持多种规划器。我挑几个最常用的给你讲讲。

避坑指南：我曾经在项目里直接用OMPL的默认参数去规划一个精密装配任务，结果路径绕来绕去，效率极低。后来换成STOMP，调了迭代次数和步长，路径平滑多了。所以选规划器要看任务，别偷懒。

OMPL是MoveIt默认的规划器库。它包含几十种算法，最常用的有RRT、RRT*、PRM、LazyPRM等。

它的核心思想是「采样」。在C空间中随机撒点，然后连接这些点形成路径。你想想看，这就像在黑夜里用手电筒找路——照到哪儿走到哪儿。

优点很明显：通用性强，高维空间也能处理。缺点呢？路径质量不稳定，有时候会绕远路。

STOMP走的是另一条路。它不采样，而是优化。它从一个初始路径开始，通过随机扰动和代价函数评估，逐步把路径「推」向更优的方向。

我刚开始用STOMP的时候，觉得它像个「强迫症患者」——非要让路径又平滑又安全。但代价是参数多：迭代次数、步长、协方差矩阵、代价权重……调起来挺费劲的。

CHOMP和STOMP有点像，但用了更数学的方法。它把路径优化问题建模成一个「弹性带」——路径像橡皮筋一样，被障碍物推开，被平滑度拉直。

CHOMP的优势是速度快，适合在线规划。但缺点也明显：容易陷入局部最优。如果初始路径太差，它可能找不到好解。

这个规划器是给工业场景准备的。它不做随机采样，也不做梯度优化，而是老老实实地做笛卡尔直线或圆弧插补。

说白了，它就是「指哪儿打哪儿」。你给一个目标位姿，它算出一条直线路径。简单、稳定、可预测。但遇到障碍物就抓瞎了——它不会绕路。

注意：Pilz Industrial规划器要求机器人运动学必须精确，否则路径会偏离。我在调试一个六轴机器人时，因为DH参数标定不准，导致直线路径末端偏差了2mm。后来重新标定才解决。

这门课的目标很明确：让你不仅会用MoveIt的规划器，还能理解它为什么这么规划，以及怎么调优。

具体来说，学完这门课，你应该能：

学习路径是这样的：我们先打基础，讲规划器的数学原理和MoveIt的架构。然后逐个深入每个规划器，看源码、调参数。最后结合真实案例，讲避坑和调优技巧。

嗯，我建议你每章都动手跑一下示例代码。光看不练，等于白学。

这张图展示了MoveIt规划器的整体知识体系。从框架到请求，再到具体的规划器插件和核心算法，最后输出路径。我们这门课会沿着这个结构，一层层往下挖。

好了，第一章就到这里。记住一句话：规划器是机器人的「大脑」，而MoveIt是让这个大脑高效运转的「操作系统」。后面我们会深入每个规划器的原理，到时候你就知道怎么调了。