机器人 / 系统课时

配置 Nav2 地图与代价图参数

配置 Nav2 地图与代价图参数

本课把 Gazebo 中已经建好的二维地图接入 Nav2,并为差速机器人配置真实足迹、全局代价图和局部代价图。完成后能够检查地图、激光、坐标变换与规划器是否接通,而不只是确认参数文件可以被解析。

学习目标

  • 区分地图元数据文件与 Nav2 节点参数文件,并正确加载静态地图。
  • 依据底盘尺寸配置双层代价图、障碍观测和膨胀半径。
  • 通过生命周期、话题及 RViz 画面判断规划输入是否有效。

核对仿真输入

以下示例适用于 ROS 2 Jazzy、Nav2 和已运行的 Gazebo 仿真。假设机器人使用 base_link 作为底盘坐标系,发布 /scan、/odom、/clock,并有 map → odom → base_link 的 TF 链。其中 map → odom 通常由 AMCL 提供,odom → base_link 由里程计或状态估计节点提供。

在已加载 ROS 环境的新终端检查时间与激光话题:

bash
source /opt/ros/jazzy/setup.bash
ros2 topic type /clock
ros2 topic type /scan

预期输出(两个命令依次返回):

text
rosgraph_msgs/msg/Clock
sensor_msgs/msg/LaserScan

如果话题不存在,应先检查 Gazebo 与 ROS 2 的桥接以及机器人传感器插件;代价图参数无法修复没有发布的数据源。地图文件也必须已存在,不能把 Gazebo 的世界文件直接当作占据栅格地图。

地图、激光、足迹和双层代价图的输入关系

设置地图元数据

假设已经把导航地图保存为 ~/nav2_ws/maps/map.pgm,同目录中的 map.yaml 可以采用以下结构。数值仅展示格式:resolution、origin 必须与实际建图结果一致,不能为了套用示例而覆盖真实地图坐标。

yaml
image: map.pgm
mode: trinary
resolution: 0.05
origin: [-5.0, -5.0, 0.0]
negate: 0
occupied_thresh: 0.65
free_thresh: 0.196

resolution: 0.05 表示每像素对应 5 cm;origin 是地图图像左下角在 map 坐标系中的位姿,第三项为偏航角(弧度)。trinary 模式把像素分为占据、空闲和未知。image 使用相对于 YAML 文件目录的路径。

map.yaml 是地图元数据,不是 Nav2 节点参数文件。后续通过启动参数 map:=... 把它传给 map_server,再由 StaticLayer 订阅 /map。

配置足迹和双层代价图

先复制 Jazzy 安装包自带的完整参数文件,避免遗漏 AMCL、规划器和控制器的必要配置:

bash
mkdir -p "$HOME/nav2_ws/config"
cp "$(ros2 pkg prefix nav2_bringup)/share/nav2_bringup/params/nav2_params.yaml" "$HOME/nav2_ws/config/nav2_params.yaml"
printf 'Nav2 参数文件已复制\n'

预期输出:

text
Nav2 参数文件已复制

下面是片段示例:在复制出的 nav2_params.yaml 中,分别完整替换原有的 local_costmap 和 global_costmap 顶层段落,保留文件里的其他节点参数;不要把这段单独作为整份 params_file。示例底盘长 0.48 m、宽 0.36 m,足迹点相对于 base_link 原点给出。

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: 3
      height: 3
      resolution: 0.05
      # 实际车体轮廓,额外外扩2 cm
      footprint: '[[0.24,0.18],[-0.24,0.18],[-0.24,-0.18],[0.24,-0.18]]'
      footprint_padding: 0.02
      plugins: ['obstacle_layer', 'inflation_layer']
      obstacle_layer:
        plugin: nav2_costmap_2d::ObstacleLayer
        observation_sources: scan
        scan:
          topic: /scan
          data_type: LaserScan
          marking: true
          clearing: true
          obstacle_max_range: 2.5
          raytrace_max_range: 3.0
      inflation_layer:
        plugin: nav2_costmap_2d::InflationLayer
        inflation_radius: 0.55
        cost_scaling_factor: 3.0

global_costmap:
  global_costmap:
    ros__parameters:
      global_frame: map
      robot_base_frame: base_link
      update_frequency: 1.0
      publish_frequency: 1.0
      resolution: 0.05
      track_unknown_space: true
      # 全局、局部代价图必须使用同一车体尺寸
      footprint: '[[0.24,0.18],[-0.24,0.18],[-0.24,-0.18],[0.24,-0.18]]'
      footprint_padding: 0.02
      plugins: ['static_layer', 'obstacle_layer', 'inflation_layer']
      static_layer:
        plugin: nav2_costmap_2d::StaticLayer
        map_subscribe_transient_local: true
      obstacle_layer:
        plugin: nav2_costmap_2d::ObstacleLayer
        observation_sources: scan
        scan:
          topic: /scan
          data_type: LaserScan
          marking: true
          clearing: true
          obstacle_max_range: 2.5
          raytrace_max_range: 3.0
      inflation_layer:
        plugin: nav2_costmap_2d::InflationLayer
        inflation_radius: 0.55
        cost_scaling_factor: 3.0

全局图以 map 为参考,叠加静态地图和实时障碍供路径规划;局部图以 odom 为参考,在机器人周围维护 3 m × 3 m 滚动窗口供控制器避障。inflation_radius: 0.55 是障碍物周边代价衰减的作用范围,不是底盘半径,也不是保证 0.55 m 净空的硬约束。若车体不是示例尺寸,应按实际碰撞轮廓重新量取足迹。

注意官方示例的 AMCL 和碰撞监视器可能使用 base_footprint。若自己的 TF 树只有 base_link,还需在同一份参数文件中把 amcl.ros__parameters.base_frame_id 与 collision_monitor.ros__parameters.base_frame_id 改为 base_link;若已有正确的 base_footprint 变换则保持原配置。

启动并验收规划输入

保证 Gazebo、雷达和里程计仍在运行,且已有能把机器人定位到地图中的 AMCL 初始位姿。另开终端执行:

bash
source /opt/ros/jazzy/setup.bash
ros2 launch nav2_bringup bringup_launch.py \
  map:="$HOME/nav2_ws/maps/map.yaml" \
  params_file:="$HOME/nav2_ws/config/nav2_params.yaml" \
  use_sim_time:=True use_composition:=False

预期结果:map_server 加载地图并由生命周期管理器激活;Nav2 的地图、规划器和代价图节点开始提供话题。启动日志包含动态时间及节点信息,不应据某条固定日志文本判定成功。

在第二个终端验证关键节点:

bash
source /opt/ros/jazzy/setup.bash
ros2 lifecycle get /map_server
ros2 lifecycle get /planner_server

预期输出(两个节点均已成功激活时):

text
active [3]
active [3]

随后在 RViz 中把 Fixed Frame 设为 map,添加 Map 显示 /map、/global_costmap/costmap 与 /local_costmap/costmap,再添加 Polygon 显示 /local_costmap/published_footprint。应能看到静态障碍、机器人周围的局部滚动窗口和与车体贴合的足迹;移动机器人时,局部窗口应随之移动。

纠正常见失败

  • 地图为空:核对 map:=... 指向的是 map.yaml,并确认其 image 路径存在;检查 /map 是否发布。
  • 代价图不更新:核对实际话题是否为 /scan,消息类型是否为 LaserScan,以及 map → odom → base_link 变换是否连续可用。
  • 足迹位置偏移:检查 base_link 原点与几何中心的相对关系,足迹顶点必须用底盘坐标表示;不要直接把图纸上的长宽当作四个顶点坐标。
  • 窄门无法规划:先核对真实车宽、footprint_padding 与门洞净宽,再调 inflation_radius;不能靠缩小虚拟足迹让机器人穿过实体障碍。

验收通过的标准是:地图在正确坐标下可见、两层代价图有有效数据、足迹覆盖实体车身、planner_server 处于 active 状态。只有这些输入可靠,后续在 Gazebo 中下发导航目标的结果才有分析价值。

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

目录与阅读设置

阅读设置

17

记录一个想法

配置 Nav2 地图与代价图参数

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

登录哪都通