机器人 / 系统课时
调整障碍标记与清除范围
调整障碍标记与清除范围
移动障碍物离开后,局部代价地图仍可能留下占用痕迹;远处障碍也可能无法标记。本课以 ROS 2 Jazzy 的 Nav2 ObstacleLayer 为例,分别设置标记与清除距离,并在 RViz 中验证两种行为。
学习目标
- 区分
obstacle_max_range与raytrace_max_range的作用范围。 - 在局部代价地图的激光数据源下配置这两个参数。
- 通过移动障碍物验证标记、射线清除及常见失效原因。
两个距离控制不同的动作
ObstacleLayer 把激光扫描用于两项操作:marking: true 将有效回波所在栅格标为障碍;clearing: true 沿有效激光束对经过的栅格做自由空间清除。两个距离都以传感器观测原点为参考,单位是米。
以 obstacle_max_range: 2.5、raytrace_max_range: 3.0 为例(这也是 Nav2 Jazzy 官方参数表 中的默认上限):
- 同方向在 2.0 m 处命中障碍:该点可以被标记,沿射线到命中点之前的栅格可以被清除;不会清除障碍物后方。
- 另一方向在 3.2 m 处获得有效有限回波:3.2 m 的点不参与障碍标记,但其前方最多 3.0 m 内的可见栅格可被清除。
- 若某方向没有有效回波,不能凭空假定能清除;只有正确处理传感器的无回波数据,才可能沿该方向执行清除。

这两个值是不同的上限,清除范围较大不代表能探测更远。有效范围还受激光实际量程、视场、TF 和代价地图尺寸限制;半径只有 1.5 m 的局部地图也无法展示 3.0 m 处的清除效果。
配置局部代价地图
先确认仿真已发布 /scan,激光坐标系能通过 TF 转换到 odom,并且 Nav2 使用的是 ObstacleLayer。下面是适用于 ROS 2 Jazzy 的参数文件片段示例:它展示 local_costmap 的相关段落,须放入现有 Nav2 参数 YAML,其他服务器参数仍沿用原文件。
local_costmap:
local_costmap:
ros__parameters:
use_sim_time: true
global_frame: odom
robot_base_frame: base_link
update_frequency: 5.0
publish_frequency: 2.0
rolling_window: true
width: 8.0
height: 8.0
resolution: 0.05
robot_radius: 0.22
plugins: ["obstacle_layer", "inflation_layer"]
obstacle_layer:
plugin: "nav2_costmap_2d::ObstacleLayer"
enabled: true
observation_sources: scan
scan:
topic: /scan
data_type: "LaserScan"
marking: true
clearing: true
obstacle_max_range: 2.5
raytrace_max_range: 3.0
# 仅当 +Inf 代表该方向无障碍回波时启用
inf_is_valid: true
inflation_layer:
plugin: "nav2_costmap_2d::InflationLayer"
inflation_radius: 0.55
cost_scaling_factor: 3.0observation_sources: scan 表示数据源名称为 scan,所以两个距离必须写在 obstacle_layer.scan 下,不能直接写在 ros__parameters 顶层。若现有配置使用 voxel_layer,应修改实际启用的 voxel_layer.scan,不要只增加一个未列入 plugins 的 obstacle_layer。inf_is_valid 默认是 false;仅在 /scan 的正无穷值确实表示未命中、且激光 range_max 大于标记上限时才采用本例的 true,否则可能在量程末端形成伪障碍。
修改后以实际使用的参数文件重新启动 Nav2,确保观察缓存和插件配置重新初始化。不要假定改动磁盘 YAML 就会立即改变运行中的观察范围。
检查参数与 RViz 实验
在 Nav2 已启动、终端已加载 ROS 2 环境的前提下执行:
# 两个参数必须来自正在运行的局部代价地图节点
ros2 param get /local_costmap/local_costmap obstacle_layer.scan.obstacle_max_range
ros2 param get /local_costmap/local_costmap obstacle_layer.scan.raytrace_max_range预期输出:
Double value is: 2.5
Double value is: 3.0如果节点带命名空间,先用 ros2 node list 查实际全名。读到参数只证明加载成功,不证明激光消息正在参与更新;还需要做场景测试。
- 在 RViz 的
Displays中添加Map,将Topic设为/local_costmap/costmap,在Global Options中将Fixed Frame设为odom;另添加LaserScan显示/scan。在静止机器人前方不同角度分别放置 2.0 m 和 2.8 m 的可移动障碍物,确保两者相隔足够远,膨胀区不重叠。 - 检查 2.0 m 处出现障碍占用及周围膨胀区,而 2.8 m 处的激光回波不会单独新增障碍占用。测试时避免与静态地图障碍、其他数据源重叠。
- 移走 2.0 m 的障碍,确保同方向出现能越过原障碍位置的有效扫描射线。若清除正常,原占用及其膨胀区应随地图更新消退。
- 做清除范围对照时,将
raytrace_max_range暂改为1.5,重启 Nav2,重新放置并移走 2.0 m 障碍;原位置可能残留占用。恢复3.0并重复实验,比较清除结果。每轮都重新布置场景,避免把重启导致的地图清空误判成射线清除。
清除失效时按链路定位
障碍始终不出现:检查 /scan 是否有对应方向的有限测距、marking 是否为 true、命中点是否在 2.5 m 内,以及数据源是否属于实际启用的插件。激光消息有数据但图层不更新时,还要核对扫描时间戳、frame_id 与 odom 的 TF。
障碍移走仍占用:先确认 clearing: true,然后检查新射线是否穿过旧栅格、射线长度是否达到原位置;raytrace_max_range 不能清除其边界以外的栅格。如果无命中以 +Inf 表示,检查 inf_is_valid 与传感器语义是否匹配。
显示看似没清除:区分原始占用、膨胀层和静态地图。inflation_radius: 0.55 会让障碍周边继续呈现代价值,静态层中的墙也不会因为局部激光射线而从地图消失。验证移动障碍时,应选择静态地图中原本空闲的区域。
保留能可靠看到的障碍标记,再逐步增加清除距离;两项测试分别通过,才算真正验证了这两个范围参数。