Prediction error method estimation for Simultaneous Localisation and Mapping

This paper presents a batch estimation method for Simultaneous Localization and Mapping (SLAM) using the Prediction Error Method (PEM). The estimation problem considers landmarks as parameter while treating dynamics using state space models. The gradient needed for parameter estimation is computed recursively using an Extended Kalman Filter (EKF). Results using simulations with a monocular camera and inertial sensors are presented and compared to a Nonlinear Least-Squares (NLS) estimator. The presented method produce both lower RMSE's and scale better to the batch length.

[1]  Ryan M. Eustice,et al.  Pose-graph visual SLAM with geometric model selection for autonomous underwater ship hull inspection , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[2]  Alex Simpkins,et al.  System Identification: Theory for the User, 2nd Edition (Ljung, L.; 1999) [On the Shelf] , 2012, IEEE Robotics & Automation Magazine.

[3]  Hauke Strasdat,et al.  Scale Drift-Aware Large Scale Monocular SLAM , 2010, Robotics: Science and Systems.

[4]  Hugh Durrant-Whyte,et al.  Simultaneous localization and mapping (SLAM): part II , 2006 .

[5]  Thomas B. Schön,et al.  Maximum likelihood calibration of a magnetometer using inertial sensors , 2014 .

[6]  Lennart Ljung,et al.  Direct prediction-error identification of unstable nonlinear systems applied to flight test data , 2009 .

[7]  Lennart Ljung,et al.  System Identification: Theory for the User , 1987 .

[8]  Thomas B. Schön,et al.  A Nonlinear Least-Squares Approach to the SLAM Problem , 2011 .

[9]  Bernhard P. Wrobel,et al.  Multiple View Geometry in Computer Vision , 2001 .

[10]  D. Marquardt.  An Algorithm for Least-Squares Estimation of Nonlinear Parameters , 1963 .

[11]  Roy M. Howard,et al.  Linear System Theory , 1992 .

[12]  Frank Dellaert,et al.  Incremental smoothing and mapping , 2008 .

[13]  Andrew Zisserman,et al.  Multiple View Geometry in Computer Vision (2nd ed) , 2003 .

[14]  Kenneth Levenberg.  A METHOD FOR THE SOLUTION OF CERTAIN NON – LINEAR PROBLEMS IN LEAST SQUARES , 1944 .

[15]  Hugh F. Durrant-Whyte,et al.  Simultaneous localization and mapping: part I , 2006, IEEE Robotics & Automation Magazine.

[16]  Frank Dellaert,et al.  iSAM: Incremental Smoothing and Mapping , 2008, IEEE Transactions on Robotics.

[17]  Frank Dellaert,et al.  Concurrent filtering and smoothing: A parallel architecture for real-time navigation and full smoothing , 2014, Int. J. Robotics Res..