在未知复杂海底地形环境中的自主水下机器人避碰方法

摘要

本发明涉及在未知复杂海底地形环境中的自主水下机器人避碰方法，包括以下步骤：水下机器人对采集的声纳图像数据进行处理，得到障碍目标；根据障碍目标在声纳图像中所处的区域位置，实时确定AUV避碰行为。本发明环境感知虚警率低。获取前视声呐图像，采用图像处理方式感知障碍，提高了障碍识别的准确性。能够满足AUV在复杂海底地形环境中安全无碰的执行任务。保证AUV不发生近底碰撞，也不会出现底部丢失的问题。提高探测效率。保证AUV探测作业的航迹要求，重复覆盖或留白的情况少。

权利要求

1.在未知复杂海底地形环境中的自主水下机器人避碰方法，其特征在于包括以下步骤：水下机器人对采集的声纳图像数据进行处理，得到障碍目标；

根据障碍目标在声纳图像中所处的区域位置，实时确定AUV避碰行为；

所述根据障碍目标在声纳图像中所处的区域位置，实时确定AUV避碰行为包括以下步骤：将声纳图像进行区域划分：声纳有效探测距离为3a米，以0-a、a-2a、2a-3a划分将声纳探测距离分为近距离n、中距离m、远距离f的3个等级，定义-A°至A°区域为中间区M，-A°至-B°区域为左区L，A°至C°区域为右区R；形成左侧近区域Ln，中间近区域Mn，右侧近区域Rn，左侧中区域Lm，中间中区域Mm，右侧中区域Rm，左侧远区域Lf，中间远区域Mf，右侧远区域Rf；

根据障碍目标的坐标和声纳图像的区域坐标得到障碍目标在各区域的分布；

当水下机器人的高度小于阈值时，左侧近区域Ln、中间近区域Mn、右侧近区域Rn中至少一个区域内有障碍目标时，则AUV执行避碰动作；

否则，中间近区域Mn或中间中区域Mm有障碍目标，则AUV执行避碰动作；

执行避碰动作，AUV以航行状态爬升，当坡度α＞θ，θ为AUV最大航行角度，则AUV垂直悬停爬升；

当水下机器人高度h＞(3/4)*H时，H为高度计最大量程，若声纳图像所有区域均无障碍目标，则悬停下潜至避碰前原有的高度；否则，AUV执行水平面避碰行为。

2.根据权利要求1所述的在未知复杂海底地形环境中的自主水下机器人避碰方法，其特征在于所述水下机器人对采集的声纳图像数据进行处理包括以下步骤：对声纳图像数据采用K均值聚类算法进行图像分割，得到初始障碍目标；

对初始障碍目标采用结构函数对图像进行腐蚀、膨胀得到障碍目标及其位置。

3.根据权利要求2所述的在未知复杂海底地形环境中的自主水下机器人避碰方法，其特征在于所述对声纳图像数据采用K均值聚类算法进行图像分割包括以下步骤：

1)任意选择k个对象作为初始聚类中心；

2)对于每个样本，找到其最近的聚类中心，并将其分配到距离最近的类中；xi为第i个样本点，pj为第j个初始聚类中心，则聚类中心为：其中，n为当前声纳图像数据的像素点个数；

3)重复步骤2)直至目标函数达到最小值为止，此时得到的聚类中心为初始障碍目标；

Xj为更新的新聚类中心，目标函数：

说明书

在未知复杂海底地形环境中的自主水下机器人避碰方法

技术领域

[0001] 本发明涉及自主水下机器人(简称AUV)技术领域，尤其涉及一种AUV在未知复杂海底地形环境中的避碰方法，实现AUV在未知复杂海底地形环境中安全无碰且保证海底探测任务完成的有效方法。

背景技术

[0002] 如今AUV已经在深海探测方面发挥了很大的作用，AUV要在地形极其复杂的深海环境下执行长期连续的探测任务，例如在热液烟囱附近执行近底观测使命，航行翻越海山区等。由于AUV是近海底作业，其微地貌十分复杂，且不可预知，这种作业环境具有非结构化、复杂性和动态变化的特点。当前已有的面向简单障碍场景的实时避碰方法并不能满足AUV在此类极端复杂环境下作业的需求。由此，复杂动态环境下的自主实时避碰技术是AUV的关键技术之一。

[0003] AUV避碰主要面临的问题包括，如何从含有虚警的传感器原始数据中提取障碍信息，以及如何根据障碍信息决策规避行为。以往传统的避碰大多采用水平层面上的绕行来规避障碍，但是在执行探测作业的AUV采用这种方法往往导致扫测的范围不可控，重复覆盖或留白的情况时有发生，而且经过水平面绕行避碰后恢复原路径也需要一定的航行时间，大大的降低了探测作业的效率。

发明内容

[0004] 为了使AUV在复杂海底地形环境中高效的执行探测作业，并且安全无碰的完成任务，本发明提供一种以垂直面为主的避碰方法，保证AUV不发生近底碰撞，也不会出现底部丢失的问题，并且保证AUV探测作业的航迹要求。

[0005] 本发明为实现上述目的所采用的技术方案是：在未知复杂海底地形环境中的自主水下机器人避碰方法，包括以下步骤：

[0006] 水下机器人对采集的声纳图像数据进行处理，得到障碍目标；

[0007] 根据障碍目标在声纳图像中所处的区域位置，实时确定AUV避碰行为。

[0008] 所述水下机器人对采集的声纳图像数据进行处理包括以下步骤：

[0009] 对声纳图像数据采用K均值聚类算法进行图像分割，得到初始障碍目标；

[0010] 对初始障碍目标采用结构函数对图像进行腐蚀、膨胀得到障碍目标及其位置。

[0011] 所述对声纳图像数据采用K均值聚类算法进行图像分割包括以下步骤：

[0012] 1)任意选择k个对象作为初始聚类中心；

[0013] 2)对于每个样本，找到其最近的聚类中心，并将其分配到距离最近的类中；xi为第i个样本点，pj为第j个初始聚类中心，则聚类中心为：

[0014]

[0015] 其中，n为当前声纳图像数据的像素点个数；

[0016] 3)重复步骤2)直至目标函数达到最小值为止，此时得到的聚类中心为初始障碍目标；

[0017] Xj为更新的新聚类中心，目标函数：

[0018]

[0019] 所述根据障碍目标在声纳图像中所处的区域位置，实时确定AUV避碰行为包括以下步骤：

[0020] 将声纳图像进行区域划分：将声纳探测距离分为近距离n、中距离m、远距离f的3个等级，定义-A°至A°区域为中间区M，-A°至-B°区域为左区L，A°至C°区域为右区R；形成左侧近区域Ln，中间近区域Mn，右侧近区域Rn，左侧中区域Lm，中间中区域Mm，右侧中区域Rm，左侧远区域Lf，中间远区域Mf，右侧远区域Rf；

[0021] 根据障碍目标的坐标和声纳图像的区域坐标得到障碍目标在各区域的分布；

[0022] 当水下机器人的高度小于阈值时，左侧近区域Ln、中间近区域Mn、右侧近区域Rn中至少一个区域内有障碍目标时，则AUV执行避碰动作；

[0023] 否则，中间近区域Mn或中间中区域Mm有障碍目标，则AUV执行避碰动作。

[0024] 执行避碰动作，AUV以航行状态爬升，当坡度α＞θ，θ为AUV最大航行角度，则AUV垂直悬停爬升。

[0025] 当水下机器人高度h＞(3/4)*H时，H为高度计最大量程，若声纳图像所有区域均无障碍目标，则悬停下潜至避碰前原有的高度；否则，AUV执行水平面避碰行为[0026] 本发明具有以下有益效果及优点：

[0027] 1.环境感知虚警率低。获取前视声呐图像，采用图像处理方式感知障碍，提高了障碍识别的准确性。

[0028] 2.能够满足AUV在复杂海底地形环境中安全无碰的执行任务。保证AUV不发生近底碰撞，也不会出现底部丢失的问题。

[0029] 3.提高探测效率。保证AUV探测作业的航迹要求，重复覆盖或留白的情况少。

附图说明

[0030] 图1是本发明的组成示意图；

[0031] 图2是前视声呐图像区域划分示意图；

[0032] 图3是避碰流程示意图。

具体实施方式

[0033] 下面结合附图及实施例对本发明做进一步的详细说明。

[0034] 本发明的硬件要求是一套二维图像声纳系统，一台测高设备，一套可以使AUV航行/悬停的执行机构，如图1所示。

[0035] 本发明的AUV避碰方法包括声纳图像数据的处理和垂直面优先的避碰策略。

[0036] 声纳图像数据处理包括：图像分割和图像识别2部分。

[0037] 图像分割是指把图像分成各具特性的区域并提取出感兴趣目标的技术和过程。

[0038] K均值聚类算法目的是将n个数据对象(声纳图像数据的像素点)合理地划分为k个类，使类内聚拢，类间疏散。采用均方差作为相似度测度函数。算法流程如下：

[0039] 1)确定聚类数目k，任意选择k个对象作为初始聚类中心；

[0040] 2)对于每个样本即每帧图像的像素点，找到其最近的聚类中心,并将其分配到距离最近的类中。设k为聚类中心个数，xi为第i个样本点，pj为第j个初始聚类中心，则聚类中心表示为：

[0041]

[0042] 3)重新计算更新每类的新聚类中心，不断重复迭代直至目标函数式达到最小值即聚类中心不再改变为止。Xj为更新的新聚类中心，xi为第i个样本点，n为当前声纳图像数据的像素点个数，目标函数式为：

[0043]

[0044] 图像识别，采用开运算用结构函数先对图像进行腐蚀，然后再用结构函数对腐蚀后的图像进行膨胀，能平滑图像的轮廓，消弱狭窄的部分，去掉细的突出。能够去掉声纳图像中回波强度相对很大的斑点，去除较小的亮点、清除图像的边缘毛刺及孤立点，并填补图像的漏洞和裂缝，同时保留所有的灰度和较大的亮区特征不变。

[0045] 针对二维多波束图像的特点，设定声纳图像区域划分如图2所示。定义-21°至21°区域为中间区，记为M；-65°至-21°区域为左区，记为L；21°至65°区域为右区，记为R；根据声纳有效探测距离为3a米，以0-a、a-2a、2a-3a划分为近距离n、中距离m、远距离f，3个等级；则形成识别区域为Ln左侧近区域，Mn为中间近区域，Rn为右侧近区域，Lm为左侧中区域，Mm为中间中区域，Rm为右侧中区域，Lf为左侧远区域，Mf为中间远区域，Rf为右侧远区域。

[0046] 实时避碰决策的过程就是根据障碍目标在声纳图像中所处的区域位置，实时确定AUV避碰行为的决策过程。

[0047] 垂直面优先的避碰策略，应尽量使AUV沿规划的梳形路径(Lawnmower Path)按照设定的目标高度航行，这样既可以保证在进行地形地貌探测时实现全覆盖探测，另外也可以尽量减少航向的变化，使探测任务的拼接效果更好。由于水下都是采用声呐测高，而AUV由于体积重量限制通常使用的测高声呐的作于距离都较小，因此确保AUV的对底跟踪，应尽量使AUV的对底速度有效也是非常重要的，即AUV距底距离应在计程仪的测速作用范围内，这样可以保证AUV的定位精度，确保探测期间导航数据的准确性。

[0048] 进入避碰流程如图3所示：

[0049] (1)获取高度计数据h∈(2-200)米，,AUV当前的高度值h及历史高度h0，当(h+h0)/2≤35米，AUV为近底状态，否则为远底状态。

[0050] (2)获取前视声呐图像，并结合近/远底状态及分区图像决策避碰行为。远底状态时，Mn或Mm感知到障碍时AUV航行爬升；近底状态时，Ln或Mn或Rn感知到障碍时AUV航行爬升。

[0051] (3)执行避碰动作，AUV以航行状态爬升，当坡度α＞θ，θ为AUV最大航行角度，采取垂直悬停爬升即垂直上升。

[0052] 当AUV高度h＞(3/4)*H时，H为高度计最大量程，则有丢底风险。如果前视声呐没有感知到障碍，则悬停下潜至避碰前原有的目标高度；如果前视声呐感知到障碍，触发水平面避碰行为。