A Cooperative Navigation Method of EKF Moving Long Baseline for AUV Based on Pseudo-range Measurements
-
摘要: 在移动长基线(MLBL)定位中, 由于水声信号在水中传播速度较慢, 以及被定位AUV的自身运动, 导致AUV与不同浮标的距离是在不同时间不同位置测量产生的, 所以应用移动长基线会产生一定的时间延迟定位误差。本文针对该定位误差, 提出了一种基于量测伪距的EKF移动长基线时间延迟算法, 该算法利用扩展Kalman滤波, 通过对AUV的位置状态的前推, 重构了系统的量测方程,实现了量测方程同系统的量测量在时间上的一致性, 有效地解决了时间延迟产生的误差。理论分析与仿真结果均表明, 该方法可以显著提高导航定位精度。
-
关键词:
- 自主式水下航行体 /
- 移动长基线 /
- 定位误差 /
- 扩展Kalman滤波
Abstract: Moving long baseline(MLBL) localization of an autonomous undersea vehicle(AUV) will produce a certain amount of time-delay positioning error due to the slow acoustic signal propagation velocity in water and the movement of AUV itself, which cause differences in time and position in measuring the distances between an AUV and different buoys. In this paper, an extended Kalman filtering(EKF) MLBL time-delay algorithm based on pseudo-range measure-ment is proposed. In this algorithm, the EKF is adopted to reconstruct the measurement equation of the system via pushing-forward the AUV’s position states. So the measurement equation matches with the system measurement in time, and the error from time delay is eliminated. Theoretical analysis and simulation results show that the algorithm can significantly improve the accuracy of navigation and localization. -
[1] Vaganay J, Leonard J, Curcio J. Experimental Validation of the Moving Long Base-Line Navigation Concept, in Autonomous Underwater Vehicles[C]//2004 IEEE/OES, 2004: 59-69. [2] Curcio J, Leonard J, Vaganay J, et al. Experiments in Moving Baseline Navigation Using Autonomous Surface Craft[C]// 2005 MTS/IEEE International Conference on Oceans. Wash-nigon, PC, USA: IEEE, 2005:730-735. [3] Bahr A, Leonard J, Fallon M. Cooperative Localization for Autonomous Underwater Vehicles[J]. The International Jour-nal of Robotics Research, 2009, 28(6): 714-728. [4] Bahr A.Cooperative Localization for Autonomous Under-water Vehicles[D]. Massachusetts Institute of Technology and Woods Hole Oceanographic Institution, 2009. [5] Baccou P, Jouvencel B, Creuze V, et al. Cooperative Positioning and Navigation for Multiple AUV operations[C]//Oceans’01 MTS/IEEE Conference and Exhibition, Honolulu, 2001: 1816-1821. [6] 张立川, 徐德民. 基于移动长基线的多AUV协同导航[J].机器人, 2009, 40(4): 794-799.Zhang Li-chuan, Xu De-min. Cooperative Navigation of Multiple AUVs Using Moving Long Baseline[J]. Robot, 2009, 40(4): 794-799. [7] 田坦. 水下定位与导航技术[M]. 北京: 国防工业出版社, 2007.
点击查看大图
计量
- 文章访问数: 1388
- HTML全文浏览量: 13
- PDF下载量: 559
- 被引次数: 0