机器人 / 系统课时

用交互标记规划并预览轨迹

用交互标记规划并预览轨迹

本篇在 RViz 中拖动机械臂末端的交互标记,设置目标位姿并完成一次只规划、不执行的运动轨迹预览。你会看到起点、终点和路径动画,学会判断碰撞与不可达目标,避免把屏幕上的运动误当作机械臂已经执行。

学习目标

  • 在 RViz 的 MotionPlanning 插件中显示并操作起点、目标交互标记。
  • 使用 Plan 生成轨迹,通过 Planned Path 检查运动过程与碰撞提示。
  • 区分 Plan、Execute 和 Plan & Execute,完成一次不触发真实执行的验收。

启动示例与确认入口

操作前应有可用的 MoveIt 2 配置、move_group 规划服务、关节状态以及 RViz。以下以已构建并加载 moveit2_tutorials 的官方示例工作空间为例;不同 ROS 2 / MoveIt 2 发布版所附机器人可能不同,本节提到的 manipulator 与 /base_link 以当前官方 Rolling 示例为准,其他配置请使用本机 SRDF 规划组和机器人基座坐标系。

打开终端,先加载自己的 ROS 2 与教程工作空间环境,再启动示例:

bash
ros2 launch moveit2_tutorials demo.launch.py

预期结果:终端持续输出启动日志,RViz 显示机械臂模型及 MotionPlanning 面板;启动日志的具体时间戳和进程号会变化。若提示 Package 'moveit2_tutorials' not found,先确认教程包已构建,并在当前终端 source 相应工作空间的 install/setup.bash。

在另一终端加载相同环境,检查关键节点:

bash
ros2 node list | grep -E '^/(move_group|rviz2)$'

预期输出:

text
/move_group
/rviz2

若节点带命名空间,实际全名会不同,应以 ros2 node list 的完整结果核对。RViz 如果没有 MotionPlanning,在 Displays → Add → moveit_ros_visualization → MotionPlanning 中添加;示例配置常用 Robot Description = robot_description、Planning Scene Topic = /monitored_planning_scene、Planned Path → Trajectory Topic = /display_planned_path,并在 Planning Request → Planning Group 选择 manipulator(或实际规划组)。

拖动交互标记指定终点

先在 MotionPlanning 的 Planning 页将 Start State 设为 current,以当前关节状态作为规划起点。随后在左侧 Displays → MotionPlanning 属性树中操作:

  1. 展开 Planning Request,勾选 Query Goal State 显示橙色目标机器人;需要比较起点时,再勾选 Query Start State 显示绿色起点机器人。
  2. 在 RViz 顶部工具栏选择 Interact。若工具栏被折叠,可用 + 找到该工具。
  3. 将鼠标移至橙色机械臂末端,拖动直线方向手柄改变位置,拖动环形手柄改变朝向;先选一个距原位较近、明显可达的目标。
  4. 如果多个机器人模型重叠,可临时取消 Scene Robot → Show Robot Visual,保留起点、目标以及 Planned Path → Show Robot Visual 以免误拖错对象。

RViz 中交互标记、规划按钮与轨迹预览区域

提交规划并预览轨迹

保持 Planning → Use Collision-Aware IK 勾选,并确认目标姿态未出现明显碰撞。为观察一般的关节空间运动,先不要勾选 Use Cartesian Path;它会改变规划目标的运动方式。

  1. 在 Displays → MotionPlanning → Planned Path 勾选 Show Robot Visual,先取消 Show Trail 以便观察单个动画模型。
  2. 在 MotionPlanning 面板的 Planning 页点击 Plan,等待规划完成。只点击 Plan,不点击 Execute 或 Plan & Execute。
  3. 成功时观察规划轨迹的机器人动画,再打开 Show Trail,查看沿路径分布的多个半透明机械臂姿态。
  4. 旋转 RViz 视角检查手臂、肘部是否穿入环境障碍;若需逐点检查,可在 Panels → Add New Panels 中添加 Trajectory - Trajectory Slider(面板名称依发布版可能略有差异),重新 Plan 后拖动滑块检查轨迹点。

验收标准:规划报告成功;轨迹从绿色起点附近出发并到达橙色目标;预览的各中间姿态没有明显相互穿透。关节空间规划不保证末端走直线,弯曲或绕行并不自动代表失败。改变目标后必须再次点击 Plan,否则可能仍在播放上一次轨迹。

用碰撞和失败结果调整目标

拖动目标时若两节连杆发生自碰撞,MoveIt 的可视化通常将碰撞连杆标红。勾选 Use Collision-Aware IK 后,逆解会尝试规避碰撞;取消勾选可能生成碰撞姿态,适合离线观察故障,但不能据此执行。

遇到规划失败,按下面顺序检查:

  1. 末端不可达:把目标拉回机械臂正常工作空间,不要为了通过演示临时放大关节极限。
  2. 目标姿态或路径碰撞:检查红色连杆、规划场景障碍物及机器人自碰撞配置;避开障碍重新选点。
  3. 规划成功但没有可见动画:核对 Planned Path → Show Robot Visual 是否启用,轨迹话题是否匹配,并重新点击 Plan。

明确规划和执行的边界

按钮 实际作用 本次是否使用
Plan 计算并显示候选运动轨迹,不下发轨迹到执行控制器 使用
Execute 将已经规划的轨迹交给执行链路,前提是轨迹仍有效 不使用
Plan & Execute 先规划,再请求执行 不使用

即使示例使用假硬件或仿真控制器,Execute 也可能更新受控机器人的关节状态;接入真实机器人时更会涉及实体运动。因此本次只验证 目标标记可拖动、Plan 成功、Show Trail 可见、场景机器人没有因执行命令而运动 四项。下一次更换目标后,重新从当前状态规划,不要直接执行缓存的旧轨迹。

按自己的节奏,确认真正理解。

目录与阅读设置

阅读设置

17

记录一个想法

用交互标记规划并预览轨迹

0 / 10000 · 笔记保存到账号。未提交的修改会在关闭、离开或刷新后丢失。

登录哪都通