Khái niệm cốt lõi
SP-VIO 是一種新型視覺慣性里程計 (VIO) 演算法,透過重建狀態和測量模型,並採用僅姿態 (PO) 理論和雙狀態變換 Rauch-Tung-Striebel (DST-RTS) 回溯方法,在保持高效能的同時,提高了定位精度和在視覺中斷條件下的穩健性。
Tóm tắt
SP-VIO:基於狀態變換模型和僅姿態視覺描述的穩健高效濾波視覺慣性里程計
研究背景
視覺慣性里程計 (VIO) 技術廣泛應用於各種移動機器人的自主導航。現有的 VIO 演算法主要分為基於優化和基於濾波兩大類。基於濾波的 VIO 具有計算效率高、内存需求小等優點,但在定位精度方面遜於基於優化的 VIO。
研究目的
本研究旨在開發一種兼具高精度和高效能的 VIO 演算法,並提高其在視覺中斷條件下的穩健性。
方法
本研究提出了一種名為 SP-VIO 的新型 VIO 演算法,該演算法以 MSCKF 為基礎系統,並整合了以下功能:
- 僅姿態測量模型:該模型與 3D 特徵解耦,避免了不精確的 3D 重建過程對精度的影響,同時保持了效率。
- 基於雙狀態變換卡爾曼濾波器 (DST-EKF) 的系統模型:通過更嚴格地定義速度誤差狀態和位置誤差狀態,使 VIO 系統獲得了穩健性和一致性的提升。
- DST-RTS 回溯平滑策略:該策略不依賴於迴環閉合,利用視覺觀測恢復後 VIO 系統提供的速度信息,通過 RTS 回溯修正運動軌跡,可以減少視覺中斷造成的累積誤差。
實驗結果
在公開數據集 (EuRoC、Tum-VI、KITTI) 和自建數據集上的實驗表明,SP-VIO 比現有的 VIO 演算法具有更好的精度和效率,並且在視覺中斷條件下具有更好的穩健性。
結論
SP-VIO 演算法通過採用僅姿態測量模型、DST-EKF 系統模型和 DST-RTS 回溯平滑策略,成功地提高了基於濾波的 VIO 的定位精度和在視覺中斷條件下的穩健性,同時保持了較高的計算效率。
Thống kê
SP-VIO 在 Kitti Odometry 數據集上的定位精度比 MSCKF 提高了 33.75%。
SP-VIO 在 EuRoC 和 Tum-VI 數據集上的平均運行時間優於 OpenVINS 和 VINS-Mono。
Trích dẫn
"Benchmark experiments [11], [12] show that filter-based VIO has the advantages of high computational efficiency and small memory requirements, and has a good application prospect in payload-constrained embedded systems."
"The newly proposed PO theory indicates that reprojection error can be obtained solely through camera pose, which is equivalent to traditional multi-view geometry description [15], [16]."
"Experiments on public (EuRoC, Tum-VI, KITTI) and personal datasets show that SP-VIO has better accuracy and efficiency than state-of-the-art (SOTA) VIO algorithms, and has better robustness under visual deprived conditions."