SLAM with Square-root Cubature Rao-Blackwillised Particle Filter
-
摘要: 面向大尺度环境中的移动机器人同时定位与地图构建(Simultaneous localization and mapping,SLAM)问题,提出平方根容积Rao-Blackwillised粒子滤波SLAM算法. 算法主要特点在于:1)采用容积律计算SLAM中的非线性函数高斯权重积分,达到减小SLAM非线性模型线性化误差、提高SLAM精度的目的;2)在SLAM中直接传播误差协方差矩阵的平方根因子,避免了耗费时间的协方差矩阵分解与重构过程,提高了SLAM计算效率. 通过仿真、实验将提出的SLAM算法与FastSLAM2.0、UFastSLAM两种算法进行对比,结果表明本文算法在SLAM性能上优于另两者.Abstract: In this paper, we derive a new large-scale environment simultaneous localization and mapping (SLAM) algorithm based on square-root cubature Rao-Blackwillised particle filter. The main contributions are: 1) to enhance the SLAM performance, the effective cubature rule is utilized to calculate the Gaussian weighted integral of the nonlinear function; 2) the covariance square-root factors are directly propagated in our SLAM process. Hence, the time-expensive decompositions on covariance matrixes are avoided. The performance of the proposed algorithm is compared with FastSLAM2.0 and UFastSLAM using a serial simulations and experiments. Results show that the proposed SLAM outperforms FastSLAM2.0 and UFastSLAM.
-
[1] Durrant-Whyte H, Bailey T. Simultaneous localization and mapping: part I. IEEE Robotics and Automation Magazine, 2006, 13(2): 99-110 [2] Bailey T, Durrant-Whyte H. Simultaneous localization and mapping: part Ⅱ. IEEE Robotics and Automation Magazine, 2006, 13(3): 108-117 [3] Montemerlo M. FastSLAM: A Factored Solution to the Simultaneous Localization and Mapping Problem with Unknown Data Association[Ph.D. dissertation], Carnegie Mellon University, Pennsylvania, 2003 [4] Grisetti G, Stachniss C, Burgard W. Improved techniques for grid mapping with Rao-Blackwellized particle filters. IEEE Transactions on Robotics, 2007, 23(1): 34-46 [5] Sim R, Elinas P, Little J J. A study of the Rao-Blackwellised particle filter for efficient and accurate vision-based SLAM. International Journal of Computer Vision, 2007, 74(3): 303-318 [6] Kim C, Sakthivel R, Chung W K. Unscented FastSLAM: a robust and efficient solution to the SLAM problem. IEEE Transactions on Robotics, 2008, 24(4): 808-820 [7] Julier S J, Uhlmann J K. Unscented filtering and nonlinear estimation. Proceedings of the IEEE, 2004, 92(3): 401-422 [8] Zhu Ji-Hua, Zheng Nan-Ning, Yuan Ze-Jian, Zhang Qiang. A SLAM algorithm based on central difference particle filter. Acta Automatica Sinica, 2010, 36(2): 249-257 (祝继华, 郑南宁, 袁泽剑, 张强. 基于中心差分粒子滤波的SLAM算法. 自动化学报, 2010, 36(2): 249-257) [9] Kim C, Kim H K, Chung W K. Exactly Rao-Blackwellized unscented particle filters for SLAM. In: Proceedings of the 2011 IEEE International Conference on Robotics and Automation. Shanghai, China: IEEE, 2011. 3589-3594 [10] Song Y, Li Q L, Kang Y F, Song Y D. CFastSLAM: a new jacobian free solution to SLAM problem. In: Proceedings of the 2012 IEEE International Conference on Robotics and Automation. Saint Paul, USA: IEEE, 2012. 3063-3068 [11] Arasaratnam I, Haykin S. Cubature Kalman filters. IEEE Transactions on Automatic Control, 2009, 54(6): 1254-1269 [12] van der Merwe R, Wan E A. The square-root unscented kalman filter for state and parameter-estimation. In: Proceedings of the 2001 IEEE International Conference on Acoustic, Speech and Signal Processing. Salt Lake City, USA: IEEE, 2001. 3461-3464 [13] Guivant J E, Nebot E M. Optimization of the simultaneous localization and map-building algorithm for real-time implementation. IEEE Transactions on Robotics and Automation, 2001, 17(3): 242-257 [14] Huang S D, Wang Z, Dissanayake G. Sparse local submap joining filter for building large-scale maps. IEEE Transactions on Robotics, 2008, 24(5): 1121-1130
点击查看大图
计量
- 文章访问数: 2596
- HTML全文浏览量: 114
- PDF下载量: 2231
- 被引次数: 0