机器人 / 系统课时

处理未知区域和窄通道规划

处理未知区域和窄通道规划

Nav2 全局规划没有路径时,问题可能来自未探索栅格被禁止穿越,也可能是走廊被底盘轮廓与障碍膨胀挤窄。这里以 ROS 2 Jazzy、NavFn 和 0.05 m 栅格地图为例,先定位阻断位置,再用可核对的参数与宽度计算修正。

学习目标

  • 区分 track_unknown_space 与 allow_unknown 对未知区域的影响。
  • 根据 footprint、footprint_padding 和膨胀代价判断窄通道是否可行。
  • 修改现有 Nav2 参数并在 RViz、终端中验证规划结果。

先区分两种断路现象

在 RViz 中添加 Map 显示,话题选择 /global_costmap/costmap,并叠加全局路径(通常为 /plan,以实际规划器发布的话题为准)。先确认起点、目标点都落在地图内,并在代价地图而非仅在原始 /map 上观察通道。

看到的现象 优先核对
路径到大片灰色未知栅格前中止 未知栅格是否保留,以及规划器是否允许进入
两侧墙体之间没有连续可用的通路 实际底盘宽度、轮廓膨胀和地图分辨率
有全局路径,但底盘停在门口 局部代价地图、控制器碰撞检查与转弯空间

未知区域和膨胀后的高代价区域不是一回事:前者表示尚未观测,后者表示已知障碍附近的通行风险。不能仅凭地图呈灰色就判断通道在几何上无法穿越。

未知区域许可和狭窄通道几何的俯视对比

未知区域的两道开关

global_costmap 的 track_unknown_space 决定未知栅格是否在代价地图中保留;NavFn 的 GridBased.allow_unknown 决定规划搜索能否走进这些未知栅格。只有两者一起看,规划策略才明确。

track_unknown_space allow_unknown 规划含义
true false 保留未知区域,并禁止规划穿越
true true 保留未知区域,允许搜索穿越,但不保证无障碍
false 任意值 未知区域按自由空间处理,不能靠规划器开关禁止

在已有静态地图的室内导航中,推荐先用 true 与 false 的组合,只规划经过确认的区域。需要探索未建图部分时,可在受控仿真中把 allow_unknown 改为 true 作对照;实际运行仍须依靠传感器与局部避障检查,不能把未知当成安全通道。

计算通道有效宽度与膨胀代价

假设一个示例矩形底盘长 0.40 m、宽 0.34 m,轮廓坐标的横向边界为 ±0.17 m,footprint_padding 为 0.02 m。直行时的近似有效宽度为 0.34 + 2 × 0.02 = 0.38 m。

地图量出的净宽 两侧平均剩余间隙 判断
0.60 m 0.11 m/侧 几何上可通过,仍需考虑定位误差
0.50 m 0.06 m/侧 余量很小,先检查量测与地图离散化
0.35 m 比所需宽度少 0.03 m 几何上不可通过,不应缩小安全参数硬闯

在 0.05 m 分辨率下,0.50 m 只对应约 10 个栅格,墙边多占一个格就会明显改变净宽。因此要先核对地图墙体厚度、底盘真实外形与轮廓朝向,而不是直接降低安全距离。

inflation_radius 控制障碍周围代价扩散的范围,cost_scaling_factor 控制超出内切半径后代价衰减的速度;膨胀半径并不等于整圈硬禁行半径。较大半径可能使窄走廊整段变成高代价带,但真正处于碰撞区的栅格不能靠调低膨胀半径变成安全空间。转弯处还要核对旋转扫过的轮廓。

合并参数并检查生效值

以下为 片段示例:合并进当前启动时实际加载的 nav2_params.yaml,不要替换整个文件。假设已有 GridBased 类型为 nav2_navfn_planner::NavfnPlanner,且全局代价地图的插件列表包含名为 inflation_layer 的膨胀层;使用其他插件 ID 时要同步修改层级名称。轮廓尺寸是算例,不是 TurtleBot3 的标准实测值。

yaml
planner_server:
  ros__parameters:
    GridBased:
      allow_unknown: false  # 先拒绝进入未观测区域

global_costmap:
  global_costmap:
    ros__parameters:
      track_unknown_space: true
      footprint: "[[0.20, 0.17], [0.20, -0.17], [-0.20, -0.17], [-0.20, 0.17]]"
      footprint_padding: 0.02
      inflation_layer:
        inflation_radius: 0.45
        cost_scaling_factor: 10.0  # 保留较快的代价衰减

配置生效行为:未知区域在全局代价地图中保持未知并被 NavFn 排除;规划器按示例轮廓及膨胀代价选择路线。修改参数文件后,用原来的启动命令重新启动 Nav2,确保确实加载了该文件。

在已启动的终端中查询真实运行值:

bash
ros2 param get /planner_server GridBased.allow_unknown
ros2 param get /global_costmap/global_costmap track_unknown_space
ros2 param get /global_costmap/global_costmap inflation_layer.inflation_radius

预期输出(加载上述片段且使用默认节点名称时):

text
Boolean value is: False
Boolean value is: True
Double value is: 0.45

如果查不到参数,先用 ros2 node list 核对节点全名,再用 ros2 param list /planner_server 查实际插件 ID;不要假设文件已被读取。

对照测试并判断是否真正修复

  1. 已知自由区测试:把目标放在无遮挡的已知区域。应能看到连续全局路径;否则先排除起终点障碍、TF 或规划器服务异常。
  2. 未知边界测试:在隔离的仿真环境中,将目标设在未知区域后方。track_unknown_space=true 且 allow_unknown=false 时,不应出现穿越该未知区域的规划路径;临时改为 true 后,可观察规划候选路径是否穿过未知区,完成对照后恢复保守值。
  3. 窄通道测试:在净宽 0.60 m 的直走廊里观察路线是否沿通道连续生成,再对比 0.35 m 走廊。后者按上述底盘尺寸应判为不可通行,不应靠谎报轮廓尺寸使规划成功。
  4. 控制器复核:如果全局路径已穿过走廊但机器人仍不动,检查 /local_costmap/costmap、局部轮廓配置及转弯空间;这已不是单纯的全局规划失败。

优先修正错误的地图、轮廓和未知区域策略;只有几何净宽足够时,才对 inflation_radius 与 cost_scaling_factor 做小幅对照调整,并逐次核查路径到墙体的间距。参数含义可核对 NavFn Jazzy 文档、Costmap2D Jazzy 文档 和 Inflation Layer Jazzy 文档。

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

目录与阅读设置

阅读设置

17

记录一个想法

处理未知区域和窄通道规划

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

登录哪都通