计算机应用 ›› 2016, Vol. 36 ›› Issue (8): 2352-2356.DOI: 10.11772/j.issn.1001-9081.2016.08.2352

• 行业与领域应用 • 上一篇    

基于自适应多提议分布粒子滤波的蒙特卡洛定位算法

罗元, 庞冬雪, 张毅, 苏琴   

  1. 重庆邮电大学 信息无障碍工程研发中心, 重庆 400065
  • 收稿日期:2016-01-25 修回日期:2016-03-06 出版日期:2016-08-10 发布日期:2016-08-10
  • 通讯作者: 庞冬雪
  • 作者简介:罗元(1972-),女,湖北宜昌人,教授,博士,主要研究方向:机器视觉、数字图像处理;庞冬雪(1991-),女,黑龙江哈尔滨人,硕士研究生,主要研究方向:移动机器人导航;张毅(1966-),男,重庆人,教授,博士,主要研究方向:移动机器人导航、多模人机交互;苏琴(1991-),女,四川眉山人,硕士研究生,主要研究方向:移动机器人导航。
  • 基金资助:
    重庆市教委科学技术研究基金资助项目(KJ130512)。

Monte Carlo localization algorithm based on particle filter with adaptive multi-proposal distribution

LUO Yuan, PANG Dongxue, ZHANG Yi, SU Qin   

  1. Engineering Research and Development Center for Information Accessibility, Chongqing University of Posts and Telecommunication, Chongqing 400065, China
  • Received:2016-01-25 Revised:2016-03-06 Online:2016-08-10 Published:2016-08-10
  • Supported by:
    This work is partially supported by Scientific and Technological Research Project Funds of Chongqing Municipal Education Commission (KJ130512).

摘要: 针对基于Cubature粒子滤波的蒙特卡罗定位(CMCL)算法存在的计算量大、实时处理能力较差的问题,提出一种基于自适应多提议分布粒子滤波的蒙特卡罗定位(AMPD-MCL)算法。该算法利用Cubature卡尔曼滤波和扩展卡尔曼滤波改进提议分布,融入当前观测信息,减弱粒子退化现象;重采样部分采用Kullback-Leibler距离(KLD)采样,根据粒子在状态空间的分布状况,在线调整下一次滤波迭代所需粒子数,从而减小计算量。仿真实验验证了自适应多提议分布粒子滤波(AMPD-PF)的有效性;同时在机器人操作系统(ROS)上进行实验,结果表明改进算法的平均定位精度达到19.891cm,定位所需粒子数稳定在60,定位时间为45.543s,较CMCL算法在定位精度上提高了71.03%,时间缩短了63.10%。实验结果表明,AMPD-MCL算法减小了定位误差,能实时在线调整粒子数,有效减少了算法计算量,提高了实时处理能力。

关键词: 蒙特卡洛定位, 多提议分布, Cubature卡尔曼滤波, 扩展卡尔曼滤波, Kullback-Leibler距离采样, 机器人操作系统

Abstract: Concerning the problems of high computation complexity and poor real-time processing capability in Monte Carlo Localization based on Cubature particle filter (CMCL), a new Monte Carlo localization algorithm based on particle filter with Adaptive Multi-Proposal Distribution (AMPD-MCL) was proposed. The proposal distribution in this algorithm was improved by using Cubature Kalman filter and the extended Kalman filter, in which the most recent measurements were added to weaken particle set degeneracy phenomenon. According to the distribution of particles in state space, Kullback-Leibler Distance (KLD) sampling was utilized in re-sampling to adjust the number of particles required for the next iteration of the filter, which reduced the amount of computation. Simulation results proved the effectiveness of Particle Filter with Adaptive Multi-Proposal Distribution (AMPD-PF). Experiments carried out on the Robot Operating System (ROS) showed that the improved algorithm achieved the average localization accuracy at 19.891cm, the number of particles needed for localization was 60, and the localization time was 45.543s; compared with CMCL algorithm, the localization accuracy was increased by 71.03%, the localization time was shortened by 63.10%. The results demonstrate that AMPD-MCL algorithm reduces localization error, adjusts the number of particles in real-time, reduces computation cost, and enhances real-time processing capability.

Key words: Monte Carlo Localization(MCL), multi-proposal distribution, Cubature Kalman filter, extended Kalman filter, Kullback-Leibler Distance(KLD)sampling, Robot Operating System(ROS)

中图分类号: