Get our free extension to see links to code for papers anywhere online!

 Add to Chrome

 Add to Firefox

CatalyzeX Code Finder - Browser extension linking code for ML papers across the web! | Product Hunt Embed

An Invariant-EKF VINS Algorithm for Improving Consistency

Mar 01, 2017
Teng Zhang, Kanzhi Wu, Daobilige Su, Shoudong Huang, Gamini Dissanayake



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.

* submitted to The 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2017) 


Share this with someone who'll enjoy it:

   Access Paper Source



Share this with someone who'll enjoy it: