在Navigation2中使用Planner Selector和Controller Selector的实践指南

概述

Navigation2作为ROS2中的导航框架，提供了灵活的规划器和控制器选择机制。本文将详细介绍如何在Navigation2中配置和使用Planner Selector与Controller Selector功能，实现不同场景下的动态规划器和控制器切换。

配置基础环境

在开始配置前，需要确保已正确安装Navigation2框架，并了解基本的导航参数配置。本文以Humble版本为例，系统环境为Ubuntu 22.04.4。

Planner和Controller的多插件配置

首先需要在planner_server的配置文件中声明多个规划器插件：

planner_server:
  ros__parameters:
    planner_plugins: ["GridBased_navfn", "GridBased_smac"]
    GridBased_navfn:
      plugin: "nav2_navfn_planner/NavfnPlanner"
    GridBased_smac:
      plugin: "nav2_smac_planner/SmacPlannerHybrid"

同样地，对于控制器也可以在controller_server中配置多个控制器插件。

行为树配置关键点

在行为树配置中，有两个关键节点需要注意：

1. PlannerSelector节点：用于动态选择规划器
2. ControllerSelector节点：用于动态选择控制器

典型的行为树配置示例如下：

<BehaviorTree ID="MainTree">
  <RecoveryNode number_of_retries="6" name="NavigateRecovery">
    <PipelineSequence name="NavigateWithReplanning">
      <ControllerSelector selected_controller="{selected_controller}" 
                         default_controller="FollowPath_DWB" 
                         topic_name="controller_selector"/>
      <PlannerSelector selected_planner="{selected_planner}" 
                      default_planner="GridBased_navfn" 
                      topic_name="planner_selector"/>
      <!-- 其他节点 -->
    </PipelineSequence>
  </RecoveryNode>
</BehaviorTree>

常见问题解决

1. 主题不可见问题：PlannerSelector和ControllerSelector使用的主题可能不会立即出现在ros2 topic list中，这是由于其使用了特定的QoS设置（transient local）。可以通过直接发布消息到该主题来验证功能是否正常。

2. 行为树加载问题：确保在nav2_params.yaml中正确指定了行为树文件路径，使用default_nav_to_pose_bt_xml参数而非default_bt_xml。

实际应用建议

1. 场景化规划器选择：可以根据不同环境特点（如开阔区域、狭窄走廊）选择最适合的规划器。
2. 动态性能调整：在需要高精度控制时选择更精确的控制器，在开阔区域选择更高效的控制器。
3. 故障恢复机制：结合行为树的恢复节点，可以在规划或控制失败时自动尝试其他规划器或控制器。

总结

Navigation2的Planner Selector和Controller Selector功能为机器人导航提供了极大的灵活性。通过合理配置多个规划器和控制器，并在行为树中实现动态选择机制，可以显著提升机器人在复杂环境中的导航性能。开发者在实现时需要注意主题的QoS设置和行为树文件的正确加载路径，这些细节往往决定了功能是否能正常工作。