Degeneracy-aware factors
本文把退化感知延伸到位姿圖:點對面 ICP 每次迭代以最大與最小特徵值的比值(條件數)作為動態門檻,只沿受約束方向更新(沿用 Zhang 等人的解重映射);再把結果以部分迴圈閉合因子加入位姿圖,只約束 X、Y 與偏航,深度、俯仰與滾轉則交由深度計與航姿參考系統的先驗處理。作者以 DIDSON 聲納子地圖的水下建圖在模擬與實際資料驗證,顯示可抵抗導航漂移並拒絕退化環境中的不良迴圈閉合(Sec. III, IV)。
本頁內容
Degeneracy-aware ICP plus partially constrained loop-closure factors that only constrain well-conditioned directions in pose-graph SLAM.
技術屬性
欄位內容為文獻擷取紀錄的原文用語(英文),以原文為據;「未查證」表示本研究尚未讀到該資訊,不代表該方法不具備此能力。
| 感測輸入 | multibeam imaging sonar (DIDSON, 96 beams, profiling mode with a concentrator lens giving 1 degree vertical FOV)、DVL (Teledyne/RDI Workhorse Navigator, 1.2 MHz)、AHRS with Honeywell HG1700 IMU、depth sensor (Paroscientific Digiquartz) |
|---|---|
| 原文測試平台 | underwater vehicle (Bluefin HAUV)、simulation |
| 狀態估計 | pose-graph optimization with partially constrained loop-closure factors |
| 資料關聯 | degeneracy-aware point-to-plane ICP (PCL-based) with solution remapping between sonar submaps |
| 時間表示 | discrete poses |
| 去畸變 | 原文未報告 |
| 迴圈閉合 | ICP loop closures inserted as partial factors constraining only well-constrained directions |
| 全域最佳化 | pose graph optimization with the iSAM library (Euler-angle poses, 3-DoF XYH odometry factors, unary ZPR factors, partial loop-closure factors) |
| 地圖表示 | volumetric sonar submaps in a submap-based pose graph |
| 先驗資訊 | vehicle odometry from DVL and AHRS dead reckoning (X, Y, yaw drift); drift-free depth, pitch and roll from the depth sensor and AHRS appended as whitened prior rows to the ICP linear system and as unary ZPR factors in the pose graph |
| 可輸出幾何 | submap-based 3D reconstruction (point clouds) and poses |
| 計算需求 | 原文未報告 |
使用設備
原文使用的感測器、運算硬體與載具(equipment)。型號保留原文寫法,連結到設備頁中同一型號的歸併名稱;角色依原文用途分為方法輸入、資料集感測器、執行運算平台、參考或真值量測(reference or ground truth)與比較對象設備。
| 類別 | 型號(原文寫法) | 角色 | 資料集 | 原文規格 | 出處 |
|---|---|---|---|---|---|
| 慣性量測單元(IMU) | Honeywell HG1700 (in the AHRS) | 方法輸入 | 未標示 | AHRS gives drift-free pitch and roll | (Hinduja et al., 2019, Sec. IV-A) |
| 載具平台 | Bluefin Hovering Autonomous Underwater Vehicle (HAUV) | 方法輸入 | 未標示 | five thrusters controlling all DoF except roll and pitch; onboard odometry from fused navigation sensors | (Hinduja et al., 2019, Sec. IV-A, Fig. 3) |
| 其他 | DIDSON (dual-frequency identification sonar) | 方法輸入 | 未標示 | 96 beams, 2D transducer array; concentrator lens reduces vertical FOV to 1 degree (profiling mode); fixed number of profile scans per submap | (Hinduja et al., 2019, Sec. IV-A) |
| 其他 | Teledyne/RDI Workhorse Navigator Doppler velocity log歸入:Livox Tele | 方法輸入 | 未標示 | 1.2 MHz | (Hinduja et al., 2019, Sec. IV-A) |
| 其他 | Paroscientific Digiquartz depth sensor | 方法輸入 | 未標示 | drift-free depth measurement | (Hinduja et al., 2019, Sec. IV-A) |
作者報告的優勢與限制
優勢
- Lower RMSE than point-to-plane ICP with odometry prior and full loop-closure factors (PTP-OP) on both simulated datasets: pilings 0.173 vs 0.618, propeller 0.168 vs 0.429; odometry alone gave 0.183 and 0.346 (Table I)
- Rejects poorly constrained loop closures: 9 accepted versus 34 for PTP-OP on pilings and 17 versus 45 on the propeller, with identical parameters (Sec. IV-C)
- On real SS Curtis running gear and pier pilings data with added noise, maps were visually closer to the noise-free odometry reference than Teixeira et al.'s submap SLAM (Sec. IV-D, Figs. 7 and 9)
限制
- X-ICP reports that this method relies more on the odometry prior and showed blurred structures at the Rümlang construction site due to prior drift (Tuna et al. 2024, Sec. VII-E)
- Different environments benefit from different threshold values; automatic threshold selection from sensor data is left to future work (Sec. V)
- Real-world evaluation is qualitative and uses the noise-free odometry-only solution as reference, not independent ground truth (Sec. IV-D)
- The partial loop-closure factor covers at most 3 DoF (X, Y, yaw) because depth, pitch and roll come from the vehicle's drift-free sensors (Sec. IV-B2)
營建工程相關證據
原文為水下聲納;在 X-ICP 的工地比較中作為基線(見 Tuna et al., 2024)。
原文驗證環境:模擬、基礎設施
報告的性能數據
以下是原文作者報告的性能數值(author-reported results),不是本研究重新量測的結果。每張圖只並列同一個比較組(comparison group,同一張表、同一組實驗設定)內的方法;不同比較組之間的數值不可直接比較,也不構成排名。
本方法共出現在 8 個比較組,合計 31 筆紀錄。以下列出本方法紀錄最多的 4 組,其餘 4 組列在最後,並連到性能比較頁。
Tuna et al., 2024 · Table I 本方法 9 筆
資料集與序列Seemuhle underground mine (authors' data) · VLP-16 run; first 15 m alignment
表格設定(擷取紀錄原文,這些數值分屬表中不同部分):(Tuna et al., 2024, Table I)
- Seemuhle underground mine, ANYmal with VLP-16, 521.8 m; APE via EVO against Leica RTC 360 ground truth, mu (sigma); 'first 15 m' = trajectory aligned on the first 15 m (about 200 poses), 'origin' = aligned at the first pose; plus last-position error
- Same setting as other Table I rows
APE Translation mu(sigma) [m],Seemuhle underground mine (authors' data) · VLP-16 run; first 15 m alignment
只並列這張表在相同設定下報告的方法;以「本方法:」開頭者為本頁方法。失敗、未執行與未報告以標記呈現,不是 0。
按 Tab 進入圖表後,用上下方向鍵逐一瀏覽各類別,Esc 關閉提示框;也可開啟表格檢視閱讀全部數值。
這些是 Tuna et al., 2024 在此表設定下報告的數值(author-reported results),只能在同一個比較組內對照,不代表方法在其他資料或設定下的表現。
資料來源作者報告值(Tuna et al., 2024, Table I)
| 方法(原文寫法) | 報告值 | 出處 |
|---|---|---|
| X-ICP (Proposed)原文提出 | 2.05 m | (Tuna et al., 2024, Table I) |
| Zhang et al. [12] | 3.36 m | (Tuna et al., 2024, Table I) |
| Hinduja et al. [17]本方法 | 5.79 m | (Tuna et al., 2024, Table I) |
Hatleskog & Alexis, 2024 · Table II 本方法 8 筆
表格設定(擷取紀錄原文):Seemühle mine, mean (SD) APE and RPE (Hatleskog & Alexis, 2024, Table II)
RPE [m], mean (SD 0.01),Seemühle Mine · full trajectory
只並列這張表在相同設定下報告的方法;以「本方法:」開頭者為本頁方法。失敗、未執行與未報告以標記呈現,不是 0。
按 Tab 進入圖表後,用上下方向鍵逐一瀏覽各類別,Esc 關閉提示框;也可開啟表格檢視閱讀全部數值。
這些是 Hatleskog & Alexis, 2024 在此表設定下報告的數值(author-reported results),只能在同一個比較組內對照,不代表方法在其他資料或設定下的表現。
資料來源作者報告值(Hatleskog & Alexis, 2024, Table II)
| 方法(原文寫法) | 報告值 | 出處 |
|---|---|---|
| Zhang [14] | 0.01 m | (Hatleskog & Alexis, 2024, Table II) |
| Hinduja [15]本方法 | 0.01 m | (Hatleskog & Alexis, 2024, Table II) |
| Ours原文提出 | 0.01 m | (Hatleskog & Alexis, 2024, Table II) |
| Lee [19] (Switch-SLAM) | 0.01 m | (Hatleskog & Alexis, 2024, Table II) |
Hatleskog & Alexis, 2024 · Table I 本方法 4 筆
指標degeneracy-induced drift (qualitative)
表格設定(擷取紀錄原文,這些數值分屬表中不同部分):(Hatleskog & Alexis, 2024, Table I)
- Qualitative presence or absence of degeneracy-induced drift in partial maps; no numeric values
- Qualitative drift check
degeneracy-induced drift (qualitative),Rümlang Construction Site · exp. 1 (VLP-16, FOV cut to 180 deg)
只並列這張表在相同設定下報告的方法;以「本方法:」開頭者為本頁方法。失敗、未執行與未報告以標記呈現,不是 0。
- 未報告(沒有數值,不是 0)
按 Tab 進入圖表後,用上下方向鍵逐一瀏覽各類別,Esc 關閉提示框;也可開啟表格檢視閱讀全部數值。
這些是 Hatleskog & Alexis, 2024 在此表設定下報告的數值(author-reported results),只能在同一個比較組內對照,不代表方法在其他資料或設定下的表現。
資料來源作者報告值(Hatleskog & Alexis, 2024, Table I)
| 方法(原文寫法) | 報告值 | 出處 |
|---|---|---|
| Ours原文提出 | 無數值未報告註記(擷取紀錄):no degeneracy-induced drift | (Hatleskog & Alexis, 2024, Table I, Fig. 2) |
| Zhang [14] | 無數值未報告註記(擷取紀錄):degeneracy-induced drift | (Hatleskog & Alexis, 2024, Table I, Fig. 2) |
| Hinduja [15]本方法 | 無數值未報告註記(擷取紀錄):degeneracy-induced drift | (Hatleskog & Alexis, 2024, Table I, Fig. 2) |
| Lee [19] (Switch-SLAM) | 無數值未報告註記(擷取紀錄):degeneracy-induced drift | (Hatleskog & Alexis, 2024, Table I, Fig. 2) |
Tuna et al., 2024 · Table II 本方法 4 筆
資料集與序列Seemuhle underground mine (authors' data) · VLP-16 run
表格設定(擷取紀錄原文,這些數值分屬表中不同部分):(Tuna et al., 2024, Table II)
- RPE per 10 m traversed distance, Seemuhle mine with VLP-16, mu (sigma)
- Same setting as other Table II rows
RPE Translation mu(sigma) [m] per 10 m,Seemuhle underground mine (authors' data) · VLP-16 run
只並列這張表在相同設定下報告的方法;以「本方法:」開頭者為本頁方法。失敗、未執行與未報告以標記呈現,不是 0。
按 Tab 進入圖表後,用上下方向鍵逐一瀏覽各類別,Esc 關閉提示框;也可開啟表格檢視閱讀全部數值。
這些是 Tuna et al., 2024 在此表設定下報告的數值(author-reported results),只能在同一個比較組內對照,不代表方法在其他資料或設定下的表現。
資料來源作者報告值(Tuna et al., 2024, Table II)
| 方法(原文寫法) | 報告值 | 出處 |
|---|---|---|
| X-ICP (Proposed)原文提出 | 0.17 m | (Tuna et al., 2024, Table II) |
| Zhang et al. [12] | 0.2 m | (Tuna et al., 2024, Table II) |
| Hinduja et al. [17]本方法 | 0.26 m | (Tuna et al., 2024, Table II) |
其他比較組
來源
Hinduja et al., 2019
(2019)Degeneracy-Aware Factors with Applications to Underwater SLAM2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 1293-1299
DOI 10.1109/iros40897.2019.8968577
同儕審查已出版已讀全文近十年查證後修正