第4章：代价地图参数调优：全局与局部代价地图配置、障碍物层与膨胀层参数调整
各位同学，欢迎来到代价地图调优的实战环节。说实话，代价地图是Nav2里最“接地气”的模块之一。你想想看，机器人能不能安全地走到目标点，全靠这张地图说了算。我刚开始接触Nav2时，总觉得参数调来调去差不多，直到有一次在实验室里，机器人对着一个纸箱子反复横跳……嗯，从那以后，我再也不敢小看代价地图的配置了。
4.1 全局代价地图 vs 局部代价地图：分工不同
先搞清楚一件事：全局代价地图和局部代价地图，它们不是“谁更好”的关系，而是“谁干什么活”的关系。
- 全局代价地图：负责全局路径规划。它通常分辨率低一些（比如0.05米/像素），范围大一些。说白了，它看的是“大方向”，比如从客厅到厨房怎么走。
- 局部代价地图：负责局部路径规划和避障。它分辨率高一些（比如0.025米/像素），范围小一些。它关注的是“眼前的路”，比如前面有个椅子腿，我得绕一下。
我个人习惯，在Gazebo仿真中，全局代价地图的宽度和高度设到10米左右就够了，局部代价地图设到3-4米。太大了计算量上去了，太小了机器人容易“近视”。
核心原则：全局地图要“看得远”，局部地图要“看得清”。
4.2 障碍物层参数调整：让机器人“看见”障碍
障碍物层是代价地图的“眼睛”。它负责把激光雷达、深度相机等传感器数据，转化成代价地图上的障碍物信息。
这里有几个关键参数，我一个个说：
| 参数名 | 作用 | 我的推荐值（仿真） |
|---|---|---|
| observation_sources | 指定传感器来源，比如激光雷达 | scan |
| obstacle_range | 障碍物被标记的最大距离 | 2.5米 |
| raytrace_range | 用于清除障碍物的射线追踪距离 | 3.0米 |
| max_obstacle_height | 障碍物最大高度，高于此值忽略 | 2.0米 |
| min_obstacle_height | 障碍物最小高度，低于此值忽略 | 0.0米 |
我曾经在项目中遇到过一个问题：机器人总是把地面上的小石子当成障碍物，导致路径规划频繁重算。后来发现是min_obstacle_height设成了0.0，把地面反射也当成障碍了。调成0.1米后，问题解决。
小技巧：在Gazebo里，如果你用的是激光雷达，obstacle_range不要设得比激光雷达最大测距还大，否则会出现“凭空障碍”。
4.3 膨胀层参数调整：给障碍物“穿衣服”
膨胀层，说白了就是给障碍物加一圈“安全距离”。机器人不能太靠近障碍物，否则容易撞上。这个“安全距离”就是通过膨胀半径来控制的。
膨胀层有两个核心参数：
- inflation_radius：膨胀半径。障碍物周围多大范围内开始产生代价。值越大，机器人离障碍物越远。
- cost_scaling_factor：代价衰减因子。控制代价从障碍物边缘向外衰减的速度。值越大，衰减越快，机器人可以更靠近障碍物边缘。
我建议在仿真中这样设置：
inflation_layer:
enabled: true
inflation_radius: 0.55 # 全局地图可以大一点，局部地图小一点
cost_scaling_factor: 10.0 # 值越大，代价衰减越快你想想看，如果inflation_radius设得太大，比如1.0米，那机器人过个窄门都费劲。如果设得太小，比如0.1米，机器人贴着墙走，稍微有点定位误差就撞上了。我个人习惯全局地图设0.55米，局部地图设0.45米，这样既安全又灵活。
避坑指南：我曾经把cost_scaling_factor设成0.0，结果代价从障碍物边缘到膨胀半径边界都是最大值，机器人根本不敢靠近任何障碍物，连门都出不去。记住，这个值不要设成0，一般5-15之间比较合理。
4.4 全局与局部地图的联动配置
全局地图和局部地图不是孤立的。它们之间有一个重要的参数：transform_tolerance。这个参数控制TF变换的容忍时间。如果设得太小，TF稍微有点延迟，代价地图就会报错。设得太大，地图更新不及时。
我一般设0.2秒，仿真环境下足够了。如果你发现控制台频繁报“Transform timeout”错误，可以适当调大到0.3或0.5秒。
另外，update_frequency和publish_frequency也要注意。全局地图更新频率可以低一些（1.0 Hz），局部地图更新频率要高一些（5.0 Hz）。毕竟局部地图要实时反映周围障碍物的变化。
4.5 实战调优步骤
好了，理论说完了，咱们来点实际的。我在Gazebo里调优代价地图时，一般按这个步骤来：
- 先调障碍物层：确保机器人能正确“看见”障碍物。打开RViz，看代价地图上障碍物是否准确标记。
- 再调膨胀层：让机器人能安全通过狭窄通道。放一个纸箱子在路中间，看机器人能不能绕过去。
- 最后调联动参数：确保全局和局部地图切换流畅，没有卡顿或抖动。
我记得有一次，我在仿真里放了一排柱子，机器人死活过不去。后来发现是全局地图的inflation_radius设得太大了，导致柱子之间的空隙被膨胀层填满了。调小之后，机器人顺利通过。
4.6 本章知识体系
下面这张图，是我自己总结的代价地图调优知识体系，你一看就明白：
这张图把全局地图、局部地图、障碍物层、膨胀层的关系都串起来了。你调参的时候，就按这个结构来，不会乱。
总结一句话：代价地图调优，就是让机器人“看得准、走得稳、躲得开”。全局地图管方向，局部地图管避障，障碍物层管感知，膨胀层管安全。四者配合好了，你的机器人在Gazebo里就能横着走。
可可精品资料库