机器人 / 系统课时

清除局部地图中过期障碍物

清除局部地图中过期障碍物

机器人前方的纸箱已经移走,局部代价图却仍显示一片高代价区域,导航因此持续绕行或停住。这里以 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,按下面配置调整。片段示例:这只是参数文件中的局部代价图部分,不能单独作为整个导航配置启动。

yaml
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 列表。可读取实际生效参数:

bash
ros2 param get /local_costmap/local_costmap obstacle_layer.scan.clearing

预期输出(无额外命名空间,且配置已正确加载):

text
Boolean value is: True

如果参数不存在,先检查 Nav2 的节点全名、实际加载的参数文件和 plugins 配置,而不是只修改磁盘上的 YAML。

实验检查旧障碍是否消失

  1. 在 RViz 2 将 Global Options → Fixed Frame 设为 odom,添加 Map 显示并选择 /local_costmap/costmap,再添加 LaserScan 显示并选择 /scan。保持机器人静止,先确认扫描点与代价图位置一致。
  2. 在雷达前方约 1.2 m 放置宽约 0.3 m 的纸箱,确保位于扫描平面。应能看到障碍占据区域及其周边膨胀代价;截图或记录当前位置。
  3. 向侧面移走纸箱,避免有人或其他物体继续遮挡原方向。让新扫描射线穿过原位置:障碍单元应转为空闲,附近膨胀代价也应随后减小。以 代价图变化 而非仅仅以 /scan 里点消失作为验收。
  4. 可将 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 服务用于排障或恢复时重置局部代价图,但那是一次性重置,随后真实障碍会被新扫描重新标记。正常运行中应依赖持续有效的观测和射线清除,而非定时清空整张图。

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

目录与阅读设置

阅读设置

17

记录一个想法

清除局部地图中过期障碍物

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

登录哪都通