Intelligent Filter-Based SLAM for Mobile Robots With Improved Localization Performance

Fast simultaneous localization and mapping (FastSLAM) is one of the most popular methods for autonomous navigation of mobile robots. However, FastSLAM is essentially a particle filter (PF) that suffers from particle impoverishment and degeneracy problems. To improve its localization performance, this paper proposes an improved FastSLAM algorithm that contains an intelligent bat-inspired resampling whose iteration times can be adaptively tuned based on the degree of filter diverging. Additionally, the square root cubature filter is merged into the algorithm for better proposal distribution and mapping results. The advantages of the proposed method are verified by simulation and dataset-based tests. The test result demonstrates that the proposed IFastSLAM has better accuracy, computational efficiency and filter consistency compared to that of the square root unscented FastSLAM (SRUFastSLAM) and strong tracking square root central difference FastSLAM (STSRCDFastSLAM). Finally, a pool experiment is demonstrated to further verify the advantages of the proposed algorithm.

[1]  Pere Ridao,et al.  EKF-SLAM for AUV navigation under probabilistic sonar scan-matching , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[2]  Zeng-Guang Hou,et al.  Neural network based FastSLAM for autonomous robots in unknown environments , 2015, Neurocomputing.

[3]  Alireza Mohammad Shahri,et al.  GA-inspired particle filter for mitigating severe sample impoverishment , 2016, 2016 4th International Conference on Control, Instrumentation, and Automation (ICCIA).

[4]  Canjun Yang,et al.  An Improved Transformed Unscented FastSLAM With Adaptive Genetic Resampling , 2019, IEEE Transactions on Industrial Electronics.

[5]  Mohammad Teshnehlab,et al.  A Square Root Unscented FastSLAM With Improved Proposal Distribution and Resampling , 2014, IEEE Transactions on Industrial Electronics.

[6]  M. Sami Fadali,et al.  Square Root Unscented Kalman Filters for state estimation of induction motor drives , 2011 .

[7]  Jianbin Qiu,et al.  State Estimation in Nonlinear System Using Sequential Evolutionary Filter , 2016, IEEE Transactions on Industrial Electronics.

[8]  Shiyin Qin,et al.  A Fast Algorithm of Simultaneous Localization and Mapping for Mobile Robot Based on Ball Particle Filter , 2018, IEEE Access.

[9]  David W. Murray,et al.  An O(N²) Square Root Unscented Kalman Filter for Visual Simultaneous Localization and Mapping , 2009, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[10]  Shen Yin,et al.  Intelligent Particle Filter and Its Application to Fault Detection of Nonlinear System , 2015, IEEE Transactions on Industrial Electronics.

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

[12]  Dan Liu,et al.  A Strong Tracking Square Root Central Difference FastSLAM for Unmanned Intelligent Vehicle With Adaptive Partial Systematic Resampling , 2016, IEEE Transactions on Intelligent Transportation Systems.

[13]  Ramazan Havangi.  A mutated FastSLAM using soft computing , 2017, Ind. Robot.

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

[15]  Sebastian Thrun,et al.  FastSLAM: A Scalable Method for the Simultaneous Localization and Mapping Problem in Robotics , 2007 .

[16]  Hossam Faris,et al.  Bat-inspired algorithms with natural selection mechanisms for global optimization , 2018, Neurocomputing.

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

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

[19]  Martin David Adams,et al.  Multifeature-based importance weighting for the PHD SLAM filter , 2016, IEEE Transactions on Aerospace and Electronic Systems.

[20]  S. Haykin,et al.  Cubature Kalman Filters , 2009, IEEE Transactions on Automatic Control.

[21]  Petar M. Djuric,et al.  Resampling Methods for Particle Filtering: Classification, implementation, and strategies , 2015, IEEE Signal Processing Magazine.

[22]  Jeffrey K. Uhlmann,et al.  Unscented filtering and nonlinear estimation , 2004, Proceedings of the IEEE.

[23]  Aristeidis G. Thallas,et al.  Topological Based Scan Matching – Odometry Posterior Sampling in RBPF Under Kinematic Model Failures , 2017, Journal of Intelligent & Robotic Systems.

[24]  Aristeidis G. Thallas,et al.  Particle filter — Scan matching hybrid SLAM employing topological information , 2016, 2016 24th Mediterranean Conference on Control and Automation (MED).

[25]  Juan D. Tardós,et al.  ORB-SLAM2: An Open-Source SLAM System for Monocular, Stereo, and RGB-D Cameras , 2016, IEEE Transactions on Robotics.

[26]  Bo Zheng,et al.  An Improved EKF-SLAM for Mars Surface Exploration , 2019 .

[27]  Myo-Taeg Lim,et al.  Improving Reliability of Particle Filter-Based Localization in Wireless Sensor Networks via Hybrid Particle/FIR Filtering , 2015, IEEE Transactions on Industrial Informatics.