不変拡張カルマンフィルタのためのSE_n(3)群上の閉形式誤差伝播とVINSへの応用
Closed-form Error Propagation on the SE_n(3) Group for Invariant Extended Kalman Filtering with Applications to VINS
行列リー群上の不変拡張カルマンフィルタ(IEKF)における誤差伝播の閉形式を導出し、視覚支援慣性航法(VINS)に応用して既存手法を上回る精度を示した。
著者: Xinghan Li, Haodong Jiang, Xingyu Chen, He Kong, Junfeng Wu
分類: cs.RO
原文アブストラクト
Pose estimation is important for robotic perception, path planning, etc. Robot poses can be modeled on matrix Lie groups and are usually estimated via filter-based methods. In this paper, we establish the closed-form formula for the error propagation for the Invariant extended Kalman filter (IEKF) in the presence of random noises and apply it to vision-aided inertial navigation. We evaluate our algorithm via numerical simulations and experiments on the OPENVINS platform. Both simulations and the experiments performed on the public EuRoC MAV datasets demonstrate that our algorithm outperforms some state-of-art filter-based methods such as the quaternion-based EKF, first estimates Jacobian EKF, etc.
