MA-LIO
MA-LIO 處理多顆非同步、視野與掃描樣式不同的 LiDAR:先以 IMU 離散模型傳播位姿與共變異數,再以 B 樣條內插求得任一點取樣時刻的位姿,把各 LiDAR 的點去畸變並轉換到最後一顆 LiDAR 最新點的座標系,因此不需嚴格硬體同步也不依賴 LiDAR 間重疊。每個點依取樣時刻(狀態共變異數)與距離傳播出點級不確定度,用於加權點到平面殘差與決定是否存入 ikd-Tree 地圖;另以量測法向量奇異值比計算定位權重,在隧道或窄走廊等退化場景中提高 IMU 先驗的比重。狀態估計採迭代誤差狀態卡爾曼濾波。
本頁內容
Asynchronous multi-LiDAR inertial odometry that uses IMU propagation with B-spline interpolation to deskew and time-align points from LiDARs with different scan patterns, propagates point-wise uncertainty from acquisition-time state covariance and range to weight point-to-plane residuals and filter map insertion, and applies a degeneracy-dependent localization weight within an iterated error-state Kalman filter with ikd-Tree mapping.
技術屬性
欄位內容為文獻擷取紀錄的原文用語(英文),以原文為據;「未查證」表示本研究尚未讀到該資訊,不代表該方法不具備此能力。
| 感測輸入 | multiple asynchronous 3D LiDARs of different makes and scan patterns (Ouster OS0-64 plus Livox; Velodyne HDL-32E, VLP-16 and LS-16C; Ouster OS2-128 plus Livox Avia and Livox Tele)、IMU (100 to 400 Hz; models not stated) |
|---|---|
| 原文測試平台 | handheld (Hilti SLAM Dataset 2021)、vehicle (UrbanNav Hong Kong; authors' city dataset up to about 50 km/h) |
| 狀態估計 | iterated error-state Kalman filter on manifold (FAST-LIO2 style) whose state includes each LiDAR-IMU extrinsic; measurement residuals weighted by point-wise uncertainty rescaled with fixed interval conversion, and a localization weight from the singular values of measurement normals that shifts weight to the IMU prior in degenerate scenes (Sec. II-A, II-E, II-F) |
| 資料關聯 | direct point-to-plane: five nearest neighbours in the ikd-Tree define a local plane whose covariance is a weighted sum of neighbour point covariances (Sec. II-E) |
| 時間表示 | discrete IMU propagation with covariance, plus cumulative B-spline interpolation over four propagated poses to obtain pose and covariance at any point time (Sec. II-B) |
| 去畸變 | B-spline interpolated IMU poses undistort every LiDAR's points to its latest point time and then compensate inter-LiDAR temporal offsets by transforming them to the latest point of the latest LiDAR (Sec. II-C) |
| 迴圈閉合 | none |
| 全域最佳化 | none |
| 地圖表示 | ikd-Tree point map storing only points whose propagated uncertainty trace is below a threshold, with downsampling that keeps low-uncertainty points near voxel centres (Sec. II-G) |
| 先驗資訊 | LiDAR-IMU extrinsics in the state; a set of LiDARs chosen to minimize arrival-time differences (Sec. II-A, II-C) |
| 可輸出幾何 | odometry and a merged multi-LiDAR point map (Figs. 1, 6) |
| 計算需求 | real time: 28.1 to 47.7 ms per scan on Whampoa with 1 to 3 LiDARs and 46.4 to 79 ms on City01 with 1 to 3 LiDARs on an Intel i7 CPU at 2.50 GHz with 48 GB RAM; point-wise uncertainty at most 5 ms (Table VI, Sec. III-F) |
使用設備
原文使用的感測器、運算硬體與載具(equipment)。型號保留原文寫法,連結到設備頁中同一型號的歸併名稱;角色依原文用途分為方法輸入、資料集感測器、執行運算平台、參考或真值量測(reference or ground truth)與比較對象設備。
| 類別 | 型號(原文寫法) | 角色 | 資料集 | 原文規格 | 出處 |
|---|---|---|---|---|---|
| LiDAR | Ouster OS0-64 | 資料集感測器 | Hilti SLAM Dataset 2021 | 原文未報告 | (Jung et al., 2023, Table I; Sec. III-A) |
| LiDAR | Livox Horizon (as written in Table I)歸入:Livox Horizon | 資料集感測器 | Hilti SLAM Dataset 2021 | limited FOV | (Jung et al., 2023, Table I; Fig. 4) |
| LiDAR | Velodyne HDL-32E | 資料集感測器 | UrbanNav | central LiDAR | (Jung et al., 2023, Table I; Table VI) |
| LiDAR | Velodyne VLP-16 | 資料集感測器 | UrbanNav | inclined side LiDAR | (Jung et al., 2023, Table I; Sec. III-C) |
| LiDAR | LS-16C (written LS-C16 in Table VI) | 資料集感測器 | UrbanNav | inclined side LiDAR | (Jung et al., 2023, Table I; Table VI) |
| LiDAR | Ouster OS2-128 | 方法輸入 | MA-LIO city dataset (City01-03) | central LiDAR | (Jung et al., 2023, Table I; Table VI) |
| LiDAR | Livox Avia | 方法輸入 | MA-LIO city dataset (City01-03) | 原文未報告 | (Jung et al., 2023, Table I) |
| LiDAR | Livox Tele | 方法輸入 | MA-LIO city dataset (City01-03) | 原文未報告 | (Jung et al., 2023, Table I) |
| 慣性量測單元(IMU) | IMU at 200 Hz (model not stated) | 資料集感測器 | Hilti SLAM Dataset 2021 | 200 Hz | (Jung et al., 2023, Table I) |
| 慣性量測單元(IMU) | IMU at 400 Hz (model not stated) | 資料集感測器 | UrbanNav | 400 Hz | (Jung et al., 2023, Table I) |
| 慣性量測單元(IMU) | IMU at 100 Hz (model not stated) | 方法輸入 | MA-LIO city dataset (City01-03) | 100 Hz; sensors time-referenced with PTP but not fired simultaneously | (Jung et al., 2023, Table I; Sec. III-A) |
| GNSS 接收器 | Inertial Navigation System (model not stated) | 參考或真值量測 | MA-LIO city dataset (City01-03) | ground truth using only positions with status INS SOLUTION FREE | (Jung et al., 2023, Sec. III-A) |
| 載具平台 | vehicle | 方法輸入 | MA-LIO city dataset (City01-03) | up to about 50 km/h, U-turns and a 400 m tunnel | (Jung et al., 2023, Sec. III-A; Sec. III-D) |
| 載具平台 | hand-held system (Hilti SLAM Dataset 2021) | 資料集感測器 | Hilti SLAM Dataset 2021 | small-scale indoor and outdoor environments | (Jung et al., 2023, Sec. III-A-1) |
| 運算硬體 | Intel i7 CPU @ 2.50 GHz (model not stated) | 執行運算平台 | 未標示 | 48 GB RAM | (Jung et al., 2023, Table VI) |
作者報告的優勢與限制
優勢
- Lowest ATEt on four of the five evaluated Hilti 2021 sequences and tied with LOCUS 2.0 on UZH (0.177 m), including Construct (0.063 m versus 0.088 m for FAST-LIO2 with the Ouster alone) (Table II)
- On UrbanNav, lowest ATEt on Mongok, Whampoa and TST (2.579, 4.236, 2.342 m) versus FAST-LIO2 5.917, 7.066, 8.783 m (Table III)
- On the authors' high-speed city data, City02 with a 400 m tunnel had ATEt 6.707 m versus 35.308 m for FAST-LIO2 and 72.382 m for M-LOAM (Table IV)
- Point-wise uncertainty was the most influential component in the ablation and enabled consistent mapping with the narrow-FOV Livox in the LAB sequence where the baseline failed (Table V, Fig. 7)
- Works with any combination of LiDAR makes and scanning patterns without strict hardware synchronization (Sec. I, III)
限制
- Adding a third LiDAR brought little gain when it overlapped strongly with the second; LiDAR placement matters (Sec. III-F, Fig. 10)
- On TST the uncertainty module slightly degraded accuracy relative to RAW because an inclined LiDAR became the primary one (Table V, Sec. III-E)
- B-spline undistortion is done before downsampling and dominates part of the runtime (Sec. III-F)
- Continuous-time terms are not included in the optimization for real-time reasons (Sec. I)
- No loop closure; own-dataset ground truth only uses INS positions with a particular solution status (Sec. III-A)
營建工程相關證據
Hilti SLAM Dataset 2021 的 Construct 序列(依名稱對應資料集中的 Construction Site 序列,推論)為營建工地,MA-LIO 在此的 ATEt 為 0.063 m,優於只用 Ouster 的 FAST-LIO2(0.088 m)與其他多 LiDAR 方法(Table II);該評估使用資料集提供的評分器與參考點(Helmberger et al., 2022)。作者自建資料含約 400 m 隧道,定位權重可在退化段降低 LiDAR 殘差比重。多顆不同廠牌 LiDAR 非同步融合、以不確定度過濾地圖點,對需要擴大視野以涵蓋天花板、樓板與牆面的工地掃描平台有直接參考價值(推論)。
原文驗證環境:公開基準、施工中工地、地下或隧道、獨立參考量測、跨場域
報告的性能數據
以下是原文作者報告的性能數值(author-reported results),不是本研究重新量測的結果。每張圖只並列同一個比較組(comparison group,同一張表、同一組實驗設定)內的方法;不同比較組之間的數值不可直接比較,也不構成排名。
本方法共出現在 5 個比較組,合計 65 筆紀錄。以下列出本方法紀錄最多的 4 組,其餘 1 組列在最後,並連到性能比較頁。
Jung et al., 2023 · Table V 本方法 30 筆
指標ATEt
表格設定(擷取紀錄原文):Component ablation with ATEt: RAW (IMU discrete model, equal point weights), CNT (B-spline interpolation), F-UNC (single state covariance as in M-LOAM), UNC (point-wise uncertainty with localization weight), FULL (CNT + UNC) (Jung et al., 2023, Table V)
ATEt,MA-LIO city dataset (City01-03) · City01
只並列這張表在相同設定下報告的方法;以「本方法:」開頭者為本頁方法。失敗、未執行與未報告以標記呈現,不是 0。
按 Tab 進入圖表後,用上下方向鍵逐一瀏覽各類別,Esc 關閉提示框;也可開啟表格檢視閱讀全部數值。
這些是 Jung et al., 2023 在此表設定下報告的數值(author-reported results),只能在同一個比較組內對照,不代表方法在其他資料或設定下的表現。
資料來源作者報告值(Jung et al., 2023, Table V)
| 方法(原文寫法) | 報告值 | 出處 |
|---|---|---|
| MA-LIO RAW本方法 | 7.345 m | (Jung et al., 2023, Table V) |
| MA-LIO CNT本方法 | 7.28 m | (Jung et al., 2023, Table V) |
| MA-LIO F-UNC本方法 | 7.001 m | (Jung et al., 2023, Table V) |
| MA-LIO UNC本方法 | 6.831 m | (Jung et al., 2023, Table V) |
| MA-LIO FULL本方法原文提出 | 6.538 m | (Jung et al., 2023, Table V) |
Jung et al., 2023 · Table III 本方法 12 筆
表格設定(擷取紀錄原文):UrbanNav (HDL-32E central, VLP-16 and LS-16C inclined, 400 Hz IMU); RMSE of ATE and RTE via evo (Jung et al., 2023, Table III)
ATEt (RMSE via evo),UrbanNav · Mongok
只並列這張表在相同設定下報告的方法;以「本方法:」開頭者為本頁方法。失敗、未執行與未報告以標記呈現,不是 0。
按 Tab 進入圖表後,用上下方向鍵逐一瀏覽各類別,Esc 關閉提示框;也可開啟表格檢視閱讀全部數值。
這些是 Jung et al., 2023 在此表設定下報告的數值(author-reported results),只能在同一個比較組內對照,不代表方法在其他資料或設定下的表現。
資料來源作者報告值(Jung et al., 2023, Table III)
| 方法(原文寫法) | 報告值 | 出處 |
|---|---|---|
| Fast-LIO2 (central LiDAR only) | 5.917 m | (Jung et al., 2023, Table III) |
| M-LOAM | 25.899 m | (Jung et al., 2023, Table III) |
| LOCUS 2.0 | 6.846 m | (Jung et al., 2023, Table III) |
| Ours本方法原文提出 | 2.579 m | (Jung et al., 2023, Table III) |
Jung et al., 2023 · Table IV 本方法 12 筆
表格設定(擷取紀錄原文):Authors' city dataset (OS2-128, Livox Avia, Livox Tele, 100 Hz IMU, PTP time reference); INS ground truth; RMSE of ATE and RTE via evo (Jung et al., 2023, Table IV)
ATEt (RMSE via evo),MA-LIO city dataset (City01-03) · City01
只並列這張表在相同設定下報告的方法;以「本方法:」開頭者為本頁方法。失敗、未執行與未報告以標記呈現,不是 0。
按 Tab 進入圖表後,用上下方向鍵逐一瀏覽各類別,Esc 關閉提示框;也可開啟表格檢視閱讀全部數值。
這些是 Jung et al., 2023 在此表設定下報告的數值(author-reported results),只能在同一個比較組內對照,不代表方法在其他資料或設定下的表現。
資料來源作者報告值(Jung et al., 2023, Table IV)
| 方法(原文寫法) | 報告值 | 出處 |
|---|---|---|
| Fast-LIO2 (central LiDAR only) | 9.97 m | (Jung et al., 2023, Table IV) |
| M-LOAM | 33.907 m | (Jung et al., 2023, Table IV) |
| LOCUS 2.0 | 23.998 m | (Jung et al., 2023, Table IV) |
| Ours本方法原文提出 | 6.538 m | (Jung et al., 2023, Table IV) |
Jung et al., 2023 · Table VI 本方法 6 筆
指標Total time per scan
表格設定(擷取紀錄原文):Average processing time per scan versus number of LiDARs (0.4 m downsampling); totals only stored (Jung et al., 2023, Table VI)
Total time per scan,UrbanNav · Whampoa, 1 LiDAR (HDL-32E, 4045 points after downsampling)
這張表在此指標與資料序列只列出本方法一筆,沒有可並列的其他方法,因此不畫圖,數值與出處見下表。這是 Jung et al., 2023 在此表設定下報告的數值(author-reported results),不代表方法在其他資料或設定下的表現。
| 方法(原文寫法) | 報告值 | 出處 |
|---|---|---|
| MA-LIO本方法原文提出硬體:Intel i7 CPU @ 2.50 GHz, 48 GB RAM | 28.1 ms | (Jung et al., 2023, Table VI) |
其他比較組
列出其餘 1 個比較組
來源
Jung et al., 2023
(2023)Asynchronous Multiple LiDAR-Inertial Odometry Using Point-Wise Inter-LiDAR Uncertainty PropagationIEEE Robotics and Automation Letters, 8(7):4211-4218
DOI 10.1109/lra.2023.3281264arXiv 2305.16792程式碼
同儕審查已出版已讀全文近十年查證後修正
相關版本
- 預印本:arXiv 2305.16792 (v1 2023-05-26; v2 2023-11-07 with typo corrections recommended by the authors over the IEEE version) https://arxiv.org/abs/2305.16792
- correction statement in article:Repository README (update 2023-11-07) states the IEEE version contains typo errors and points to the revised arXiv version https://github.com/minwoo0611/MA-LIO
- 程式碼釋出:minwoo0611/MA-LIO https://github.com/minwoo0611/MA-LIO
程式碼:https://github.com/minwoo0611/MA-LIO(授權:GPL-2.0 (LICENSE file checked))。有公開程式碼不等於已被重現,也不代表目前版本與論文版本相同。