ROS导航栈架构：move_base框架详解、costmap_2d原理、global_planner与local_planner的分工

各位同学，今天我们来啃一块硬骨头——ROS导航栈的核心架构。说实话，我刚入行那会儿，看着move_base那一堆参数和节点图，头都是大的。但后来我发现，只要把几个关键模块拆开理解，整个导航系统其实没那么玄乎。

咱们这节课，就围绕三个核心问题展开：move_base到底在干什么？代价地图是怎么算出来的？全局规划和局部规划到底谁听谁的？

1. move_base：导航系统的总调度

move_base，说白了就是一个动作服务器（Action Server）。它接收一个目标位姿（比如“去厨房门口”），然后协调全局规划器、局部规划器、代价地图这些模块，最终输出速度指令给底盘。

我习惯把move_base比作一个项目经理。它自己不干活，但它知道谁该干什么，什么时候干，干砸了怎么补救。

它的核心工作流程是这样的：

1. 接收目标：通过/move_base/goal话题拿到导航目标。
2. 调用全局规划器：在全局代价地图上算出一条从起点到终点的粗路径。
3. 调用局部规划器：沿着全局路径走，同时用局部代价地图实时避障。
4. 发布速度指令：把计算出的线速度和角速度发到/cmd_vel。
5. 状态反馈：不断发布当前执行状态（正在走、卡住了、到达了）。

2. costmap_2d：机器人的“电子皮肤”

代价地图（costmap）是导航栈里最容易被忽视，但也是最容易出问题的模块。它本质上是一张栅格地图，每个格子都有一个代价值，表示这个位置“能不能走”以及“有多危险”。

ROS里有两张代价地图：

• 全局代价地图（global_costmap）：用于全局路径规划，通常基于静态地图，更新频率低。
• 局部代价地图（local_costmap）：用于局部避障，融合激光雷达、深度相机等传感器数据，更新频率高。

代价地图的更新机制，我简单画了个流程图：

这里有个关键概念——膨胀层（Inflation Layer）。它会在障碍物周围生成一个梯度递减的代价区域。离障碍物越近，代价值越高。这样做是为了让规划器“主动远离”障碍物，而不是贴着墙走。

3. global_planner与local_planner的分工

这两个规划器，是导航栈里最容易被混淆的概念。我直接用一个表格来对比：

对比维度	全局规划器（Global Planner）	局部规划器（Local Planner）
规划范围	整个已知地图	机器人周围（通常3-5米）
地图来源	全局代价地图（静态为主）	局部代价地图（动态传感器）
规划频率	低（0.5-2 Hz）	高（10-20 Hz）
输出	路径点序列（Path）	速度指令（Twist）
典型算法	A*、Dijkstra、Navfn	DWA、TEB、MPC
失败处理	重新规划整条路径	减速、停止、请求重规划

你想想看，全局规划器就像你手机上的高德地图，它告诉你“从北京到上海走京沪高速”。但实际开车时，你不可能完全按导航走——前面有车祸、修路、临时封路，你得自己判断怎么绕。这个“自己判断”就是局部规划器干的事。

具体来说，它们的协作流程是这样的：

1. 全局规划器在全局代价地图上跑A*或Dijkstra，算出一条从起点到终点的路径。这条路径通常由几十到几百个离散点组成。
2. 局部规划器拿到这条路径后，不会傻乎乎地逐点跟踪。它会以当前机器人为中心，在局部代价地图上搜索一条“既能靠近全局路径，又能避开突然出现的障碍物”的最优轨迹。
3. 如果局部规划器发现“这条路走不通了”（比如全局路径被新出现的障碍物堵死了），它会向move_base发送一个重规划请求。move_base收到后，会重新调用全局规划器算一条新路径。

4. 三个模块的协作关系图

为了让你更直观地理解，我画了一张整体架构图：

5. 实际项目中的避坑指南

最后，分享几个我在实际项目中踩过的坑：

• 全局路径频繁重规划：如果你发现机器人走几步就停一下，然后重新算路径，八成是planner_frequency设得太高，或者conservative_reset_dist设得太小。我一般把全局规划频率设在0.5-1Hz。
• 局部规划器震荡：机器人在一个地方左右摇摆，就是过不去。这通常是DWA的sim_time（模拟时间）太短，或者max_vel_x太小。试着把sim_time从1.5秒加到3秒，往往能解决问题。
• 代价地图不更新：机器人明明看到障碍物了，但代价地图上就是没有。检查一下observation_sources配置，看看激光雷达的topic是不是对的。我曾经把/scan写成了/scan_raw，结果查了三天。