1. ROS2导航系统概述：架构、核心组件与工作流程
各位好，我是老张。做机器人导航有些年头了，从ROS1一路折腾到ROS2。今天咱们聊聊ROS2导航系统的整体框架。说实话，很多新手一上来就急着跑导航，结果出了问题一脸懵——这很正常，因为你不了解它的骨架长什么样。
ROS2导航系统，官方叫Nav2，说白了就是一套让机器人从A点走到B点的工具集。但它不是简单的「走直线」，它要处理地图、定位、路径规划、避障、速度控制等一系列问题。我刚开始接触时也觉得复杂，后来发现只要理清架构，一切就顺了。
核心观点：ROS2导航系统是一个行为树驱动的、模块化的导航框架。每个组件各司其职，通过话题和服务通信。
1.1 导航系统的核心组件
ROS2导航系统由几个关键组件构成。嗯，这里我按功能把它们分成四类，这样好理解：
1.1.1 定位模块
定位是导航的基石。机器人得先知道「我在哪」，才能谈「去哪」。ROS2里最常用的是AMCL（自适应蒙特卡洛定位）。它用粒子滤波来估计机器人的位姿。
我的经验：AMCL的参数调校是个细活。粒子数设太多，CPU扛不住；设太少，定位精度又不够。我一般从2000个粒子开始调，看实际效果再增减。
1.1.2 规划模块
规划分两层：
- 全局规划器：负责从起点到终点的宏观路径。常用算法有A*、Dijkstra。说白了就是在地图上画一条大路线。
- 局部规划器：负责实时避障和路径跟踪。常用的是DWA（动态窗口法）或TEB（时间弹性带）。它根据传感器数据动态调整速度。
我记得有个项目，全局路径明明规划得很好，但机器人就是撞墙。查了半天，发现是局部规划器的代价地图参数没配好——它压根没把障碍物当回事。
1.1.3 控制模块
控制模块接收规划器输出的速度指令，然后平滑处理后发给底盘。它要保证机器人运动平稳，不能忽快忽慢。ROS2里有个controller_server节点专门干这事。
1.1.4 行为树引擎
这是Nav2最大的亮点。它用行为树（Behavior Tree）来管理导航的整个生命周期。比如：先定位，再规划，然后执行，遇到障碍就重新规划——这些逻辑都写在行为树里。
为什么用行为树？ 传统的状态机写起来又臭又长，改一个逻辑要动整个代码。行为树是模块化的，你可以像搭积木一样组合导航行为。我团队后来所有导航项目都改用行为树了，维护成本降了一大截。
1.2 导航工作流程
好，咱们走一遍完整的导航流程。假设你给机器人下达了一个目标点：
- 接收目标：用户通过RViz或API发布一个
/goal_pose。 - 更新定位：AMCL根据当前激光数据和里程计，估算机器人在地图上的位置。
- 全局规划：全局规划器在代价地图上计算一条从当前位置到目标点的无碰撞路径。
- 局部规划：局部规划器接收全局路径，结合实时传感器数据，生成具体的速度指令。
- 执行控制：控制器将速度指令平滑处理后，发布到
/cmd_vel话题，驱动底盘运动。 - 反馈循环：机器人一边走一边更新定位，如果前方突然出现障碍物，局部规划器会实时调整路径。
你看，整个过程是闭环的。我见过不少新手以为导航就是「给个点，走过去」，结果机器人卡在门口出不来——就是因为没理解这个反馈循环的重要性。
1.3 关键话题与服务
ROS2导航系统里，组件之间通过话题和服务通信。下面这张表列出了最常用的一些：
| 话题/服务名称 | 类型 | 说明 |
|---|---|---|
/map |
nav_msgs/OccupancyGrid | 静态地图数据 |
/amcl_pose |
geometry_msgs/PoseWithCovarianceStamped | AMCL估计的机器人位姿 |
/goal_pose |
geometry_msgs/PoseStamped | 导航目标点 |
/cmd_vel |
geometry_msgs/Twist | 速度指令输出 |
/odom |
nav_msgs/Odometry | 里程计数据 |
/scan |
sensor_msgs/LaserScan | 激光雷达数据 |
注意：话题名称是可以重映射的。但千万别乱改，否则组件之间找不到彼此。我曾经有个学生把/cmd_vel改成了/my_cmd_vel，结果机器人半天不动——控制器根本没收到指令。
1.4 代价地图：导航的「隐形骨架」
代价地图（Costmap）是导航系统里一个容易被忽视但极其重要的概念。它本质上是一张栅格地图，每个格子都有一个代价值，表示该位置是否可通行。
ROS2里有两张代价地图：
- 全局代价地图：用于全局规划，通常基于静态地图生成，更新频率较低。
- 局部代价地图：用于局部规划，实时融合传感器数据，更新频率高。
代价地图的配置直接影响导航效果。比如膨胀半径设太大，机器人过不了窄门；设太小，又容易刮蹭。我一般设成机器人宽度的一半，然后根据实际测试微调。
1.5 常见误区与避坑
最后，分享几个我踩过的坑：
- 坐标系混乱：ROS2里坐标系很多（map、odom、base_link、laser_frame）。一个对不齐，定位就全歪了。我建议用
tf2_echo工具实时查看坐标变换关系。 - 参数没加载：Nav2的配置文件是YAML格式。有时候改了参数但没生效，是因为没在启动文件中正确加载。检查一下
params_file路径对不对。 - 行为树文件缺失：默认行为树文件在Nav2的安装目录下。如果你自定义了行为树，记得把路径配正确。
调试小技巧：用ros2 run rqt_graph rqt_graph查看节点和话题的连接情况。如果某个节点没连上，一眼就能看出来。这招帮我解决过不少通信问题。
好了，第一章就聊到这。ROS2导航系统的架构其实不复杂，关键是理解每个组件负责什么、它们之间怎么配合。后面我们会深入每个模块的细节，到时候再细聊。