针对潜器惯导定位误差修正问题,提出惯导/多信标水声测距组合导航实现方法,并主要针对由于潜器运动与水声传播时间延迟导致的误差进行分析,提出一种基于水声传播时延补偿的水下惯导定位误差修正方法,该方法利用扩展卡尔曼滤波,通过对惯导系统位置误差状态的前推,重构量测方程,实现量测方程与系统量测量时间的一致性,补偿时间延迟产生的误差。仿真结果表明,该方法可有效提高惯导/多信标水声测距组合导航系统对惯导定位误差修正的精度。
In allusion to positioning error correction for underwater vehicle INS(Inertial Navigation System), the INS/multi-becons acoustic range measurements integrating method is proposed. The error result from vehicle motion and acoustic propagation time is mainly analyzed, and a correcting positioning error algorithm based on acoustic propagation time compensation is presented. In this algorithm, the EKF(Extended Kalman Filters) is adopted, and the measurement equation is reconstructed via pushing-forward the INS's position error states. As a result, the measurement equation and the system measurement become synchronous, and the error from time delay is eliminated. The simulation results indicate that the algorithm can significantly improve the accuracy of correcting INS positioning error with INS/multi-becons acoustic range measurements integrated navigation system.
2016,38(3): 97-100 收稿日期：2015-07-16
DOI：10.3404/j.issn.1672-7619.2016.03.020
分类号：U666.11
作者简介：陈建华(1987-),男,博士研究生,主要从事水下导航及信息融合技术研究。
参考文献：
[1] 刘芙蓉, 陈辉. 自主式水下潜器研究开发综述[J]. 舰船科学技术, 2008, 30(5):20-23. LIU Fu-rong, CHEN Hui. A review of the development and research of autonomous underwater vehicles[J]. Ship Science and Technology, 2008, 30(5):20-23.
[2] 冀大雄, 刘健, 周波, 等. 深水机器人低成本导航系统的位置估计方法研究[J]. 仪器仪表学报, 2009, 30(1):35-38. JI Da-xiong, LIU Jian, ZHOU Bo, et al. Position estimation method for deep water vehicle using low-cost navigation sensors[J]. Chinese Journal of Scientific Instrument, 2009, 30(1):35-38.
[3] 张立川, 徐德民, 刘明雍. 双伪测量的多水下航行器移动长基线协同导航算法[J]. 火力与指挥控制, 2013, 38(1):34-36. ZHANG Li-chuan, XU De-min, LIU Ming-yong. Cooperative navigation method of multiple autonomous underwater vehicles based on double acoustic measurement[J]. Fire Control & Command Control, 2013, 38(1):34-36.
[4] 张福斌, 马朋. 一种基于虚拟移动长基线的多AUV协同导航算法[J]. 鱼雷技术, 2013, 21(2):115-119. ZHANG Fu-bin, MA Peng. A cooperative navigation algorithm of multiple AUVs based on synthetic moving long baseline[J]. Torpedo Technology, 2013, 21(2):115-119.
[5] ENGEL R, KALWA J. Relative positioning of multiple underwater vehicles in the GREX project[C]//Proceedings of the 2009-EUROPE Oceans. Bremen:IEEE, 2009:1-7.
[6] WOITHE H C, KREMER U. Using slocum gliders for coordinated spatial sampling[C]//Proceedings of the 2011 IEEE-Spain Oceans. Santander:IEEE, 2011:1-8.
[7] 刘明雍, 黄博, 蔡挺. 一种基于量测伪距的EKF移动长基线AUV协同导航方法[J]. 鱼雷技术, 2012, 20(6):432-436. LIU Ming-yong, HUANG Bo, CAI Ting. A cooperative navigation method of EKF moving long baseline for AUV based on pseudo-range measurements[J]. Torpedo Technology, 2012, 20(6):432-436.
[8] 高伟, 杨建, 刘菊, 等. 基于水声通信延迟的多UUV协同定位算法[J]. 系统工程与电子技术, 2014, 36(3):539-545. GAO Wei, YANG Jian, LIU Ju, et al. Cooperative location of multiple UUVs based on hydro-acoustic communication delay[J]. Systems Engineering and Electronics, 2014, 36(3):539-545.
[9] 陈云飞, 李桂娟, 贾兵, 等. 水下合作目标三维定位技术[J]. 舰船科学技术, 2010, 32(5):48-51. CHEN Yun-fei, LI Gui-juan, JIA Bing, et al. Underwater cooperate target 3D positioning[J]. Ship Science and Technology, 2010, 32(5):48-51.
[10] 葛锡云, 申高展, 潘琼文, 等. 基于惯性导航/地磁的水下潜器组合导航定位方法[J]. 舰船科学技术, 2014, 36(11):120-124. GE Xi-yun, SHEN Gao-zhan, PAN Qiong-wen, et al. The underwater integrated navigation method of underwater vehicle based on INS/geomagnetic[J]. Ship Science and Technology, 2014, 36(11):120-124.
