机器人 / 系统课时

发送导航目标并核对到达状态

发送导航目标并核对到达状态

在 ROS 2 Jazzy 的 TurtleBot3 仿真中,从 RViz 发送一个可通行目标,连续观察规划路径、底盘运动和导航反馈,最后结合 Action 终态与实际位姿判断任务是否完成,避免把“机器人停下”误判为“成功到达”。

学习目标

  • 在 RViz 设置初始位姿、目标位置和目标朝向。
  • 对照全局路径、Gazebo 运动和 Nav2 的实时反馈观察导航过程。
  • 识别成功、取消与失败终态,并核对最终位置误差。

启动仿真并确认 Action 可用

以下操作适用于 Ubuntu 24.04、ROS 2 Jazzy、已安装 Nav2 与 TurtleBot3 仿真依赖的环境。打开图形桌面终端运行官方 Nav2 示例;已有正常运行的 TurtleBot3、定位、Nav2 和 RViz 时,不要重复启动第二套节点。

bash
# 启动包含仿真、定位、Nav2 与 RViz 的集成示例
source /opt/ros/jazzy/setup.bash
ros2 launch nav2_bringup tb3_simulation_launch.py headless:=False

预期结果:出现 Gazebo 和 RViz 窗口;仿真世界加载机器人,RViz 可显示地图。若 Nav2 未自动激活,在 RViz 的 Navigation 2 面板点击 Startup,等待地图和机器人定位显示正常。缺少安装包时参考 Nav2 Jazzy 官方快速入门。

在第二个终端检查导航 Action,确认不是只有 RViz 界面而没有接收目标的服务器。

bash
# 确认目标 Action 服务器已经注册
source /opt/ros/jazzy/setup.bash
ros2 action list -t | grep '^/navigate_to_pose '

预期输出:

text
/navigate_to_pose [nav2_msgs/action/NavigateToPose]

如果没有这一行,先检查 bt_navigator 是否已激活,以及终端和启动进程是否使用相同的 ROS_DOMAIN_ID;不要反复点击目标按钮。

在 RViz 发送目标位姿

  1. 在左侧 Displays → Global Options → Fixed Frame 选择 map,确认栅格地图、机器人轮廓和激光观测位置大致一致。
  2. 如果机器人尚未定位,点击顶部 2D Pose Estimate,在地图中机器人实际所在处按下鼠标并沿当前朝向拖动,等待 AMCL 粒子逐渐收敛。这一步设置的是当前位姿,不是目标。
  3. 点击顶部 Nav2 Goal(部分配置显示为 Navigation2 Goal),在离机器人约 1~2 m、周边至少约 0.5 m 没有障碍物的已知空闲区按下鼠标,拖出指向期望最终朝向的箭头后松开。箭头起点是目标位置,箭头方向是目标朝向;松开后提交 NavigateToPose Action。

RViz 导航目标、全局路径与状态观察位置

同时核对路径、运动与任务反馈

目标被接收后,应该出现从机器人附近通向终点的全局路径。若 RViz 没有显示线段,在 Displays → Add → By display type → Path 添加路径显示项,并把 Topic 指向实际发布的 nav_msgs/msg/Path 话题(示例配置常见 /plan,具体以当前系统为准)。

至少同时检查三处:RViz 中路径绕开地图障碍,Gazebo 中底盘沿路线真实移动,Navigation 2 面板的剩余距离逐步下降。面板还可能显示导航用时、预计剩余时间、恢复次数;遇障短暂重新规划不一定是失败,但持续不动、距离不减或恢复次数反复增加需要排查。

NavigateToPose 目标包括地图坐标系下的位置和朝向。机器人到达坐标点后可能原地旋转对正箭头;此时应等待任务结束,不要因为线速度接近零就提前宣布成功。

用终态和位姿共同验收

若要查看底层 Action 状态,在再次发送一个目标之前,先打开第三个已加载 Jazzy 环境的终端运行以下监听,再从 RViz 发送目标;这是持续监听命令,按 Ctrl+C 结束。

bash
# 先监听,再从 RViz 发送目标
source /opt/ros/jazzy/setup.bash
ros2 topic echo /navigate_to_pose/_action/status action_msgs/msg/GoalStatusArray | grep --line-buffered 'status:'

预期输出(单目标成功执行时的典型状态行,可能重复):

text
  status: 2
  status: 4

2 表示执行中,4 为成功,5 为已取消,6 为已中止。此话题可能包含多个目标的状态;同时发送多个目标时要查看原始消息中的目标 UUID,不可把别的目标的 4 当成本次成功。RViz 的 Navigation 2 面板也应显示任务完成,而不是取消或失败。

最后逐项验收:Action 终态成功;Gazebo 中机器人位于目标附近且停止;RViz 中机器人最终朝向与目标箭头一致到容差范围内。若使用 Jazzy 的 nav2_controller::SimpleGoalChecker 默认值,位置容差为 0.25 m,偏航角容差为 0.25 rad(约 14.3°),实际以已加载参数为准。状态成功表示通过配置的到达判定,并不等于误差严格为零。

目标不动或任务失败时先查什么

  • **目标发出却没有规划线:**检查 Nav2 是否激活、是否完成 2D Pose Estimate、Fixed Frame 是否为 map;把目标移到地图中明确空闲、远离障碍的位置再试。
  • **有路径但机器人不动:**检查 Gazebo 是否暂停、机器人是否仍被其他速度控制源接管,以及 Nav2 控制输出到仿真底盘的速度链路是否连通。
  • **接近目标后反复旋转:**先检查目标箭头是否朝向可实现的位置、定位是否抖动,再查看控制器的到达容差;不要通过不断增大容差掩盖定位问题。
  • **出现 status: 5 或 status: 6:**分别记录取消或中止,检查 Nav2 面板和相关节点日志,不要把两者写成导航成功。

完成验收时,应能提供同一次目标的路径画面、机器人最终停靠位置和对应的 Action 终态;三者一致才算完成这次仿真导航。

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

目录与阅读设置

阅读设置

17

记录一个想法

发送导航目标并核对到达状态

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

登录哪都通