A Fast Algorithm of Simultaneous Localization and Mapping for Mobile Robot Based on Ball Particle Filter

The FastSLAM algorithm has become an effective way to solve the simultaneous localization and mapping (SLAM) problem. However, measured in terms of the number of particles required to build an accurate map, currently, its accuracy cannot be easily enhanced because of particle degeneracy. In view of these problems, in this paper, we present a fast algorithm of SLAM based on the ball particle filter (Ball-PF), which originates from the modification of the box particle filter (Box-PF). First, the transform relationship between Box-PF and Ball-PF are studied in depth so as to show the advantages of Ball-PF with respect to solving the interval constraints satisfaction problem and prevent from breaking down effectively. Then, a new fast algorithm of SLAM is designed with Ball-PF, in which the firefly algorithm is used to maintain the diversity of the ball particles to increase the consistency of the pose estimation effectually. Furthermore, the map matching technique is used to compute the weight of the ball particles and learn the grid maps incrementally. The simulation and experimental results demonstrate the performance superiority of the proposed algorithm.

[1]  Vikram Krishnamurthy,et al.  Particle Filtering Combined with Interval Methods for Tracking Applications , 2012 .

[2]  Fahed Abdallah,et al.  An Introduction to Box Particle Filtering [Lecture Notes] , 2013, IEEE Signal Processing Magazine.

[3]  E. O. Tartan,et al.  Square root central difference-based FastSLAM approach improved by differential evolution , 2016 .

[4]  Mark A. Paskin,et al.  Thin Junction Tree Filters for Simultaneous Localization and Mapping , 2002, IJCAI.

[5]  Habibollah Haron,et al.  GA-PSO-FASTSLAM: A Hybrid Optimization Approach in Improving FastSLAM Performance , 2016, ISDA.

[6]  Paul Newman,et al.  Loop closure detection in SLAM by combining visual and spatial appearance , 2006, Robotics Auton. Syst..

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

[8]  Wolfram Burgard,et al.  OctoMap: an efficient probabilistic 3D mapping framework based on octrees , 2013, Autonomous Robots.

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

[10]  Abdelhafid Elouardi,et al.  Guaranteed simultaneous localization and mapping algorithm using interval analysis , 2014, 2014 13th International Conference on Control Automation Robotics & Vision (ICARCV).

[11]  D. Ribas.  Towards Simultaneous Localization & Mapping for an AUV using an Imaging Sonar , 2005 .

[12]  Ronald Parr,et al.  DP-SLAM: fast, robust simultaneous localization and mapping without predetermined landmarks , 2003, IJCAI 2003.

[13]  Wolfram Burgard,et al.  An efficient fastSLAM algorithm for generating maps of large-scale cyclic environments from raw laser range measurements , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[14]  R. Baker Kearfott,et al.  Introduction to Interval Analysis , 2009 .

[15]  Alain Lambert,et al.  Experimental comparison of Bounded-Error State Estimation and Constraints Propagation , 2011, 2011 IEEE International Conference on Robotics and Automation.

[16]  Amadou Gning,et al.  Guaranteed dynamic localization using constraints propagation techniques on real intervals , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[17]  Luc Jaulin.  Localization of an Underwater Robot Using Interval Constraint Propagation , 2006, CP.

[18]  Branko Ristic,et al.  Bernoulli Particle/Box-Particle Filters for Detection and Tracking in the Presence of Triple Measurement Uncertainty , 2012, IEEE Transactions on Signal Processing.

[19]  Gary R. Bradski,et al.  ORB: An efficient alternative to SIFT or SURF , 2011, 2011 International Conference on Computer Vision.

[20]  Daniel Cremers,et al.  Box-particle PHD filter for multi-target tracking , 2012, 2012 15th International Conference on Information Fusion.

[21]  Visakan Kadirkamanathan,et al.  Autonomous crowds tracking with box particle filtering and convolution particle filtering , 2016, Autom..

[22]  Rabindranath Sen,et al.  A globally convergent ball Stirling method , 2004 .

[23]  Amadou Gning,et al.  Constraints propagation techniques on intervals for a guaranteed localization using redundant data , 2006, Autom..

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

[25]  Lindsay Kleeman,et al.  Laser scan matching in polar coordinates with application to SLAM , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[26]  Alain Lambert,et al.  Comparison of Interval Constraint Propagation Algorithms for Vehicle Localization , 2012 .

[27]  Peter Cheeseman,et al.  On the Representation and Estimation of Spatial Uncertainty , 1986 .

[28]  Eric Walter,et al.  Guaranteed non-linear estimation using constraint propagation on sets , 2001 .

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

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

[31]  Fahed Abdallah,et al.  Mixture of uniform probability density functions for non linear state estimation using interval analysis , 2010, 2010 13th International Conference on Information Fusion.

[32]  Hichem Snoussi,et al.  Guaranteed Boxed Localization in MANETs by Interval Analysis and Constraints Propagation Techniques , 2008, IEEE GLOBECOM 2008 - 2008 IEEE Global Telecommunications Conference.

[33]  Fahed Abdallah,et al.  Box particle filtering for nonlinear state estimation using interval analysis , 2008, Autom..

[34]  Lyudmila Mihaylova,et al.  Box Particle Filtering for extended object tracking , 2012, 2012 15th International Conference on Information Fusion.

[35]  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.

[36]  T. Csendes,et al.  A review of subdivision direction selection in interval methods for global optimization , 1997 .

[37]  Luc Jaulin,et al.  A set approach to the simultaneous localization and map building - application to underwater robots , 2007, ICINCO-RA.

[38]  Andrea Garulli,et al.  Set membership localization and mapping for autonomous navigation , 2001 .

[39]  Lyudmila Mihaylova,et al.  Crowd tracking with box particle filtering , 2014, 17th International Conference on Information Fusion (FUSION).

[40]  Nando de Freitas,et al.  Rao-Blackwellised Particle Filtering for Dynamic Bayesian Networks , 2000, UAI.

[41]  Luc Jaulin,et al.  Applied Interval Analysis , 2001, Springer London.

[42]  Yu Ji.  A Survey of Box Particle Filter Theory , 2015 .