ROS 2（機器人操作系統(tǒng)2）是一個強大的機器人開發(fā)中間件，其導航系統(tǒng)是構建自主移動機器人的核心模塊。本文將對ROS 2導航棧的核心概念，特別是其定位系統(tǒng)進行極簡。

1. 導航系統(tǒng)簡介

ROS 2導航系統(tǒng)（Navigation2，簡稱Nav2）是ROS 1導航棧的繼承與發(fā)展。它提供了一套完整的軟件框架，使機器人能夠實現從A點到B點的自主移動。其核心目標可概括為：感知環(huán)境 -> 確定自身位置 -> 規(guī)劃安全路徑 -> 控制機器人移動。Nav2采用了基于行為的樹（Behavior Tree）架構，使其模塊化、可配置性和可靠性更強。

2. 自定位：導航的基石

自定位是導航系統(tǒng)知道“我在哪里”的關鍵環(huán)節(jié)。在ROS 2導航中，這主要通過自適應蒙特卡洛定位算法實現，對應的核心節(jié)點是 nav2_amcl。

• 核心原理：AMCL是一種粒子濾波算法。它維護一組代表機器人可能位姿（位置和朝向）的“粒子”。算法持續(xù)進行兩個循環(huán)：

1. 預測：根據機器人的運動模型（如里程計數據），移動所有粒子，模擬機器人可能的移動。

1. 更新（校正）：利用機器人傳感器（通常是激光雷達）觀測到的環(huán)境特征，與已知的全局地圖進行匹配，為每個粒子計算一個權重（權重越高，代表該粒子描述的真實位姿可能性越大）。根據權重對粒子群進行重采樣，淘汰低權重粒子，復制高權重粒子，從而使粒子群逐漸收斂到機器人的真實位姿上。

• 輸入與輸出：
• 輸入：激光掃描數據、里程計數據、預先加載的靜態(tài)地圖。

• 輸出：機器人在地圖坐標系中的估計位姿（/amcl_pose話題），以及該估計的協(xié)方差（不確定性）。

• 特點：AMCL對初始位姿敏感，通常需要一個初始姿態(tài)（如通過RViz手動指定或通過服務調用設置）。它擅長在已知地圖中進行局部跟蹤，但在全局定位失效（如機器人被“綁架”到全新位置）時恢復較慢。

3. 導航定位系統(tǒng)運作流程

一個典型的ROS 2導航定位與運動流程，可以簡化為以下協(xié)同運作的閉環(huán)：

1. 建圖與地圖加載：通過SLAM工具（如nav2<em>slam</em>toolbox）創(chuàng)建環(huán)境的二維占用網格地圖，并保存。導航時，地圖服務器（nav2<em>map</em>server）將此靜態(tài)地圖加載到系統(tǒng)中，作為全局參考。

1. 定位初始化：啟動AMCL節(jié)點，并提供機器人大致的初始位姿。AMCL開始工作，粒子云擴散在初始位姿周圍。

1. 實時定位循環(huán)：

• 里程計持續(xù)提供機器人的相對運動信息（預測）。

• 激光雷達持續(xù)掃描環(huán)境，獲取觀測數據。

• AMCL將觀測數據與全局地圖匹配，不斷更新和收斂粒子群，輸出當前最優(yōu)的估計位姿。

• 定位信息被發(fā)布到 /tf 坐標系變換樹中，建立“地圖(map)” -> “里程計基準(odom)” -> “機器人基座(base_link)”的變換關系。其中，map->odom 的變換由AMCL持續(xù)修正，以消除里程計的累積誤差。

1. 路徑規(guī)劃與跟隨：

• 全局規(guī)劃器（如nav2<em>navfn</em>planner）：接收到目標位姿后，結合全局地圖和當前AMCL提供的定位，規(guī)劃出一條從起點到終點的全局最優(yōu)或次優(yōu)路徑。

• 局部規(guī)劃器/控制器（如nav2<em>regulated</em>pure<em>pursuit</em>controller）：負責執(zhí)行路徑。它結合全局路徑、高頻率的實時定位（來自AMCL）以及最新的傳感器數據（用于動態(tài)障礙物檢測），計算并發(fā)送速度命令（線速度和角速度）給機器人驅動系統(tǒng)，使機器人沿路徑安全行駛，同時避開未在地圖中標注的臨時障礙物。

1. 閉環(huán)與恢復：整個過程中，定位（AMCL）為規(guī)劃和控制器提供“我在哪”的輸入，而控制器的運動結果又通過里程計反饋給AMCL進行下一輪的預測。如果定位丟失或路徑被阻斷，系統(tǒng)內置的恢復行為（如原地旋轉以重新定位、清除代價地圖等）會被觸發(fā)。

**：ROS 2導航系統(tǒng)是一個以自定位（AMCL）為核心反饋，以靜態(tài)地圖為全局知識，通過分層規(guī)劃與控制**實現自主移動的智能閉環(huán)。理解“感知-定位-規(guī)劃-執(zhí)行”這一流程，是掌握機器人導航的關鍵。