1. 课程导论

机器人操作系统（ROS2）作为现代机器人研发的事实标准，其导航功能包集（Nav2）为移动机器人在未知或已知环境中的自主移动提供了完整的解决方案。然而，面对复杂多变的真实场景——从动态障碍物的避让到多楼层间的任务切换，从单一导航指令到多目标点的顺序执行——仅靠传统的“起点-终点”式导航已无法满足需求。行为树（Behavior Tree, BT）作为一种结构化、可复用且具备实时决策能力的任务编排模型，恰好弥补了Nav2在高层级任务调度上的不足。本章作为整个课程的开篇，将系统梳理Nav2与行为树在ROS2导航生态中的角色定位，明确课程学习目标与路径，并帮助学习者建立正确的知识框架与前置技能准备。

1.1 Nav2在ROS2导航中的核心角色

核心原理：从导航栈到导航框架

Nav2是ROS2官方维护的导航功能包集，其前身为ROS1时代的move_base导航栈。Nav2并非单一节点，而是一组松耦合的模块化组件，通过ROS2的节点生命周期（Lifecycle Node）机制进行统一管理。其核心设计理念是将导航任务拆解为四个关键子任务：全局路径规划（Global Planning）、局部路径跟踪（Local Control）、环境建模（Costmap）以及行为协调（Behavior Coordination）。其中，行为协调层正是通过行为树导航器（BT Navigator）实现的，它接收高层级的目标指令，将其分解为一系列可执行的导航原语，并监控整个执行过程的状态流转。

Nav2的架构设计体现了“策略与机制分离”的软件工程思想。全局规划器（如NavFn、Smac Planner）负责在静态地图上计算最优路径；局部控制器（如DWB、Regulated Pure Pursuit）负责在动态环境中跟踪全局路径并规避突发障碍；而代价地图层则维护着静态层、障碍物层、膨胀层等多层代价信息，为规划与控制提供统一的环境表示。BT Navigator作为“大脑”，通过行为树XML文件定义导航策略，决定何时调用规划器、何时执行路径跟踪、何时进行恢复行为（如旋转恢复、清除代价地图）。

Nav2核心模块与行为树的对应关系

Nav2模块	功能职责	行为树中的角色	典型BT节点
BT Navigator	任务编排与状态机管理	行为树根节点与执行框架	Sequence、Selector、Decorator
Planner Server	全局路径规划	动作节点（ComputePathToPose）	ComputePath、FollowPath
Controller Server	局部路径跟踪	动作节点（FollowPath）	FollowPath、Wait
Costmap	环境建模与障碍检测	条件节点（检测代价地图状态）	IsPathValid、CostmapUpdated
Recovery Server	故障恢复行为	装饰节点或动作节点（重试/恢复）	Retry、Recovery、ClearCostmap

案例拆解：单点导航中的BT执行流程

以一个最简单的“从当前位置导航到目标点A”任务为例，BT Navigator加载默认的navigate_to_pose.xml行为树。该树的顶层是一个Sequence节点，依次执行以下子节点：

1. 条件节点：检查全局代价地图是否就绪（IsCostmapReady）；
2. 动作节点：调用Planner Server计算全局路径（ComputePathToPose）；
3. 动作节点：调用Controller Server执行路径跟踪（FollowPath）；
4. 条件节点：检查是否到达目标点（IsGoalReached）。

当路径跟踪过程中遇到障碍导致控制器失败时，Sequence节点会返回FAILURE，此时外层Selector节点会尝试执行恢复行为（如清除代价地图、旋转恢复），然后重新尝试规划。这一流程体现了行为树“失败-重试-恢复”的天然优势。

1.2 行为树在任务编排中的独特价值

核心原理：行为树的执行语义

行为树是一种树形结构的任务编排模型，其核心执行单元是节点。每个节点执行后返回三种状态之一：SUCCESS（成功）、FAILURE（失败）或RUNNING（运行中）。控制节点（Sequence、Selector、Parallel）根据子节点的返回状态决定后续执行逻辑。Sequence节点按顺序执行子节点，任一子节点失败则整体失败；Selector节点依次尝试子节点，任一子节点成功则整体成功。这种简洁的语义使得行为树天然支持任务的顺序执行、条件分支、优先级选择和并行处理。

在ROS2导航场景中，行为树的价值体现在三个维度：可组合性——导航任务可以被拆解为可复用的BT节点，如“计算路径”“跟踪路径”“检测障碍”等，通过XML配置即可组合出不同的导航策略；可调试性——BT的执行状态可以通过Groot等可视化工具实时监控，每个节点的运行状态一目了然，极大降低了任务编排的调试难度；运行时动态修改——通过BT的Blackboard机制，可以在运行时动态修改节点参数，实现任务的自适应调整。

行为树与Nav2的集成方式

Nav2的BT Navigator通过bt_navigator节点加载XML格式的行为树定义文件。该节点内部集成了BehaviorTree.CPP库，提供了一系列预定义的导航相关BT节点（如ComputePathToPose、FollowPath、IsGoalReached等）。用户可以通过修改XML文件来定制导航策略，而无需重新编译C++代码。这种“配置即代码”的模式，使得导航策略的调整变得极其灵活。

案例拆解：多目标点巡检任务

假设一个室内巡检机器人需要依次访问A、B、C三个目标点，并在每个点停留5秒进行数据采集。使用行为树可以这样编排：

<root main_tree_to_execute="MainTree">
  <BehaviorTree ID="MainTree">
    <Sequence name="巡检任务">
      <Action ID="NavigateToPose" goal="A"/>
      <Action ID="Wait" duration="5"/>
      <Action ID="NavigateToPose" goal="B"/>
      <Action ID="Wait" duration="5"/>
      <Action ID="NavigateToPose" goal="C"/>
      <Action ID="Wait" duration="5"/>
    </Sequence>
  </BehaviorTree>
</root>

这个简单的Sequence结构实现了顺序导航。但实际场景中，如果A点导航失败，整个任务将终止。更健壮的设计是使用Selector节点，在导航失败时尝试重新规划或跳过该点：

<Selector name="访问A点">
  <Action ID="NavigateToPose" goal="A"/>
  <Action ID="Recovery"/>
  <Action ID="NavigateToPose" goal="A" retry="2"/>
</Selector>

这种设计体现了行为树在异常处理上的灵活性——通过组合不同的控制节点，可以构建出从“严格顺序执行”到“容错跳过”的多种任务策略。

1.3 课程目标与学习路径

课程目标体系

本课程旨在培养学习者以下核心能力：理解能力——深入理解Nav2架构与行为树原理，能够解释BT Navigator的工作机制；设计能力——能够根据实际导航需求，设计并编写行为树XML文件，实现复杂的任务编排逻辑；调试能力——熟练使用Groot、Nav2日志等工具，定位并解决行为树执行中的问题；优化能力——掌握行为树性能优化技巧，包括节点复用、Blackboard设计、并行执行等高级主题。

学习路径规划

阶段	章节范围	核心内容	实践项目
基础入门	第1-5章	Nav2架构、BT基础语法、ROS2接口	搭建仿真环境，运行默认导航BT
核心进阶	第6-15章	自定义BT节点、代价地图集成、恢复行为	实现带避障的多目标点导航
高级应用	第16-25章	并行任务、动态参数调整、多机器人协同	开发仓库多机器人调度系统
工程实战	第26-30章	性能优化、故障排查、真实机器人部署	完成室内巡检机器人完整导航方案

前置要求与技能准备

学习本课程需要具备以下基础：

• ROS2基础：熟悉节点、话题、服务、动作等核心概念，能够使用ros2 run、ros2 topic等命令行工具；
• Linux与C++/Python：具备基本的Linux命令行操作能力，至少掌握C++或Python中的一种，能够阅读和修改简单的代码；
• 机器人学基础：了解坐标变换（TF）、里程计（Odometry）、激光雷达/相机等基本传感器原理；
• 仿真环境：建议安装Gazebo或Ignition仿真器，并配置好TurtleBot3或类似机器人模型。

1.4 常见误区与学习建议

误区一：将行为树视为万能工具

行为树擅长处理“有明确状态转移逻辑”的任务编排，但并非所有导航问题都适合用BT解决。例如，需要复杂数学计算的路径优化算法，应放在Planner插件中实现，而非BT节点。行为树的价值在于“编排”而非“计算”。

误区二：忽视Blackboard的作用

Blackboard是行为树各节点间共享数据的机制，类似于全局变量池。许多初学者在编写BT节点时，习惯将数据通过节点参数传递，导致节点耦合度高、复用性差。正确做法是：将动态数据（如目标点坐标、路径结果）存入Blackboard，节点通过键值读取。这样，同一个BT节点可以被不同任务复用，只需在XML中配置不同的Blackboard键名。

误区三：忽略生命周期管理

Nav2的节点采用生命周期管理，BT Navigator只有在ACTIVE状态下才会执行行为树。初学者在调试时，常遇到“BT不执行”的问题，往往是因为节点未正确激活。建议在启动Nav2后，使用ros2 lifecycle get /bt_navigator检查节点状态，确保其处于ACTIVE状态。