Skip to content

踩坑GitHub ros-navigation/navigation23 天前

Nav2重发路径报错Resulting plan has 0 poses因搜索窗口受限 ​

本文由 AI 根据公开内容整理,可能有误,请以原文为准:"Resulting plan has 0 poses" when the same path is resent(GitHub ros-navigation/navigation2 #6235)

状态:有绕过办法

问题 ​

机器人沿路径行驶中FollowPath中止后重发相同路径,报错"Resulting plan has 0 poses"。原因是setPath重置global_plan_起点,而机器人已远离起点(如pose 480/483),受max_robot_pose_search_dist(5m)限制的有界搜索仅能覆盖前100个pose,找到的最近点(pose 99)超出局部costmap范围,导致转换后的计划为空并陷入重试死循环。

环境 ​

Ubuntu 22.04, ROS2 Humble, Cyclone DDS, MPPI Controller, Navigation2

解决办法 ​

  1. 在行为树(BT)中增加路径裁剪节点(如TruncatePathLocal),在控制失败取消后、重发路径前,将全局路径截断为从当前机器人位姿到终点的子路径,避免控制器搜索窗口无法覆盖实际位置。
  2. 或者在BT逻辑中检测到FollowPath因该错误中止时,直接触发全局重规划(ComputePathToPose),基于当前位置生成新路径;维护者指出在路径末端附近重规划计算开销较小。
  3. 若坚持修改控制器,需在pruning逻辑中增加回退机制:当有界搜索结果距离显著超限时自动切换为全路径搜索,但需额外处理环路/U-turn场景下的误匹配风险,目前官方未提供此补丁。

讨论原作者:@BCKSELFDRIVEWORLD 等,版权归原作者所有。

基于本页技术方向关联的整机参数、核心零部件、实测报告与同赛道选型横评。

外部来源

本页事实对应的公开页面,以原文为准。(点击将离开本站)

  1. GitHub ros-navigation/navigation2 #6235:"Resulting plan has 0 poses" when the same path is resent ↗访问 2026-11-19