先說個現(xiàn)象不少技術群里隔三差五就會有人貼同一句報錯——無法定位軟件包 ros-noetic-desktop-full底下回復基本是一串“換源、sudo apt update、再試試”。這句報錯背后其實是安裝Cartographer的第一道門檻ROS環(huán)境沒理清楚。如果你也被困在環(huán)境上或者已經裝好了ROS但不知道接下來怎么編譯Cartographer這篇就是給你寫的。這篇文章會從Ubuntu和ROS版本的選擇講起把Cartographer的源碼編譯、官方2D/3D建圖demo、再到純定位模式pure localization的配置一條線走通。我假設你至少有基本的Linux命令行能力也用過rosbag、rviz這類工具。整個過程中我會把容易踩的坑單獨指出來尤其是那些“網上教程不會寫但幾乎人人都會遇到”的細節(jié)。1. 先別急著編譯ROS版本和安裝源決定了一半的成敗1.1 版本匹配為什么我推薦Ubuntu 20.04 Noetic Cartographer 1.0Cartographer是Google維護的激光SLAM庫核心是純C的cartographer庫加一層ROS適配層cartographer_ros。它支持2D和3D建圖也支持基于已有地圖的純定位這也是標題里“2D/3D建圖與定位”分不開的原因。先說版本。目前網上能找到的Cartographer教程主要針對ROS1其中Ubuntu 20.04配ROS Noetic是最穩(wěn)的組合。用Ubuntu 22.04配ROS2 Humble也可以從源碼編Cartographer但ROS2分支的文檔、launch組織方式、依賴處理都更繞對新手不友好。你要是為了快速跑通、理解原理直接選20.04 Noetic別糾結。很多人掛在“無法定位軟件包 ros-noetic-desktop-full”這一步大概率是系統(tǒng)版本不是20.04或者apt源里沒有ROS倉庫。這里有個隱藏前提Cartographer目前沒有打包好的二進制必須源碼編譯但它的依賴又大量來自ROS所以ROS環(huán)境是繞不開的前置條件。與其糾結要不要裝desktop-full不如先把ROS源的配置搞明白。1.2 報“無法定位軟件包 ros-noetic-desktop-full”時先查這三處無法定位軟件包的直譯就是apt源里找不到這個候選包。按下面順序排查比盲目換源有效得多確認系統(tǒng)版本。運行l(wèi)sb_release -a看Ubuntu版本是不是20.04。Noetic只支持20.04你在18.04上裝當然找不到。確認ROS源是否正確配置。查看/etc/apt/sources.list以及/etc/apt/sources.list.d/下的文件看有沒有ROS官方源或國內鏡像源。官方源格式大致是deb http://packages.ros.org/ros/ubuntu focal main其中focal對應20.04。執(zhí)行sudo apt update。很多時候是索引沒刷新包列表還是舊的。更新完再試一次apt policy ros-noetic-desktop-full如果能看到候選版本說明源沒問題。如果你是國內網絡建議直接配置清華或阿里云的ROS鏡像速度差距非常明顯。apt-key過期也是一個高頻問題如果在apt update時報NO_PUBKEY需要提前把ROS公鑰重新導入具體命令ROS官方文檔里有按當前版本的指引操作即可。另外很多一鍵安裝腳本會把ROS源、python工具、rosdep一把梭裝好比如“魚香ROS”那套腳本確實省事。我的建議是可以用但你最好知道它改了什么。它通常做的事情無非是寫入ROS apt源、安裝python3-rosdep等基礎工具。如果你自己排查問題心里要有數(shù)別出事了連自己改過什么都不知道。1.3 不裝desktop-full也能跑按需裁剪依賴很多人卡在“無法定位軟件包 ros-noetic-desktop-full”其實即使定位到了desktop-full的體積也很大因為里面帶了Gazebo、navigation、move_base這些和Cartographer無關的包。如果你只想跑Cartographer裝ros-noetic-ros-base就夠然后額外補ros-noetic-rviz和ros-noetic-rosbag。Cartographer的demo launch會依賴rviz所以這個包必須裝。最小化安裝的參考命令sudo apt update sudo apt install -y ros-noetic-ros-base ros-noetic-rviz ros-noetic-rosbag echo source /opt/ros/noetic/setup.bash ~/.bashrc source ~/.bashrc這樣裝完再補python3-wstool、python3-rosdep、ninja-build等編譯工具就夠了。別小看這個選擇編譯Cartographer時如果系統(tǒng)里的ROS包越多遇到依賴版本沖突的可能性也越大精簡環(huán)境反而好排查問題。2. 源碼編譯沒有捷徑先把cartographer和cartographer_ros的關系理清2.1 你編譯的不是一個包而是兩層Cartographer從宏觀上看分兩層cartographer核心SLAM算法庫純C不依賴ROS。它負責激光掃描匹配、子圖構建、位姿圖優(yōu)化、回環(huán)檢測這些真正的“大腦”工作。cartographer_rosROS適配層把激光話題、IMU話題、TF變換、launch文件、參數(shù)配置接進去并調用cartographer完成建圖和定位。這個區(qū)分非常重要。你去看“cartographer代碼解析”時如果直接一頭扎進cartographer_ros包里的源碼會發(fā)現(xiàn)大量代碼都是ROS消息和內部數(shù)據(jù)結構互轉真正的算法都在cartographer核心庫里。編譯時也建議從核心庫開始然后再編譯ROS層。2.2 完整編譯命令與順序官方推薦用catkin_make_isolated來編譯原因是cartographer本身不是catkin包catkin_make_isolated會按依賴順序逐個編譯不會因為非catkin包的存在而中斷。完整流程如下mkdir -p ~/cartographer_ws/src cd ~/cartographer_ws wstool init src wstool merge -t src https://raw.githubusercontent.com/cartographer-project/cartographer_ros/master/cartographer_ros.rosinstall wstool update -t src sudo src/cartographer/scripts/install_proto3.sh sudo rosdep init rosdep update rosdep install --from-paths src --ignore-src --rosdistronoetic -y catkin_make_isolated --install --use-ninja注意幾個關鍵點wstool update之后src目錄下會多出cartographer、cartographer_ros、abseil-cpp幾個倉庫這是好事。很多人編譯時報缺失abseil就是因為這步沒執(zhí)行成功導致倉庫根本沒有拉全。install_proto3.sh腳本會從源碼編譯安裝一個特定版本的protobuf到/usr/local。這個腳本比較耗時但必須執(zhí)行因為Cartographer對protobuf版本有硬性要求。rosdep install這步會讀取包依賴并自動安裝系統(tǒng)依賴。如果它報找不到某個包多半是ROS源沒配好或者版本不對。編譯時用--use-ninja會快不少尤其是改代碼后重新編譯體驗差距明顯。2.3 abseil和protobuf組合新手最容易栽的坑編譯過程中最經典的錯誤是一堆和absl相關的編譯失敗類似fatal error: absl/strings/str_split.h: No such file or directory原因在于Cartographer依賴的abseil版本是特定的它并不是隨便用系統(tǒng)里apt install libabsl-dev裝出來的版本就能替代。官方cartographer_ros.rosinstall文件里已經鎖定了abseil的commit這個版本和Cartographer當時使用的protobuf接口是配套的。如果你系統(tǒng)環(huán)境里同時存在其他abseil版本鏈接階段可能直接沖突。我的建議是嚴格按官方rosinstall的版本走不要自己升級abseil或protobuf。如果之前在系統(tǒng)里裝過libabsl-dev最好先卸掉再用wstool拉下來的版本編譯。另外也不要圖省事手動apt install python3-protobuf或升級系統(tǒng)protobuf一旦/usr/local的protobuf和ROS自帶的protobuf混合就會冒出一堆“google::protobuf版本沖突”的詭異報錯。2.4 編譯完成后的自檢清單編譯完成不代表萬事大吉建議按順序驗證一次執(zhí)行source install_isolated/setup.bash確認環(huán)境變量生效。這個setup.bash替代了普通工作空間的devel/setup.bash路徑別搞混。運行rosversion cartographer_ros如果能輸出版本號一般是1.0.0說明ROS層安裝成功。試著啟動一個不會跑數(shù)據(jù)的launch例如roslaunch cartographer_ros demo_revo_lds.launch。這一步即使沒有任何bag只要launch能正常加載參數(shù)、rviz能打開、終端不報FATAL就說明基本環(huán)境已經OK。如果這三步都過了你已經跨過了最痛苦的環(huán)境階段接下來就是真正打開建圖世界的大門。3. 2D建圖實戰(zhàn)用官方bag跑通第一個完整流程3.1 數(shù)據(jù)包準備先檢查bag再跑省得白折騰我第一次跑Cartographer時犯過一個低級錯誤直接拿自己錄的2D激光bag去跑結果rviz里什么點云都沒有。后來才發(fā)現(xiàn)是話題名對不上官方launch配置里訂閱的是/scan我的bag里話題叫/laser_scan。所以無論官方數(shù)據(jù)集還是自己錄的bag先執(zhí)行一遍rosbag info your_bag.bag重點看兩個方面話題名和消息類型。如果是2D建圖需要的是sensor_msgs/LaserScan或sensor_msgs/PointCloud2如果話題名不是/scan要么改launch的remap參數(shù)要么改bag里的topic名用rosbag reindex這類操作比較麻煩推薦直接remap。官方2D數(shù)據(jù)集可以從Cartographer項目的GitHub頁面找到常見的是基于Revo LDS傳感器采集的bag。這個bag體積不大適合第一次用來理解整個流程。3.2 一條launch命令背后發(fā)生了什么運行2D建圖demo最常用的命令是roslaunch cartographer_ros demo_revo_lds.launch bag_filename:/path/to/your.bag這條launch展開后做了這么幾件事啟動cartographer_node它負責接收傳感器數(shù)據(jù)、調用核心SLAM算法并發(fā)布子圖、軌跡、位姿估計等話題。加載revo_lds.lua參數(shù)文件。這個lua文件在/opt/ros/noetic/share/cartographer_ros/configuration_files目錄下里面定義了map_builder、trajectory_builder、pose_graph等一大串參數(shù)。啟動rviz并加載預制的顯示配置你不需要手動添加PointCloud2、Map、Trajectory等顯示項。看到這里你應該理解了lua文件就是Cartographer的“大腦配置文件”想要調參改的就是這個文件。launch本身只是把它讀進來再傳給節(jié)點。3.3 運行與觀察回環(huán)閉合那一刻發(fā)生了什么用官方bag跑起來之后rviz里會看到這樣的過程一開始激光點云拼出一片模糊的小塊軌跡線歪歪扭扭地延伸子圖也是零散的隨著數(shù)據(jù)繼續(xù)播放當機器人走回曾經經過的位置時會發(fā)生一次明顯的“拉回”——原本錯開的走廊、墻角突然對齊了整幅地圖一下子變得干凈了很多。這個“拉回”瞬間就是回環(huán)閉合觸發(fā)了全局位姿圖優(yōu)化。Cartographer之所以比很多傳統(tǒng)2D SLAM表現(xiàn)好關鍵在于它把建圖看成“在不斷增長的子圖集合里做全局優(yōu)化”回環(huán)檢測一旦命中優(yōu)化器會把之前所有累積的漂移重新分配讓地圖收斂。如果你跑的時候發(fā)現(xiàn)全程沒有明顯的回環(huán)優(yōu)化或者地圖永遠不會閉合可能是數(shù)據(jù)集本身不包含回環(huán)也可能是參數(shù)里的回環(huán)檢測閾值不合適。后面會專門講參數(shù)。3.4 影響2D建圖質量的參數(shù)按優(yōu)先級排序很多人拿到lua文件不知道從哪下手幾個關鍵參數(shù)我整理成了表格參數(shù)作用經驗參考use_online_correlative_scan_matching是否使用實時CSM做前端匹配2D建議truefalse時純Ceres匹配容易陷入局部極值num_subdivisions_per_laser_scan每幀激光被細分成幾段參與匹配數(shù)值越大計算越密一般保持默認rotation_weight/translation_weightCeres匹配器對旋轉和平移的權重平移權重稍大更有利于走廊環(huán)境純旋轉場景適當調大rotation_weightmin_score回環(huán)檢測的最低分數(shù)閾值太高會漏檢太低會誤檢默認值附近微調max_range超過該距離的激光點會被忽略空曠場景可以調大但要注意噪點調參千萬不要一次動五六個參數(shù)。先改一個跑一段bag看效果再改下一個。我自己常用的做法是先保證use_online_correlative_scan_matching true然后調max_range把異常遠點過濾掉最后再看回環(huán)情況。一個參數(shù)一個參數(shù)改才知道哪個改動起了作用。4. 3D建圖實戰(zhàn)傳感器不同邏輯同根4.1 硬件前提與數(shù)據(jù)條件沒有IMU3D基本是空中樓閣3D建圖比2D復雜一大截最核心的區(qū)別在于2D激光通常只輸出一個平面范圍內的掃描而3D建圖面對的是多線激光雷達輸出的大量三維點且機器人自身有俯仰、橫滾、偏航六個自由度。沒有IMU提供的姿態(tài)先驗6自由度位姿估計很容易發(fā)散。所以官方3D demo的數(shù)據(jù)包中一定有IMU話題通常叫/imu消息類型是sensor_msgs/Imu。如果你要跑自己錄的數(shù)據(jù)務必檢查三點點云話題類型是sensor_msgs/PointCloud2并且話題名和launch里配置一致。IMU話題存在且有數(shù)據(jù)rostopic hz /imu能看到正常頻率。TF樹里有imu_link到base_link、base_link到雷達的變換通常通過URDF描述。沒有IMU的情況下3D建圖幾乎不可用。網上也有人嘗試只用3D激光做純匹配但那種方案對環(huán)境要求極高也容易漂實際項目里不要這么干。4.2 3D demo跑起來和2D的直觀差異3D官方demo命令和2D很像roslaunch cartographer_ros demo_backpack_3d.launch bag_filename:/path/to/your.bag但啟動之后你會很快感受到差異rviz里顯示的是三維子圖submap不再是二維柵格平面視野里是一片立體點云。加載的是backpack_3d.lua不是revo_lds.lua。這個lua里trajectory_builder的配置整體換成3D版本比如num_accumulated_range_data、motion_filter這些參數(shù)。同樣的bag時長3D的處理速度和效率明顯低于2DCPU占用率會高一大截。我第一次跑3D時明顯感覺體感不同激光一幀的數(shù)據(jù)量比2D大一個數(shù)量級整個前端匹配和子圖構建的計算量都上來了。如果你的電腦性能一般跑起來會卡頓甚至出現(xiàn)實時性跟不上導致漂移。4.3 3D調參的觀察與心得3D建圖的調參相比2D更謹慎。以下是我實際測試后的幾個結論optimize_every_n_nodes這個參數(shù)在3D下對性能影響很大。它表示每積累多少個節(jié)點觸發(fā)一次全局優(yōu)化。數(shù)值越小優(yōu)化越頻繁地圖越容易收斂但CPU壓力也越大。實測中如果CPU頂不住可以把默認的10改成20甚至更高犧牲一些收斂速度換實時性。use_online_correlative_scan_matching在3D下是否需要開啟要分場景。開起來對精度有幫助但計算壓力大在一些點云特征豐富的室內環(huán)境不開也夠用。3D建圖數(shù)據(jù)里機器人的運動速度對結果影響很大。轉場太快時點云會拖影站定不動時IMU零偏會累積。理想的數(shù)據(jù)是勻速慢速移動讓雷達和IMU都能持續(xù)觀測到足夠多的特征。3D調參比2D更容易陷入“盲目調參”的泥潭。我的建議是先把CPU占用和實時性控制住再談精度。如果節(jié)點本身都跑不到實時任何參數(shù)優(yōu)化都白搭。5. 建完圖之后才是重頭戲把pbstream變成可用定位服務5.1 定位和建圖的本質區(qū)別地圖固定軌跡單開建圖的過程中Cartographer會不斷添加新的子圖到全局地圖并不斷做回環(huán)優(yōu)化來修正地圖本身。而純定位模式做的事情完全不同它把已經保存好的地圖當作固定世界不再往地圖里添加新子圖只開一條新的軌跡用實時激光數(shù)據(jù)和IMU去估計這輛機器人在地圖中的位姿。這個區(qū)分對理解“定位”非常關鍵。很多人以為定位就是“跑一個建圖節(jié)點但不用保存地圖”這是錯誤的。定位必須有一個預先建好的地圖文件Cartographer官方后綴名是.pbstream它是序列化后的整個子圖集合和位姿圖狀態(tài)然后你在啟動時加載它并讓算法以“純定位”方式運行。5.2 導出地圖從pbstream到定位地圖建圖完成后先結束軌跡再保存狀態(tài)rosservice call /finish_trajectory 0 rosservice call /write_state {filename: /home/user/maps/my_map.pbstream, include_unfinished_submaps: false}注意/finish_trajectory 0里的0是軌跡ID第一次建圖通常是0如果你開過多條軌跡這個ID不一定是0。include_unfinished_submaps建議設false這樣保存的是已經完成優(yōu)化的子圖定位時更穩(wěn)定。保存出.pbstream后如果你只是要在Cartographer內部使用這個文件就夠了。如果你還想把它轉成ROS的.pgm.yaml地圖給map_server或Navigation棧用那還需要額外轉換工具步驟比較繁瑣。這里我只講Cartographer自身定位因為它最能發(fā)揮這套系統(tǒng)閉環(huán)優(yōu)化的優(yōu)勢。5.3 定位模式的配置pure_localization與初始位姿定位模式的launch通常是從建圖launch改過來的。關鍵步驟復制一份建圖用的lua比如my_2d.lua在里面找到-- pure_localization相關的字段不同版本寫法略有差異但核心是pure_localization true同時確保把建圖相關的“新建子圖”邏輯關掉。在launch文件里給cartographer_node增加一個參數(shù)用load_state_filename指定pbstream路徑例如node namecartographer_node pkgcartographer_ros typecartographer_node outputscreen param nameconfiguration_directory value$(find cartographer_ros)/configuration_files/ param nameconfiguration_basename valuemy_2d.lua/ param nameload_state_filename value/home/user/maps/my_map.pbstream/ /node啟動后在rviz里用2D Pose Estimate給一個大約的初始位姿。這一步是必須的系統(tǒng)無法自己猜出你在地圖的哪個位置。初始位姿給得越準匹配收斂越快。有一個非常常見的現(xiàn)象初始位姿給錯后定位直接跳到一個奇怪的地方隨后完全丟失。這不是算法壞了而是激光掃描匹配落在了錯誤的局部極值上。遇到這種情況重新給一次準確的初始位姿即可。定位模式下系統(tǒng)依然會發(fā)布/map、/scan_matched_points2、/submap_list等話題但地圖不會變了。你可以把定位節(jié)點當作一個“只輸出位姿的無地圖更新SLAM”這是理解它輸出結果的最快路徑。5.4 實測定位的漂移問題和排查順序純定位模式跑起來后漂移是最常見的抱怨。我的排查順序是先看TF樹。map - odom - base_link這條鏈路必須完整。如果odom來自輪式里程計它的漂移會影響整個系統(tǒng)的穩(wěn)定性如果odom完全沒有輸出定位很難跑好。確認IMU方向。IMU的坐標系和朝向必須和建圖時一致否則算法對姿態(tài)的信念會錯位。這點在建圖時不明顯因為建圖容忍度大定位時初始狀態(tài)高度依賴姿態(tài)一錯就崩。驗證初始位姿。不要相信模糊的“大概在那個方向”。先對比rviz里激光點云和地圖的墻體重合情況再確認位姿發(fā)布的方向角對不對?？磪?shù)是否和建圖時一致。定位時使用的地圖是之前建圖參數(shù)下產生的如果傳感器內外參、max_range這些和建圖時相差太大算法會“讀不懂”激光數(shù)據(jù)。定位模式跑穩(wěn)之后會明顯感受到它和建圖的區(qū)別地圖不再增長但軌跡和位姿依然實時更新小范圍繞圈幾乎不漂長距離勻速跑會有累積誤差但一般比純輪式里程計要準得多。6. 編譯和運行過程中的高頻報錯附排查思路6.1 編譯期報錯版本沖突類編譯期報錯大多集中在依賴版本上沒有太多“靈丹妙藥”但常見問題可以快速定位fatal error: absl/strings/...abseil缺失或版本不對。檢查src目錄下有沒有abseil-cpp倉庫重新執(zhí)行wstool update -t src后再編譯。如果系統(tǒng)里裝了libabsl-dev先卸掉再編。Could not find a package configuration file provided by cartographer核心庫沒編譯成功或者install_isolated路徑沒有正確加載。確認source install_isolated/setup.bash執(zhí)行過再重新編譯cartographer_ros。protobuf相關錯誤比如*.pb.h文件過舊或缺失重新執(zhí)行sudo src/cartographer/scripts/install_proto3.sh確認/usr/local/bin/protoc版本和Cartographer要求一致。不要隨手apt install protobuf-compiler去覆蓋它。6.2 運行期報錯話題、TF樹、數(shù)據(jù)不匹配跑demo時報錯先分清是數(shù)據(jù)問題還是配置問題Message dropped: No match for time stamp時間戳不匹配常見原因是bag里的話題時間戳跳變或者沒有設置use_sim_time: true。官方launch已經設置了use_sim_time如果你自己手寫launch很容易漏掉。No transform from [map] to [base_link]TF樹斷鏈。先跑rosrun tf tf_echo map base_link看輸出是否正常。如果output報錯說明某個TF沒有發(fā)布。2D建圖、3D建圖、定位都依賴URDF和TF樹這一步是排查的重中之重。rviz里沒有任何點云檢查話題名。/scan、/points2、/imu的話題名有任何一處和launch配置不一致都可能導致數(shù)據(jù)沒有被訂閱。用rostopic list對比一下就知道。6.3 建圖/定位效果差的排查順序效果類問題比報錯難查因為系統(tǒng)不會直接告訴你哪里不對。我的順序一般是先確認數(shù)據(jù)質量。rosbag play --pause暫停后在rviz里檢查當前時刻的激光點云有沒有抖動、跳變、測距噪聲。再確認傳感器外參。雷達安裝位置和IMU的坐標變換如果差了幾厘米室內環(huán)境可能看不出來走廊或門框邊上就會暴露問題。然后調整前端匹配和后端優(yōu)化的參數(shù)。但記住參數(shù)是“錦上添花”不是“無中生有”。數(shù)據(jù)質量太差時參數(shù)怎么調都沒用。最后才是看回環(huán)檢測閾值、優(yōu)化頻率這類細節(jié)參數(shù)。很多初學者一上來就先改min_score結果越改越亂就是因為跳過了前面的步驟。定位效果差時優(yōu)先懷疑初始位姿和坐標系其次再懷疑參數(shù)。定位對環(huán)境和地圖的匹配要求比建圖更苛刻地圖舊了、環(huán)境變了定位質量下降是正?，F(xiàn)象不是算法出了問題。Cartographer這套東西我第一次從零到跑通2D花了一整天3D又花了一整天?；剡^頭看最大的感受是先跑通官方bag再碰自己的傳感器。拿自己小車的數(shù)據(jù)直接上很容易把參數(shù)問題、數(shù)據(jù)問題、硬件問題混在一起最后卡到懷疑人生。建議你第一次就老老實實用官方數(shù)據(jù)包把建圖、回環(huán)、定位機制都看明白再一步步替換成自己的數(shù)據(jù)。遇到報錯時先把launch、lua、TF這三樣理一遍八成問題都出在這里。Cartographer的版本更新不算快但它的2D/3D建圖和定位能力依然是移動機器人項目里的可靠選擇值得花時間吃透。