[发明专利]一种基于DVL与单信标的深远海海底电缆定位方法

说明书

本发明公开了一种基于DVL与单信标的深远海海底电缆定位方法，首先，海底电缆探测机器人在水面通过北斗卫星导航系统获取准确的位置信息；其次，当海底电缆探测机器人潜入水下时，考虑到此时DVL还无法获取对低速度，采用单信标声学定位完成对水下机器人的位置解算，同时提出一种最大熵扩展卡尔曼滤波算法用于位置解算；最后，当海底电缆探测机器人到达海底电缆附近时，采用DVL和单信标融合定位方法，并通过平均加权法提高海底电缆的定位精度。本发明可以解决深远海海底电缆定位问题，提高海缆探测的定位精度。

技术领域

本发明属于水下海底电缆探测领域，具体涉及一种基于DVL与单信标的深远海海底电缆定位方法。

背景技术

近年来，随着可再生能源的发展，海上风电场发电越来越成熟，然而随着海上风电场的发展，其带来的运维问题也越来越突出，其中海底电缆探测与维护是一项非常艰巨的任务，特别时在深远海海域。考虑到水下环境的复杂性和危险性，近年来，水下机器人自主探测越来越多。水下机器人在探测海底电缆的同时，将电缆的破损情况及自身的位置信息发到管控中心进行分析。因此水下机器人的定位准确性决定了海底电缆破损的位置精度。传统方法采用超短基线定位设备实现对水下机器人的的定位，然而，超短基设备的通信距离在水下受限，该设备只能保证几千米范围内的定位精度。在考虑定位范围的同时，基于海洋环境的复杂性，还需要解决传感器噪声问题，以及定位连续性等问题。针对上述问题，本发明提出了一种基于DVL(多普勒计程仪)与单信标的深远海海底电缆定位方法。

发明内容

发明目的：本发明为了解决深远海海底电缆定位问题，提供一种基于DVL与单信标的深远海海底电缆定位方法。

技术方案：本发明提供一种基于DVL与单信标的深远海海底电缆定位方法，包括以下步骤：

(1)海底电缆探测机器人处于水面，通过北斗获取其位置信息；

(2)在深海中水层海域采用单信标声学原理及最大熵扩展卡尔曼滤波算法实现对海底电缆探测机器人的定位；

(3)考虑DVL测量速度噪声的影响，基于滤波器实现对DVL三轴速度的降噪处理；

(4)在海缆探测区域，基于DVL和单信标的混合定位方法，通过平均加权法提高海底电缆的定位精度。

进一步地，所述海底电缆探测机器人的位置信息为：

P_R,k＝[L_BDS λ_BDS h_BDS]

其中，P_R,k表示海底电缆探测机器人k时刻的位置，L_BDS表示北斗定位系统输出的经度、λ_BDS表示北斗定位系统输出的纬度、h_BDS表示北斗定位系统输出的高度。

进一步地，所述步骤(2)实现过程如下：

状态一步预测：

其中，表示状态向量估计值；F_k-1表示非线性状态转移矩阵；A_k-1表示转移矩阵，表示如下：

X_K＝[l_d,k λ_D,k V_cx V_cy]

其中，Δt表示单信标收发周期；L_d,K表示k时刻基于单信标的经度信息；λ_D,k表示k时刻基于单信标的纬度信息；V_cx表示x方向水流速度信息；V_cy表示y方向水流速度信息；