ROS2 MoveIt2 机械臂运动规划与控制实战

核心概念

MoveIt2 的核心逻辑是将用户的运动需求转化为机械臂可执行的关节指令。

核心模块

• MoveGroup：核心接口，整合规划、检测与控制功能，用户可直接调用。
• Planning Scene：描述工作环境（机械臂、障碍物、目标物体），用于碰撞检测。
• Planning Pipeline：负责路径规划，输入目标位姿后计算无碰撞平滑路径。
• Servo：支持实时手动控制，内置奇异点与碰撞检测。

关键术语

• 位姿 (Pose)：末端位置与姿态，是运动目标的核心。
• 关节空间运动：直接控制关节角度，适合精准定位。
• 笛卡尔空间运动：控制末端平移旋转，适合抓取放置。
• URDF/Xacro：机械臂模型描述文件，定义关节、连杆参数。

基础操作

本章基于官方样例，通过 RViz 和终端掌握基础控制。

启动样例

source ~/ws_moveit/install/setup.bash
ros2 launch moveit2_tutorials demo.launch.py rviz_tutorial:=true

启动后打开 RViz 和终端，左侧为操作面板。

RViz 可视化操作

在 RViz 左侧'MotionPlanning'面板中：

1. 点击'Select Group'，选择'panda_arm'或'panda_hand'。
2. 设置目标位姿：
   • 关节空间：拖动滑块调整姿态，点击'Plan'→'Execute'。
   • 笛卡尔空间：点击'Pose Goal'，拖动鼠标调整末端位置，点击'Plan'→'Execute'。
3. 碰撞检测：在'Planning Scene'中添加障碍物，规划时会自动避开。

键盘控制（实时伺服）

支持关节与笛卡尔模式，需注意代码分支稳定性。

1. 启动服务端：ros2 launch moveit2_tutorials servo_teleop.launch.py
2. 启动键盘节点：ros2 run moveit2_tutorials servo_keyboard_input
3. 操作说明：
   • 笛卡尔模式：W/E 切换坐标系，箭头键控制前后左右。
   • 关节模式：1~7 控制关节，R 切换方向。

若启动失败，建议回退到稳定分支：git reset <commit_id> --hard

夹爪控制

通过终端命令控制 Panda 夹爪开合：

# 打开
ros2 service call /panda_hand/set_joint_value trajectory_msgs/srv/JointTrajectory "{joint_names: [panda_finger_joint1, panda_finger_joint2], points: [{positions: [0.04, 0.04], velocities: [0.1, 0.1], time_from_start: {sec: 1, nanosec: 0}}]}"
# 闭合
# 将 positions 改为 [0.0, 0.0]

实战案例：仿真抓取

结合 Gazebo 实现'识别→移动→抓取→放置'流程。

环境加载

mkdir -p ~/moveit_grab/src && cd ~/moveit_grab
git clone https://github.com/ros-planning/moveit2_tutorials.git -b humble --depth 1
rosdepc install -r --from-paths src --ignore-src --rosdistro $ROS_DISTRO -y
colcon build
source install/setup.bash
ros2 launch moveit2_tutorials gazebo_demo.launch.py

抓取流程

1. 设置场景：在 RViz'Planning Scene'中添加目标立方体模型，位置需与 Gazebo 一致。
2. 规划位姿：调整机械臂末端至目标上方（约 5cm），确保夹爪对准物体，规划并执行。
3. 闭合夹爪：输入闭合命令，观察 Gazebo 中是否抓住立方体。
4. 放置物体：设置远离抓取点的放置位姿，规划移动，随后输入打开命令松开物体。

拓展方向

真实场景中可集成深度相机（如 Intel Realsense），获取目标坐标后发送给 MoveIt2，实现视觉辅助的自主抓取。

常见问题汇总

启动类

• Fixed Frame 不存在：检查模型加载，重新 source 工作空间。
• Gazebo 无响应：确认 gazebo_ros_pkgs 安装正确，重启节点。

规划类

• No solution found：目标超出范围或碰撞，调整位姿或移除障碍。
• 路径卡顿：优化路径参数或更换算法（如 RRT*）。

控制类

• 键盘无响应：检查伺服端是否启动，代码分支是否正确。
• 夹爪异常：核对关节名称与服务调用命令。

进阶方向

掌握基础后可按需深入学习：

1. 代码开发：C++/Python 调用 MoveGroup 接口编写自定义控制。
2. 模型自定义：编写 URDF/Xacro 适配新机械臂。
3. 视觉融合：集成深度相机实现目标识别与定位。
4. 实物控制：连接真实机械臂（如 UR、ABB）进行调试。
5. 高级规划：学习路径优化与避障算法自定义。

结语

本教程覆盖从环境搭建到仿真抓取的核心流程，适合零基础入门者快速上手。MoveIt2 的学习关键在于多实操、多调试。遇到问题可参考官方文档或社区资源，逐步尝试进阶功能，助力从仿真走向实战。