1. 從雷達(dá)原始數(shù)據(jù)到可導(dǎo)航地圖的整體鏈路拆解Mid-360 這類固態(tài)激光雷達(dá)在近兩年成了移動機(jī)器人和小型無人平臺上的?？腕w積小、點頻高、非重復(fù)掃描的特性讓它在室內(nèi)外過渡場景里表現(xiàn)相當(dāng)能打。但很多人拿到雷達(dá)、跑通 FAST-LIO 之后會卡在同一個地方手里只有一個.pcd點云文件離真正能喂給 ROS 導(dǎo)航棧的二維柵格地圖還差著十萬八千里。這篇內(nèi)容就是把這中間的“八千里路”一步步走完——從 FAST-LIO 建圖輸出到 PCL 濾波降噪再到 GIMP 手工后處理最后落到 ROS 導(dǎo)航能直接加載的地圖文件。先說清楚這套流程適合誰。如果你剛接觸 ROS手里有 Mid-360 或者類似雷達(dá)想跑一遍完整的 SLAM 建圖到導(dǎo)航地圖生成的鏈路那這篇就是給你寫的。如果你已經(jīng)會跑 FAST-LIO但每次生成的地圖要么噪點滿天飛、要么墻是斷的、要么導(dǎo)航時機(jī)器人老撞“幽靈障礙”那這篇同樣對你有用。整套鏈路的核心關(guān)鍵詞就是Mid-360、ROS、FAST-LIO、PCL、GIMP我會把每個環(huán)節(jié)為什么這么做、參數(shù)怎么定、坑在哪里都講透。整體思路其實不復(fù)雜一句話概括FAST-LIO 負(fù)責(zé)把雷達(dá)幀拼成三維點云PCL 負(fù)責(zé)把點云里的噪聲和冗余砍掉GIMP 負(fù)責(zé)把剩下的點云“描”成干凈的二維圖ROS 負(fù)責(zé)把這張圖變成導(dǎo)航能吃的格式。為什么不是一步到位全自動因為純自動的二維投影往往會把該保留的細(xì)節(jié)抹掉、把該去掉的拖影留下人工介入這一步在現(xiàn)階段依然是性價比最高的選擇。下面我按這條鏈路逐段拆。1.1 為什么選 FAST-LIO 而不是別的 SLAM 方案Mid-360 是 Livox 系列的固態(tài)雷達(dá)它的掃描方式和傳統(tǒng)機(jī)械旋轉(zhuǎn)雷達(dá)完全不同——不是一圈一圈掃而是花瓣狀的非重復(fù)掃描。這種掃描方式在靜止時點云會逐漸填滿視場運動時靠時間累積補點。FAST-LIO 這套緊耦合的激光慣性里程計恰好能吃透這種特性它把 IMU 和激光點云在同一個濾波器里做融合對非重復(fù)掃描的雷達(dá)特別友好。對比一下常見方案LOAM 系列對機(jī)械雷達(dá)調(diào)參成熟但對 Mid-360 這種非重復(fù)掃描支持一般LIO-SAM 依賴回環(huán)和 GPS室內(nèi)純激光場景下不如 FAST-LIO 直接Cartographer 的 2D 建圖在三維雷達(dá)上要先降維信息損失大。所以如果你的雷達(dá)是 Mid-360FAST-LIO 基本是當(dāng)前社區(qū)里最省心的選擇建圖漂移小、實時性好跑完直接吐.pcd。1.2 整條鏈路的分工與數(shù)據(jù)流把鏈路拆成四段每段的輸入輸出都很明確階段工具輸入輸出核心任務(wù)建圖FAST-LIO雷達(dá)IMU 原始數(shù)據(jù)三維點云.pcd拼接、去畸變、位姿估計濾波PCL三維點云降噪后點云去離群點、降采樣、裁剪后處理GIMP點云投影圖二維柵格圖描邊、補洞、去拖影落地ROS二維圖.pgm.yaml導(dǎo)航棧加載這個分工的邏輯是能用算法自動做的盡量自動做算法做不干凈的交給人工。PCL 濾波能去掉大部分統(tǒng)計意義上的噪聲但比如玻璃反射造成的“幽靈墻”、動態(tài)行人留下的拖影這些語義層面的東西算法很難判斷GIMP 手工描一遍反而更快更準(zhǔn)。2. FAST-LIO 建圖環(huán)節(jié)的關(guān)鍵細(xì)節(jié)與實操建圖這一步?jīng)Q定了后面所有工作的上限。點云質(zhì)量差后面濾波和后處理都是白搭。很多人建圖時覺得“跑通了就行”結(jié)果后面花幾倍時間擦屁股。這里把建圖階段真正影響成圖質(zhì)量的幾個點講清楚。2.1 環(huán)境準(zhǔn)備與依賴安裝的穩(wěn)妥路徑ROS 環(huán)境這塊Ubuntu 20.04 配 Noetic 是目前最穩(wěn)的組合Mid-360 的驅(qū)動和 FAST-LIO 在這個組合上社區(qū)驗證最充分。Ubuntu 22.04 配 Humble 也能跑但部分依賴包的版本兼容性需要自己處理新手不建議一上來就挑戰(zhàn)。安裝 ROS 本身如果嫌官方流程繁瑣社區(qū)里流傳的“魚香 ROS 一鍵安裝”腳本確實能省不少事它把源配置、依賴安裝、環(huán)境變量這些瑣碎步驟打包了實測下來對新手很友好。但要注意一鍵腳本裝完之后一定要手動驗證roscore能不能正常起來別裝完就以為萬事大吉。FAST-LIO 的依賴主要是 Eigen、PCL、livox_ros_driver2。這里有個坑livox_ros_driver 和 livox_ros_driver2 不兼容Mid-360 必須用 driver2如果你之前裝過老版本驅(qū)動先把老的工作空間清理干凈否則編譯時會報一堆找不到符號的錯誤。PCL 的安裝建議直接用apt裝預(yù)編譯版本自己源碼編譯 PCL 在 Ubuntu 上很容易因為 VTK 版本問題卡住除非你有特殊需求否則沒必要折騰。sudo apt install libpcl-dev pcl-tools裝完用pcl_viewer隨便打開一個點云文件驗證一下能彈出窗口就說明 PCL 環(huán)境沒問題。2.2 雷達(dá)與 IMU 的外參標(biāo)定不能偷懶FAST-LIO 對雷達(dá)和 IMU 之間的外參比較敏感尤其是旋轉(zhuǎn)部分。Mid-360 內(nèi)置了 IMU理論上出廠已經(jīng)標(biāo)定過但如果你是把雷達(dá)裝在減震平臺上、或者 IMU 和雷達(dá)有相對位移那外參就必須重新標(biāo)。外參錯了會有什么表現(xiàn)建圖時墻面會出現(xiàn)明顯的“重影”走一圈回來閉環(huán)對不上點云整體是斜的。標(biāo)定思路是先確認(rèn)雷達(dá)和 IMU 的坐標(biāo)系定義Mid-360 的 IMU 坐標(biāo)系和雷達(dá)坐標(biāo)系原點基本重合主要標(biāo)的是安裝角度的微小偏差。實操上可以用手眼標(biāo)定或者簡單的平面擬合來估。如果你只是做室內(nèi)低速建圖用出廠默認(rèn)外參通常夠用但如果是車載或者有振動的平臺建議老老實實標(biāo)一遍。標(biāo)定完把參數(shù)寫進(jìn) FAST-LIO 的 config 文件里extrinsic_R和extrinsic_T這兩個字段別填錯。2.3 FAST-LIO 配置文件里真正要調(diào)的參數(shù)FAST-LIO 的 config 文件參數(shù)一大堆但真正影響成圖質(zhì)量的就那么幾個。我按重要性排一下lidar_typeMid-360 要設(shè)成對應(yīng)的類型填錯直接沒點云。scan_lineMid-360 不是按線掃的這個參數(shù)按官方示例填。blind_spot盲區(qū)一般設(shè) 0.5 米左右太近的點噪聲大。filter_size_surf/filter_size_map降采樣尺寸這兩個直接決定點云密度和建圖速度。室內(nèi)場景我一般設(shè) 0.2 到 0.3太小了計算量大太大了墻面細(xì)節(jié)丟失。max_iteration迭代次數(shù)默認(rèn) 3 一般夠漂移嚴(yán)重可以加到 5。注意filter_size_map設(shè)得太小會讓地圖文件爆炸一個幾百平米的室內(nèi)場景能生成好幾個 G 的點云后面 PCL 處理時內(nèi)存直接吃滿。室內(nèi)建圖 0.2 到 0.3 是比較平衡的值。2.4 建圖過程中的操作要領(lǐng)建圖不是拿著雷達(dá)隨便走一圈就完事。想要成圖質(zhì)量高走位有講究第一起步要慢。FAST-LIO 初始化需要一段時間的靜止或者緩慢運動來讓 IMU 收斂一上來就快速移動初始位姿估計會飄整張圖從起點就是歪的。我一般讓設(shè)備靜止 5 到 10 秒再開始走。第二避免純旋轉(zhuǎn)。固態(tài)雷達(dá)在純旋轉(zhuǎn)時點云覆蓋會變差盡量保持邊走邊轉(zhuǎn)讓雷達(dá)視場不斷有新的幾何約束。第三回環(huán)要走到。雖然 FAST-LIO 本身不帶回環(huán)檢測但走回起點能讓點云在空間上重疊方便你后面判斷漂移程度。如果走一圈回來發(fā)現(xiàn)起點和終點的墻錯開了十幾厘米那說明漂移已經(jīng)比較明顯要么重新建要么后面靠 GIMP 硬修。第四動態(tài)物體盡量避開。建圖時前面走個人點云里就會留下一串“人影拖影”這種噪聲 PCL 的統(tǒng)計濾波很難完全去掉因為它在局部也是“密集”的。建圖時盡量選人少的時間段或者讓人別在雷達(dá)正前方晃。建完圖FAST-LIO 會把點云保存成.pcd文件。這時候先用pcl_viewer打開看一眼心里有個底噪聲多不多、有沒有明顯拖影、墻面直不直。3. PCL 濾波降噪的實操與參數(shù)計算拿到.pcd之后下一步是用 PCL 把噪聲砍掉。這一步的目標(biāo)很明確去掉離群點、降低點云密度、裁剪掉不需要的區(qū)域讓點云變得“干凈且輕量”方便后面投影成二維圖。3.1 PCL 環(huán)境驗證與常見報錯處理在動手寫濾波代碼之前先確認(rèn) PCL 工具鏈能用。有個很典型的報錯很多人會遇到loading map.pcd [pcl::PCDReader::readHeader] height given (0) but no width!這個報錯的意思是 PCD 文件的頭信息里height和width字段不合法。正常的有序點云height是行數(shù)、width是列數(shù)無序點云height應(yīng)該是 1、width是點數(shù)。出現(xiàn)這個報錯通常是文件頭被寫壞了或者用了不兼容的 PCD 格式。解決辦法是用pcl_convert_pcd_ascii_binary轉(zhuǎn)一下格式或者直接用文本編輯器打開.pcd文件手動把頭部改成HEIGHT 1和正確的WIDTH值。這個坑我在處理 FAST-LIO 輸出的點云時踩過好幾次尤其是點云特別大的時候?qū)懭脒^程出問題就會留下壞頭。3.2 統(tǒng)計濾波去離群點的原理與參數(shù)統(tǒng)計濾波Statistical Outlier Removal是去噪的主力。它的原理是對每個點找它最近的 K 個鄰居算這些鄰居的平均距離然后看這個平均距離是否超過全局均值加若干倍標(biāo)準(zhǔn)差。超過的就判定為離群點刪掉。參數(shù)就兩個MeanK和StddevMulThresh。MeanK是鄰居數(shù)量一般設(shè) 20 到 50StddevMulThresh是標(biāo)準(zhǔn)差倍數(shù)閾值設(shè) 1.0 到 2.0。這兩個參數(shù)怎么定我的經(jīng)驗是點云密度高比如filter_size_map設(shè)得小MeanK可以設(shè)大一點30 到 50。噪聲多、拖影明顯StddevMulThresh設(shè)小一點1.0 左右刪得狠一些。如果發(fā)現(xiàn)墻面被刪出洞了說明閾值太嚴(yán)往上調(diào)到 1.5 到 2.0。pcl::StatisticalOutlierRemovalpcl::PointXYZ sor; sor.setInputCloud(cloud); sor.setMeanK(30); sor.setStddevMulThresh(1.0); sor.filter(*cloud_filtered);3.3 體素降采樣的尺寸選擇邏輯體素降采樣Voxel Grid是把空間劃分成小立方體每個立方體里只保留一個代表點。這一步的目的是降低點云密度減小文件體積同時讓點云分布更均勻。體素尺寸怎么定這直接關(guān)系到后面二維圖的精度。如果你最終要生成分辨率 0.05 米每像素的柵格圖那體素尺寸設(shè) 0.05 到 0.1 米比較合適。設(shè)得比地圖分辨率還小降采樣沒意義設(shè)得太大墻面會變得稀疏投影成二維圖時墻會斷斷續(xù)續(xù)。pcl::VoxelGridpcl::PointXYZ vg; vg.setInputCloud(cloud_filtered); vg.setLeafSize(0.1f, 0.1f, 0.1f); vg.filter(*cloud_downsampled);3.4 直通濾波裁剪與高度切片建圖時難免會把天花板、地面、以及一些不關(guān)心的區(qū)域也掃進(jìn)去。直通濾波PassThrough可以按坐標(biāo)軸裁剪。對于導(dǎo)航地圖我們通常只關(guān)心機(jī)器人高度范圍內(nèi)的障礙物比如地面以上 0.1 米到 2 米這個區(qū)間。pcl::PassThroughpcl::PointXYZ pass; pass.setInputCloud(cloud_downsampled); pass.setFilterFieldName(z); pass.setFilterLimits(0.1, 2.0); pass.filter(*cloud_cropped);這里有個關(guān)鍵點Z 軸的方向要和你的建圖坐標(biāo)系對齊。FAST-LIO 輸出的點云 Z 軸通常是豎直向上的但如果你建圖時初始位姿有傾斜Z 軸就不是嚴(yán)格豎直切片會切歪。所以切片前最好先確認(rèn)一下點云的坐標(biāo)系朝向必要時先做一次姿態(tài)校正。3.5 完整濾波流程的串聯(lián)與驗證把上面幾步串起來一個完整的濾波流程是讀入點云 → 統(tǒng)計濾波去離群點 → 體素降采樣 → 直通濾波裁剪 → 保存。每一步做完都用pcl_viewer看一眼確認(rèn)效果符合預(yù)期再往下走。別一口氣跑完再看出了問題都不知道是哪一步的鍋。濾波完的點云應(yīng)該滿足墻面連續(xù)、沒有明顯孤立的漂浮點、文件體積在可接受范圍室內(nèi)場景一般幾十兆到一兩百兆。如果濾波后墻面出現(xiàn)大量空洞說明統(tǒng)計濾波太狠或者體素太大回去調(diào)參數(shù)。4. GIMP 后處理把三維點云變成干凈二維圖濾波后的點云還是三維的要變成導(dǎo)航用的二維柵格圖需要先投影再用 GIMP 手工修。這一步是整套流程里最“手工”的部分但也是最能把地圖質(zhì)量拉開差距的地方。4.1 點云投影成二維圖的兩種方式投影方式有兩種一種是直接用 PCL 把點云按 Z 軸壓扁生成一張俯視圖另一種是用octomap或者map_server相關(guān)的工具生成占據(jù)柵格。對于手工后處理我推薦第一種因為生成的是一張灰度圖GIMP 處理起來直觀。投影的思路是把三維點云的 X、Y 坐標(biāo)映射到圖像的像素坐標(biāo)Z 值忽略或者用高度做灰度。投影完你會得到一張黑白點圖點密集的地方是障礙物空白的地方是自由空間。投影時要注意分辨率和范圍。分辨率一般設(shè) 0.05 米每像素這是 ROS 導(dǎo)航的常用值。范圍要覆蓋你建圖的整個區(qū)域別投影完發(fā)現(xiàn)邊緣被裁掉了。4.2 GIMP 描邊與補洞的核心操作投影出來的圖通常是“點狀”的墻是一排排離散的點不是連續(xù)的線。GIMP 要做的就是把這些點連成線、把洞補上、把拖影擦掉。具體操作流程打開投影圖先調(diào)整對比度讓點更明顯。用閾值工具把灰度圖轉(zhuǎn)成黑白二值圖點變成純黑背景純白。用畫筆工具描邊沿著墻的點跡畫黑線把斷開的墻連起來。畫筆大小根據(jù)墻的厚度定一般 3 到 5 像素。用橡皮擦去拖影動態(tài)物體留下的拖影、玻璃反射的幽靈點手動擦掉。補洞門洞、窗洞這些該通的地方要保持白色不該通的縫隙用黑色補上。提示GIMP 里善用圖層。把原始投影圖放一個圖層描邊放另一個圖層這樣隨時可以對照原始點跡檢查有沒有描歪。描邊圖層用純黑背景圖層保持白色最后導(dǎo)出時只導(dǎo)出這兩個圖層的合成結(jié)果。4.3 地圖格式轉(zhuǎn)換與 ROS 導(dǎo)航加載GIMP 處理完導(dǎo)出成.pgm或者.png然后需要配一個.yaml文件告訴 ROS 這張圖的分辨率、原點位置、占據(jù)閾值。.yaml的格式是這樣的image: map.pgm resolution: 0.05 origin: [-10.0, -10.0, 0.0] negate: 0 occupied_thresh: 0.65 free_thresh: 0.196origin是地圖左下角在真實世界坐標(biāo)系里的位置這個值要和建圖時的坐標(biāo)系對齊填錯了導(dǎo)航時機(jī)器人會以為自己在錯誤的位置。resolution要和投影時的分辨率一致。occupied_thresh和free_thresh是灰度閾值決定多黑的像素算障礙物、多白的算自由空間。配好之后用map_server加載測試rosrun map_server map_server map.yaml然后在 RViz 里加一個 Map 顯示看看地圖能不能正常顯示、障礙物位置對不對。4.4 地圖質(zhì)量的自檢清單一張合格的導(dǎo)航地圖應(yīng)該滿足這些條件墻面連續(xù)沒有大段斷裂。沒有孤立的漂浮障礙物幽靈點。門洞、通道保持暢通沒有被誤判為障礙。地圖邊界清晰沒有超出實際范圍的空白區(qū)域。分辨率與.yaml一致加載后尺寸正確。如果地圖加載后機(jī)器人規(guī)劃路徑時老是繞遠(yuǎn)路或者卡住多半是地圖里有幽靈障礙或者通道被堵了回 GIMP 里檢查。5. 常見問題排查與避坑經(jīng)驗實錄這套流程跑下來坑主要集中在幾個地方。我把踩過的和社區(qū)里高頻出現(xiàn)的問題整理成速查表方便對照排查。5.1 建圖與濾波階段的典型問題問題現(xiàn)象可能原因排查與解決FAST-LIO 跑起來沒點云雷達(dá)驅(qū)動版本不對確認(rèn)用 livox_ros_driver2檢查話題名建圖墻面重影外參不準(zhǔn)或 IMU 未收斂重新標(biāo)定外參起步放慢點云文件巨大filter_size_map太小調(diào)到 0.2 到 0.3PCD 讀取報 height/width 錯誤文件頭損壞手動改頭或用工具轉(zhuǎn)格式濾波后墻面大量空洞統(tǒng)計濾波太嚴(yán)調(diào)大StddevMulThresh點云整體傾斜初始位姿有傾角建圖起步時確保設(shè)備水平5.2 后處理與導(dǎo)航加載的典型問題問題現(xiàn)象可能原因排查與解決地圖加載后位置偏移.yaml的 origin 填錯核對建圖坐標(biāo)系原點導(dǎo)航時機(jī)器人撞幽靈障礙拖影未清理干凈回 GIMP 擦除地圖分辨率不對投影分辨率與 yaml 不一致統(tǒng)一設(shè) 0.05通道被堵描邊時誤連檢查門洞區(qū)域地圖顯示模糊導(dǎo)出格式有壓縮用 pgm 無損格式5.3 幾條用血淚換來的實操心得第一建圖階段多花十分鐘后處理省兩小時。建圖時走位規(guī)范、避開動態(tài)物體后面 PCL 和 GIMP 的工作量能少一大半。我見過太多人建圖時圖快結(jié)果點云里全是拖影GIMP 里擦到懷疑人生。第二PCL 濾波參數(shù)沒有萬能值。每個場景的點云密度、噪聲分布都不一樣別人給的參數(shù)只能當(dāng)起點。我的習(xí)慣是先用一組保守參數(shù)跑一遍看效果再逐步調(diào)整每次只調(diào)一個參數(shù)這樣才能搞清楚每個參數(shù)的實際影響。第三GIMP 描邊別追求完美。導(dǎo)航地圖不需要像素級精確墻面大概連續(xù)、通道暢通就夠了?；ù罅繒r間把每個點都描得嚴(yán)絲合縫性價比很低。抓住主要結(jié)構(gòu)細(xì)節(jié)差不多就行。第四地圖做完一定要在仿真里先跑一遍。別直接上真車。用 Gazebo 或者簡單的 RViz 仿真讓機(jī)器人在新地圖上規(guī)劃幾條路徑看看有沒有明顯問題。這一步能提前發(fā)現(xiàn)大部分地圖缺陷避免真車撞墻。第五養(yǎng)成版本管理的習(xí)慣。每次調(diào)整參數(shù)或者 GIMP 修改都另存一個版本文件名帶上日期和關(guān)鍵參數(shù)。地圖這東西經(jīng)常需要回退沒有版本管理會非常痛苦。5.4 關(guān)于工具鏈版本選擇的補充ROS 版本和 Ubuntu 版本的搭配目前社區(qū)驗證最充分的是 Ubuntu 20.04 Noetic。Ubuntu 22.04 Humble 也能用但 Mid-360 驅(qū)動和 FAST-LIO 在 Humble 上的適配資料相對少一些遇到問題查起來費勁。如果你是新手強(qiáng)烈建議從 20.04 Noetic 起步把整條鏈路跑通之后再考慮升級環(huán)境。PCL 的版本同理apt裝的預(yù)編譯版本雖然舊一點但穩(wěn)定。自己編譯最新版 PCL 在 Ubuntu 上經(jīng)?？ㄔ?VTK 和 Boost 的版本沖突上除非你有明確的版本需求否則沒必要折騰。內(nèi)存方面跑 FAST-LIO 建圖加 PCL 處理建議至少 16G 內(nèi)存。點云文件大的時候PCL 濾波會吃掉大量內(nèi)存8G 的機(jī)器很容易在降采樣那一步卡死。如果內(nèi)存實在緊張可以在濾波前先用命令行工具把點云裁小一點再處理。整套流程走下來從 Mid-360 原始數(shù)據(jù)到一張能用的 ROS 導(dǎo)航地圖熟練之后大概兩三個小時能搞定一個中等規(guī)模的室內(nèi)場景。其中建圖占三分之一時間PCL 濾波占三分之一GIMP 后處理占三分之一。隨著經(jīng)驗積累GIMP 那部分會越來越快因為你會逐漸知道哪些地方必須修、哪些地方可以放過。地圖質(zhì)量這東西最終還是要靠實際導(dǎo)航效果來檢驗仿真里跑得順、真車上不撞就是好地圖。