一、Nav2 概览与核心架构

大家好，我是你们的导航讲师。今天咱们聊聊 Nav2 的整体架构。说实话，我刚接触 Nav2 时也被它的模块数量吓了一跳——十几个节点，各种生命周期状态，还有行为树这种听起来就很唬人的东西。但别担心，拆开来看，其实没那么复杂。

1.1 Nav2 的模块组成

Nav2 本质上是一套导航服务的集合。它不像 ROS1 的 move_base 那样是个单体架构，而是把导航拆成了多个独立模块。我个人觉得，这种设计最大的好处是——你可以只换其中一个模块，而不影响其他部分。

核心模块包括：

• 控制器（Controller）：负责生成速度指令，说白了就是让机器人怎么走
• 规划器（Planner）：负责全局路径规划，从 A 点到 B 点的路线
• 恢复器（Recover）：当机器人卡住时，尝试各种自救手段
• 行为树（Behavior Tree）：整个导航流程的编排者
• 代价地图（Costmap）：环境障碍物的表示层

嗯，这里要注意：这些模块都是独立运行的节点，通过 ROS2 的通信机制协作。我在项目中遇到过有人试图把所有模块塞进一个节点里——结果调试起来简直噩梦。

1.2 生命周期节点

生命周期节点是 ROS2 引入的一个好东西。为什么需要它？你想想看，导航系统启动时，各个模块的初始化顺序很重要。比如代价地图还没加载完，控制器就开始跑——那肯定出问题。

生命周期节点有四个状态：

状态	说明	我踩过的坑
Unconfigured	节点刚创建，啥也没干	此时不能发布任何话题
Inactive	已配置，但未激活	可以接收参数，但不处理数据
Active	正常运行	所有功能都可用
Finalized	节点销毁前	清理资源，关闭文件句柄

我曾经在调试时发现，如果某个节点卡在 Inactive 状态，整个导航系统都不会动。后来才意识到——生命周期节点的状态转换需要手动触发，或者通过导航启动脚本自动完成。

1.3 行为树基础

行为树是 Nav2 最核心的设计之一。我第一次看到行为树时，心想：这不就是状态机吗？后来用多了才发现，它比状态机灵活得多。

行为树有四种节点类型：

• 控制节点：决定子节点的执行顺序（Sequence、Fallback、Parallel）
• 执行节点：实际干活的节点（比如 ComputePathToPose）
• 条件节点：检查某个条件是否满足（比如 IsPathValid）
• 装饰节点：修改子节点的行为（比如 Retry、Timeout）

举个例子，一个简单的导航行为树可能是这样的：

Sequence
├── ComputePathToPose    // 规划路径
├── FollowPath           // 跟随路径
└── Wait                 // 等待任务完成

你可能会问：为什么不用状态机？嗯，状态机的问题是——当你要添加一个新状态时，往往需要修改整个状态转换逻辑。而行为树只需要在树里加一个节点就行。我在项目中遇到过，客户要求机器人在导航过程中先停下来检查一下电量——用行为树，加一个 Condition 节点就搞定了。

1.4 整体架构图

下面这张图是我自己画的 Nav2 核心架构。它展示了模块之间的数据流和依赖关系：

从这张图可以看出，行为树是 Nav2 的大脑。它决定什么时候调用规划器，什么时候让控制器执行，什么时候触发恢复行为。代价地图则是所有模块共享的环境信息——规划器用它找路，控制器用它避障，恢复器用它判断是否卡住。

1.5 生命周期管理实战

最后聊点实际的。Nav2 的生命周期管理是通过 nav2_lifecycle_manager 节点实现的。它会自动帮你管理所有生命周期节点的状态转换。

启动顺序是这样的：

1. 所有节点启动，进入 Unconfigured 状态
2. Lifecycle Manager 发送 configure 命令，节点进入 Inactive
3. Lifecycle Manager 发送 activate 命令，节点进入 Active
4. 导航开始工作
5. 关闭时，Lifecycle Manager 发送 deactivate 和 cleanup

嗯，这里有个小技巧：如果你在调试时想单独重启某个模块，可以直接用命令行操作：

ros2 lifecycle set /controller configure
ros2 lifecycle set /controller activate

不用重启整个导航系统。这个功能在调试时特别有用——我经常用它来单独重启代价地图，而不影响其他模块。

可可精品资料库