Computer Science ›› 2020, Vol. 47 ›› Issue (9): 213-218.doi: 10.11896/jsjkx.190700186

• Artificial Intelligence • Previous Articles     Next Articles

FastSLAM Algorithm Based on Adaptive Fading Unscented Kalman Filter

WANG Bing-zhou, WANG Hui-bin, SHEN Jie, ZHANG Li-li   

  1. School of Computer and Information,Hohai University,Nanjing 210098,China
  • Received:2019-07-25 Published:2020-09-10
  • About author:WANG Bing-zhou,born in 1995,postgraduate.His main research interests include signal processing and so on.
    WANG Hui-bin,born in 1967,Ph.D,professor,is a member of China Computer Federation.His main research interests include image processing and multi-source information fusion.
  • Supported by:
    National Natural Science Foundation of China (51709083).

Abstract: Simultaneous localization and mapping(SLAM) is the main method to realize autonomous navigation of robots in unknown environments and FastSLAM algorithm is a popular solution to SLAM problem.Due to the sequential importance sampling method used in FastSLAM,a few of particles have a larger weight while the weight of most particles becomes very small throughout the iterative process,which leads to particle degradation.In order to make the particle distribution more accurate and reduce the particle degradation,a FastSLAM algorithm based on adaptive fading unscented Kalman filter (AFUKF) is proposed to improve the estimation accuracy of FastSLAM algorithm.To overcome the problem of particle degradation in FastSLAM,starting from the study of particle’s proposal distribution function,this paper uses adaptive fading unscented Kalman filter (AFUKF) instead of EKF to estimate the proposed distribution function of robot’s position to avoid the linearization error of EKF.With using the idea of adaptive fading filter,the proposal distribution is closer to the posterior position of the mobile robot and the particle set degradation is relieved.The simulation results on MATLAB platform show that the mean square error of position estimation of the proposed method is 28.7% lower than that of standard FastSLAM,i.e.the estimation accuracy is improved by 28.7%.And the proposed method achieves high estimation accuracy compared with the related algorithms in recent years.When increasing the increase of the number of particles,the estimation accuracy of each algorithm is improved,and the proposed algorithm still achieves the highest estimation accuracy.The experimental results fully show that the proposed algorithm can calculate the proposed distribution function more accurately and effectively alleviate the particle degradation problem in FastSLAM algorithm,which significantly improve the estimation accuracy of FastSLAM algorithm.

Key words: Adaptive fading unscented kalman filter, Particle degradation, Proposal distribution function, Robot, Simultaneous localization and mapping

CLC Number: 

  • TP242.6
[1] DURRANT-WHYTE H,BAILEY T.Simultaneous localization and mapping:part I[J].IEEE Robotics& Automation Magazine,2006,13(2):99-108.
[2] BAILEY T,DURRANT-WHYTE H.Simultaneous localization and mapping (SLAM):part II[J].IEEE Robotics & Automation Magazine,2006,13(2):108-117.
[3] KARRER M,SCHMUCK P,CHLI M.CVI-SLAM—Collaborative Visual-Inertial SLAM[J].IEEE Robotics and Automation Letters,2018,3(4):2762-2769.
[4] GOMEZ-OJED A R,ZUIGA-NOL D,MOREON F A,et al.PL-SLAM:a Stereo SLAM System through the Combination of Points and Line Segments[J].IEEE Transactions on Robotics,2019,35(3):734-746.
[5] NIU X N,LIU H Z,YUAN J Z,et al.RGB-D Indoor Location and Map Building Based on Inliers Tracking Statistics[J]. Computer Engineering,2018,44(9):15-21,27.
[6] WANG T C,CAI Y F,TANG Z M.SLAM Method Based on Region Particle Swarm Optimization and Partial Gaussian Re-sampling[J].Computer Engineering,2017,43(11):310-316.
[7] HWANG S Y,SONG J B.Monocular vision-based SLAM in indoor environment using corner,lamp,and door features from upward-looking camera[J].IEEE Transactions on Industrial Electronics,2011,58(10):4804-4812.
[8] MUNGUIA R,SARQUIS U,YOLANDA B,et al.Vision-Based SLAM System for Unmanned Aerial Vehicles[J].Sensors,2016,16(3):372.
[9] WANG H J,FU G X,LI J,et al.Strong tracking CKF based SLAM method for unmanned underwater vehicle[J].Chinese Journal of Scientific Instrument,2013,34(11):2542-2550.
[10] CASTELLANOS J,NEIRA J,TARDOS J.Limits to the consis-tency of EKF-based SLAM[J].IFAC Proceedings Volumes,2004,37(8):716-721.
[11] HUANG S,DISSANAYAKE G.Convergence and consistencyanalysis for extended Kalman filter based SLAM[J].IEEE Transactions on Robotics,2007,23(5):1036-1049.
[12] MONTEMARLO M.FastSLAM:A factored solution to thesimultaneous localization and mapping problem[C]//Procee-dings of the AAAI National Conference on Artificial Intelligence.Menlo Park:AAAI Press,2002:593-598.
[13] BAILEY T,BROOKS A.Hybrid SLAM:Combining FastSLAM and EKF-SLAM for reliable mapping[C]//Proceedings of International Workshop on Algorithmic Foundation of Robotics VIII.Berlin:Springer,2009:647-661.
[14] ZHANG L,MENG X J,CHEN Y W.Convergence and consistency analysis for FastSLAM[C]//Proceedings of the Intelligent Vehicles Symposium.Piscataway:IEEE Press:2009:447-452.
[15] KIM C,SAKTHIVEL R,CHUNG W K.Unscented Fast-SLAM:A Robust and Efficient Solution to the SLAM Problem[J].IEEE Transactions on Robotics,2008,24(4):808-820.
[16] LIU D,DUAN J M,YU H X.FastSLAM algorithm basedon adaptive fading extended Kalman filter[J].Systems Engineering and Electronics,2016,38(3):644-651.
[17] GE Q,SHAO T,CHEN S,et al.Carrier Tracking Estimation Analysis by Using the Extended Strong Tracking Filtering[J].IEEE Transactions on Industrial Electronics,2017,64(2):1415-1424.
[18] WANG X X,ZHAO L,XIA Q X,et al.Strong tracking filter based on unscented transformation[J].Control and Decision,2010,25(7):1063-1068.
[19] PAN S,LIU H G,LI N,et al.An improved FastSLAM algorithm based on quantum particle swarm optimization immune particle filter[J].Computer Simulation,2018(8):202-205.
[20] CHEN S M,LIU J K,XIAO J.Unscented FastSLAM2.0 algorithm based on gravitational field optimization[J].ControlTheo-ry and Applications,2018,35(8):139-146.
[1] HE Xiao, ZHOU Jia-li, WU Chao. Low Cost Accurate Calibration and Tool Path Fitting Method for Milling Robot [J]. Computer Science, 2022, 49(7): 187-195.
[2] YIN Hong-jun, DENG Nan, CHENG Ya-di. Teleoperation Method for Hexapod Robot Based on Acceleration Fuzzy Control [J]. Computer Science, 2022, 49(6A): 714-722.
[3] CHENG Yu, LIU Tie-jun, TANG Yuan-gui, WANG Jian, JIANG Zhi-bin, QI Sheng. Underwater Robert Visual Simulation Based on UNITY3D [J]. Computer Science, 2021, 48(6A): 281-284.
[4] CHEN Jing-yu, GUO Zhi-jun, YIN Ya-kun. Full Traversal Path Planning and System Design of Intelligent Lawn Mower Based on Hybrid Algorithm [J]. Computer Science, 2021, 48(6A): 633-637.
[5] JIANG Hua-nan, ZHANG Shuai, LIN Yu-fei, LI Hao. Simulation Optimization and Testing Based on Gazebo of MPI Distributed Parallelism [J]. Computer Science, 2021, 48(11A): 672-677.
[6] CHEN Ji-qing, TAN Cheng-zhi, MO Rong-xian, WANG Zhi-kui, WU Jia-hua, ZHAO Chao-yang. Path Planning of Mobile Robot with A* Algorithm Based on Artificial Potential Field [J]. Computer Science, 2021, 48(11): 327-333.
[7] WANG Zi-qiang, HU Xiao-guang, LI Xiao-xiao, DU Zhuo-qun. Overview of Global Path Planning Algorithms for Mobile Robots [J]. Computer Science, 2021, 48(10): 19-29.
[8] LI Zhong-fa, YANG Guang, MA Lei and SUN Yong-kui. Research on Relocation of Substation Inspection Robot [J]. Computer Science, 2020, 47(6A): 599-602.
[9] MA Hong. Fusion Localization Algorithm of Visual Aided BDS Mobile Robot Based on 5G [J]. Computer Science, 2020, 47(6A): 631-633.
[10] LI Hu, FANG Bao-fu. Emotional Robot Collaborative Task Assignment Auction Algorithm Based on Positive GroupAffective Tone [J]. Computer Science, 2020, 47(4): 169-177.
[11] WANG Wei-guang, YIN Jian, QIAN Xiang-li, ZHOU Zi-hang. Realtime Multi-obstacle Avoidance Algorithm Based on Dynamic System [J]. Computer Science, 2020, 47(11A): 111-115.
[12] CHEN Jun-ling, QIN Xiao-lin, LI Xing-luo, ZHOU Yang-hao, BAO Bin-guo. Multi-robot Collaborative Obstacle Avoidance Based on Artificial Potential Field Method [J]. Computer Science, 2020, 47(11): 220-225.
[13] CHAI Hui-min, FANG Min, LV Shao-nan. Local Path Planning of Mobile Robot Based on Situation Assessment Technology [J]. Computer Science, 2019, 46(4): 210-215.
[14] SONG Yi-fan, ZHANG Peng, LIU Li-bo. Human-machine Interaction System with Vision-based Gesture Recognition [J]. Computer Science, 2019, 46(11A): 570-574.
[15] LI Bo, KANG Xiao-dong, GAO Wan-chun, HONG Rui, WANG Ya-ge, ZHANG Hua-li. Robot Aided Lung Biopsy Positioning Mechanism Based on CT Image Guidance [J]. Computer Science, 2019, 46(11A): 320-323.
Viewed
Full text


Abstract

Cited

  Shared   
  Discussed   
No Suggested Reading articles found!