工具与仿真 · G2
MoveIt 2 与机械臂控制栈
机械臂的「规划 + 碰撞 + 执行」几乎全在这套里。不会 MoveIt 2,机械臂岗位的面试基本没法往下聊;会了它,一台陌生型号的臂你两天能让它动。
课程正文 · 人话版
MoveIt 2 是机械臂的「运动规划全家桶」:运动学、碰撞检测、采样规划、笛卡尔规划、执行。学它的正确姿势不是背 API,是理解它替你做了哪些决策。
采样规划:RRT 的直觉
高维空间(6/7 自由度)没法穷举路径,RRT 的答案是随机撒点、逐步长树:撒一个采样点,找到树上最近节点,朝它伸一小步,无碰撞就留下。看动图:灰树「长」过去,撞上目标就回溯出路径。
代价:路径歪歪扭扭。标配后处理是 Shortcut(随机剪枝拉直)+ 时间参数化(B4 的梯形/S 曲线)。MoveIt 默认 OMPL 一族全是这个思想的变体。
动图 · 拖一拖,亲眼看
碰撞检测:规划的成本中心
每次「伸一小步」都要查碰撞:机械臂与环境(场景)、机械臂自碰。FCL 引擎 + 加速结构(BVH)把它做到亚毫秒级——但采样几千次的总成本依然是规划时间的主体。
工程要点:场景用 octomap/点云维护并定期降采样;自碰矩阵(SRDF)把不可能碰的连杆对排除;安全距离(padding)设 2–5cm,太小了贴边走,太大了窄缝钻不过。
笛卡尔规划与它的死穴
采样规划走不出「直线焊缝」这类笛卡尔约束。笛卡尔规划(Descartes/MoveIt Cartesion)直接在关节空间做 IK 逐点求解——问题是经过奇异点时无解。
工程组合拳:远距离用 OMPL,接近目标切笛卡尔;奇异点附近绕过去或用阻尼最小二乘(B2)。流程编排比单个算法更重要——MoveIt 的 task composer 就是在干这个。
学到什么程度
能用 Motion Planning Pipeline 跑通「给定目标位姿→规划→执行」;能解释 OMPL 与笛卡尔规划的取舍;能调 padding 和规划超时并知道后果。做到这些,MoveIt 就是你的工具而不是黑盒。
三道题,测你真懂了
1. RRT 在高维空间能用的核心原因是?
- A算得快
- B路径最短
- C随机采样避免了维度灾难下的穷举
看答案
C。概率完备:撒够多采样必然找到解(如果存在),且每次代价极低。
2. 采样规划输出的路径通常需要?
- A直接执行
- B重新规划
- CShortcut 拉直+时间参数化后再执行
看答案
C。RRT 路径扭曲且无时间信息。后处理是标配而非可选。
3. 碰撞检测是规划时间主体的原因?
- A算法复杂
- B内存不足
- C每次采样伸步都要查碰撞,采样次数成千上万
看答案
C。N 次采样 × 每次碰撞检查。优化方向:排除不可能碰撞对、简化场景。
在本站继续深入
正文讲完。下面是这个领域的完整大纲、深度要求与常见错误——查漏和面试准备时用。
要学什么
- SRDF 才是个性化配置:planning group、virtual joint(把臂挂到 world 或底盘)、disable collision、passive joint、末端 link
- 规划插件分工:OMPL(RRTConnect 默认,快而随机)、Pilz(工业直线/圆弧,可预测)、CHOMP/STOMP(优化型,路径更顺但慢)
- IK 插件:KDL 慢且常失败、TRAC-IK 明显更稳、ikfast 快但生成麻烦;规划失败十次有四次是 IK 无解不是规划器不行
- Planning Scene:碰撞体、octomap 实时障碍、allowed collision matrix(相邻连杆必须放行)
- 控制器:joint_trajectory_controller、MoveIt Servo(遥操作与视觉伺服)、夹爪的 GripperCommand
- 时间参数化:TOTG 平滑但对加速度限制敏感,Iterative 更保守;参数里写的能力必须与驱动器实际能力一致
- 工程细节:奇异点附近的关节速度爆炸、多解跳变、轨迹执行超时(controller 的 goal_time 容差)
这个领域的主流软件
| 软件 / 库 | 是什么 | 什么时候用 | 优先级 |
|---|---|---|---|
| MoveIt 2 | 规划、碰撞、执行的整套框架 | 所有机械臂项目 | 必装 |
| MoveIt Setup Assistant | 图形化生成 SRDF 与配置包 | 接一台新臂的第一小时 | 必装 |
| MoveIt Servo | 末端笛卡尔实时伺服,吃遥操作/视觉伺服输入 | 遥操作、手眼伺服、力控外层 | 进阶 |
| TracIK / Pick-IK | 更稳、更快的逆解插件 | KDL 求解失败率高时 | 进阶 |
| Pilz Industrial Motion Planner | 直线、圆弧、点到点(PTP)工业运动 | 要可预测路径而非随机采样 | 进阶 |
四条路线需要多深
「精通」= 能从零推导 / 能手写实现 / 能判断别人的方案对不对;「用过」= 能调起来、能改参数;「知道」= 能听懂、能提问。
怎么算学会了
把一台 6 轴臂从 URDF 接到 MoveIt 2:RViz 里拖末端能规划出无碰撞轨迹并执行;能用 Servo 键盘遥操作;能解释某条轨迹执行时为什么抖(是时间参数化还是驱动器跟不上)。
常见错误
- 只在 RViz 的假控制器里规划成功,换真控制器就超时——轨迹的速度/加速度上限比驱动器实际能力高 3 倍
- 不改 allowed collision matrix,相邻连杆永远自碰撞,规划成功率 0 却以为模型建错了
- 过奇异点时用笛卡尔直线,关节速度瞬间到限幅,保护一停一停