机器人 / 系统课时
发送导航目标并核对到达状态
发送导航目标并核对到达状态
在 ROS 2 Jazzy 的 TurtleBot3 仿真中,从 RViz 发送一个可通行目标,连续观察规划路径、底盘运动和导航反馈,最后结合 Action 终态与实际位姿判断任务是否完成,避免把“机器人停下”误判为“成功到达”。
学习目标
- 在 RViz 设置初始位姿、目标位置和目标朝向。
- 对照全局路径、Gazebo 运动和 Nav2 的实时反馈观察导航过程。
- 识别成功、取消与失败终态,并核对最终位置误差。
启动仿真并确认 Action 可用
以下操作适用于 Ubuntu 24.04、ROS 2 Jazzy、已安装 Nav2 与 TurtleBot3 仿真依赖的环境。打开图形桌面终端运行官方 Nav2 示例;已有正常运行的 TurtleBot3、定位、Nav2 和 RViz 时,不要重复启动第二套节点。
# 启动包含仿真、定位、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 界面而没有接收目标的服务器。
# 确认目标 Action 服务器已经注册
source /opt/ros/jazzy/setup.bash
ros2 action list -t | grep '^/navigate_to_pose '预期输出:
/navigate_to_pose [nav2_msgs/action/NavigateToPose]如果没有这一行,先检查 bt_navigator 是否已激活,以及终端和启动进程是否使用相同的 ROS_DOMAIN_ID;不要反复点击目标按钮。
在 RViz 发送目标位姿
- 在左侧
Displays → Global Options → Fixed Frame选择map,确认栅格地图、机器人轮廓和激光观测位置大致一致。 - 如果机器人尚未定位,点击顶部
2D Pose Estimate,在地图中机器人实际所在处按下鼠标并沿当前朝向拖动,等待 AMCL 粒子逐渐收敛。这一步设置的是当前位姿,不是目标。 - 点击顶部
Nav2 Goal(部分配置显示为Navigation2 Goal),在离机器人约 1~2 m、周边至少约 0.5 m 没有障碍物的已知空闲区按下鼠标,拖出指向期望最终朝向的箭头后松开。箭头起点是目标位置,箭头方向是目标朝向;松开后提交NavigateToPoseAction。

同时核对路径、运动与任务反馈
目标被接收后,应该出现从机器人附近通向终点的全局路径。若 RViz 没有显示线段,在 Displays → Add → By display type → Path 添加路径显示项,并把 Topic 指向实际发布的 nav_msgs/msg/Path 话题(示例配置常见 /plan,具体以当前系统为准)。
至少同时检查三处:RViz 中路径绕开地图障碍,Gazebo 中底盘沿路线真实移动,Navigation 2 面板的剩余距离逐步下降。面板还可能显示导航用时、预计剩余时间、恢复次数;遇障短暂重新规划不一定是失败,但持续不动、距离不减或恢复次数反复增加需要排查。
NavigateToPose 目标包括地图坐标系下的位置和朝向。机器人到达坐标点后可能原地旋转对正箭头;此时应等待任务结束,不要因为线速度接近零就提前宣布成功。
用终态和位姿共同验收
若要查看底层 Action 状态,在再次发送一个目标之前,先打开第三个已加载 Jazzy 环境的终端运行以下监听,再从 RViz 发送目标;这是持续监听命令,按 Ctrl+C 结束。
# 先监听,再从 RViz 发送目标
source /opt/ros/jazzy/setup.bash
ros2 topic echo /navigate_to_pose/_action/status action_msgs/msg/GoalStatusArray | grep --line-buffered 'status:'预期输出(单目标成功执行时的典型状态行,可能重复):
status: 2
status: 42 表示执行中,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 终态;三者一致才算完成这次仿真导航。