Convergence and consistency analysis for FastSLAM

The main contribution of this paper is an analysis of the FastSLAM algorithm for simultaneous localization and mapping (SLAM) problem. The convergence properties of the landmark uncertainty for FastSLAM are provided. The proofs clearly show that the limit of the uncertainty for the landmark estimation has no relationship with the vehicle's initial pose uncertainty. Furthermore, the consistency of vehicle pose in FastSLAM is analyzed by Monte Carlo tests and finding that through reducing the control noise and measurement noise the consistency of the vehicle pose can't be improved remarkably, whereas, by cancelling the re-sampling process in FastSLAM the consistency of the vehicle pose can be enhanced obviously.

[1]  Gamini Dissanayake,et al.  Convergence and Consistency Analysis for Extended Kalman Filter Based SLAM , 2007, IEEE Transactions on Robotics.

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

[3]  Hugh F. Durrant-Whyte,et al.  Simultaneous Localization and Mapping with Sparse Extended Information Filters , 2004, Int. J. Robotics Res..

[4]  Beom Hee Lee,et al.  Analysis of Resampling Process for the Particle Depletion Problem in FastSLAM , 2007, RO-MAN 2007 - The 16th IEEE International Symposium on Robot and Human Interactive Communication.

[5]  Gamini Dissanayake,et al.  Convergence analysis for extended Kalman filter based SLAM , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[6]  Thiagalingam Kirubarajan,et al.  Estimation with Applications to Tracking and Navigation , 2001 .

[7]  Eduardo Mario Nebot,et al.  Consistency of the EKF-SLAM Algorithm , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[8]  Sebastian Thrun,et al.  FastSLAM: a factored solution to the simultaneous localization and mapping problem , 2002, AAAI/IAAI.

[9]  Matthew R. Walter,et al.  Exactly Sparse Extended Information Filters for Feature-based SLAM , 2007, Int. J. Robotics Res..

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

[11]  Eduardo Mario Nebot,et al.  Consistency of the FastSLAM algorithm , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[12]  Sebastian Thrun,et al.  FastSLAM 2.0: An Improved Particle Filtering Algorithm for Simultaneous Localization and Mapping that Provably Converges , 2003, IJCAI.

[13]  Wan Kyun Chung,et al.  Unscented FastSLAM: A Robust and Efficient Solution to the SLAM Problem , 2008, IEEE Transactions on Robotics.

[14]  Gamini Dissanayake,et al.  D-SLAM: Decoupled Localization and Mapping for Autonomous Robots , 2005, ISRR.

[15]  Sebastian Thrun,et al.  Simultaneous Localization and Mapping , 2008, Robotics and Cognitive Approaches to Spatial Mapping.