4. 地图服务故障排查：地图加载、map_server配置、代价地图参数
地图服务，说白了就是机器人的「眼睛」和「记忆」。如果地图加载不对，导航肯定跑偏。我调试过不少机器人，十次导航出问题，有三次是地图服务在搞鬼。今天咱们就把这块掰开揉碎了讲清楚。
4.1 地图加载：第一步就卡住
地图加载失败，是最常见也最容易排查的问题。我个人习惯先检查三样东西：文件路径、文件格式、YAML 参数。
4.1.1 文件路径与格式
ROS2 的 map_server 支持 PNG、PGM、JPG 等常见图像格式。但要注意，图像必须是灰度图，彩色图会导致加载失败。我在项目中遇到过有人用了一张彩色 PNG，结果 map_server 直接报错退出。
4.1.2 YAML 参数文件
地图的元数据写在 YAML 文件里。嗯，这里要注意几个关键参数：
# 典型的地图 YAML 文件
image: my_map.png
resolution: 0.05 # 每像素对应 0.05 米
origin: [-10.0, -10.0, 0.0] # 地图左下角在世界坐标系中的位置
occupied_thresh: 0.65 # 占用阈值
free_thresh: 0.196 # 空闲阈值
negate: 0 # 是否反转像素值你想想看，如果 origin 写错了，机器人定位就会整体偏移。我调试过一个项目，地图原点设成了 [0,0,0]，但实际地图左下角在 [-5,-5]，结果机器人一启动就显示在地图外面。
ros2 run nav2_map_server map_server --ros-args -p yaml_filename:=/path/to/map.yaml 单独启动 map_server，看终端输出有没有错误信息。
4.2 map_server 配置：别小看启动参数
map_server 在 ROS2 里是一个生命周期节点。说白了，它需要被「激活」才能开始工作。很多新手以为节点启动了地图就自动发布了，其实不是。
4.2.1 生命周期管理
map_server 启动后处于未配置状态，需要经历 Configure → Activate 两个阶段。如果你用 launch 文件启动，通常会自动处理。但如果你手动启动，记得调用服务：
# 手动激活 map_server
ros2 service call /map_server/configure std_srvs/srv/Trigger
ros2 service call /map_server/activate std_srvs/srv/Trigger我曾经在调试时忘了激活，盯着 /map 话题看了十分钟，就是没数据。后来一拍脑袋——哦，没激活！
4.2.2 话题发布验证
地图加载成功后，map_server 会发布 /map 话题（nav_msgs/msg/OccupancyGrid）。你可以用命令行验证：
ros2 topic echo /map --once | head -20如果看到 info 字段里有正确的宽度、高度和分辨率，说明地图加载成功了。如果没数据，检查 map_server 的日志输出。
- map_server 节点是否处于 active 状态？
- /map 话题是否有发布者？
- 地图图像文件是否存在且可读？
- YAML 文件中的图像路径是否正确？
4.3 代价地图参数：调不好就撞墙
代价地图是导航决策的基础。它把地图分成三种区域：自由空间、障碍物、未知区域。参数调不好，机器人要么贴着墙走，要么离墙八丈远。
4.3.1 膨胀半径
膨胀半径决定了机器人离障碍物多远才算「安全」。这个值至少应该等于机器人半径。我习惯设成机器人半径的 1.2 倍，留点余量。
# costmap_common_params.yaml
robot_radius: 0.3
inflation_layer:
inflation_radius: 0.36 # 1.2 * robot_radius
cost_scaling_factor: 10.0 # 值越大，远离障碍物时代价下降越快你想想看，如果膨胀半径设得太小，机器人可能会卡在窄通道里；设得太大，又可能找不到路。我调试过一个仓库机器人，膨胀半径设了 0.5 米，结果 1 米宽的通道它死活过不去——因为两边各膨胀 0.5 米，中间只剩 0 米了。
4.3.2 静态层与动态层
代价地图通常有三层：静态层（来自 map_server）、障碍物层（来自传感器）、膨胀层。每层可以单独配置更新频率。
| 图层名称 | 数据来源 | 更新频率建议 | 常见问题 |
|---|---|---|---|
| static_layer | map_server | 仅加载一次 | 地图未更新导致与真实环境不符 |
| obstacle_layer | 激光雷达/深度相机 | 5-10 Hz | 频率太高导致 CPU 过载 |
| inflation_layer | 基于前两层计算 | 随障碍物层更新 | 膨胀半径不合理导致路径规划失败 |
4.3.3 代价地图的坐标系
代价地图默认使用 map 坐标系。如果 TF 树有问题，代价地图会显示空白或错位。我曾经遇到一个情况：map 到 odom 的 TF 变换一直没发布，代价地图始终显示「未知区域」，机器人一步都不敢动。
ros2 run tf2_tools view_frames 查看 TF 树，确认 map → odom → base_link 的变换链是否完整。
4.4 实战：一个完整的排查流程
假设你启动导航后，RViz 里地图显示空白。我会按这个顺序排查：
- 检查 map_server 状态：
ros2 node list | grep map_server，确认节点在运行。 - 检查话题：
ros2 topic list | grep map，看有没有/map话题。 - 检查日志：
ros2 node info /map_server，看有没有错误信息。 - 检查 YAML 文件： 确认图像路径、分辨率、原点坐标是否正确。
- 检查 TF 树：
ros2 run tf2_tools view_frames，确认坐标系完整。 - 检查代价地图参数： 看膨胀半径、更新频率是否合理。
这个流程我用了好几年，90% 的地图服务问题都能在这六步里找到答案。剩下的 10%，嗯，那就要看具体场景了——比如多地图切换时的坐标跳变，或者动态障碍物层和静态层冲突。这些咱们后面章节再细聊。