Experimental implementation of an Invariant Extended Kalman Filter-based scan matching SLAM

We describe an application of the Invariant Extended Kalman Filter (IEKF) design methodology to the scan matching SLAM problem. We review the theoretical foundations of the IEKF and its practical interest of guaranteeing robustness to poor state estimates, then implement the filter on a wheeled robot hardware platform. The proposed design is successfully validated in experimental testing.

[1]  Fawzi Nashashibi,et al.  Digitizing and 3D modeling of urban environments and roads using vehicle-borne laser scanner system , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[2]  S. Kay.  Fundamentals of statistical signal processing: estimation theory , 1993 .

[3]  Tor Arne Johansen,et al.  A nonlinear observer for integration of GNSS and IMU measurements with gyro bias estimation , 2012, 2012 American Control Conference (ACC).

[4]  Evangelos E. Milios,et al.  Robot Pose Estimation in Unknown Environments by Matching 2D Range Scans , 1994, 1994 Proceedings of IEEE Conference on Computer Vision and Pattern Recognition.

[5]  Philippe Martin,et al.  Non-linear observer on Lie Groups for left-invariant dynamics with right-left equivariant output , 2008 .

[6]  Philippe Martin,et al.  Invariant Extended Kalman Filter: theory and application to a velocity-aided attitude estimation problem , 2009, Proceedings of the 48h IEEE Conference on Decision and Control (CDC) held jointly with 2009 28th Chinese Control Conference.

[7]  Robert E. Mahony,et al.  Gradient-Like Observers for Invariant Dynamics on a Lie Group , 2008, IEEE Transactions on Automatic Control.

[8]  Philippe Martin,et al.  Generalized Multiplicative Extended Kalman Filter for Aided Attitude and Heading Reference System , 2010 .

[9]  Paul J. Besl,et al.  A Method for Registration of 3-D Shapes , 1992, IEEE Trans. Pattern Anal. Mach. Intell..

[10]  Silvere Bonnabel,et al.  Left-invariant extended Kalman filter and attitude estimation , 2007, 2007 46th IEEE Conference on Decision and Control.

[11]  Richard A. Brown,et al.  Introduction to random signals and applied kalman filtering (3rd ed , 2012 .

[12]  Richard M. Murray,et al.  A Mathematical Introduction to Robotic Manipulation , 1994 .

[13]  Rita Cunha,et al.  A nonlinear position and attitude observer on SE(3) using landmark measurements , 2010, Syst. Control. Lett..

[14]  Philippe Martin,et al.  Non-Linear Symmetry-Preserving Observers on Lie Groups , 2007, IEEE Transactions on Automatic Control.

[15]  Silvere Bonnabel.  Symmetries in observer design: review of some recent results and applications to EKF-based SLAM , 2011, ArXiv.

[16]  Manuela Herman,et al.  Aided Navigation Gps With High Rate Sensors , 2016 .

[17]  Philippe Martin,et al.  Symmetry-Preserving Observers , 2006, IEEE Transactions on Automatic Control.

[18]  Eduardo Mario Nebot,et al.  Scan-SLAM: Combining EKF-SLAM and Scan Correlation , 2005, FSR.

[19]  Bruno Steux,et al.  CoreBot M : Le robot de la Team CoreBots préparé pour l'édition 2011 du défi Carotte , 2011 .

[20]  François Goulette,et al.  Accurate 3D maps from depth images and motion sensors via nonlinear Kalman filtering , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[21]  Pascal Morin,et al.  Nonlinear filter design for pose and IMU bias estimation , 2011, 2011 IEEE International Conference on Robotics and Automation.

[22]  Peter C. Cheeseman,et al.  Estimating uncertain spatial relationships in robotics , 1986, Proceedings. 1987 IEEE International Conference on Robotics and Automation.

[23]  Hugh F. Durrant-Whyte,et al.  A solution to the simultaneous localization and map building (SLAM) problem , 2001, IEEE Trans. Robotics Autom..

[24]  Sebastian Thrun,et al.  6D SLAM with an application in autonomous mine mapping , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[25]  Alan F. Lynch,et al.  Invariant Observer Design for a Helicopter UAV Aided Inertial Navigation System , 2013, IEEE Transactions on Control Systems Technology.

[26]  Minh-Duc Hua.  Attitude estimation for accelerated vehicles using GPS/INS measurements , 2010 .