[发明专利]一种基于海流剖面的UUV辅助导航方法

说明书

技术领域

本发明涉及的是一种UUV导航方法，尤其涉及一种基于UUV搭载的DVL声纳数据失效情况下海流剖面辅助导航方法。

背景技术

随着水下无人航行器UUV(Unmanned Underwater Vehicle)在海洋开发中的应用越来越广泛，对UUV导航系统的精度要求也越来越高。传统航位推算法是UUV中目前最常用的导航方法之一，这种方法依赖于多普勒测速仪(DVL)采集的速度数据和姿态传感器采集的姿态数据。但是，当UUV在转弯、海水较深超过DVL底跟踪的最大范围等情况下可能发生失效，DVL一旦失效或者由于性能下降导致UUV的实时速度无法获得，只能采用DVL失效前几拍的速度信息，而UUV的速度在复杂海洋环境下是实时变化的，从而对UUV的导航产生较大的影响，推算的UUV位置信息偏差会越来越大。因此在DVL失效时，寻求一种能够有效避免因速度传感器失效或者故障导致航位推算产生较大导航误差的问题，就显得尤为迫切。

目前，国内外试图寻求一种有效的在UUV测速传感器失效情况下能够辅助UUV导航的手段。如莫军在文献《基于海流数据库的水下导航信息融合方法探讨》(系统仿真学报，2002年，第14卷第10期)中提出了基于海流数据库的水下导航信息融合方法，该方法需要大量的工作海域的海流信息，工作量大，难以推广。2009年，中国海军工程大学的吴太旗等人在文献《重力场辅助水下导航仿真及分析平台的构建》(舰船科学技术，2009年，第31卷第2期)中提出了利用重力场进行水下无人航行器辅助导航的方法，该方法需要增加重力传感器、重力基准图数据等软硬件，增加了UUV系统的复杂性。2007年，挪威等人在文献《Comparison of Mathematical Models for the HUGIN 4500 AUV Based on Experimental Data》(International Symposium on Underwater Technology)中提出了利用UUV动力学模型进行辅助导航的方法，而UUV动力学模型涉及的参数较多，难以准确确定UUV的动力学模型，从而无法保证导航的精度。

发明内容

本发明的目的在于提供一种当UUV搭载的DVL(多普勒测速仪，Doppler Velocity Log)失效时能够利用ADCP(声学多普勒海流剖面仪，Acoustic Doppler Current Profile)测得的海流剖面数据进行辅助自身导航的于海流剖面的UUV辅助导航方法。

本发明的目的是这样实现的：包括下列步骤：

(1)海流剖面数据和DVL速度获取

利用UUV携带的控制计算机控制ADCP发射一定频率的声波，利用多普勒效应获取下部紧贴UUV水层厚度的海流剖面；

利用UUV携带的控制计算机控制DVL发射一定频率的声波，利用多普勒效应获取DVL的速度，即UUV的航行速度；

(2)海流剖面的Kalman滤波

根据海流环境以及UUV自身模型的特点，建立海流剖面数据Kalman滤波数据模型；并参照海流高频残差的数量级确定海流Kalman滤波数据模型中的观测噪声方差R，同时根据DVL测得的UUV速度信息动态调节过程噪声方差Q值的大小；

(3)“UUV速度-海流信息”关系库建立

当DVL导航声纳数据有效时，利用DVL测得的UUV速度、OCTANS姿态传感器测量得到的UUV的航向信息，ADCP测量得到的海流剖面数据，建立“UUV速度-海流信息”关系库；

(4)海流剖面辅助导航

当DVL导航声纳数据失效时，利用“UUV速度-海流信息”关系库，以及ADCP声纳实时测得的海流剖面信息，推算UUV的导航速度；再根据初始UUV的经纬度和船位推算算法得到推算UUV的位置信息。

所述UUV的位置信息的获取方法为：

推算的UUV导航速度在正东方向和正北方向的分量如下式：