一貫性を改善する不変EKFに基づくVINSアルゴリズム
An Invariant-EKF VINS Algorithm for Improving Consistency
従来のEKFベースVINSが持つ不変性の欠如による推定の不整合を解決するため、右不変誤差EKF(RIEKF-VINS)を提案し、マルチステート制約カルマンフィルタと組み合わせて一貫した状態推定を実現した。
著者: Teng Zhang, Kanzhi Wu, Daobilige Su, Shoudong Huang, Gamini Dissanayake
分類: cs.RO
原文アブストラクト
The main contribution of this paper is an invariant extended Kalman filter (EKF) for visual inertial navigation systems (VINS). It is demonstrated that the conventional EKF based VINS is not invariant under the stochastic unobservable transformation, associated with translations and a rotation about the gravitational direction. This can lead to inconsistent state estimates as the estimator does not obey a fundamental property of the physical system. To address this issue, we use a novel uncertainty representation to derive a Right Invariant error extended Kalman filter (RIEKF-VINS) that preserves this invariance property. RIEKF-VINS is then adapted to the multistate constraint Kalman filter framework to obtain a consistent state estimator. Both Monte Carlo simulations and real-world experiments are used to validate the proposed method.
