Invariant filtering for Pose EKF-SLAM aided by an IMU
Authors:
- 1 December 2015
- conference paper
- Published by Institute of Electrical and Electronics Engineers (IEEE)
- p. 2133-2138
Abstract
This paper presents a new method to combine measurements from motion sensors (wheel encoders or inertial measurements) with relative pose estimates inferred from scan matching of dense depth images taken at different time instants. These can optionally be completed with measurements of relative position to landmarks with known location. The fusion is performed through an invariant extended Kalman filter (IEKF) with augmented state, as an application of the stochastic cloning method. This results in a fusion algorithm allowing to include IMU information in pose EKF-SLAM and which inherits the desirable properties of IEKFs, that is, although the system is non-linear, the evolution of the error is independent of the trajectory, as in the linear case.Keywords
This publication has 19 references indexed in Scilit:
- An invariant Linear Quadratic Gaussian controller for a simplified car2015
- Globally exponentially stable attitude and gyro bias estimation with application to GNSS/INS integrationAutomatica, 2015
- Implementation of a Nonlinear Attitude Estimator for Aerial Robotic VehiclesIEEE Transactions on Control Systems Technology, 2013
- Invariant Observer Design for a Helicopter UAV Aided Inertial Navigation SystemIEEE Transactions on Control Systems Technology, 2012
- Generalized Multiplicative Extended Kalman Filter for Aided Attitude and Heading Reference System2010
- Gradient-Like Observers for Invariant Dynamics on a Lie GroupIEEE Transactions on Automatic Control, 2009
- Information-Based Compact Pose SLAMIEEE Transactions on Robotics, 2009
- Symmetry-Preserving ObserversIEEE Transactions on Automatic Control, 2008
- An accurate closed-form estimate of ICP's covarianceProceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (cat. No.01ch37164), 2007
- Robot localization based on scan-matching—estimating the covariance matrix for the IDC algorithmRobotics and Autonomous Systems, 2003