4. MoveIt2基础与机械臂控制：MoveIt2安装与配置、运动学求解器（KDL/TRAC-IK）、规划组与碰撞检测
好，咱们进入正题。机械臂要动起来，光有硬件不行，得有个靠谱的“大脑”来指挥它。在ROS2的世界里，这个大脑就是MoveIt2。说实话，我最早接触MoveIt还是ROS1时代，那时候配置起来挺折腾的。到了ROS2，架构变了，但核心思想没变——把复杂的运动规划、逆解、碰撞检测这些脏活累活，封装成一套好用的API。
这一章，咱们就手把手把MoveIt2搭起来，然后聊聊它背后的几个关键模块。你跟着我走一遍，后面做协同导航的时候，心里就有底了。
4.1 MoveIt2安装与配置
安装MoveIt2，我建议直接用二进制包。省心，稳定。除非你要改源码，否则别自己编译，浪费时间。
# 安装MoveIt2（以Humble为例）
sudo apt install ros-humble-moveit
# 如果你需要完整的开发工具
sudo apt install ros-humble-moveit-*装完之后，验证一下。启动一个简单的Demo，看看能不能跑起来。
# 启动Panda机械臂的Demo
ros2 launch moveit2_tutorials demo.launch.py如果看到Rviz里出现了一个红色的机械臂，恭喜你，环境搭好了。嗯，这里要注意：第一次启动可能会慢一点，因为要加载URDF和SRDF文件。别急，等一会儿。
配置方面，核心文件就两个：
- URDF：描述机械臂的物理结构，连杆、关节、质量、惯性这些。
- SRDF：描述机械臂的“能力”，比如哪些关节可以动，哪些是固定位姿，规划组怎么划分。
我个人习惯，URDF用xacro写，参数化好，维护起来方便。SRDF则用MoveIt Setup Assistant生成，虽然界面老点，但胜在直观。
4.2 运动学求解器：KDL vs TRAC-IK
机械臂控制的核心问题之一，就是逆运动学（IK）。说白了，就是知道末端要走到哪个位置，反算出每个关节该转多少度。
ROS2里最常用的两个求解器：KDL 和 TRAC-IK。
| 特性 | KDL | TRAC-IK |
|---|---|---|
| 算法基础 | 基于牛顿-拉夫森迭代 | 结合KDL与SQP优化 |
| 求解速度 | 中等，偶尔会卡在奇异点 | 快，鲁棒性更好 |
| 奇异点处理 | 容易发散 | 有回退策略，不容易崩 |
| 配置难度 | 默认集成，开箱即用 | 需要额外安装插件 |
我在项目里遇到过好几次，KDL在接近奇异位姿时直接报错，导致整个规划失败。后来换了TRAC-IK，虽然配置多了一步，但稳定性提升明显。你想想看，产线上机械臂突然卡住不动，那可不是闹着玩的。
配置TRAC-IK很简单，在SRDF里指定插件就行：
<group name="arm_group">
<kinematics_solver>
<plugin>trac_ik_kinematics_plugin/TRAC_IKKinematicsPlugin</plugin>
<param name="position_only_ik">false</param>
<param name="solve_type">Speed</param>
</kinematics_solver>
</group>参数solve_type我一般设成Speed，追求实时性。如果精度要求高，可以改成Distance，但计算会慢一点。
4.3 规划组与碰撞检测
规划组（Planning Group）是MoveIt2里一个很重要的概念。它把机械臂的关节分成一组，告诉规划器：“这些关节是一起动的，你规划的时候要考虑它们之间的约束。”
举个例子，一个六轴机械臂，你可以把前三个关节设成一个组（负责位置），后三个关节设成另一个组（负责姿态）。也可以全部放在一个组里，看你的需求。
我一般这样划分：
- 主规划组：包含所有运动关节，用于笛卡尔空间规划。
- 末端执行器组：只包含夹爪或工具，用于抓取动作。
- 固定组：比如基座，不参与运动，但参与碰撞检测。
碰撞检测这块，MoveIt2默认用的是FCL（Flexible Collision Library）。它会自动检测机械臂自身、机械臂与环境之间的碰撞。你想想看，如果没这层保护，机械臂随便一挥，可能就把旁边的传感器打飞了。
配置碰撞检测，通常在SRDF里定义：
<group name="arm_group">
<collision>
<link name="link1" />
<link name="link2" />
<-- 可以手动排除某些不会碰撞的连杆对 -->
<disable_collision link1="link1" link2="link3" reason="Never" />
</collision>
</group>为什么要手动排除？因为有些连杆在物理上永远不会碰到，比如相邻的两个连杆。排除之后，碰撞检测的计算量能减少一半以上。
4.4 本章知识体系
下面这张图，是我自己画的，把这一章的核心逻辑串起来了。你一看就明白：
这张图把MoveIt2的三大块串起来了。安装配置是基础，运动学求解器是核心算法，规划组和碰撞检测是安全保障。三者缺一不可。
好了，这一章的内容就到这儿。你跟着我把MoveIt2装好，把KDL和TRAC-IK配明白，再搞清楚规划组怎么划分，后面做机械臂和导航协同的时候，就能直接上手了。
可可精品资料库