LUO Yuan, XIONG Yan, ZHANG Yi. Simultaneous localization and mapping implementation based on improved iterated unscented particle filter[J]. Editorial Office of Optics and Precision Engineering, 2015,23(10z): 559-565
LUO Yuan, XIONG Yan, ZHANG Yi. Simultaneous localization and mapping implementation based on improved iterated unscented particle filter[J]. Editorial Office of Optics and Precision Engineering, 2015,23(10z): 559-565 DOI: 10.3788/OPE.20152313.0560.
Simultaneous localization and mapping implementation based on improved iterated unscented particle filter
For particle filter inconsistency in mobile robot Simultaneous Localization and Mapping(SLAM)
an improved unscented particle filter algorithm is proposed in this paper. To overcome this phenomenon mentioned above
the algorithm utilizes an iterated sigma point particle filter to generate more accurate proposal distribution
which fuses the robot's odometer information and laser information into sequential importance sampling routine through iterated update processing. The algorithm effectively improves the filter consistency and state estimation accuracy
and requires smaller number of particles. Based on the robot operating system
this algorithm is performed on a platform of Pioneer3-DX robot equipped with a URG laser range finder to compare with the traditional fast SLAM algorithm. Experimental results show that it creates a same consistency map and the improved algorithm with only 10 particles and consumes 325 s reduces the number of particles needed and improves the mapping efficiency. At the same time
the robot heading error is-1.4861
showing a lower uncertainty of the robot pose. In addition
it indicates that the stability of the improved algorithm is higher than that of the FastSLAM algorithm by comparing their variances.
关键词
Keywords
references
陈晨,程荫杭. 基于迭代无迹卡尔曼滤波的SLAM算法仿真研究[J]. 系统仿真学报,2012,24(8):1643-1650. CHEN CH, CHENG Y H. Simulation research of SLAM algorithm based on iterated unscented Kalman filter[J]. Journal of System Simulation, 2012, 24(8):1643-1650.(in Chinese)
MONTEMERLO M, THRUN S, KOLLER D, et al. FastSLAM:a factored solution to the simultaneous localization and mapping problem[C].Proceedings of the 18th National Conference on Artificial Intelligence, Cambridge, MA:MIT Press, 2002:593-598.
宋宇,李庆玲,康轶非,等. 平方根容积Rao-Blackwellised粒子滤波SLAM算法[J]. 自动化学报,2014, 40(2):357-367. SONG Y, LI Q L, KANG Y F, et al. SLAM with square-root cubature rao-Blackwellised particle filter[J]. Acta Automatica Sinice, 2014, 40(2):357-367.(in Chinese)
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.
KIM C, KIM H K, CHUNG W K. Exactly Rao-Blackwellized unscented particle filters for SLAM[C].Proceedings of the 2011 IEEE International Conference on Robotics and Automation. Shanghai, China:IEEE, 2011, 3589-3594.
MORAVEC H P. Sensor fusion in certainty grids for mobile robots[J]. AI Magazine, 1988, 9(2):61-75.
张建伟,张立新,胡颖,等. 开源机器人操作系统-ROS[M]. 北京:科学出版社,2012. ZHANG J W, ZHANG L X, HU Y, et al. The Open Source Robot Operating System-ROS[M]. Beijing:Science Press,2012.(in Chinese)
AARON M E F á ndez. Learning ROS for Robotics Programming[M]. Beijing:China Machine Press, 2014.
罗元,傅有力,程铁凤. 基于改进Rao-Blackwellized粒子滤波器的同时定位与地图构建[J]. 控制理论与应用,2015,32(2):267-272. LUO Y, FU Y L, CHENG T F. Simultaneous localization and mapping implementation based on the improved Rao-Blackwellized particle filter[J]. Control Theory & Applications, 2015, 32(2):267-272.(in Chinese)