An intelligent UFastSLAM with MCMC move step

FastSLAM is a framework for simultaneous localization and mapping (SLAM). However, FastSLAM algorithm has two serious drawbacks, namely the linear approximation of nonlinear functions and the derivation of the Jacobian matrices. For solving these problems, UFastSLAM has been recently proposed. However, UFastSLAM is inconsistent over time due to the loss of particle diversity that is caused mainly by the particle depletion in the resampling step and incorrect a priori knowledge of process and measurement noises. To improve consistency, intelligent UFastSLAM with Markov chain Monte Carlo (MCMC) move step is proposed. In the proposed method, the adaptive neuro-fuzzy inference system supervises the performance of UFastSLAM. Furthermore, the particle impoverishment caused by resampling is restrained after the resample step with MCMC move step. Simulations and experiments are presented to evaluate the performance of algorithm in comparison with UFastSLAM. The results show the effectiveness of the proposed method.

[1]  Beom Hee Lee,et al.  Improved particle fusing geometric relation between particles in FastSLAM , 2009, Robotica.

[2]  Duan Zhuo-hua,et al.  Survey on some key technologies of mobile robot localization based on particle filter , 2007 .

[3]  Hugh F. Durrant-Whyte,et al.  A new method for the nonlinear transformation of means and covariances in filters and estimators , 2000, IEEE Trans. Autom. Control..

[4]  Zhen-hua Wei,et al.  A novel method for mobile robot simultaneous localization and mapping , 2006 .

[5]  Francesco Martinelli,et al.  A FastSLAM Algorithm Based on the Unscented Filtering with Adaptive Selective Resampling , 2007, FSR.

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

[7]  Wan Kyun Chung,et al.  Unscented FastSLAM: A Robust Algorithm for the Simultaneous Localization and Mapping Problem , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[8]  Sebastian Thrun,et al.  FastSLAM: An Efficient Solution to the Simultaneous Localization And Mapping Problem with Unknown Data , 2004 .

[9]  Gon Woo Kim,et al.  A new compensation technique based on analysis of resampling process in FastSLAM , 2008, Robotica.

[10]  N. Metropolis,et al.  Equation of State Calculations by Fast Computing Machines , 1953, Resonance.

[11]  Chongzhao Han,et al.  Adaptive UKF for target tracking with unknown process noise statistics , 2009, 2009 12th International Conference on Information Fusion.

[12]  Wolfram Burgard,et al.  On actively closing loops in grid-based FastSLAM , 2005, Adv. Robotics.

[13]  Beom Hee Lee,et al.  Adaptive prior boosting technique for the efficient sample size in fastSLAM , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[15]  N. F. Toda,et al.  Divergence in the Kalman Filter , 1967 .

[16]  Hong Zhang,et al.  A UPF-UKF Framework For SLAM , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[17]  R. Mehra.  On the identification of variances and adaptive Kalman filtering , 1970 .

[18]  Rudolph van der Merwe,et al.  The unscented Kalman filter for nonlinear estimation , 2000, Proceedings of the IEEE 2000 Adaptive Systems for Signal Processing, Communications, and Control Symposium (Cat. No.00EX373).

[19]  Jianda Han,et al.  A novel adaptive unscented Kalman filter for nonlinear estimation , 2007, 2007 46th IEEE Conference on Decision and Control.

[20]  Jianda Han,et al.  An Adaptive UKF Algorithm and Its Application in Mobile Robot Control , 2006, 2006 IEEE International Conference on Robotics and Biomimetics.

[21]  Wolfram Burgard,et al.  Improving Grid-based SLAM with Rao-Blackwellized Particle Filters by Adaptive Proposals and Selective Resampling , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[22]  Wan Kyun Chung,et al.  Exactly Rao-Blackwellized unscented particle filters for SLAM , 2011, 2011 IEEE International Conference on Robotics and Automation.

[23]  S. A. Stoeter,et al.  Proceedings - IEEE International Conference on Robotics and Automation , 2003 .

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

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

[26]  Wolfram Burgard,et al.  Improved Techniques for Grid Mapping With Rao-Blackwellized Particle Filters , 2007, IEEE Transactions on Robotics.

[27]  Nando de Freitas,et al.  An Introduction to MCMC for Machine Learning , 2004, Machine Learning.

[28]  Jagath Samarabandu,et al.  Recent advances in simultaneous localization and map-building using computer vision , 2007, Adv. Robotics.