一种适用于极地高纬度的AUV多传感器组合回坞导引方法技术

一种适用于极地高纬度的AUV多传感器组合回坞导引方法，包括：由USBL引导AUV进行远距离回航；当AUV达到近距离范围时，基于训练好的自适应学习率BP神经网络，由磁力仪获得的磁场大小B与磁场线夹角γ作为输入得到方位角β与距离d；判断视觉是否可以识别光标，若视觉无法识别光标时，自适应学习率BP神经网络通过磁力仪获得的磁场大小B与磁场线夹角γ可以得到方位角β与距离d，回坞导航控制器将通过这一路数据进行导航；若视觉可以识别光标时，机器视觉与USBL的位置参数以及拟合得到的位置参数，通过自适应卡尔曼滤波多信息融合生成最终的方位角β与距离d，并作用于回坞导航控制器；判断AUV是否回坞，若AUV已经回坞，则结束进程，若AUV没有回坞，则重复上述步骤。则重复上述步骤。则重复上述步骤。

【技术实现步骤摘要】
一种适用于极地高纬度的AUV多传感器组合回坞导引方法


[0001]本专利技术属于探测
，具体涉及一种适用于极地高纬度的AUV多传感器组合回坞导引方法。

技术介绍

[0002]自主水下航行器(Autonomous Underwater Vehicle)，简称AUV，是一种无人操控自主导航的水下航行器。作为海洋空间探测器，AUV在科研、军事和商业领域有广泛应用如何让AUV在水下工作更久，具有更强的自主控制，更快的信息采集以及通信传输能力，是各国科研工作者的目标。由于工作在海洋空间，AUV不同于陆上和太空中的无人飞行器，目前限制AUV发展的技术难点主要有水下通信速率低，传输距离短，无法实现及时有效的信息传输，以及电池存储技术尚未有重大突破，自身携带的能源有限，导致在水下无法长时间、大范围的巡航探测，所以需要在水下固定点建立接驳站，自动导引AUV进入接驳站的坞口，实现安全对接，完成信息传输和能源补给。
[0003]回坞导引技术是实现AUV自动导引到接驳站坞口的关键技术，是保证AUV与水下接驳站顺利对接的前提。目前回坞导引方式有声学导引、光学引导和电磁导引。光学导引在非湍急水流和非污染环境中有良好的导引性能，但受到背景照明和水浊度的影响，光学导引容易受到背景照明和水浊度的影响，同时光标必须出现在AUV的摄像头视野范围内才能检测到。声学导引有效距离远，但是AUV越靠近坞口越需要快速的时间分辨率和精确的空间测量精度，声学导引系统的实时性差测量精度低的特点，使得它难以满足AUV近端回坞的要求。而电磁导引能克服光学导引易受海水清晰度影响和声学导引实时性较低的缺点，但同时也容易受到地磁场信号与其他电子设备磁场的干扰。
[0004]文献《AUV电磁导引回坞系统研究与设计》利用电磁导引AUV回坞，采用渐进式回坞方法，电磁感应线圈固定在回坞站发射低频交变磁场，磁力仪通过对磁场信号的解析可以实时获得AUV与当前位置磁场线方向的夹角和磁场大小。
[0005]申请号为202010826664.9的专利技术方法，公开了一种基于深度学习的AUV光学引导与测向方法，通过DNN网络结构进行分类，判断方位角区间，再根据方位角区间，通过改进BP神经网络判断具体方位角与斜角，根据相对位置信息引导AUV朝对接坞移动靠近，直至AUV回坞。
[0006]申请号为202010138694.0的专利技术方法，公开了一种基于多声学信标引导的AUV水下回收对接系统，包括AUV和水下回收平台。AUV通过接收声学信号计算与回收平台中轴线的偏差并修正自身位置和姿态，从而实现在水平和垂直方向上与回收平台的精准对接。
[0007]现有技术存在以下不足之处：
[0008]1)电磁导引是渐进式回坞，检测的导引信号只与AUV当前位置相关，只能获得AUV与当前位置磁场线方向的夹角，无法判断对接坞的具体方位。这是不够的。因为当AUV接近对接坞时，很有必要知道相对于对接坞的距离和方位，这样AUV可以根据相对距离调整对接策略。当距离较远时，AUV主要在对接导航设备的导引下通过主推和简单的姿态调整快速逼
近；但距离较近时，AUV就需要减速并启动动力定位控制，并根据测得的相对距离和方位实现精准的轨迹跟踪或者悬停，从而实现最终的精准对接。
[0009]2)光学导引容易受到背景照明和水浊度的影响，同时光标必须出现在AUV的摄像头视野范围内才能检测到，使得AUV在受到干扰后容易丢失视觉跟踪的导引目标。
[0010]3)声学导引有效距离远，但是AUV越靠近坞口越需要快速的时间分辨率和精确的空间测量精度，声学导引系统的实时性差测量精度低的特点，使得它难以满足AUV近端回坞的要求。此外，冰下复杂水声环境影响AUV的稳健水声通信和定位。这说明在极地冰下仅仅依靠声学是很难有效导引AUV回坞的。
[0011]4)常见的AUV导航是基于惯导和罗盘进行的，但是极地的高纬度条件会影响AUV惯导和罗盘的导航定位。

技术实现思路

[0012]针对上述
技术介绍
介绍中存在的问题，本专利技术的目的在于提供了一种适用于极地高纬度的AUV多传感器组合回坞导引方法，实现在极地高纬度条件不依赖于惯导和罗盘的AUV回坞导引方法，并且可以实时获取AUV与对接坞的相对位置，从而使得AUV可以更加精准可靠的回坞。
[0013]本专利技术采用的技术方案是：
[0014]一种适用于极地高纬度的AUV多传感器组合回坞导引方法，其具体步骤如下：
[0015]S1，由USBL引导AUV进行远距离回航；
[0016]S2，当AUV达到近距离范围时，基于训练好的自适应学习率BP神经网络，可以由磁力仪获得的磁场大小B与磁场线夹角γ作为输入得到AUV相对于对接坞的方位角β与AUV到对接坞的距离d；
[0017]S3，当AUV达到近距离范围时，判断视觉是否可以识别光标，若视觉无法识别光标时，自适应学习率BP神经网络通过磁力仪获得的磁场大小B与磁场线夹角γ可以得到方位角β与距离d，回坞导航控制器将通过这一路数据进行导航；若视觉可以识别光标时，机器视觉与USBL的基于视觉置信度的互补滤波融合得到的位置参数以及自适应学习率BP神经网络拟合得到的位置参数，二者通过自适应卡尔曼滤波多信息融合生成最终的方位角β与距离d，并作用于回坞导航控制器；
[0018]S4，判断AUV是否回坞，若AUV已经回坞，则结束进程，若AUV没有回坞，则重复上述步骤。
[0019]进一步，步骤S3中在AUV回坞时采集有效数据并存储起来用于定期更新自适应学习率BP神经网络。保证样本数据的多样性，并提高自适应学习率BP神经网络的准确度。
[0020]进一步，步骤S2中的自适应学习率BP神经网络结构，包含输入层、双隐含层、输出层，网络结构具有两输入和两输出，假设系统中共有p个训练样本，期望输出为t
n
，实际输出为0
n
，则每个样本的损失函数为：
[0021][0022]η为学习率，学习率是梯度下降算法中非常重要的一个参数，采用自适应学习率算法，利用tanh函数的非线性特点结合损失函数变化值，使学习率自适应增大或减小，公式如
[0035]d0＝w1×
d1+w2×
d2[0036]β1、β2分别为机器视觉与USBL得到的AUV与回坞站的方向夹角，d1、d2为机器视觉与USBL得到的AUV与回坞站的距离；
[0037]在融合过程中，如果视觉识别置信度为1，则输出结果就是视觉识别的数据；如果视觉识别置信度为0，则输出结果就是USBL的数据；如果USBL没有数据，则不管conf为多少，融合结果直接用视觉测得的来代替；如果视觉和USBL数据都没有，则将输出结果标记为不可用。
[0038]进一步，步骤S3中自适应卡尔曼滤波多信息融合过程如下：
[0039]以其中方位角数据β为例，常规一维卡尔曼滤波的系统状态方程和观测方程分别为：
[0040]X
k
＝AX
k
‑1[0041]Z<本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种适用于极地高纬度的AUV多传感器组合回坞导引方法，其具体步骤如下：S1，由USBL引导AUV进行远距离回航；S2，当AUV达到近距离范围时，基于训练好的自适应学习率BP神经网络，可以由磁力仪获得的磁场大小B与磁场线夹角γ作为输入得到AUV相对于对接坞的方位角β与AUV到对接坞的距离d；S3，当AUV达到近距离范围时，判断视觉是否可以识别光标，若视觉无法识别光标时，自适应学习率BP神经网络通过磁力仪获得的磁场大小B与磁场线夹角γ可以得到方位角β与距离d，回坞导航控制器将通过这一路数据进行导航；若视觉可以识别光标时，机器视觉与USBL的基于视觉置信度的互补滤波融合得到的位置参数以及自适应学习率BP神经网络拟合得到的位置参数，二者通过自适应卡尔曼滤波多信息融合生成最终的方位角β与距离d，并作用于回坞导航控制器；S4，判断AUV是否回坞，若AUV已经回坞，则结束进程，若AUV没有回坞，则重复上述步骤。2.根据权利要求1所述的一种适用于极地高纬度的AUV多传感器组合回坞导引方法，其特征在于：步骤S3中在AUV回坞时采集有效数据并存储起来用于定期更新自适应学习率BP神经网络。3.根据权利要求1所述的一种适用于极地高纬度的AUV多传感器组合回坞导引方法，其特征在于：步骤S2中的自适应学习率BP神经网络结构，包含输入层、双隐含层、输出层，网络结构具有两输入和两输出，假设系统中共有p个训练样本，期望输出为t
n
，实际输出为0
n
，则每个样本的损失函数为：η为学习率，学习率是梯度下降算法中非常重要的一个参数，采用自适应学习率算法，利用tanh函数的非线性特点结合损失函数变化值，使学习率自适应增大或减小，公式如下：η＝η(1+tanh(E
p
‑
E
p+1
))+α；E
p
‑
E
p+1
表示为第p个和第p+1个样本损失函数的变化值，α为超参数；tanh函数值域为(
‑
1,1)，因此学习率不会因为损失函数变化较大而产生过大波动；由于tanh函数调节，学习率会自适应增大，有效提升前期收敛速度，解决固定学习率前期收敛速度慢的问题；后期，随着损失函数值变化接近于0，tanh(E
p
‑
E
p+1
)值接近于0，学习率几乎以原步长速度逐渐收敛，避免学习率线性下降带来的后期步长过小、收敛速度慢或不收敛问题；考虑到部分情况存在学习率可能减小到非常小甚至是0的情况，使后期收敛变得慢，甚至陷入局部最优解，对此引入超参数α，使网络在训练后期，损失函数变化几乎为0，学习率可几乎稳定在某一值，这样可以到达更高的精度要求；根据BP神经网络反向传播的原理，为了使得连接权值和阈值沿着损失函数E的梯度下降的方向改善需要依次计算ΔW
ih
、ΔW
hj
、Δθ
j
、Δγ
h
，其中ΔW
ih
为输入层第i个神经元和隐藏层第h个神经元的连接权值变化，ΔW
hj
为隐藏层第h个神经元和输出层第j个神经元的连接权值变化，Δθ
j
为输出层第j个神经元的阈值变化，Δγ
h
为输出层第h个神经元的阈值变
化；化；化；化；起初给每个权值和阈值设立初始值，通过学习率的不断调节神经网络经过收敛得到最优的权值和阈值。4.根据权利要求1所述的一种适用于极地高纬度的AUV多传感器组合回坞导引方法，其特征在于：步骤S3中基于视觉置信度的互补滤波融合方法如下：在YOLOv5模型的视觉识别过程中，每个检测框都会被分配一个置信度conf表示该检测框中包含目标的概率，conf的值域为(0,1)，当检测框中包含目标的概率超过阈值时，该检测框被认为是有效的，并且其对应的类别标签和置信度将被输出；由于USBL在近距离对接时误差较大，置信度conf的大小在0到1之间；所以将视觉置信度作为权值调节参数求得两路数据的权重比值，这样就形成互补滤波融合得到最终的测量值；假设w1为视觉信息的权重比，则w1＝conf+λ，w2为USBL信息的权重比，则w2＝1
‑
conf
‑
λ，其中λ作为调节因子，可在不同环境对接时人为调节，在水质较为清澈的水域对接时将其调大，在水质较为混浊的水域内对接时将其调小；β0、d0为互补滤波融合后得到的最终测量数据；互补滤波融合公式为：β0＝w1×
β1+w2×
β2d0＝w1×
d1+w2×
d2β1、β2分别为机器视觉与USBL得到的AUV与回坞站的方向夹角，d1、d2为机器视觉与USBL得到的AUV与回坞站的距离；在融合过程中，如果视觉识别置信度为1，则输出结果就是视觉识别的数据；如果视觉识别置信度为0，则输出结果就是USBL的数据；如果USBL没有数据，则不管conf为多少，融合结果直接用视觉测得的来代替；如果视觉和USBL数据都没有，则将输出结果标记为不可用。5.根据权利要求4所述的一种适用于极地高纬度的AUV多传感器组合回坞导引方法，其特征在于：步骤S3中自适应卡尔曼滤波多信息融合过程如下：以其中方位角数据β为例，常规一维卡尔曼滤波的系统状态方程和观测方程分别为：X
k
＝AX
k
‑1Z
k
＝HX
k
式中：X
k
为k时刻的系统状态，Z
k
为k时刻的观测值；A为状态转移矩阵；H为测量系数参数矩阵；令自适应学习率BP神经网络拟合数据β3为系统状态带入为β
k
‑
，声光互补滤波融合数据β0为观测值带入为β
zk
，为了获得最优估计值β
k
，根据卡尔曼滤波算法获得以下五个递推公式，分别为：先验估计状态变量
β
k
‑
＝Aβ
k
‑1；先验估计误差协方差P
k
‑
＝AP
k
‑1A
T
+Q卡尔曼增益数据融合方程β
k
＝β
k
‑
+K
k
(β
zk
‑
Hβ
k
‑
)数据融合误差协方差P
k
＝(I
‑
K
k
H)P
k
‑
式中：β
k
...

【专利技术属性】
技术研发人员：彭时林，黄栩，王佳浩，于海滨，史剑光，江晓，潘斌，
申请(专利权)人：杭州电子科技大学，
类型：发明
国别省市：