[发明专利]基于激光传感器和前视声纳的无人艇组合避障装置和方法

说明书

技术领域

本发明涉一种基于激光传感器和前视声纳的无人艇组合避障装置和方法，属于无人艇避障控制领域。

背景技术

无人艇是实现近海环境实时监测、资源探测、海洋灾害预警和防治等的重要工具，它具有模块化、无人驾驶以及高速智能等优势。为了保证航行安全，无人艇须具有对周围环境做出快速检测、分析和反应的能力，并以此为基础，运用避障控制方法，实现躲避已知或突然出现的障碍物。

目前无人艇大多采用单独使用激光传感器的方式进行避障，这种方法只能对水面障碍物有效，不能兼顾水下障碍物。

发明内容

本发明的目的在于要解决现有技术存在的问题，提供一种基于激光传感器和前视声纳的无人艇组合避障装置和方法，实现水面水下立体避障。

为解决上述技术问题，本发明基本思路是：利用激光传感器获得无人艇前方一定范围内水面障碍物信息，前视多波束声纳获得无人艇前方一定范围内水下障碍物信息的特点，本方法通过两种传感器栅格数据投影的方法计算无人艇前方障碍物信息，并根据一定的控制策略完成无人艇的组合避障。

根据上述发明构思，本发明采用下述技术方案：

一种基于激光传感器和前视声纳的无人艇组合避障装置, 包括：无人艇、避障控制主板、GPS、激光传感器、前视多波束声纳，主控计算机，所述避障控制主板安装于所述无人艇内部，分别与所述激光传感器、GPS相连，并通过电缆与主控计算机相连；所述激光传感器通过支架安装在无人艇甲板前方，优选在甲板前方正中线上；所述GPS传感器安装于无人艇甲板高处，优选在最高处的正中线上；所述前视多波束声纳固定安装于艇底前方，并与水线成一定倾斜角。

本发明避障策略具体过程如下:

1)     用栅格数组描述激光传感器探测信息及前视多波束声纳探测信息，分别为第一栅格数组和第二栅格数组，将第一栅格数组和第二栅格数组投影到组合第三栅格数组；

2)     设定当前障碍物距无人艇最小距离为                                                ，最小可通行半径为，最小安全距离，紧急臂章区最大半径r₂，精确规划区最大半径r₃，紧急避障区范围为，精确规划区为，直接趋向区为，当相邻两障碍物中间距离大于，视此区域为可通行区域，与当前无人艇最近的可通行区域为最近可通行区域；

3)     如果组合第三栅格数组没有障碍物，则沿主航线航行。若上一节组合第三栅格数组中含有障碍物信息，并且当前执行的任务是航渡任务，则以当前位置为起点、航渡目标点为终点重新规划一条新的航线；

4)     如果组合第三栅格数组中有障碍物，但是不阻碍主航线，即主航线在可通行区域内，则沿主航线直线航行；

5)     如果组合第三栅格数组中有障碍物，阻碍主航线，且位于紧急避障区，无人艇紧急停止，若此时距离障碍物距离小于最小安全距离，则实现倒车，直到大于或保持最小安全距离，当大于最小安全距离，寻找最近可通行区域，然后转入步骤7）；

6)     如果组合第三栅格数组中有障碍物,阻碍主航线,且位于精确规划区内,则寻找最近可通行区域；

7)     如果组合第三栅格数组中有障碍物，阻碍障碍物，且位于直接趋向区，则无人艇继续沿主航线航行，直至进入精确规划区；

8)     寻找到最近可执行区域后，以可执行区域中距离无人艇最近点为目标点，以当前无人艇位置为初始点，重新设定航线进入航渡过程；直至航线中无障碍物信息，以当前位置为起点，航渡目标点为终点重新规划路径。

本发明与现有技术相比较，具有如下突出特点和显著进步：本发明采用安装在无人艇甲板前方的激光传感器获得水面障碍物信息，通过数据处理，进而得到障碍物与激光传感器之间的关系，所探测的障碍物信息用第一栅格数组表述；所述GPS传感器安装于无人艇甲板高处，用于探测无人艇当前的位置信息；所述前视多波束声纳固定安装于艇底前方，并与水线成一定倾斜角，防止船速过快时露出水面，用于探测水下障碍物信息，所探测的障碍物信息用第二栅格数组表述，通过栅格投影技术进行计算获得组合障碍物信息，同时实现水下水面立体避障。本发明的避障控制系统可广泛适用于各种无人艇的避障控制。

附图说明

图1是本发明无人艇避障装置平面结构示意图。

图2是本发明的控制系统原理图。

图3是本发明无人艇障碍物栅格投影图。

图4是本发明无人艇避障区域划分图。

具体实施方式