深度解构 ROS 2：如何手动调通 Nav2 A* 路径规划引擎

在复杂的机器人系统中，导航堆栈（Navigation 2） 往往被封装在复杂的 Launch 文件中。为了深入理解其背后的运行逻辑，本文将带你脱离整机环境，通过分步启动组件的方式，手动触发 *SmacPlanner (A)** 算法进行路径规划。

我们将跳过物理仿真，直接在坐标系中通过 Action 通信下发指令，观察 A* 算法如何避开地图障碍物生成最优路径。

🛠 第一阶段：环境清理与通信重置

在正式开始前，必须确保系统中没有残留的 ROS 2 进程干扰 DDS（数据分发服务）通信。

bash 复制代码

# 1. 强制清理可能残余的导航节点
pkill -9 planner_server; pkill -9 map_server; pkill -9 lifecycle_manager

# 2. 重置 ROS 2 后台守护进程，确保节点列表干净
ros2 daemon stop && ros2 daemon start

🏗 第二阶段：核心组件启动（分窗口执行）

窗口 1：建立虚拟坐标系 (TF)

由于我们没有物理底盘或仿真器，我们需要手动发布静态坐标变换，构建从地图到机器人的逻辑链条。

bash 复制代码

source /opt/ros/humble/setup.bash
# 发布 map -> odom -> base_link 的 0 偏移变换
ros2 run tf2_ros static_transform_publisher 0 0 0 0 0 0 map odom &
ros2 run tf2_ros static_transform_publisher 0 0 0 0 0 0 odom base_link

窗口 2：启动地图与规划器服务器

我们将加载 TurtleBot3 的经典地图，并显式指定使用 SmacPlanner2D（A* 算法的现代实现）插件。

bash 复制代码

source /opt/ros/humble/setup.bash

# 1. 启动地图服务器
ros2 run nav2_map_server map_server --ros-args \
    -p yaml_filename:=/opt/ros/humble/share/nav2_bringup/maps/turtlebot3_world.yaml \
    -p use_sim_time:=false &

# 2. 启动规划器服务器 (注入 A* 算法配置)
ros2 run nav2_planner planner_server --ros-args \
    -p expected_planner_frequency:=20.0 \
    -p planner_plugins:=['GridBased'] \
    -p GridBased.plugin:='nav2_smac_planner/SmacPlanner2D' \
    -p use_sim_time:=false

窗口 3：节点状态激活 (Lifecycle Manager)

Nav2 采用 Lifecycle 状态机管理。节点启动后处于 unconfigured 状态，需要一个管理器来统一点火。

bash 复制代码

source /opt/ros/humble/setup.bash
ros2 run nav2_lifecycle_manager lifecycle_manager --ros-args \
    -p node_names:="['map_server','planner_server']" \
    -p autostart:=true

演示重点： 当该窗口输出 Managed nodes are active 时，说明 A* 引擎已进入 Ready 状态。

👁 第三阶段：可视化配置 (RViz 2)

打开 RViz 2（窗口 4），手动配置以下参数以观察结果：

Global Options : 将 Fixed Frame 改为 map。
Add Map : 订阅话题 /map，将 Durability Policy 改为 Transient Local。
Add Path : 订阅话题 /plan，并将 Style 设置为 Billboards 以获得更好的视觉效果。

🚀 第四阶段：下发 A* 规划指令

这是最核心的一步。我们将直接向 /compute_path_to_pose 动作服务器发送一个 Goal，要求它计算从点 A 到点 B 的避障路径。

bash 复制代码

source /opt/ros/humble/setup.bash

ros2 action send_goal /compute_path_to_pose nav2_msgs/action/ComputePathToPose "{
  goal: {
    header: {frame_id: 'map'}, 
    pose: {position: {x: 1.5, y: -1.5, z: 0.0}, orientation: {w: 1.0}}
  },
  start: {
    header: {frame_id: 'map'}, 
    pose: {position: {x: -1.5, y: 1.5, z: 0.0}, orientation: {w: 1.0}}
  },
  planner_id: 'GridBased',
  use_start: true
}"

💡 实验现象

终端反馈：你会看到 Action 交互的成功响应，包含路径点序列。
RViz 表现：地图上会出现一条绿色的线条，灵巧地绕过中心障碍物，连接你设定的起止点。

📝 总结

通过这种"分拆启动"的方法，我们验证了 Nav2 的三个关键点：

解耦性：即使没有底盘驱动，只要 TF 树完整，规划器就能工作。
生命周期管理：Lifecycle 节点必须被激活后才能响应请求。
插件机制：通过参数传递，我们可以随时将 A* (SmacPlanner) 替换为 Dijkstra 或 Theta*。

这套流程是开发自定义导航策略或排查规划故障的最佳实践。