基于迭代平方根UKF的SLAM 算法

赵琳; 闫鑫; 郝勇

doi:10.15892/j.cnki.djzdxb.2011.01.011

2011 , Vol. 31 >Issue 1: 157 - 160,166

DOI: https://doi.org/10.15892/j.cnki.djzdxb.2011.01.011

摘要

针对载体在大范围、多路标特征环境下,应用于SLAM的无迹卡尔曼滤波(unscentedKalmanfilter,UKF)所产生的Sigma点会逐渐偏离真实状态估计值的问题,提出了迭代测量更新的UKF-SLAM算法。当获得某一时刻观测值后,使用经过更新的状态估计值和协方差重新产生Sigma采样点,并进行UT变换,计算滤波参数。仿真结果表明,与平方根UKF-SLAM算法相比,能将载体状态估计误差在x轴和y轴分别降低约19%和21%,使载体状态估计值更接近真实值,并加快SLAM收敛速度。

关键词： UKF; 同步定位与地图构建; 状态估计; 迭代测量更新

本文引用格式

赵琳 , 闫鑫 , 郝勇 . 基于迭代平方根UKF的SLAM 算法[J]. 弹箭与制导学报, 2011 , 31(1) : 157 -160,166 . DOI: 10.15892/j.cnki.djzdxb.2011.01.011

Abstract

The sigma points whose center and covariance were predictive value and predictive variance would deviate from true value while UKF applied for large-scale outdoor SLAM. This paper advantage of an iteration mechanism in update equations of unscented SLAM Updated state estimate and covariancere applied to new sigma points while the observation obtained for one instant. Filtering parameters calculated after nscented of these sigma points, the state estimate value close to the true one, and efficiency of data association and accuracy of map building. The simulation results show that this proposed method could reduce error approximately 19% in x while 21% in y while accelerate convergence speed of SLAM.

Key words： unscented Kalman filter; SLAM; state estimate; iterat observation update

[an error occurred while processing this directive]

参考文献

[1]	Durrant-Whyte H, Bailey T. Simultaneous localization and mapping: Part I[J]. IEEE on Robotics & Automation Magazine, 2006, 13(2): 99-108.
[2]	Bailey T, Nieto J, Guivant J. Consistency of the EKF-SLAM algorithm[C]// Proc. of IEEE Conference on Intelligent Robots and System, China, 2006: 3562-3568.
[3]	Huang S, Dissanayake G. Convergence analysis for extended Kalman filter based SLAM[J]. IEEE Trans. Robotics, 2007, 23(4): 1036-1050.
[4]	Martinez-Cantin R, Castellanos JA. Unscented SLAM for large-scale outdoor environments [C]//Proc. of IEEE Conference on Intelligent Robots and Systems, Alberta, Canada, 2005: 3427-3432.
[5]	Van der Merwe R, Wan E A. The square root unscented Kalman filter for state and parameter-estimation [C]//Proceedings of the IEEE International Conference on Acoustics, SPeech, and Signal Processing, Piscataway, NJ, USA: IEEE, 2001: 3461-3464.

Options

文章导航