移動機器人的自主定位導(dǎo)航過程如下：

　　1）采用激光掃描儀或深度相機創(chuàng)建地圖；

　　2）定位：機器人根據(jù)傳感器的信息并采用自適應(yīng)蒙特卡羅定位算法計算機器人在地圖中的當(dāng)前位置。

　　3）全局路徑規(guī)劃：采用Dijkstra（迪杰斯特拉）算法規(guī)劃出機器人從當(dāng)前位置到目標(biāo)位置的全局最優(yōu)路徑，該算法以起始點為中心向外層擴(kuò)展，直到擴(kuò)展到終點為止。

　　4）控制機器人運動：采用動態(tài)窗口法計算出控制命令并發(fā)送給移動平臺，使其沿規(guī)劃的路徑前進(jìn)，如圖1所示。

圖1移動機器人的導(dǎo)航定位

　　下面將以TurtleBot機器人為例，介紹實現(xiàn)自主定位導(dǎo)航的方法。

　　1導(dǎo)航仿真

　　為了簡單，我們使用采用rbx1_nav/maps中的地圖進(jìn)行定位導(dǎo)航仿真實驗。

　　在終端窗口中，分別運行下面的命令：

　　$ roslaunch rbx1_bringup fake_turtlebot.launch

　　$ roslaunch rbx1_nav fake_amcl.launch map:=test_map.yaml

　　$ rosrun rviz rviz -d `rospack find rbx1_nav`/amcl.rviz

　　其中fake_amcl.launch文件位于rbx1_nav/launch目錄下，它的作用是加載地圖、啟動并配置move_base節(jié)點、運行fake_location節(jié)點。

　　運行結(jié)果如圖2所示：

圖2啟動定位導(dǎo)航

　　使用rviz工具欄上的2DNav Goal，為機器人設(shè)置目標(biāo)位姿（綠色箭頭），運行效果如圖3所示。