机器人 / 系统课时
配置 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 环境的新终端检查时间与激光话题:
source /opt/ros/jazzy/setup.bash
ros2 topic type /clock
ros2 topic type /scan预期输出(两个命令依次返回):
rosgraph_msgs/msg/Clock
sensor_msgs/msg/LaserScan如果话题不存在,应先检查 Gazebo 与 ROS 2 的桥接以及机器人传感器插件;代价图参数无法修复没有发布的数据源。地图文件也必须已存在,不能把 Gazebo 的世界文件直接当作占据栅格地图。

设置地图元数据
假设已经把导航地图保存为 ~/nav2_ws/maps/map.pgm,同目录中的 map.yaml 可以采用以下结构。数值仅展示格式:resolution、origin 必须与实际建图结果一致,不能为了套用示例而覆盖真实地图坐标。
image: map.pgm
mode: trinary
resolution: 0.05
origin: [-5.0, -5.0, 0.0]
negate: 0
occupied_thresh: 0.65
free_thresh: 0.196resolution: 0.05 表示每像素对应 5 cm;origin 是地图图像左下角在 map 坐标系中的位姿,第三项为偏航角(弧度)。trinary 模式把像素分为占据、空闲和未知。image 使用相对于 YAML 文件目录的路径。
map.yaml 是地图元数据,不是 Nav2 节点参数文件。后续通过启动参数 map:=... 把它传给 map_server,再由 StaticLayer 订阅 /map。
配置足迹和双层代价图
先复制 Jazzy 安装包自带的完整参数文件,避免遗漏 AMCL、规划器和控制器的必要配置:
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'预期输出:
Nav2 参数文件已复制下面是片段示例:在复制出的 nav2_params.yaml 中,分别完整替换原有的 local_costmap 和 global_costmap 顶层段落,保留文件里的其他节点参数;不要把这段单独作为整份 params_file。示例底盘长 0.48 m、宽 0.36 m,足迹点相对于 base_link 原点给出。
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 初始位姿。另开终端执行:
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 的地图、规划器和代价图节点开始提供话题。启动日志包含动态时间及节点信息,不应据某条固定日志文本判定成功。
在第二个终端验证关键节点:
source /opt/ros/jazzy/setup.bash
ros2 lifecycle get /map_server
ros2 lifecycle get /planner_server预期输出(两个节点均已成功激活时):
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 中下发导航目标的结果才有分析价值。