Please wait a minute...
J4  2010, Vol. 44 Issue (8): 1454-1459    DOI: 10.3785/j.issn.1008-973X.2010.08.004
自动化技术、计算机技术     
基于权值平滑的改良FastSLAM算法
陈家乾,何衍,蒋静坪
浙江大学 电气工程学院,浙江 杭州 310027
Improved FastSLAM algorithm based on importance weight smoothing
CHEN Jia-qian, HE Yan, JIANG Jing-ping
College of Electrical Engineering, Zhejiang University, Hangzhou Zhejiang 310027, China
 全文: PDF  HTML
摘要:

针对FastSLAM算法中频繁重采样会导致粒子快速坍塌,从而破化路标估计的多样性并最终影响估计结果的问题,提出一种基于权值平滑的改良算法.该方法采用平滑方式计算粒子权值,不仅考虑机器人当前的运动和观测结果,并且综合一定长度滑动窗口内的历史权值信息,可抑制由噪声和归一化等因素引起的权值过度波动,以及由此引发的频繁重采样和估计性能降低.蒙特卡罗仿真结果表明,选取合适的滑动窗口大小,改良算法能有效减少重采样次数,保持粒子多样性,显著提高估计精度.

Abstract:

Frequent resampling during the process of the FastSLAM algorithm leads to quick sample impoverishment that will subsequently cause the loss of landmark estimate diversity and affect the final estimate result. A novel improved FastSLAM algorithm based on importance weight smoothing was proposed to overcome the problem. Not only the current motion and observation information but also all the past importance weights in a sliding window influenced the current importance weights that were calculated by smoothing. So by reducing the over fluctuation of the importance weights induced by noise and normalization, the proposed method decreased the resampling times and improved the estimate effect. Monte Carlo simulations in two different environments indicate that with an appropriate sliding window the proposed method can effectively reduce the resampling frequency and achieve better estimation precision.

出版日期: 2010-09-21
:  TP 242.6  
基金资助:

国家自然科学基金资助项目(60405012,60675055)

通讯作者: 何衍,男,副教授.     E-mail: heyan@zju.edu.cn
作者简介: 陈家乾(1980-),男,浙江湖州人,博士生,从事机器人定位与地图构建的研究. E-mail: street_zju@yahoo.com.cn
服务  
把本文推荐给朋友
加入引用管理器
E-mail Alert
RSS
作者相关文章  

引用本文:

陈家乾, 何衍, 蒋静坪. 基于权值平滑的改良FastSLAM算法[J]. J4, 2010, 44(8): 1454-1459.

CHEN Jia-Gan, HE Yan, JIANG Jing-Ping. Improved FastSLAM algorithm based on importance weight smoothing. J4, 2010, 44(8): 1454-1459.

链接本文:

http://www.zjujournals.com/eng/CN/10.3785/j.issn.1008-973X.2010.08.004        http://www.zjujournals.com/eng/CN/Y2010/V44/I8/1454

[1] DURRANTWHYTE H F, RYE D, NEBOT E. Localization of autonomous guided vehicles [C]∥ Proceedings of the 8th International symposium on Robotics Research, New York: SpringerVerlag, 1995: 613625.
[2] SMITH R C, CHEESEMAN P. On the representation and estimation of spatial uncertainty [J]. The International Journal of Robotics Research, 1986, 5(4): 5668.
[3] SMITH R, SELF M, CHEESEMAN P. Estimating uncertain spatial relationships in robotics [M]. Autonomous Robot Vehicles, New York: SpringerVerlag, 1990: 167193.
[4] MURPHY K. Bayesian map learning in dynamic environments [C]∥ Advances in Neural Information processing Systems. Denver: [s.n.], 1999: 10511021.
[5] MONTEMERLO M. FastSLAM: a factored solution to the simultaneous localization and mapping problem with unknown data association[D]. Pittsburgh: Carnegie Mellon University, 2003.
[6] MONTEMERLO M, THRUN S, KOLLER D, et al. FastSLAM 20: an improved particle filtering algorithm for simultaneous localization and mapping that provably converges [C]∥ International Joint Conference on Artificial Intelligence. Acapulco: [s. n. ], 2003: 11511156.
[7] BAILEY T, NIETO J, NEBOT E. Consistency of the FastSLAM algorithm [C]∥ Proceedings of the IEEE International Conference on Robotics and Automation. Orlando: IEEE, 2006: 424429.
[8] CRISAN D, DOUCET A. A survey of convergence results on particle filtering methods for practitioners [J]. IEEE Transactions on Signal Processing, 2002, 50(3): 736746.
[9] DOUCET A. On sequential simulationbased methods for Bayesian filtering [R]. Cambridge Cambridge University,  1998.
[10] GRISETTI G, STACHNISS C, BURGARD W. Improving gridbased SLAM with RaoBlackwellized particle filters by adaptive proposals and selective resampling [C]∥ Proceedings of the IEEE International Conference on Robotics and Automation. Barcelona: IEEE, 2005: 24432448.
[11] LIU J S. Metropolized independent sampling with comparisons to rejection sampling and importance sampling [J]. Statistics and Computing, 1996, 6:113119.
[12] CUGLIARI M, MARTINELLI F. A FastSLAM algorithm based on the unscented filtering with adaptive selective resampling [C]∥ Springer Tracts in Advanced Robotics. New York: SpringerVerlag, 2008, 42: 359368.
[13] 沈庭芝, 王卫江, 闫雪梅. 数字图像处理及模式识别 [M]. 2版.北京: 北京理工大学出版社, 2007:5053.

[1] 陈明芽, 项志宇, 刘济林. 单目视觉自然路标辅助的移动机器人定位方法[J]. J4, 2014, 48(2): 285-291.
[2] 林颖, 龚小谨, 刘济林. 基于单位视球的鱼眼相机标定方法[J]. J4, 2013, 47(8): 1500-1507.
[3] 王会方, 朱世强, 吴文祥. 谐波驱动伺服系统的改进自适应鲁棒控制[J]. J4, 2012, 46(10): 1757-1763.
[4] 欧阳柳,徐进,龚小谨,刘济林. 基于不确定性分析的视觉里程计优化[J]. J4, 2012, 46(9): 1572-1579.
[5] 马丽莎, 周文晖, 龚小谨, 刘济林. 基于运动约束的泛化Field D*路径规划[J]. J4, 2012, 46(8): 1546-1552.
[6] 徐进,沈敏一,杨力,王炜强,刘济林. 基于双目光束法平差的机器人定位与地形拼接[J]. J4, 2011, 45(7): 1141-1146.
[7] 陈家乾,柳玉甜,何衍,蒋静坪. 基于栅格模型和样本集合的动态环境地图创建[J]. J4, 2011, 45(5): 794-798.
[8] 徐生林, 刘艳娜. 两足机器人的SimMechanics建模[J]. J4, 2010, 44(7): 1361-1367.
[9] 梅红, 张智丰, 赖欢欢. 基于连续时间的生产过程优化调度[J]. J4, 2010, 44(7): 1423-1427.
[10] 潘华东, 王其聪, 谢斌, 许世芳, 刘济林. 飞行时间法三维成像摄像机数据处理方法研究[J]. J4, 2010, 44(6): 1049-1056.
[11] 王立, 熊蓉, 褚健, 等. 基于模糊评价的未知环境地图构建探测规划[J]. J4, 2010, 44(2): 253-258.
[12] 陈少斌, 蒋静坪. 四轮移动机器人轨迹跟踪的最优状态反馈控制[J]. J4, 2009, 43(12): 2186-2190.