一种水下航行器立体航行自主避让障碍物的方法技术

本发明专利技术提供了一种水下航行器立体航行自主避让障碍物的方法，包括以下步骤：S1、在水下航行器上设置不少于一个测距声纳；S2、通过测距声纳探测设定范围内的障碍物位置；S3、对探测到的障碍物进行区域划分。本发明专利技术所述的一种水下航行器立体航行自主避让障碍物的方法根据预先定义的路径或任务进行操作，通过自主避让系统，以便允许水下航行器偏离其预计的任务路线，并在水下航行器离开障碍物后返回。并在水下航行器离开障碍物后返回。并在水下航行器离开障碍物后返回。

【技术实现步骤摘要】
一种水下航行器立体航行自主避让障碍物的方法


[0001]本专利技术属于水下航行器自动避让障碍物领域，尤其是涉及一种水下航行器立体航行自主避让障碍物的方法。

技术介绍

[0002]随着自主式水下航行器探索越来越具有挑战性的地形，对于避障系统的需求也越来越迫切，水下障碍物传感器依赖于有限且易受噪声影响的声学距离传感器，航行器的机动能力有限，将其他声学设备的干扰降到最低是一个挑战。
[0003]去年，国际潜艇工程有限公司(ISE)完成了在其探险家AUV系列中增加OAS的任务。采用矢量场、反应和目标映射算法相结合的方法，开发了一个鲁棒可配置的避障系统。
[0004]国际潜艇工程探测器(ISE)是一个模块化的深潜式自主水下载具探测器(AUV)，包括一个前向自由进水部分、全直径压力船体和一个后向自由进水部分。它通常配备有惯性导航系统、多普勒测速仪、深度传感器和用于导航的海底回避声纳，用于通信的声学调制解调器、无线电和卫星调制解调器，以及用于定位的超短基线定位系统。它是高度可配置的，有效载荷传感器可以在整个飞行器生命周期的任何时候定制。有效载荷可以包括侧扫声纳、多声束回音测深仪和分层剖析器，所有这些都可以并发操作。
[0005]“探险者”自动水下航行器配备了一个底部避让声纳。BAS是一种单波束测距声纳，安装在距车辆中心线45度的地方。BAS算法是一种反应式算法，当AUV前方海底上升速度快于普通海底跟踪算法时，它可以快速降低水下机器人的航行深度。实际上，BAS作为一个垂直避让系统运作。
[0006]BAS允许AUV在许多环境中靠近海底安全操作；然而，随着AUV继续探索越来越具有挑战性的地形，增加一个分层平面避让系统变得必要。

技术实现思路

[0007]有鉴于此，本专利技术旨在提出一种水下航行器立体航行自主避让障碍物的方法，以解决上述问题中的不足之处。
[0008]为达到上述目的，本专利技术的技术方案是这样实现的：
[0009]一种水下航行器立体航行自主避让障碍物的方法，包括以下步骤：
[0010]S1、在水下航行器上设置不少于一个测距声纳；
[0011]S2、通过测距声纳探测设定范围内的障碍物位置；
[0012]S3、对探测到的障碍物进行区域划分。
[0013]进一步的，步骤S1所述测距声纳包括中心声纳、垂直声纳以及角度声纳；
[0014]中心声纳设置在水下航行器正前方，用于检测水下航行器正前方的障碍物；中心声纳将提供正负50度的覆盖范围，使水下航行器能够避开正前方的障碍物，根据其他的组合声纳采集结果确定左转操作或右转操作；
[0015]垂直声纳设置在水下航行器的左右侧，用于检测水下航行器左右侧的障碍物；
[0016]角度声纳设置在相邻的中心声纳与垂直声纳之间，用于检测水下航行器正前方的障碍物；两个角度声纳(或两个角度和一个中心)将提供可25度交互叠加的覆盖面和智能定向决策，而五个声纳将提供水下三维空间轮廓跟踪能力；
[0017]测距声纳的设置角度及数量可调节。
[0018]进一步的，步骤S2中所述的通过测距声纳探测设定范围内的障碍物位置的方法包括：
[0019]通过测距声纳采集障碍物的半径信息、位置信息和概率系数，现有声纳无法准确采集和计算上述三种数据，其中概率系数是根据经验值设定的障碍物参数系统，半径信息是对障碍物进行包裹建模形成的标志性参数；通过在障碍物半径范围内的附加声纳返回，附加声纳返回是声纳在多次频繁探测某一位置或者物体后、多次返回的信号和参数相互叠加附加形成的一种返回型数据，增加该障碍物的概率因子及因素和算子，因素为障碍物的类型、算子为该类型障碍物的计算数值和模型，概率因子是结合了因素和算子的各自概率之后形成的一个概率描述形式及对应数值；
[0020]概率随每个附加范围即障碍物形状、体积、姿态所自动形成的一个区域轮廓范围，呈指数增长的公式为：
[0021]P＝1
‑
e
‑
λ
·
n
‑
β
·
t
[0022]其中，n是范围数，λ是概率增长常数，β是时间衰减常数，t是障碍物登记后的秒数。
[0023]进一步的，设定超过概率阈值的障碍物为活动障碍物，概率阈值是由行业、用户根据经验设定的经验型数值，并且在回避算法中只使用活动障碍物，回避算法指的是探测到障碍物之后自动躲开回避这个障碍物；
[0024]设定无效障碍物，用于减少所需的数据存储量，障碍物一旦在航行器“后方”移动一定距离，就会被丢弃，标记为无效障碍物；
[0025]每个障碍物也有一个计算范围和方位，计算范围指的是障碍物轮廓、体积、形状，其方位指的是放置角度、位置、姿态，随着潜航器航向和位置的变化而更新，障碍物的距离和方位决定了水下航行器的自反行为，自反行为指的是自动反馈躲避、规避或返航；现有潜航器无法完全规避或自动处理该类型任务。
[0026]进一步的，设定避障区域、限制区域和紧急停止航行区；
[0027]若检测到障碍物位于某个限制区域内，则水下航行器不会采取任何规避措施；
[0028]若检测到障碍物位于某个避开区域内，则调整水下航行器的航向以避免碰撞；
[0029]若检测到障碍物太近以致水下航行器无法避免碰撞，代表水下航行器进入紧急停止航行区，对水下航行器启动紧急停止操作。
[0030]进一步的，在避开区域内，水下航行器偏离其航向的偏航量由以下公式确定：
[0031][0032]其中，δφ是偏航修正，K是回避增益，P是前面定义的障碍概率，rmin是最近障碍物的范围(单位为m)。
[0033]进一步的，水下航行器在检测到避障区域、限制区域和紧急停止航行区时的避让方法包括：
[0034][0035][0036]进一步的，若检测到障碍物位于某个限制区域内时，通过多声纳组合的方法将限制航行器向目标移动的航向变化。
[0037]相对于现有技术，本专利技术所述的一种水下航行器立体航行自主避让障碍物的方法具有以下优势：
[0038](1)本专利技术所述的一种水下航行器立体航行自主避让障碍物的方法根据预先定义的路径或任务进行操作，通过自主避让系统，以便允许水下航行器偏离其预计的任务路线，并在水下航行器离开障碍物后返回，该算法的其他考虑因素是，如果障碍物太近而无法避免，则需要“紧急停止”，以及适当的故障响应，以防止水下航行器偏离其计划航线太远。
附图说明
[0039]构成本专利技术的一部分的附图用来提供对本专利技术的进一步理解，本专利技术的示意性实施例及其说明用于解释本专利技术，并不构成对本专利技术的不当限定。在附图中：
[0040]图1为本专利技术实施例所述的一种水下航行器立体航行自主避让障碍物的方法示意图；
[0041]图2为本专利技术实施例所述的声纳布置示意图；
[0042]图3为本专利技术实施例所述的障碍物探测，距离和方位示意图。
具体实施方式
[00本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种水下航行器立体航行自主避让障碍物的方法，其特征在于，包括以下步骤：S1、在水下航行器上设置不少于一个测距声纳；S2、通过测距声纳探测设定范围内的障碍物位置；S3、对探测到的障碍物进行区域划分。2.根据权利要求1所述的一种水下航行器立体航行自主避让障碍物的方法，其特征在于：步骤S1所述测距声纳包括中心声纳、垂直声纳以及角度声纳；中心声纳设置在水下航行器正前方，用于检测水下航行器正前方的障碍物；中心声纳将提供正负50度的覆盖范围，使水下航行器能够避开正前方的障碍物，根据其他的组合声纳采集结果确定左转操作或右转操作；垂直声纳设置在水下航行器的左右侧，用于检测水下航行器左右侧的障碍物；角度声纳设置在相邻的中心声纳与垂直声纳之间，用于检测水下航行器正前方的障碍物；两个角度声纳(或两个角度和一个中心)将提供可25度交互叠加的覆盖面和智能定向决策，而五个声纳将提供水下三维空间轮廓跟踪能力；测距声纳的设置角度及数量可调节。3.根据权利要求1所述的一种水下航行器立体航行自主避让障碍物的方法，其特征在于，步骤S2中所述的通过测距声纳探测设定范围内的障碍物位置的方法包括：通过测距声纳采集障碍物的半径信息、位置信息和概率系数，现有声纳无法准确采集和计算上述三种数据，其中概率系数是根据经验值设定的障碍物参数系统，半径信息是对障碍物进行包裹建模形成的标志性参数；通过在障碍物半径范围内的附加声纳返回，附加声纳返回是声纳在多次频繁探测某一位置或者物体后、多次返回的信号和参数相互叠加附加形成的一种返回型数据，增加该障碍物的概率因子及因素和算子，因素为障碍物的类型、算子为该类型障碍物的计算数值和模型，概率因子是结合了因素和算子的各自概率之后形成的一个概率描述形式及对应数值；概率随每个附加范围即障碍物形状、体积、姿态所自动形成的一个区域轮廓范围，呈指数增长的公式为：P＝1
‑
e
‑
λ
·
n
‑
β
·
t其中，...

【专利技术属性】
技术研发人员：刘利钊，
申请(专利权)人：天津蓝鳍海洋工程有限公司，
类型：发明
国别省市：