A novel robust approach for SLAM of mobile robot

Abstract

The task of simultaneous localization and mapping (SLAM) is to build environmental map and locate the position of mobile robot at the same time. FastSLAM 2.0 is one of powerful techniques to solve the SLAM problem. However, there are two obvious limitations in FastSLAM 2.0, one is the linear approximations of nonlinear functions which would cause the filter inconsistent and the other is the “particle depletion” phenomenon. A kind of PSO & H_∞-based FastSLAM 2.0 algorithm is proposed. For maintaining the estimation accuracy, H_∞ filter is used instead of EKF for overcoming the inaccuracy caused by the linear approximations of nonlinear functions. The unreasonable proposal distribution of particle greatly influences the pose state estimation of robot. A new sampling strategy based on PSO (particle swarm optimization) is presented to solve the “particle depletion” phenomenon and improve the accuracy of pose state estimation. The proposed approach overcomes the obvious drawbacks of standard FastSLAM 2.0 algorithm and enhances the robustness and efficiency in the parts of consistency of filter and accuracy of state estimation in SLAM. Simulation results demonstrate the superiority of the proposed approach.

Keywords

mobile robot / simultaneous localization and mapping (SLAM) / improved FastSLAM 2.0 / H_∞ filter / particle swarm optimization (PSO)

References

[1] ChenB-f, CaiZ-x, HuD-wen. Approach of simultaneous localization and mapping based on local maps for robot [J]. Journal of Central South University of Technology, 2006, 13(6): 713-716

[2] LiH-p, XuD-m, ZhangF-b, YaoYao. Consistency analysis of EKF-based SLAM by measurement noise and observation times [J]. Acta Automatica Sinica, 2009, 35(9): 1177-1184

[3] BooijO, ZivkovicZ, KröseB. Efficient data association for view based SLAM using connected dominating sets [J]. Robotics and Autonomous Systems, 2009, 57(12): 1225-1234

[4] NassreddineG, AbdallahF, DenouxT. State estimation using interval analysis and belief-function theory: Application to dynamic vehicle localization [J]. IEEE Transactions on Systems, Man, and Cybernetics, Part B: Cybernetics, 2010, 40(5): 1205-1218

[5] AuatC F, SteinerG, PerezP G. Optimized EIF-SLAM algorithm for precision agriculture mapping based on stems detection [J]. Computers and Electronics in Agriculture, 2011, 78(2): 195-207

[6] ChatterjeeA, MatsunoF. A Geese PSO tuned fuzzy supervisor for EKF based solutions of simultaneous localization and mapping (SLAM) problems in mobile robots [J]. Expert Systems with Applications, 2010, 37(8): 5542-5548

[7] CastellanosJ A, MartinezC R, TardósJ D. Robocentric map joining: Improving the consistency of EKF-SLAM [J]. Robotics and Autonomous Systems, 2007, 55(1): 21-29

[8] YuL-l, CaiZ-x, ZhouZ, FengZ-qiu. Fault detection and identification for dead reckoning system of mobile robot based on fuzzy logic particle filter [J]. Journal of Central South University, 2012, 19(5): 1249-1257

[9] ThrunSrobotics and cognitive approaches to spatial mapping [M], 2008, Berlin, Springer Berlin Heidelberg: 13-41

[10] KimC, SakthivelR, ChungW K. Unscented FastSLAM: A robust and efficient solution to the SLAM problem [J]. IEEE Transactions on Robotics, 2008, 24(4): 808-820

[11] ShangL, LiuG-h, ZhangR, LiG-tong. An information fusion algorithm for integrated autonomous orbit determination of navigation satellites [J]. Acta Astronautica, 2013, 85: 33-40

[12] ZhangQ, MaJ-c, LiuQiang. Improved FastSLAM2.0 based on the H_∞ filter for intelligent mobile robot [J]. Research Journal of Applied Sciences, Engineering and Technology, 2012, 16(4): 2748-2754

[13] HuG-h, MaoZ-z, HeD-kuo. Multi-objective optimization for leaching process using improved two-stage guide PSO algorithm [J]. Journal of Central South University of Technology, 2011, 18(2): 1200-1210

[14] ChangX-h, YangG-hong. Non-fragile fuzzy H_∞ filter design for nonlinear continuous-time systems with stability constraints [J]. Signal Processing, 2012, 92(2): 575-586

[15] SahooH K, DashP K, RathN P. Frequency estimation of distorted non-stationary signals using complex H_∞ filter [J]. International Journal of Electronics and Communications, 2012, 66(4): 267-274

[16] PoliR, KennedyJ, BlackwellTSwarm itelligence [M], 2007, New York, USA, Springer US: 3-57

[17] GrzonkaS, PlagemannC, GrisettiG, BurgardW. Look-ahead proposals for robust grid-based slam with rao-blackwellized particle filters [J]. The International Journal of Robotics Research, 2009, 28(2): 191-200

[18] DoucetA, FreitasNSequential monte-carlo methods in practice [M], 2001, Cambridge, USA, MIT Press: 221-235

[19] CastellanosJ A, MartinezC R, TardósJ D. Robocentric map joining: Improving the consistency of EKF-SLAM [J]. Robotics and Autonomous Systems, 2007, 55(1): 21-29