计算机科学 ›› 2017, Vol. 44 ›› Issue (8): 306-311.doi: 10.11896/j.issn.1002-137X.2017.08.053

• 图形图像与模式识别 • 上一篇    下一篇

基于迭代无迹H∞滤波的移动机器人SLAM

罗元,苏琴,张毅,管国伦   

  1. 重庆邮电大学信息无障碍工程与机器人技术研发中心 重庆400065,重庆邮电大学信息无障碍工程与机器人技术研发中心 重庆400065,重庆邮电大学信息无障碍工程与机器人技术研发中心 重庆400065,重庆邮电大学信息无障碍工程与机器人技术研发中心 重庆400065
  • 出版日期:2018-11-13 发布日期:2018-11-13
  • 基金资助:
    本文受重庆市教委科学技术研究项目基金(KJ130512),重庆市科学技术委员会项目资助

Iterated Unscented H∞ Filter Based Mobile Robot SLAM

LUO Yuan, SU Qin, ZHANG Yi and GUAN Guo-lun   

  • Online:2018-11-13 Published:2018-11-13

摘要: 为缓解移动机器人同步定位与构图(Simultaneous Localization and Mapping,SLAM)在恶劣噪声干扰下存在估计精度低、不一致及鲁棒性差的问题,提出一种新颖的基于迭代无迹H∞滤波的SLAM算法。所提算法将无迹变换融入到扩展H∞滤波中,以此估计系统状态均值和协方差,无需推导Jacobian矩阵,避免了线性化误差积累,增强了算法的数值稳定性;此外,通过迭代更新方式,利用观测信息不断校正系统状态均值和协方差,进一步减小估计误差。在仿真实验中,在不同环境和不同噪声下对比分析所提算法、EKF-SLAM、UKF-SLAM及CEHF-SLAM。结果表明所提算法在不同恶劣噪声干扰下依然能保持高的估计精度和强鲁棒性,并能适应不同的环境,是一种有效且可行的SLAM算法。

关键词: 同时定位与地图构建,迭代无迹H∞滤波,鲁棒性,估计精度

Abstract: To alleviate the problems of low estimation accuracy,serious inconsistencies and poor robustness in mobile robot simultaneous localization and mapping(SLAM),a novel iterated unscented H∞ filter based SLAM algorithm was derived.The unscented transformation is introduced into the extended H∞filter to estimate the system state mean and covariance matrix,avoiding the derivation of Jacobian matrix and linearization error accumulation.Meanwhile,the numerical stability of the algorithm is enhanced.With the iterative update method,the observation information is utilized to repeatedly correct the state mean and the covariance matrix to further lower the estimation error.The proposed algorithm was compared with EKF-SLAM,UKF-SLAM and CEHF-SLAM under different environments and noises in simulation experiments.Results show that the proposed SLAM can still maintain the high estimation accuracy and robustness in different terrible noises,and adapts to different environments.The effectiveness and feasibility of the algorithm are verified.

Key words: Simultaneous localization and mapping,Iterated unscented H∞ filter,Robustness,Estimation accuracy

[1] DURRANTWHYTE H,BAILEY T.Simultaneous localization and mapping:part I[J].IEEE Robotics & Automation Magazine,2006,13(2):99-110.
[2] BEGUM M,MANN G K I,GOSINE R G.An EvolutionarySLAM Algorithm for Mobile Robots[C]∥IEEE/RSJ International Conference on Intelligent Robots and Systems.2006:4066-4071.
[3] ESPARZA-JIMENEZ J O,DEVY M,Gordillo J L.EKF-basedSLAM fusing heterogeneous landmarks[C]∥2014 17th International Conference on Information Fusion (FUSION).IEEE,2014:1-8.
[4] LIU M,LEUNG H.EM-EKF based visual SLAM for simple robot localization[C]∥IEEE International Conference on Systems,Man and Cybernetics.IEEE,2014:3121-3125.
[5] KIM C,SAKTHIVEL R,CHUNG W K.Unscented Fast-SLAM:A robust and efficient solution to the SLAM problem[J].IEEE Transactions on Robotics,2008,24(4):808-820.
[6] HOLMES S A,KLEIN G,MURRAY D W.An O(N2) square root unscented kalman filter for visual simultaneous localization and mapping[J].IEEE Transactions on Pattern Analysis &Machine Intelligence,2009,31(7):1251-1263.
[7] HUANG G P,MOURIKIS A I,R OUMELIOTIS S I.A quadratic-complexity observability-constrained unscented kalman filter for SLAM[J].IEEE Transactions on Robotics,2013,29(5):1226-1243.
[8] LE H X,MATUNAGE S.A residual based adaptive unscented Kalman filter for fault recovery in attitude determination system of microsatellites[J].Acta Astronautica,2014,105(1):30-39.
[9] ZHU Q G,YUAN M,CHEN W D,et al.CEH∞F based SLAM algorithm for mobile robots[J].Chinese Journal of Scientific Instrument,2015,36(10):2304-2311.(in Chinese) 朱奇光,袁梅,陈卫东,等.基于CEH∞ F的移动机器人SLAM算法研究[J].仪器仪表学报,2015,36(10):2304-2311.
[10] AHMAD H,NAMERIKAWA T.Covariance inflation efficiency in H∞ filter based SLAM[C]∥2011 International Conference on Electrical,Control and Computer Engineering (INECCE).IEEE,2011:136-141.
[11] YU Y.Combining H∞ filter and cost-reference particle filter for conditionally linear dynamic systems in unknown non-Gaussian noises[J].Signal Processing,2013,93(7):1871-1878.
[12] VIET-CUONG P,JYH-CHING J.Robust and efficient SLAMvia compressed H∞ filtering[J].Asian Journal of Control,2014,16(3):878-889.
[13] CHANDRA K P B.A cubature H∞ filter and its square-rootversion[J].International Journal of Control,2014,87(4):764-776.
[14] WANG D,YUAN G,LIAN J.The application and analysis of H∞ filter based on SLAM in detection and location of underwater oil pipeline leakage[C]∥Intelligent Control and Automation.IEEE,2015:261-264.
[15] SONG Y,LI Q L,KANG Y F,et al.SLAM with square-root cubature Rao-Blackwillised particle filter[J].Acta Automatica Sinica,2014,40(2):357-367.(in Chinese) 宋宇,李庆玲,康轶非,等.平方根容积Rao-Blackwillised粒子滤波SLAM算法[J].自动化学报,2014,40(2):357-367.
[16] LI W,JIA Y.Rao-Blackwellised unscented particle filtering for jump Markov non-linear systems:an H∞ approach[J].Iet Signal Processing,2011,5(2):187-193.
[17] XIANG Z,QIAO C,MAHMOUD M S.Robust H∞ filtering for switched stochastic systems under asynchronous switching[J].Journal of the Franklin Institute,2012,349(3):1213-1230.

No related articles found!
Viewed
Full text


Abstract

Cited

  Shared   
  Discussed   
No Suggested Reading articles found!