Abstract:Unscented Kalman filter (UKF) is lack of adaptive on-line adjustment ability that seriously decreases the estimation accuracy of system state. To deal with this problem, this paper proposes an improved SLAM (simultaneous localization and mapping) algorithm that combines the strengths of strong tracking filter (STF) and UKF. Each sampling point of UKF is updated by STF, the effects of noises on system state estimation are suppressed by optimizing filter gains, and the system state estimation converges to real values quickly. Performances of several SLAM algorithm in different noisy environments are compared by simulation. The experimental results show that this adaptive SLAM algorithm based on STF and UKF is of better adaptability and robustness.
[1] Smith R,Self M,Cheeseman E Estimating uncertain spatial relationships in robotics[M]//Autonomous robot vehicles.New York,NY,USA:Springer-Verlag,1990:167-193.
[2] Li M H,Hong B R,Luo R H.Mobile robot simultaneous localization and mapping using novel Rao-Blackweilised particle filter[J].Chinese Journal of Electronics,2007,16(1):34-39.
[3] Australian Centre for Field Robotics.Source Code[DB/OL].(2008-06-10)[2009-03-30].http://www-personal.acfr.usyd.edu.au/tbailey/.
[4] Julier S,Uhlmann J,Durrant-Whyte H F.A new method for the nonlinear transformation of means and covariances in filters and estimators[J].IEEE Transactions on Automatic Control,2000,45(3):477-482.
[5] Sunderhauf N,Lange S,Protzel P.Using the unscented Kalman filter in mono-SLAM with inverse depth parameterization for autonomous airship control[C]//IEEE International Workshop on Safety,Security and Rescue Robotics.Piscataway,NJ,USA:IEEE,2007:1-6.
[6] Julier S J.The sealed unscented transformation[C]//American Control Conference.Piseataway,NJ,USA:IEEE,2002:4555-4559.
[7] Wang X,Zhang H.A UPF-UKF framework for SLAM[C]//IEEE International Conference on Robotics and Automation.Piseataway,NJ,USA:IEEE,2007:1664-1669.
[8] Kim C,Sakthivel R,Chung W K.Unscented FastSLAM:A robust and efficient solution to the SLAM problem[J].IEEE Transactions on Robotics,2008,24(4):808-820.
[9] Shojaie K,Shahri A M.Iterated unscented SLAM algorithm for navigation of an autonomous mobile robot[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems.Piscataway,NJ,USA:IEEE,2008:1582-1587.
[10] 周东华,席裕庚,张钟俊.非线性系统带次优渐消因子的扩展卡尔曼滤波[J].控制与决策,1990,5(5):1-6.Zhou Donghua,Xi Yugeng,Zhang Zhongjun.Suboptimal fading extended Kalman filtering for nonlinear systems[J].Control and Decision,1990,5(5):1-6.
[11] Thrun S,Fox D,Bnrgard W.Monte Carlo localization with mixture proposal disttibution[C]//National Conference on Artificial Intelligence.Menlo Park,CA,USA:AAAI,2000:859-865.
[12] Julier S J,Uhlmann J K.Unscented filtering and nonlinear estimarion[J].Proceedings of the IEEE,2004,92(3):401-422.
[13] 周宏仁,敬忠良,王培德.机动目标跟踪[M].北京:国防工业出版社,1991.Zhou Hongren,Jin Zhongliang,Wang Peide.Tracking of maneuvering targets[M].Beijing:National Defense Industry Press,1991.