ROS2 Humble版nav2_bringup实战:如何自定义导航启动文件并禁用Recoveries功能
如果你已经用ROS2 Humble跑通了官方的TurtleBot3仿真导航,看着机器人在Gazebo里流畅地规划路径、避开障碍,心里可能正盘算着如何把这套系统搬到自己的机器人上。但很快你就会发现,官方提供的启动文件像一套“全家桶”,功能齐全却也略显臃肿。比如,当机器人卡在墙角时,它会自动执行原地旋转、后退等“恢复行为”(Recoveries)。这在演示中很智能,但在某些特定应用场景下——比如你的机器人负载着精密仪器,或者工作空间极其狭窄——这些自动恢复动作可能带来风险,甚至是你根本不需要的冗余逻辑。
这时,你就需要深入nav2_bringup的内部,学会“拆解”和“重组”这套导航系统。这不是简单的参数调整,而是从启动文件的架构层面进行定制,让导航栈只运行你需要的部分。今天,我们就来聊聊如何基于ROS2 Humble的nav2_bringup,动手创建一个高度定制化的导航启动流程,并重点演示如何彻底、干净地禁用Recoveries功能,让你的机器人导航行为变得更可控、更符合实际需求。
1. 理解nav2_bringup的启动架构:从“全家桶”到“模块化”
在动手修改之前,我们必须先搞清楚nav2_bringup这个包到底做了什么。很多人把它当作一个黑盒,用ros2 launch nav2_bringup tb3_simulation_launch.py一键启动就完事了。但当你需要定制时,这个黑盒必须被打开。
nav2_bringup本质上是一个高级启动封装包,它本身并不包含核心算法,而是像一个交响乐指挥,负责将Nav2栈中的各个独立功能节点(地图服务器、规划器、控制器、行为服务器等)按照正确的生命周期顺序启动并配置好。它的设计哲学是“开箱即用”,但也预留了充足的接口供你“按需定制”。
1.1 核心启动文件剖析
通过APT安装后,所有启动文件位于/opt/ros/humble/share/nav2_bringup/launch/。其中,最值得关注的是bringup_launch.py,它是所有导航启动的基石。
# 这是一个简化的概念性代码,用于说明bringup_launch.py的结构
# 实际文件更复杂,但逻辑相通
from launch import LaunchDescription
from launch_ros.actions import Node, ComposableNodeContainer
from launch.actions import IncludeLaunchDescription, DeclareLaunchArgument
# ... 其他导入
def generate_launch_description():
# 1. 声明一系列启动参数,如地图路径、是否使用SLAM、参数文件位置等
declare_use_slam_cmd = DeclareLaunchArgument(
'slam', default_value='False',
description='Whether to run SLAM'
)
# ... 更多参数声明
# 2. 根据参数,有条件地包含或启动各个节点
# 例如,启动生命周期管理器来管理所有Nav2节点
lifecycle_manager_cmd = Node(
package='nav2_lifecycle_manager',
executable='lifecycle_manager',
name='lifecycle_manager_navigation',
output='screen',
parameters=[{...}] # 这里指定了需要管理的节点列表
)
# 3. 启动行为服务器(即Recoveries功能所在)
behavior_server_cmd = Node(
package='nav2_behaviors',
executable='behavior_server',
name='behavior_server',
output='screen',
parameters=[{...}] # 这里加载行为插件,如spin, backup, wait
)
# 4. 将上述所有动作组合成一个LaunchDescription
ld = LaunchDescription()
ld.add_action(declare_use_slam_cmd)
ld.add_action(lifecycle_manager_cmd)
ld.add_action(behavior_server_cmd)
# ...
return ld
关键点在于,bringup_launch.py是通过组合多个独立的Node或ComposableNodeContainer来构建整个导航栈的。这意味着,你可以通过不包含某个节点,或者修改其参数,来达到禁用特定功能的目的。
1.2 仿真启动与实物启动的差异
很多开发者混淆了bringup_launch.py和tb3_simulation_launch.py。理解它们的区别是正确定制的前提:
| 启动文件 | 核心功能 | 包含的额外组件 | 适用场景 |
|---|---|---|---|
| bringup_launch.py | 启动纯导航栈(规划、控制、恢复等) | 无(或仅RViz) | 物理机器人(已有底层驱动和传感器数据) |
| tb3_simulation_launch.py | 启动导航栈 + 仿真环境 | Gazebo仿真器、机器人模型生成、世界加载、RViz | TurtleBot3的Gazebo仿真演示 |
注意:
tb3_simulation_launch.py内部会调用(Include)bringup_launch.py。因此,定制导航栈本身,通常需要从修改bringup_launch.py或其调用方式入手,而不是直接改仿真启动文件。
对于你自己的机器人,无论是实物的还是其他模型的仿真,最佳实践是以bringup_launch.py为蓝本,创建属于你自己机器人的启动文件,而不是强行修改官方文件。
2. 创建你的自定义导航启动文件
直接修改/opt/ros/humble/share/下的文件是糟糕的做法,因为系统更新会覆盖你的修改。正确的方式是在你自己的功能包中创建启动文件。假设你有一个名为my_robot_navigation的包。
2.1 项目结构与基础启动文件
首先,建立标准的ROS2包结构:
# 在你的工作空间src下
ros2 pkg create --build-type ament_python my_robot_navigation
mkdir -p launch params
接下来,在launch/目录下创建你的主启动文件,例如my_nav_bringup.launch.py。我们可以从复制并简化bringup_launch.py的逻辑开始,但更推荐的方式是直接包含它,并通过参数覆盖来进行定制。
# my_robot_navigation/launch/my_nav_bringup.launch.py
from launch import LaunchDescription
from launch.actions import IncludeLaunchDescription, DeclareLaunchArgument
from launch.substitutions import PathJoinSubstitution, LaunchConfiguration
from launch_ros.substitutions import FindPackageShare
from launch.launch_description_sources import PythonLaunchDescriptionSource
def generate_launch_description():
# 定义一些你自己的默认参数
default_params_file = PathJoinSubstitution(
[FindPackageShare('my_robot_navigation'), 'params', 'my_nav2_params.yaml']
)
default_map_file = PathJoinSubstitution(
[FindPackageShare('my_robot_navigation'), 'maps', 'my_lab.yaml']
)
# 声明参数,允许从命令行覆盖
declare_params_file_cmd = DeclareLaunchArgument(
'params_file',
default_value=default_params_file,
description='Full path to the ROS2 parameters file for Nav2'
)
declare_map_cmd = DeclareLaunchArgument(
'map',
default_value=default_map_file,
description='Full path to map yaml file'
)
declare_use_sim_time_cmd = DeclareLaunchArgument(
'use_sim_time',
default_value='false',
description='Use simulation (Gazebo) clock if true'
)
# **核心部分:包含官方的bringup_launch,但传入我们的参数**
nav2_bringup_launch = IncludeLaunchDescription(
PythonLaunchDescriptionSource([
PathJoinSubstitution([
FindPackageShare('nav2_bringup'),
'launch',
'bringup_launch.py'
])
]),
launch_arguments={
'map': LaunchConfiguration('map'),
'use_sim_time': LaunchConfiguration('use_sim_time'),
'params_file': LaunchConfiguration('params_file'),
# 我们可以在这里传入控制特定功能的参数
'autostart': 'true',
}.items()
)
ld = LaunchDescription()
ld.add_action(declare_params_file_cmd)
ld.add_action(declare_map_cmd)
ld.add_action(declare_use_sim_time_cmd)
ld.add_action(nav2_bringup_launch)
return ld
这种方法利用了Nav2已有的、经过充分测试的启动逻辑,我们只需通过params_file这个入口,传入我们高度定制的参数文件,就能控制导航栈的方方面面,包括禁用Recoveries。
3. 深度定制:禁用Recoveries功能的两种策略
Recoveries功能在Humble版本中归属于Behavior Server。禁用它不是简单地“关掉一个开关”,而是需要从插件加载和行为树逻辑两个层面协同处理。否则,导航过程中行为树可能会调用一个不存在的恢复动作,导致任务失败。
3.1 策略一:修改参数文件,清空行为插件列表(推荐)
这是最直接的方法。Nav2的所有服务器都通过ROS2参数服务器加载插件。Behavior Server有一个关键参数behavior_plugins,它定义了要加载和执行的恢复行为插件列表。
-
找到并复制默认参数文件: 首先,将官方的参数模板复制到你的包中作为起点:
cp /opt/ros/humble/share/nav2_bringup/params/nav2_params.yaml ~/ros2_ws/src/my_robot_navigation/params/my_nav2_params.yaml -
修改
my_nav2_params.yaml中的Behavior Server配置: 在YAML文件中找到behavior_server部分。原始配置可能如下所示:behavior_server: ros__parameters: costmap_topic: local_costmap/costmap_raw footprint_topic: local_costmap/published_footprint cycle_frequency: 10.0 behavior_plugins: ["spin", "backup", "drive_on_heading", "wait", "assisted_teleop"] # 默认加载了5个插件 spin: plugin: "nav2_behaviors/Spin" # ... spin插件的具体参数 backup: plugin: "nav2_behaviors/BackUp" # ... backup插件的具体参数 # ... 其他插件的配置为了禁用所有恢复行为,你可以将
behavior_plugins列表设为空,并移除或注释掉所有具体插件的配置块:behavior_server: ros__parameters: costmap_topic: local_costmap/costmap_raw footprint_topic: local_costmap/published_footprint cycle_frequency: 10.0 behavior_plugins: [] # 关键!清空插件列表,Behavior Server将不加载任何恢复行为 # 注意:下面的spin、backup等插件配置块可以全部删除或注释掉,因为不会被加载 # spin: # plugin: "nav2_behaviors/Spin" # backup: # plugin: "nav2_behaviors/BackUp"提示:如果你只想禁用部分行为(例如只禁用
spin和backup,但保留wait),那么可以修改列表为["wait"],并只保留wait插件的配置块。 -
同步修改行为树XML文件: 仅仅清空插件还不够。Nav2默认的行为树(例如
navigate_to_pose_w_replanning_and_recovery.xml)中包含了调用这些恢复行为的节点。如果插件不存在,行为树执行到这些节点时会报错。- 找到默认行为树文件:通常位于
/opt/ros/humble/share/nav2_bt_navigator/behavior_trees/。 - 将其复制到你的包中,例如
my_robot_navigation/behavior_trees/my_custom_bt.xml。 - 编辑这个XML文件,删除或注释掉与恢复行为相关的节点。主要查找
<RecoveryNode>标签及其内部的Spin、BackUp等Behavior节点。一个简单的做法是,将整个<RecoveryNode>替换为一个始终返回成功的AlwaysSuccess节点,或者直接移除该分支。
<!-- 原始恢复节点示例 --> <RecoveryNode number_of_retries="1" name="ComputePathToPose"> <ReactiveSequence name="RecoveryFallback"> <GoalUpdated/> <ComputePathToPose path="{path}" planner_id="GridBased"/> </ReactiveSequence> <RecoveryNode number_of_retries="1" name="ClearGlobalCostmap-Context"> <ClearEntireCostmap service_name="global_costmap/clear_entirely_global_costmap"/> <ReactiveSequence name="RecoveryFallback"> <GoalUpdated/> <ComputePathToPose path="{path}" planner_id="GridBased"/> </ReactiveSequence> <!-- 这里原本可能有 Spin 或 Backup 节点 --> <Spin spin_dist="1.57"/> <!-- 删除或注释此行 --> <BackUp backup_dist="0.15" backup_speed="0.025"/> <!-- 删除或注释此行 --> </RecoveryNode> </RecoveryNode>- 在你的参数文件中,指定导航器使用修改后的行为树:
bt_navigator: ros__parameters: default_nav_to_pose_bt_xml: /path/to/your/my_robot_navigation/behavior_trees/my_custom_bt.xml # ... 其他参数 - 找到默认行为树文件:通常位于
3.2 策略二:在启动文件中排除Behavior Server节点(更彻底)
如果你确定完全不需要任何恢复行为,并且连Behavior Server这个节点进程都想省掉,可以在启动层面动手。这需要你不完全依赖官方的bringup_launch.py,而是自己组装节点。
-
创建“组装式”启动文件: 在
my_robot_navigation/launch/下创建my_nav_without_recovery.launch.py。这个文件不再包含bringup_launch.py,而是显式地启动除Behavior Server外的所有其他Nav2节点。# 示例片段,展示核心思路 from launch_ros.actions import Node, ComposableNodeContainer from nav2_common.launch import RewrittenYaml # ... 省略参数声明等前置代码 def generate_launch_description(): ld = LaunchDescription() # 1. 启动地图服务器 map_server_node = Node( package='nav2_map_server', executable='map_server', name='map_server', output='screen', parameters=[configured_params], # 使用处理后的参数 # ... ) ld.add_action(map_server_node) # 2. 启动AMCL(假设定位模式) amcl_node = Node( package='nav2_amcl', executable='amcl', name='amcl', output='screen', parameters=[configured_params], # ... ) ld.add_action(amcl_node) # 3. 启动规划器、控制器、平滑器等... planner_server_node = Node(...) controller_server_node = Node(...) smoother_server_node = Node(...) bt_navigator_node = Node(...) # ... 将它们都加入ld # 4. **特别注意:我们不启动 behavior_server_node** # 5. 启动生命周期管理器,但管理的节点列表里不包含behavior_server lifecycle_manager_node = Node( package='nav2_lifecycle_manager', executable='lifecycle_manager', name='lifecycle_manager_navigation', output='screen', parameters=[{ 'use_sim_time': LaunchConfiguration('use_sim_time'), 'autostart': True, 'node_names': [ 'map_server', 'amcl', 'planner_server', 'controller_server', 'smoother_server', 'bt_navigator' # 注意,这里没有'behavior_server' ] }] ) ld.add_action(lifecycle_manager_node) return ld这种方法更底层,控制力更强,但工作量也更大,需要你确保参数配置(尤其是行为树)与缺失的节点相匹配。它适合对Nav2架构非常熟悉,且追求极致精简和控制的开发者。
4. 验证与调试:确保定制生效
修改完成后,不能想当然地认为一切正常。必须通过系统性的验证。
-
启动并检查节点列表: 使用你的自定义启动文件启动导航。
ros2 launch my_robot_navigation my_nav_bringup.launch.py在另一个终端,查看活跃的节点:
ros2 node list确认
behavior_server节点不存在(如果采用策略二),或者虽然存在但已按预期配置(如果采用策略一)。 -
检查已加载的插件: 如果Behavior Server节点仍在运行,你可以通过ROS2服务调用查询其加载的插件。
# 首先列出behavior_server提供的服务 ros2 service list | grep behavior_server # 可能会看到 /behavior_server/list_plugins 这样的服务 ros2 service call /behavior_server/list_plugins std_srvs/srv/Empty观察响应,确认插件列表是否为空或仅包含你允许的插件。
-
行为树可视化与测试: 使用
Groot2工具加载你修改后的行为树XML文件,直观地检查所有RecoveryNode和Behavior节点是否已被正确移除或替换。 在仿真或实物上进行导航测试,故意将机器人置于困境(例如用虚拟障碍物挡住去路)。观察机器人的反应:- 期望行为(禁用Recoveries后):机器人可能会在控制器尝试一段时间后,由行为树触发全局重新规划,或者直接报告规划失败,但绝不会执行旋转或后退动作。
- 错误情况:如果控制台出现类似
PluginLoader exception: Plugin not found的错误,说明行为树仍在尝试调用已被移除的插件,需要回头检查行为树XML的修改是否彻底。
-
性能与资源监控: 使用
ros2 top或htop命令,对比禁用Recoveries前后,整个导航进程的内存和CPU占用率。对于资源受限的嵌入式平台,移除不必要的节点和插件通常会带来可观的资源节省。
定制化Nav2启动文件并禁用特定功能,是一个从“用户”到“系统架构师”角色转变的过程。它要求你不仅知道如何调用API,更要理解各个模块之间的依赖与数据流。当你成功地将一个通用的导航“全家桶”修剪成贴合自己机器人形态和任务需求的精简系统时,那种对代码的掌控感和对机器人行为的信心,是使用默认配置无法比拟的。每一次对启动文件和参数的成功调整,都是对你机器人认知的一次深化。
444



被折叠的 条评论
为什么被折叠?



