基于多次测量更新的移动机器人SLAM仿真

doi:10.16182/j.cnki.joss.2015.06.020

系统仿真学报 ›› 2015, Vol. 27 ›› Issue (6): 1288-1293.doi: 10.16182/j.cnki.joss.2015.06.020

• 信息、控制、决策与仿真 • 上一篇下一篇

基于多次测量更新的移动机器人SLAM仿真

许亚芳¹, 孙作雷¹, 曾连荪¹, 张波²

1.上海海事大学信息工程学院,上海 201306;
2.中国科学院上海高等研究所,上海 201210

收稿日期:2014-05-09 修回日期:2014-11-19 出版日期:2015-06-08 发布日期:2021-01-15
作者简介:许亚芳(1989-),女,河北邢台人,硕士, 研究方向为移动机器人导航、数据融合; 孙作雷(1982-),男,山东枣庄人,博士,副教授,研究方向为移动机器人导航、多传感器融合、机器学习等。
基金资助:
国家自然科学基金项目(61105097;51279098;6140127); 上海市教育委员会科研创新项目(13YZ081)

Mobile Robot SLAM Simulation with Multi Measurement Update

Xu Yafang¹, Sun Zuoleit¹, Zeng Liansun¹, Zhang Bo²

1. Information Communication College, Shanghai Maritime University, Shanghai 201 306, China;
2. Shanghai Advanced Research Instiute, Chinese Academy of Sciences, Shanghai 201210, China

Received:2014-05-09 Revised:2014-11-19 Online:2015-06-08 Published:2021-01-15

摘要/Abstract

摘要： 针对移动机器人同时定位与地图构建(SLAM)技术中,非线性系统进行线性化处理所产生的线性化误差问题,从费切尔信息角度分析,提出多次测量更断算法。该算法利用滤波中预测和各次更新阶段状态向量的费切尔信息加权关系,解算每次测量更新后的状态估计,通过多次将更接近于真实状态的估计值融入观测信息,可得到较高精度的后验状态估计,降低线性化误差的同事提高了机器人定位与构图准确性。实验部分实现多次测量更新与一次测量更新算法的仿真与对比,结果表明:所提算法能有效降低机器人位姿误差和地图估计误差。

关键词: 移动机器人, 费切尔信息, 多次测量更新, 践性化误差

Abstract: Aiming at the problem of the accumulation of linearization error in the nonlinear system linearizing of Simultaneous Localization and Mapping (SLAM) in mobile robot, an algorithm named multi measurement update was put forward according to the analysis of Fisher information. In order to compute the state estimation after each measurement update, the Fisher information weight relationship between prediction variable and update variable was made use of Due to a number of data association with an estimation which was more close to the real data than the former, the algorithm could achieve a more accuracy posterior state. As a result, it could decrease the linearization error and improving the precision of localization and mapping. The experiments made a comparison between the multi measurement update and single measurement update. It shows that the proposed method can efficiently reduce the robot pose error and map information error.

Key words: mobile robot, Fisher information, multi measurement information, linearization error

中图分类号:

TP242

许亚芳, 孙作雷, 曾连荪, 张波. 基于多次测量更新的移动机器人SLAM仿真[J]. 系统仿真学报, 2015, 27(6): 1288-1293.

Xu Yafang, Sun Zuoleit, Zeng Liansun, Zhang Bo. Mobile Robot SLAM Simulation with Multi Measurement Update[J]. Journal of System Simulation, 2015, 27(6): 1288-1293.

参考文献

[1] Durant-Whyte H, Bailey T.Simultaneous Localization and Mapping part I[J]. Roboies & Automation Magazine IEEE (S107009932), 2006, 13(2): 99-110
[2] Zamora E, Yu W.Elipsid mebod for Simultaneous, Localization and Mapping of mobile robot[C]//Decision and Control(CDC), 2014 IEEE 53rd Annual Conference on. USA: IEEE, 2014: 5334.5339.
[3] Thrun S, Burgard W, Fox D.Peobabilistic robotics [M]. USA: MIT Press, 2005.
[4] Magaboco M, Brckon T P Cross-spectral visual simultaneous loalizaion and mapping (SLAM) with sensor handover[J]. Robor Autou Syst (S0921-88980), 2013, 61(2): 195-208.
[5] Chowdhary G, Johnson E N,Magree D, et al.GPS - denied Indoor and Outdoor Monocular Vision Aided Navigation and Control of Unmanned Aircraft[J].Journal of Field Robotics (S1556- 4959), 2013, 30(3): 415-438.
[6] Ko N Y, Kim T G.Filtering Method for Location Estimation of an Underwater Robot[J]. LAES Intermational Journal of Robotics and Automation (S8268-8185), 2014, 3(3): 168-183.
[7] Shojaei K, Shahri A M.Experimental study of iterated Kalman filters for simultaneous localization and mapping of autonomous mobile robots[J]. Journal of Intelligent & Robotic Systems (S0921-0296), 2011, 63(3-4): 575-594.
[8] Yadkuri F F, Khosrowjerdi M J. Methods for Improving the Linearization Problem of Extended Kalman Filter [J]. Jourmal of Intelligent & Robotic Systerms (S0921-0296), 2014, 3- 4(78): 1-13.
[9] Huang s. Understanding Extended Kalman Filter- Part II: Multidimensional Kalman Filter[M]. CAS, Australia: University ofTechnology Sydney, March.2009.
[10] Huang S.Understanding Extended Kalman Filter -Part m: Extended Kalman Filter[M]// Notes appear to be ftom a course based at the University of Technology Sydney. Australia: University of Technology Sydney, April 2010.
[11] 张俊根,姬红兵. IMM迭代扩展卡尔曼粒子滤波跟踪算法[J]. 电子与信息学报, 2010, 32(5): 116-1120.
[12] 陈晨,程荫杭,基于迭代无迹卡尔曼滤波的SLAM算法仿真研究[J]. 系统仿真学报,2012, 24(8): 1643-1650.(Chen Chen, Cheng Meng-hang.Simulation Research of SLAM Algorithm Based on Iterated Unscented Kalman Filter[J]. Journal of System Simulation (S1004-731X), 2012, 24(8): 1643-1650.)
[13] Zhou W, Zhao C, Guo J.The study of improving Kalman filters family for nonlinear SLAM[J]. Journal of Intelligent and Robotic Systems (S0921-0296), 2009, 56(5): 543-564.
[14] Durrant-Whyte H.Introduction to decentralised data fusion[M]. NSW2006 Australia: The University of Sydney, 2004.

基于多次测量更新的移动机器人SLAM仿真

Mobile Robot SLAM Simulation with Multi Measurement Update

PDF (PC)

可视化

被引次数

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 5

编辑推荐

Metrics

本文评价

[1]	于雅楠, 史敦煌, 华春杰. 特征点法SLAM视觉里程计自适应优化算法[J]. 系统仿真学报, 2022, 34(1): 104-112.
[2]	尤波, 王明睿, 李智, 丁亮. 基于模型预测控制的轮式移动机器人轨迹规划[J]. 系统仿真学报, 2020, 32(4): 591-600.
[3]	赵萍, 雷新宇, 陈波芝, 杨矫云. 基于TI-A*的多机器人动态规划协调方法研究[J]. 系统仿真学报, 2019, 31(5): 925-935.
[4]	苏程, 王砚麟, 刘继涛, 赵志刚. 紧耦合多机器人联合吊运系统虚拟平台仿真分析[J]. 系统仿真学报, 2015, 27(12): 2981-2987.
[5]	刘子龙, 胡少凯, 刘洁, 王亚刚. 非完整移动机器人在线辨识级联路径跟随控制[J]. 系统仿真学报, 2015, 27(11): 2748-2755.