Autonomous navigation based on unscented-FastSLAM using particle swarm optimization for autonomous underwater vehicles

Abstract Simultaneous localization and mapping (SLAM) is the crucial prerequisite for mobile robots to accomplish autonomy. In this paper, PSO-UFastSLAM based on the unscented-FastSLAM (UFastSLAM) and the particle swarm optimization (PSO) is proposed. The UFastSLAM combines unscented particle filter (UPF) and unscented Kalman filter (UKF) to estimate the robot poses and features. Furthermore, to prevent the particles degeneracy and impoverishment, PSO is adapted to optimize particles. The proposed method is applied on our own research platform, autonomous underwater vehicle (AUV), through sea trials in Tuandao Bay. The results of simulation and sea trial reveal that PSO-UFastSLAM has better accuracy and effectiveness in terms of estimation of robot and features while compared with UFastSLAM and standard FastSLAM.

[1]  Sebastian Thrun,et al.  Simultaneous localization and mapping with unknown data association using FastSLAM , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[2]  Jun S. Liu,et al.  Metropolized independent sampling with comparisons to rejection sampling and importance sampling , 1996, Stat. Comput..

[3]  Bijaya Ketan Panigrahi,et al.  A hybrid unscented filtering and particle swarm optimization technique for harmonic analysis of nonstationary signals , 2010 .

[4]  José A. Castellanos,et al.  Unscented SLAM for large-scale outdoor environments , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[5]  Amitava Chatterjee,et al.  Development of a real-life EKF based SLAM system for mobile robots employing vision sensing , 2011, Expert Syst. Appl..

[6]  Neil J. Gordon,et al.  A tutorial on particle filters for online nonlinear/non-Gaussian Bayesian tracking , 2002, IEEE Trans. Signal Process..

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

[8]  B. Todor,et al.  Simultaneous Localization and Mapping with Particle Swarm Localization , 2005, 2005 IEEE Intelligent Data Acquisition and Advanced Computing Systems: Technology and Applications.

[9]  Mohammed El-Abd,et al.  Performance assessment of foraging algorithms vs. evolutionary algorithms , 2012, Inf. Sci..

[10]  R. Nagarajan,et al.  Visual based SLAM using modified PSO , 2010, 2010 6th International Colloquium on Signal Processing & its Applications.

[11]  Bo He,et al.  A Distributed Parallel Motion Control for the Multi-Thruster Autonomous Underwater Vehicle , 2013 .

[12]  Chao Li,et al.  Autonomous Navigation for Autonomous Underwater Vehicles Based on Information Filters and Active Sensing , 2011, Sensors.

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

[14]  Beom Hee Lee,et al.  PSO-FastSLAM: An improved FastSLAM framework using particle swarm optimization , 2009, 2009 IEEE International Conference on Systems, Man and Cybernetics.

[15]  Jamshaid Ali,et al.  Initial orientation of inertial navigation system realized through nonlinear modeling and filtering , 2011 .

[16]  Kevin P. Murphy,et al.  Bayesian Map Learning in Dynamic Environments , 1999, NIPS.

[17]  H.F. Durrant-Whyte,et al.  A new approach for filtering nonlinear systems , 1995, Proceedings of 1995 American Control Conference - ACC'95.

[18]  P. K. Dash,et al.  Accurate tracking of harmonic signals in VSC-HVDC systems using PSO based unscented transformation , 2011 .

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

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

[21]  Liang Zhang,et al.  Convergence and consistency analysis for FastSLAM , 2009, 2009 IEEE Intelligent Vehicles Symposium.

[22]  Nando de Freitas,et al.  The Unscented Particle Filter , 2000, NIPS.

[23]  Gerasimos G. Rigatos,et al.  Extended Kalman and Particle Filtering for sensor fusion in motion control of mobile robots , 2010, Math. Comput. Simul..

[24]  Wolfram Burgard,et al.  Fast and accurate SLAM with Rao-Blackwellized particle filters , 2007, Robotics Auton. Syst..

[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]  Mohammad Reza Mohammadi,et al.  Integrated PSO and line based representation approach for SLAM , 2011, SAC '11.

[27]  Mohd Yamani Idna Idris,et al.  A co-processor design to accelerate sequential monocular SLAM EKF process , 2012 .

[28]  Leonardo A. B. Tôrres,et al.  On unscented Kalman filtering with state interval constraints , 2010 .

[29]  Qi Li,et al.  Parameter Identification for PEM Fuel-Cell Mechanism Model Based on Effective Informed Adaptive Particle Swarm Optimization , 2011, IEEE Transactions on Industrial Electronics.

[30]  Ryan M. Eustice,et al.  Perception-driven navigation: Active visual SLAM for robotic area coverage , 2013, 2013 IEEE International Conference on Robotics and Automation.

[31]  Gamini Dissanayake,et al.  Evolutionary computing based mobile robot localization , 2006, Eng. Appl. Artif. Intell..

[32]  J. Kennedy,et al.  Matching algorithms to problems: an experimental test of the particle swarm and some genetic algorithms on the multimodal problem generator , 1998, 1998 IEEE International Conference on Evolutionary Computation Proceedings. IEEE World Congress on Computational Intelligence (Cat. No.98TH8360).

[33]  Eduardo Nebot,et al.  Localization and map building using laser range sensors in outdoor applications , 2000, J. Field Robotics.

[34]  Q. Pan,et al.  Particle Filter Based on PSO , 2008, 2008 International Conference on Intelligent Computation Technology and Automation (ICICTA).

[35]  Bjarne A. Foss,et al.  Applying the unscented Kalman filter for nonlinear state estimation , 2008 .

[36]  Salah Sukkarieh,et al.  Real-time implementation of airborne inertial-SLAM , 2007, Robotics Auton. Syst..