CN110389318B - 一种基于立体六元阵的水下移动平台定位系统及方法 - Google Patents

Abstract

本发明提供了一种基于立体六元阵的水下移动平台定位系统和方法，该系统包括水面信标、立体六元阵、姿态仪、深度计和测速仪；所述水面信标用于按预先设定的时间间隔发射声学信号；所述立体六元阵安装在水下移动平台上；包括五个接收水听器与一个中心换能器，接收所述水面信标发送的声学信号。所述方法包括：立体六元阵获取相对时间延迟数据，结合水下移动平台的深度数据、姿态数据经过几何解算、坐标转换得到水下移动平台空间位置的第一估计值；然后在以水面信标为原点的测量坐标系下，建立水下移动平台的状态方程，计算得到水下移动平台的空间位置的第二估计值；将第一估计值和第二估计值进行数据融合得到所述水下移动平台空间位置的最终估计值。

Description

一种基于立体六元阵的水下移动平台定位系统及方法

技术领域

本发明涉及水声导航定位技术领域，具体涉及一种基于立体六元阵的水下移动平台定位系统及方法。

背景技术

水下移动平台是海洋科学考察、海洋资源勘探、海洋资源开发等工程的必备平台，而水下电磁波信号衰减快，卫星导航系统无法直接应用于水下移动平台定位，所以水声定位技术是目前水下定位系统的主要研究方向。

水声传感器阵列可分为线阵、面阵和立体阵。对于固定式阵列来说，线阵只能对阵列所在直线为界的半个平面进行定向；面阵可以在整个平面对目标进行定向,也可以对阵列所在平面为界的半个空间进行定向；立体阵可以对整个空间定向。

现有的水下声学定位系统主要有长基线定位系统、短基线定位系统、超短基线定位系统三种。长基线和短基线定位系统相对于超短基线定位系统来说，虽然定位精度高，但是布放和校正复杂、耗时多、缺乏灵活性。超短基线定位系统的特点则是安装方便、操作简单、成本低廉，适用于水下移动平台的定位、导航和通信。

传统超短基线一般采用平面四元阵用于水下定位，但由于平面阵本身阵元较少且缺乏垂直方向上的时延信息，因此在大俯仰角时定位性能急剧下降，同时传统超短基线定位方法中其询问应答的工作方式使得位置信息更新率低，并且往返时间的测量也会给定位精度带来一定的误差。整体而言，基于几何关系解算的超短基线平面阵应用于水下移动平台定位的探测范围与探测精度受到很大的限制。

发明内容

本发明的目的在于克服上述技术缺陷，提供了一种探测范围大、定位精度高的基于立体六元阵的水下移动平台定位系统及方法。

为了实现上述目的，本发明提出了一种基于立体六元阵的水下移动平台定位系统，该系统包括水面信标、姿态仪、深度计和测速仪；所述系统还包括立体六元阵；

所述水面信标安装在母船船底或者水面浮标底部，用于发送一次声学唤醒信号激活立体六元阵然后按预先设定的时间间隔发射声学信号；

所述立体六元阵安装在水下移动平台的顶部或者前部；包括五个接收水听器与一个收发合置的中心换能器，用于接收所述水面信标发送的声学信号；

所述姿态仪安装在水下移动平台上，用于获取水下移动平台的加速度和姿态数据；

所述深度仪安装在水下移动平台上，用于获取水下移动平台的深度信息；

所述测速仪安装在水下移动平台上，用于获得水下移动平台相对于海底的速度信息。

作为上述系统的一种改进，所述水面信标发送的声学信号包括用于多普勒频偏补偿、时延估计的宽带导频信号和用于与水下移动平台通信的宽带编码信号。

作为上述系统的一种改进，所述中心换能器为中心阵元，以中心阵元为原点建立立体六元阵坐标系：X轴指向水下移动平台艏部，Y轴指向水下移动平台右舷，Z轴正方向指向水下移动平台的垂直上方；在所述立体六元阵坐标系中，以原点为中心在X轴上对称安装两个接收水听器，以原点为中心在Y轴上对称安装两个接收水听器，在Z轴正方向上安装一个接收水听器；所有接收水听器到中心阵元的距离相等。

作为上述系统的一种改进，通过调整所述接收水听器到中心阵元的距离能够实现接收不同频率的信号。

基于上述系统，本发明还提供了一种基于立体六元阵的水下移动平台定位方法，所述方法包括：

步骤1)所述立体六元阵接收水面信标发送的声学信号，获取相对时间延迟数据；结合水下移动平台的深度数据、姿态数据经过几何解算、坐标转换得到所述水下移动平台空间位置的第一估计值；

步骤2)在以水面信标为原点的测量坐标系下，建立水下移动平台的运动方程，从而建立状态方程；通过状态方程离散与线性化、卡尔曼滤波后计算得到所述水下移动平台的空间位置的第二估计值；

步骤3)采用多源信息融合算法将所述水下移动平台的空间位置的第一估计值和第二估计值进行数据融合得到所述水下移动平台空间位置的最终估计值。

作为上述方法的一种改进，所述步骤1)具体包括以下步骤：

步骤1-1)所述水面信标先发送一次声学唤醒信号激活水下移动平台立体六元阵，然后按预先设定的时间间隔发射信号；

步骤1-2)所述立体六元阵的六个阵元依次接收发射信号，得到水下移动平台到立体六元阵的六个阵元的绝对时延t0、t1、t2、t3、t4和t5，由此得到各接收水听器与中心阵元的相对时延差t01、t02、t03、t04、t05；

步骤1-3)在所述立体六元阵坐标系中，设水面信标表示为P点，其位置为(x,y,z)，根据时延解算(x,y,z)，其中z通过深度计获取：

令：AX＝B

其中，

其中，d为接收水听器到中心换能器的距离；

利用最小二乘法求取近似解：

其中Q为A的伪逆，即Q＝(A′A)^-1A′；

步骤1-4)通过坐标变换将(x,y,z)转换到以水面信标为原点的测量坐标系下，获得水下移动平台相对于水面信标的空间坐标位置(x1,y1,z1，水面信标到水下移动平台的距离为：

所述水下移动平台空间位置的第一估计值为：(x1,y1,z1)和r1。

作为上述方法的一种改进，所述步骤2)具体包括以下步骤：

步骤2-1)建立水下移动平台的运动数学模型为：

其中，x2、y2、z2分别为以水面信标为原点的测量坐标系下的x轴、y轴和z轴的状态分量，V为水下移动平台的航速，V_cx、V_cy和V_cz洋流的三个方向的速度；θ为水下移动平台的航向角，

为水下移动平台的俯仰角；

步骤2-2)建立状态方程：

其中，

状态量

控制量

水下移动平台与水面信标之间的距离值

步骤2-3)将步骤2-2)的状态方程离散化，利用卡尔曼滤波算法进行求解，由此得到所述水下移动平台空间位置的第二估计值：(x2,y2,z2)和r2。

作为上述方法的一种改进，所述步骤3)具体包括以下步骤：

步骤3-1)根据海洋环境效应分析结果，利用自适应处理进行动态定位调整，对步骤1)得到的第一估计值和步骤2)得到的第二估计值分别进行后置滤波；

步骤3-2)根据步骤3-1)得到滤波后的两个空间位置的估计值，利用相关处理对其进行融合得到所述水下移动平台空间位置的最终估计值。

本发明的有益效果在于：

1、本发明在超短基线平面阵的基础上，设计了一种立体六元阵用于水下移动平台定位的系统，该阵型利用富余的时延信息与辅助传感器测量数据，消除俯仰探测盲区的同时还提高了距离、方位探测精度；

2、本发明的系统结合了宽带信号的多普勒补偿与高精度时延估计技术、结合了水面信标地理坐标的水声通信技术、基于多传感器协同的免校准技术、自适应后置滤波技术，使得该定位系统在工作过程中无需时间同步，无需询问，简化了水下移动平台的定位过程，可以满足水下定位系统宽范围、高精度、低功耗、小型化的要求；

3、本发明还提供了一种与航位推算类似的水下移动平台定位方法，该方法通过立体阵中心阵元建立系统运动模型、状态可观性分析、状态方程离散化与线性化、卡尔曼滤波等步骤获得水下移动平台位置估计值，由于充分考虑了实时运动状态模型，该方法非常适用于水下运动平台定位；并对两种不同算法得到的两个相对独立的位置信息，利用相关处理技术进行数据融合，从而取得比单一算法性能更精确、可靠的水下移动平台位置估计值。

附图说明

图1为本发明的实施例2提供的基于立体六元阵的水下移动平台定位方法的示意图；

图2为本发明的解算水下移动平台的空间位置的第一估计值的示意图；

图3为本发明的x轴距离差解算示意图；

图4为本发明的水下移动平台运动模型图。

具体实施方式

下面结合附图和具体实施例对本发明作进一步详细说明。

实施1

本发明的实施1提供了一种基于立体六元阵的水下移动平台定位系统，该系统包括立体六元阵、水面信标、姿态仪、深度计和测速仪；

所述水面信标安装在母船船底或者水面浮标底部，并配备卫星定位系统与深度计。

所述立体六元阵为超短基线阵列，安装在水下移动平台(包括水下AUV、UUV等)的顶部或者前部，由五个接收水听器和一个收发合置的换能器组成，以收发合置的换能器作为中心阵元建立三维坐标系，以中心阵元为立体六元阵的原点，X轴指向水下移动平台艏部，Y轴指向右舷，Z轴正方向指向平台垂直上方，在X轴与Y轴上以原点为中心对称各安装两个接收水听器；Z轴正方向上安装一个接收水听器，所有接收水听器到中心阵元的距离相等；所述五个接收水听器到原点的位置可任意扩展，以满足不同频率的接收信号。

所述姿态仪安装在水下移动平台上，获取水下移动平台加速度、姿态角(含航向角、纵倾角、横摇角)等信息；所述深度计安装在水下移动平台上，用于获取水下移动平台的深度信息；所述测速仪安装在水下移动平台上，获得水下移动平台相对于海底的速度信息。

实施例2

如图1所示，本实施例提供了一种与航位推算类似的水下移动平台定位方法，该方法采用立体六元阵的超短基线阵列并结合深度计测得的水面信标与水下移动平台的深度差信息、测速仪得到的水下移动平台相对于海底的速度信息以及姿态仪测得的航向角、纵倾角、横摇角等信息，通过几何关系解算得到水面信标相对水下移动平台的相位位置，再结合解码自水面信标发送的来自于卫星定位系统的地理坐标信息并通过坐标变换得到最终的水下移动平台的地理位置信息。然后通过立体阵中心阵元建立系统运动模型，结合状态可观性分析、状态方程离散化与线性化、卡尔曼滤波等步骤获得水下移动平台位置估计值，最后对两种不同方法得到的两个相对独立的位置信息，利用相关处理技术进行数据融合，从而取得比单一算法性能更精确、可靠的水下移动平台位置估计值。除此之外，在本实施例中，系统还结合了宽带信号的多普勒补偿与高精度时延估计技术、编码了水面信标地理坐标的水声通信技术、基于多传感器协同的免校准技术以及自适应后置滤波技术。

如图2和图3所示，在本实施例中，建立水下移动平台的几何位置模型，以立体阵中心阵元为原点，X轴指向水下移动平台艏部，Y轴指向右舷，Z轴正方向指向平台垂直上方，设水面信标在直角坐标系中表示为P点，其位置表示为(x,y,z)。立体阵中心0号阵元为收发合置换能器，阵元1-5号为接收水器阵且距离中心原点的距离相等都为d。由于采用免问询被动定位，因此无法直接获得水面信标到水下移动平台的绝对时延，只能依赖于各阵元之间的时延差间接求取。

设P点到六元立体阵阵元i的绝对时延为t0、t1、t2、t3、t4和t5；假定水下声速为恒定值c，则根据距离公式:

公式依次相减消去x²+y²+z²，有：

利用高精度时延估计算法求得各接收水听器与中心阵元的相对时延差t01、t02、t03、t04、t05为：

进一步化解得到：

其中，z可以由深度计测量得到，即未知数包括x，y，t0，将上式改写成矩阵形式:

令

则位置解算即是求取矩阵方程AX＝B的解，由于A并不是方阵，因此利用最小二乘法求取近似解，

其中Q为A的伪逆，即Q＝(A′A)^-1A′，到此，求得水面信标在P点的位置，最后，通过坐标变换将(x,y,z)转换到以水面信标为原点的测量坐标系下，获得水下移动平台相对于水面信标的空间坐标位置(x1,y1,z1，水面信标到水下移动平台的距离为：

所述水下移动平台空间位置的第一估计值为：(x1,y1,z1)和r1。

如图4所示，水下移动平台的运动数学模型为：

其中，x2、y2、z2分别为水下移动平台在以水面信标为原点的测量坐标系下的x轴、y轴和z轴的状态分量，V为水下移动平台的航速，V_cx、V_cy和V_cz洋流的三个方向的速度；θ为水下移动平台的航向角，

为水下移动平台的俯仰角(都可通过姿态仪得到)，水下移动平台的初始位置以及后续处理的位置信息由超短基线立体六元阵实时提供。

建立水下移动平台的状态模型，并定义观测模型，其中需要估计的量是，水下移动平台的当前位置(x2,y2,z2。并做如下假设：航向角θ和航速V的滤波误差为零；水下移动平台与水面信标之间的距离值r的测量噪声为高斯白噪声；洋流的流速Vc为恒定值；水面信标位置已知且固定。

由于V_cx、V_cy和V_cz为恒定值，因此

均为0；由上式可得：

令

令状态量

控制量：

水下移动平台与水面信标之间的距离值：

由此，定义观测模型

因此得到状态方程，

由于该算法是基于卡尔曼滤波的，因此需要对系统模型进行状态可观性分析，同时又由于卡尔曼滤波针对的是线性系统，因此还需要对系统进行非线性处理。对于一个非线性系统，进行可观性分析的方法是李导数法，结果表明，(1)水下移动平台在过Z轴平面上运动时，系统不可观；(2)水下移动平台的航向过水下移动平台与水面信标之间连线时，系统不可观，除此之外，系统一般可观；

由于前面分析都是基于连续系统，因此还需要对系统模型进行离散化处理得到，

X_k＝CX_k-1+DU_k-1+w_k-1，最后一项是过程噪声项，对观测模型离散化(采用泰勒展开线性化)得到，

Z_k＝H_kX_k+v_k

其中，

在对系统进行可观性分析以及离散化处理后，便可以进行卡尔曼滤波，使得状态向量X中的各项值逐渐逼近真实值，步骤如下：

①先验估计：

②更新协方差矩阵P：

其中Q为w_k的协方差矩；

③计算先验估计对应的距离：

④计算H矩阵：

⑤计算卡尔曼增益kg：

其中，R是vk的协方差矩阵

⑥后验估计：

⑦更新协方差：

X_k即为估计的水下移动平台的运动轨迹(状态量的离散化形式)，X_k中包括所要估计的水下移动平台的位置坐标(x2,y2,z2。所述水下移动平台空间位置的第二估计值：(x2,y2,z2)和r2

根据上述独立得到水下移动平台的第一估计值和第二估计值后，进行多源信息融合，以提高立体六元阵对水下移动平台的定位精度：

a)根据海洋环境效应分析结果，利用自适应处理技术进行动态定位调整，对两个独立得到的第一估计值和第二估计值分别进行后置滤波，以剔除野值，减少定位误差；

b)根据步骤a)得到滤波后的第一估计值和第二估计值，利用相关处理技术对其进行数据融合，坐标转换后得到更精确的水下移动平台地理位置信息。

最后所应说明的是，以上实施例仅用以说明本发明的技术方案而非限制。尽管参照实施例对本发明进行了详细说明，本领域的普通技术人员应当理解，对本发明的技术方案进行修改或者等同替换，都不脱离本发明技术方案的精神和范围，其均应涵盖在本发明的权利要求范围当中。

Claims (4)

1.一种基于立体六元阵的水下移动平台定位方法，基于一种基于立体六元阵的水下移动平台定位系统实现，该系统包括水面信标、姿态仪、深度计、测速仪和立体六元阵；

所述水面信标安装在母船船底或者水面浮标底部，用于发送一次声学唤醒信号激活立体六元阵然后按预先设定的时间间隔发射声学信号；

所述立体六元阵安装在水下移动平台的顶部或者前部；包括五个接收水听器与一个收发合置的中心换能器，用于接收所述水面信标发送的声学信号；

所述姿态仪安装在水下移动平台上，用于获取水下移动平台的加速度和姿态数据；

所述深度仪安装在水下移动平台上，用于获取水下移动平台的深度信息；

所述测速仪安装在水下移动平台上，用于获得水下移动平台相对于海底的速度信息；

所述方法包括：

步骤1)所述立体六元阵接收水面信标发送的声学信号，获取相对时间延迟数据；结合水下移动平台的深度数据、姿态数据经过几何解算、坐标转换得到所述水下移动平台空间位置的第一估计值；

步骤2)在以水面信标为原点的测量坐标系下，建立水下移动平台的运动方程，从而建立状态方程；通过状态方程离散与线性化、卡尔曼滤波后计算得到所述水下移动平台的空间位置的第二估计值；

步骤3)采用多源信息融合算法将所述水下移动平台的空间位置的第一估计值和第二估计值进行数据融合得到所述水下移动平台空间位置的最终估计值；

所述步骤1)具体包括以下步骤：

步骤1-1)所述水面信标先发送一次声学唤醒信号激活水下移动平台立体六元阵，然后按预先设定的时间间隔发射信号；

步骤1-2)所述立体六元阵的六个阵元依次接收发射信号，得到水面信标到立体六元阵的六个阵元的绝对时延t0、t1、t2、t3、t4和t5，由此得到各接收水听器与中心阵元的相对时延差t01、t02、t03、t04、t05；

步骤1-3)在所述立体六元阵坐标系中，设水面信标表示为P点，其位置为(x,y,z)，根据时延解算(x,y,z)，其中z通过深度计获取：

令：AX＝B

其中，

其中，d为接收水听器到中心换能器的距离；

利用最小二乘法求取近似解：

其中Q为A的伪逆，即Q＝(A′A)^-1A′；

步骤1-4)通过坐标变换将(x,y,z)转换到以水面信标为原点的测量坐标系下，获得水下移动平台相对于水面信标的空间坐标位置(x1,y1,z1)，水面信标到水下移动平台的距离为：

所述水下移动平台空间位置的第一估计值为：(x1,y1,z1)和r1；

所述步骤2)具体包括以下步骤：

步骤2-1)建立水下移动平台的运动数学模型为：

其中，x2、y2、z2分别为以水面信标为原点的测量坐标系下的x轴、y轴和z轴的状态分量，V为水下移动平台的航速，V_cx、V_cy和V_cz洋流的三个方向的速度；θ为水下移动平台的航向角，

为水下移动平台的俯仰角；

步骤2-2)建立状态方程：

其中，

状态量

控制量

水下移动平台与水面信标之间的距离值

步骤2-3)将步骤2-2)的状态方程离散化，利用卡尔曼滤波算法进行求解，由此得到所述水下移动平台空间位置的第二估计值：(x2,y2,z2)和r2；

所述步骤3)具体包括以下步骤：

步骤3-1)根据海洋环境效应分析结果，利用自适应处理进行动态定位调整，对步骤1)得到的第一估计值和步骤2)得到的第二估计值分别进行后置滤波；

步骤3-2)根据步骤3-1)得到滤波后的两个空间位置的估计值，利用相关处理对其进行融合得到所述水下移动平台空间位置的最终估计值。

2.根据权利要求1所述的基于立体六元阵的水下移动平台定位方法，其特征在于，所述水面信标发送的声学信号包括用于多普勒频偏补偿、时延估计的宽带导频信号和用于与水下移动平台通信的宽带编码信号。

3.根据权利要求1所述的基于立体六元阵的水下移动平台定位方法，其特征在于，所述中心换能器为中心阵元，以中心阵元为原点建立立体六元阵坐标系：X轴指向水下移动平台艏部，Y轴指向水下移动平台右舷，Z轴正方向指向水下移动平台的垂直上方；在所述立体六元阵坐标系中，以原点为中心在X轴上对称安装两个接收水听器，以原点为中心在Y轴上对称安装两个接收水听器，在Z轴正方向上安装一个接收水听器；所有接收水听器到中心阵元的距离相等。

4.根据权利要求1所述的基于立体六元阵的水下移动平台定位方法，其特征在于，通过调整所述接收水听器到中心阵元的距离能够实现接收不同频率的信号。

Images