专利名称：一种无人潜航器海流观测数据融合方法
技术领域：
本发明涉及的是一种水下无人航行器海洋观测数据处理方法。
背景技术：
无人潜航器(Unmanned Underwater Vehicles，简称UUV)又称无人水下航行器或水下机器人，是一种以水面船舶为支援平台，可长时间在水下自主远程航行的无人智能小型装备平台。UUV携带多普勒海流剖面仪(Acoustic Doppler Current Prof ile，简称ADCP) 海流测量法，属于水下自航式海洋观测技术，该海流观测方法可隐蔽观测、不受海面风浪影响、可实现全天候工作等特点，克服了传统坐底自容式海流监测方式的观测范围�。挤呕厥绽训牟蛔悖部朔怂娲靶鳤DCP观测海流时受海面环境影响严重、不能够对深�：Ａ鞴鄄獾娜毕荩鳸UV携带ADCP在水下测量海流时不能够接收到GPS信号，从而导致海流信息因缺失地理位置信息而变得不够准确和全面。而国内外文献中对于UUV搭载ADCP 在水下航行时，测得的海流剖面数据未有对其进行数据融合的相关报道。
发明内容
本发明的目的在于提供一种可以得到在大地坐标系下，准确、完整的海流剖面信息的无人潜航器海流观测数据融合方法。本发明的目的是这样实现的1.海流剖面数据获取由外壳、推进器、DVL、ADCP、姿态传感器、罗经、GPS和控制计算机组成UUV，UUV在水下一定深度航行时，ADCP在控制计算机控制下，发射一定频率的声波，利用多普勒效应获取UUV上部或下部一定水层厚度的海流剖面；2.海流剖面数据滤波对获取的海流剖面原始数据进行滤波，消除野值，并对测量的随机误差进行平滑修正；3.海流剖面数据时间配准在对海流观测数据融合之前将经过滤波处理的异步数据归算为相同时刻下的同步数据；4. UUV位置信息的推算UUV从一个已知的坐标位置开始，根据UUV在该点的航向、航速和航行时间，推算下一时刻的坐标位置；5.海流剖面数据融合将位置信息的推算所得的经纬度位置信息转换成ASCII码，插入到ADCP数据包的相应位置，更新包长与校验码之后完成位置信息与海流数据的融合。为了解决UUV携带ADCP在水下测量海流时不能够实时接收到GPS信号，从而导致海流信息因缺失地理位置信息而变得不够准确和全面的问题，本发明提出了一种UUV自身信息和海流数据融合的方法，以得到在大地坐标系下，准确、完整的海流剖面信息。为获得持续、稳定的海流剖面数据，本发明设计了一个ADCP的平台，即UUV，UUV主要有外壳、推进器、DVL、ADCP、姿态传感器、罗经、GPS和控制计算机组成，UUV在水下一定深度航行时，ADCP(换能器头向上或向下安装)在控制计算机控制下，发射一定频率的声波， 利用多普勒效应获取UUV上部或下部一定水层厚度的海流剖面。UUV携带ADCP测量海流的过程中，由于仪器的自噪声、�？鲆蛩�、声纳安装偏差和参数设置的不合理，以及姿态、罗经等传感器的误差，特别是当水层中有运动的鱼或海洋生物时，使得海流观测数据中含有异常数据(野值)和随机误差。本发明在对海流观测数据进行后处理时，对这些原始数据进行滤波，消除野值，并对测量的随机误差进行平滑修正， 提高海流数据的精度。由于DVL、姿态传感器、罗经等传感器在采样起始时间、采样频率、传输延迟上很难完全同步，测得的海流数据、UUV的速度和航向数据在融合前往往是异步的。本发明在海流观测数据融合之前先将这些异步数据归算为相同时刻下的同步数据，这一处理过程就称为海流剖面信息时间配准。UUV在水下航行时，GPS无法接收到实时的位置信息，为了获得UUV经纬度信息， 需要对UUV的位置进行推算估计，这里采用舰位推算的方法uuv从一个已知的坐标位置开始，根据UUV在该点的航向、航速和航行时间，推算下一时刻的坐标位置。UUV水下航行获得的海流剖面数据，不包含相应的经纬度位置信息，为了获得准确、全面的海流剖面数据，本发明将UUV经纬度位置信息与海流剖面信息进行数据融合将舰位推算所得的经纬度位置信息转换成ASCII码，插入到ADCP数据包的相应位置，更新包长与校验码之后便完成了位置信息与海流数据的融合。本发明相对现有技术具有如下的优点及效果本发明能够实现UUV搭载的ADCP获得的海流剖面与UUV位置信息进行数据融合， 从而得到全面、稳定、可靠的海流信息。
图1是本发明的海流观测数融合过程示意图；图2是本发明的UUV组成框图；图3是本发明的UUV位置推算示意图；图4是本发明的海流信息时间配准方案示意图；图5是本发明的融合后海流剖面信息WinRiver处理结果。
具体实施例方式下面结合附图对本发明作进一步的描述。附图2是本发明的UUV系统组成示意图，1是推进器，2是DVL，3是ADCP，4是姿态传感器，5是罗经，6是控制计算机，7是GPS，8是UUV外壳。图3是本发明中UUV位置推算原理示意图，其中初始经纬度CVWci)是指进行位置推算时初始时刻记录下的GPS经纬度，(J，W)为UUV位置推算时任意时刻UUV所在位置。1.海流剖面数据获取
通过设计一个UUV(如图1所示)来获取观测海域的海流剖面信息，该UUV主要有外壳、推进器、DVL、ADCP、姿态传感器、罗经、GPS和控制计算机组成，UUV在水下一定深度航行时，ADCP (换能器头向上或向下安装)在控制计算机控制下，发射一定频率的声波，利用多普勒效应可获取UUV上部或下部一定水层厚度的海流剖面数据，海流剖面数据通过串口 (或网口)传输到控制计算机的存储介质进行存储，这样通过UUV就可以获取到海流剖面数据。2.海流观测数据滤波UUV携带ADCP测量海流的过程中，由于仪器的自噪声、�？鲆蛩�、声纳安装偏差和参数设置的不合理，以及姿态、罗经等传感器的误差，特别是当水层中有运动的鱼或海洋生物时，使得海流观测数据中含有异常数据(野值)和随机误差。因此，在对海流观测数据进行后处理时，必须对这些原始数据进行滤波，消除野值，并对测量的随机误差进行平滑修正，提高海流数据的精度。(1)基于多项式拟合的海流数据野值剔除基于多项式拟合的野值剔除方法需要对已知的海流观测数据拟合一个多项式，再利用三倍拟合残差序列的均方误差准则进行判别剔除，较其它方法易于操作。该方法对海流观测数据野值剔除步骤如下①对已知的海流观测数据(ti; Yi), i =0,1, m，合适的次数η进行最小二乘多项式拟合，其中、为海流测量时间，Yi为海流速度大�。�
权利要求
1.一种无人潜航器海流观测数据融合方法，其特征是(1)海流剖面数据获取由外壳、推进器、DVL、ADCP、姿态传感器、罗经、GPS和控制计算机组成UUV，UUV在水下一定深度航行时，ADCP在控制计算机控制下，发射一定频率的声波，利用多普勒效应获取 UUV上部或下部一定水层厚度的海流剖面；(2)海流剖面数据滤波对获取的海流剖面原始数据进行滤波，消除野值，并对测量的随机误差进行平滑修正；(3)海流剖面数据时间配准在对海流观测数据融合之前将经过滤波处理的异步数据归算为相同时刻下的同步数据；(4)UUV位置信息的推算UUV从一个已知的坐标位置开始，根据UUV在该点的航向、航速和航行时间，推算下一时刻的坐标位置；(5)海流剖面数据融合将位置信息的推算所得的经纬度位置信息转换成ASCII码，插入到ADCP数据包的相应位置，更新包长与校验码之后完成位置信息与海流数据的融合。
2.根据权利要求1所述的一种无人潜航器海流观测数据融合方法，其特征是 所述消除野值是采用基于多项式拟合的海流数据野值剔除方法，步骤如下①对已知的海流观测数据(ti;Yi), i = 0,l,..., m，合适的次数η进行最小二乘多项式拟合，其中、为海流测量时间，Yi为海流速度大�。沪洽谇蟪鱿凳卣驝Itl,CI1，·，CIn，得到拟合多项式凡⑴=k=Q③计算出相应的拟合值序列Pi:i = 1，2， ，m;④生成拟合残差序列Ayi= Pi-yi，i = 1，2，·，m;⑤计算拟合残差序列的均方误差ο σ= /Ay1VAy22+- +Ay2mVm⑥利用3σ准则判断并剔除野值，剔除野值后的数据为γ' i :i = 1，2，·，m 当 I AyiI < 3σ 时1' i = Yi当 I AyiI > 3σ 时Yi = (Υ -3+Υ -2+Υ -1+Υ +1+Υ +2+Υ +3) /6根据式y' i = Yi和式Yi = (y^+yH+yH+yM+yM+yJ/e，若残差值小于门限值，为正少；=只常值，此值不变；若大于或等于门限值，则判断为野值，用与其相邻的六个数据的均值代替此野值；所述平滑修正是基于小波分解与重构的海流数据平滑。
3.根据权利要求1或2所述的一种无人潜航器海流观测数据融合方法，其特征是所述异步数据归算为相同时刻下的同步数据是采用基于线性插值的时间配准方案，具体过程①定义数组并赋值，分别为t□，y□，其中t[]为海流测量时间，y[]为海流速度大�。虎谑淙氪蠛档鉚；③在t数组内搜索T的位置，找到T邻近的插值节点、、ti+1，其中、彡T彡ti+1；④找到对应的y的插值节点Yi和yi+1，利用每两个相邻插值基点作线性插值，得到如下线性插值函数·Κ =+V~I7yM。
4.根据权利要求1或2所述的一种无人潜航器海流观测数据融合方法，其特征是UUV 载体航行速度在正东方向和正北方向的分量计算方法为ivE = vF sin H -vLcos// = vF cos// +vlsin H式中VE、VN——分别为载体航行速度在正东方向和正北方向的分量； VF> Vl——分别为DVL测得的载体相对大地的前向速度和左向速度； H——UUV载体的航向角，顺时针为正，由罗经测得； UUV载体航行中经纬度由以下公式进行计算ηJ = J0+T^vex1-VAt 1rmx1-dZ=I<ηw = w0+yjvn ^at/rncj^ 、 i=l式中At—DVL采样周期；J、W——分别为η时刻UUV载体所在位置的经度和纬度；Jo>W0——分别为初始时刻载体的经度和纬度，由GPS接收机测得；νΕ, α-^ν,, (η)——分别为i-Ι时刻UUV航行速度在正东方向和正北方向的分量；R , U-D^Rn, (i-D—分别为i-1时刻地球子午曲率半径和纬度圈曲率半径。
5.根据权利要求3所述的一种无人潜航器海流观测数据融合方法，其特征是UUV载体航行速度在正东方向和正北方向的分量计算方法为\ve = vf sin h -vlcosh [vw = vp cosh +vl sin h式中VE、VN——分别为载体航行速度在正东方向和正北方向的分量； VF> Vl——分别为DVL测得的载体相对大地的前向速度和左向速度； H——UUV载体的航向角，顺时针为正，由罗经测得； UUV载体航行中经纬度由以下公式进行计算η J = J0+T^vex1-VAt 1rmx1-dZ=I<ηw = w0+yjvn ^at/rncj^ 、 i=l式中At—DVL采样周期；J、W——分别为η时刻UUV载体所在位置的经度和纬度； Jo>W0——分别为初始时刻载体的经度和纬度，由GPS接收机测得；νΕ, α-^ν,, (η)——分别为i-Ι时刻UUV航行速度在正东方向和正北方向的分量； R , U-D^Rn, (i-D—分别为i-1时刻地球子午曲率半径和纬度圈曲率半径。
全文摘要
本发明提供的是一种无人潜航器海流观测数据融合方法。1、海流剖面数据获�。琔UV在水下一定深度航行时，获取UUV上部或下部一定水层厚度的海流剖面；2、海流剖面数据滤波，对获取的海流剖面原始数据进行滤波，消除野值，并对测量的随机误差进行平滑修正；3、海流剖面数据时间配准，将异步数据归算为相同时刻下的同步数据；4、UUV位置信息的推算，UUV从一个已知的坐标位置开始，根据UUV在该点的航向、航速和航行时间，推算下一时刻的坐标位置；5、海流剖面数据融合，将位置信息的推算所得的经纬度位置信息转换成ASCII码，插入到ADCP数据包的相应位置。本发明可以得到在大地坐标系下，准确、完整的海流剖面信息。
文档编号G01C13/00GK102213594SQ20111006296
公开日2011年10月12日 申请日期2011年3月16日 优先权日2011年3月16日
发明者严浙平, 张伟, 张勋, 张宏瀚, 徐健, 边信黔, 陈涛 申请人:哈尔滨工程大学
专业数控铣床产品供应商
20年生产经验，实力工厂，精工品质，质量有保障
