欢迎访问中国科学院大学学报,今天是

中国科学院大学学报 ›› 2020, Vol. 37 ›› Issue (4): 507-515.DOI: 10.7523/j.issn.2095-6134.2020.04.010

• 电子科学 • 上一篇    下一篇

一种基于改进粒子滤波的水下采矿导航方法

张志慧1,2,3, 冯迎宾1,2, 李智刚1,2, 赵小虎1,2,3   

  1. 1. 中国科学院沈阳自动化研究所机器人学国家重点实验室, 沈阳 110016;
    2. 中国科学院机器人与智能制造创新研究院, 沈阳 110169;
    3. 中国科学院大学, 北京 100049
  • 收稿日期:2018-12-24 修回日期:2019-03-04 发布日期:2020-07-15
  • 通讯作者: 张志慧
  • 基金资助:
    Supported by National Key Research and Development Program of China (2016YFC0304102-6)

An underwater mining navigation method based on an improved particle filter

ZHANG Zhihui1,2,3, FENG Yingbin1,2, LI Zhigang1,2, ZHAO Xiaohu1,2,3   

  1. 1. State Key Laboratory of Robotics, Shenyang Institute of Automation, Chinese Academy of Sciences, Shenyang 110016, China;
    2. Institutes for Robotics and Intelligent Manufacturing, Chinese Academy of Sciences, Shenyang 110169, China;
    3. University of Chinese Academy of Sciences, Beijing 100049, China
  • Received:2018-12-24 Revised:2019-03-04 Published:2020-07-15
  • Supported by:
    Supported by National Key Research and Development Program of China (2016YFC0304102-6)

摘要: 针对水下采矿导航系统所面临的噪声具有非高斯性和频率随机性的问题,提出基于粒子滤波的深海采矿导航算法,并针对粒子滤波的粒子退化和贫化提出一种新的重采样算法。结合湖试数据,仿真实验表明新的重采样算法在获得更好的滤波精度的同时可以避免粒子贫化现象。最后,将基于改进的粒子滤波的深海采矿导航算法与基于无迹卡尔曼滤波算法的导航算法进行对比。结果表明本文提出的算法具有较高的精度和优良的鲁棒性。

关键词: 粒子滤波, 重采样, 水下采矿导航, 粒子退化, 粒子贫化

Abstract: An underwater mining navigation method based on an improved particle filter (PF) is proposed to solve the problems of non-Gaussian and intense measurement noise during underwater mining, and a new resampling algorithm is designed, as an improvement, to eliminate the influences of particle degeneration and particle impoverishment of PF. Compared to the resampling algorithms, the proposed algorithm avoids particle impoverishment and improves estimation accuracy. Finally, the estimation accuracies of underwater mining navigation algorithms based on the improved PF and the unscented Kalman filter (UKF) are compared by combining the lake trial data and underwater mining navigation model. The results of simulation experiments manifest that the proposed method has more accurate estimation and remarkable robustness.

Key words: particle filter (PF), resampling, underwater mining navigation, particle degeneration, particle impoverishment

中图分类号: