机器人 / 系统课时
清除局部地图中过期障碍物
清除局部地图中过期障碍物
机器人前方的纸箱已经移走,局部代价图却仍显示一片高代价区域,导航因此持续绕行或停住。这里以 ROS 2 Jazzy 的 Nav2 ObstacleLayer 为例,配置激光扫描的障碍标记与射线清除,并用“放入—移走—复原”实验确认过期障碍确实被清除。
学习目标
- 区分
marking、clearing与观测缓存时长的作用。 - 为局部代价图配置可标记也可清除障碍的
/scan数据源。 - 用 RViz 2 验证代价恢复,并定位无法清除的常见原因。
障碍为什么会留下残影
marking: true 将激光雷达的有效回波端点标为障碍;clearing: true 则沿激光发射点至观测端点的射线,把确认可穿过的栅格更新为空闲。只启用前者时,纸箱即使移开,旧占据单元也可能留在障碍层中。
例如,雷达曾在前方 1.2 m 处看到纸箱,移开后该方向读到 2.8 m 的远处墙面。清除射线能经过原来的 1.2 m 位置,随后新的远处端点仍可被标记。若返回 +Inf 表示量程内没有回波,则需根据驱动语义开启 inf_is_valid,才能利用这种无回波射线进行清除。

observation_persistence: 0.0 表示不额外保留历史扫描消息,不是让地图中所有旧障碍过几秒自动过期。rolling_window: true 只会在机器人移动、窗口滑动时移出远处栅格,不能代替原地射线清除。
为局部代价图开启清除
前提是 Nav2 已启动,/scan 发布 sensor_msgs/msg/LaserScan,且扫描消息的 frame_id 可以按时间戳转换到 odom。在当前 Nav2 参数文件(通常为 nav2_params.yaml)中,找到 local_costmap.local_costmap.ros__parameters,按下面配置调整。片段示例:这只是参数文件中的局部代价图部分,不能单独作为整个导航配置启动。
local_costmap:
local_costmap:
ros__parameters:
global_frame: odom
robot_base_frame: base_link
update_frequency: 5.0
publish_frequency: 2.0
rolling_window: true
width: 6.0
height: 6.0
resolution: 0.05
robot_radius: 0.22
plugins: ["obstacle_layer", "inflation_layer"]
obstacle_layer:
plugin: "nav2_costmap_2d::ObstacleLayer"
enabled: true
footprint_clearing_enabled: true
observation_sources: scan
scan:
topic: /scan
data_type: "LaserScan"
marking: true
clearing: true
# 仅当驱动用 +Inf 表示无回波时开启
inf_is_valid: true
obstacle_max_range: 2.5
raytrace_max_range: 3.0
# 不跨周期积存旧扫描
observation_persistence: 0.0
inflation_layer:
plugin: "nav2_costmap_2d::InflationLayer"
inflation_radius: 0.5
cost_scaling_factor: 3.0这组参数以 5 Hz 更新内部栅格、2 Hz 发布可视化代价图;最大标记距离 2.5 m,最大清除距离 3.0 m。后者不能超过雷达实际可用观测范围而产生凭空清除。robot_radius: 0.22 与膨胀半径 0.5 m 仅为示例尺寸,须按底盘实际外形调整。参数含义可对照 Nav2 Jazzy Obstacle Layer 文档。
修改后重新启动使用此配置的 Nav2 节点。若原配置使用 voxel_layer,不要让旧层继续同时写入相同障碍;应明确保留哪一层并检查 plugins 列表。可读取实际生效参数:
ros2 param get /local_costmap/local_costmap obstacle_layer.scan.clearing预期输出(无额外命名空间,且配置已正确加载):
Boolean value is: True如果参数不存在,先检查 Nav2 的节点全名、实际加载的参数文件和 plugins 配置,而不是只修改磁盘上的 YAML。
实验检查旧障碍是否消失
- 在 RViz 2 将 Global Options → Fixed Frame 设为
odom,添加Map显示并选择/local_costmap/costmap,再添加LaserScan显示并选择/scan。保持机器人静止,先确认扫描点与代价图位置一致。 - 在雷达前方约 1.2 m 放置宽约 0.3 m 的纸箱,确保位于扫描平面。应能看到障碍占据区域及其周边膨胀代价;截图或记录当前位置。
- 向侧面移走纸箱,避免有人或其他物体继续遮挡原方向。让新扫描射线穿过原位置:障碍单元应转为空闲,附近膨胀代价也应随后减小。以 代价图变化 而非仅仅以
/scan里点消失作为验收。 - 可将
clearing临时设为false并重新加载配置,在同样条件下对比旧障碍残留;实验结束恢复true。测试时暂停自主移动,避免机器人依赖未验证的代价图行驶。
如果仅看到膨胀圈缩小却未完全消失,要进一步区分障碍层中的旧致命障碍、其他插件提供的占据以及周边真实物体带来的新膨胀代价。
清除失败时检查哪些条件
- 始终无法清除:先确认参数读回为
true;检查/scan是否持续更新、frame_id是否存在到odom的有效 TF。缺少变换的扫描可能被丢弃。 - 无回波方向留有障碍:检查驱动发的是
+Inf、有限最大距离还是NaN。inf_is_valid: true只适用于特定无回波语义,不会把任意无效数值变成自由空间;同时核对LaserScan.range_max与raytrace_max_range。 - 障碍被清除又马上出现:检查是否仍积存历史观测、其他扫描源是否重新标记,以及
voxel_layer、static_layer或其他层是否也写入占据。清除传感器障碍不会删除静态地图上的墙。 - 挡住后方的格子未清除:射线只证明自己经过的区域为空闲,不能穿透仍存在的遮挡物。应等待机器人换角度重新观测,不应直接把所有未观察区域判为空闲。
Nav2 还提供 /local_costmap/clear_entirely_local_costmap 服务用于排障或恢复时重置局部代价图,但那是一次性重置,随后真实障碍会被新扫描重新标记。正常运行中应依赖持续有效的观测和射线清除,而非定时清空整张图。