机器人 / 系统课时
处理未知区域和窄通道规划
处理未知区域和窄通道规划
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 的标准实测值。
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,确保确实加载了该文件。
在已启动的终端中查询真实运行值:
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预期输出(加载上述片段且使用默认节点名称时):
Boolean value is: False
Boolean value is: True
Double value is: 0.45如果查不到参数,先用 ros2 node list 核对节点全名,再用 ros2 param list /planner_server 查实际插件 ID;不要假设文件已被读取。
对照测试并判断是否真正修复
- 已知自由区测试:把目标放在无遮挡的已知区域。应能看到连续全局路径;否则先排除起终点障碍、TF 或规划器服务异常。
- 未知边界测试:在隔离的仿真环境中,将目标设在未知区域后方。
track_unknown_space=true且allow_unknown=false时,不应出现穿越该未知区域的规划路径;临时改为true后,可观察规划候选路径是否穿过未知区,完成对照后恢复保守值。 - 窄通道测试:在净宽 0.60 m 的直走廊里观察路线是否沿通道连续生成,再对比 0.35 m 走廊。后者按上述底盘尺寸应判为不可通行,不应靠谎报轮廓尺寸使规划成功。
- 控制器复核:如果全局路径已穿过走廊但机器人仍不动,检查
/local_costmap/costmap、局部轮廓配置及转弯空间;这已不是单纯的全局规划失败。
优先修正错误的地图、轮廓和未知区域策略;只有几何净宽足够时,才对 inflation_radius 与 cost_scaling_factor 做小幅对照调整,并逐次核查路径到墙体的间距。参数含义可核对 NavFn Jazzy 文档、Costmap2D Jazzy 文档 和 Inflation Layer Jazzy 文档。