一种水面无人艇避障方法与流程

1.本发明属于水面无人艇自主任务决策技术领域，更具体地，涉及一种针对静态和动态障碍物进行避障的水面无人艇避障方法。


背景技术：

2.水面无人艇作为一种水面无人装备，在执行危险任务时，具有独特优势，同时无人艇具有高航速、模块化等特点，通过换装任务载荷，可以适用不同的任务场景，因此水面无人艇的发展也越来越受到重视；自主避障是无人艇能进行自主航行的基础，水面障碍物类型多样，根据移动性可以将障碍物划分为静态和动态两类，因此，如何针对静态和动态障碍物进行路径规划和避障，为无人艇自主航行的安全提供保障是目前亟需解决的问题。


技术实现要素：

3.针对现有技术的以上缺陷或改进需求，本发明提出了一种水面无人艇避障方法，针对水面艇航行区域附近出现的静态和/或动态障碍物，利用联合避障算法，支撑无人艇完成自主避障动作，为无人艇自主航行的安全提供保障。
4.为实现上述目的，本发明提供了一种水面无人艇避障方法，包括：
5.根据航行区域全局信息，考虑已知的障碍物，根据先验的电子海图，结合起始位置，完成路径规划；
6.在航行过程中，获取动态障碍物，结合航行区本艇所在位置，完成局部避障。
7.在一些可选的实施方案中，所述根据航行区域全局信息，考虑已知的障碍物，根据先验的电子海图，结合起始位置，完成路径规划，包括：
8.根据无人艇实际航行区域，选择实际航行区域的电子海图，将该电子海图栅格化后提取实际航行区域的静态障碍物，将静态障碍物所在区域视为不可达区域，其余区域划分为可达区域，得到二值化后的电子海图；
9.利用a*算法，结合二值化的电子海图，规划一条从起点到终点的目标路径。
10.在一些可选的实施方案中，所述在航行过程中，获取动态障碍物，结合航行区本艇所在位置，完成局部避障，包括：
11.在无人艇根据目标路径进行航行时，不间断的获取动态障碍物，并将动态障碍物定位于二值化的电子海图中，当某一动态障碍物与本艇的距离小于预设安全距离，且本艇航向位于障碍区域时，进行局部避障。
12.在一些可选的实施方案中，所述障碍区域的确定方式为：
13.设本艇的行驶速度为以本艇o0为坐标原点，建立直角坐标系，动态移动目标o1行驶速度为以o1为中心，进行半径为r的圆形膨胀c作为不可达区域，经o0做圆c的切线l
r
和l
l
，l
r
与l
l
的夹角范围作为障碍区域δ。
14.在一些可选的实施方案中，所述本艇航向位于障碍区域时，包括：本艇o0与动态移
动目标o1的相对速度当在障碍区域δ内时，表示本艇航向位于障碍区域，其中，
15.在一些可选的实施方案中，所述进行局部避障，包括：
16.计算与l
l
的夹角θ1，与l
r
的夹角θ2，若θ1<θ2，则调整速度和航向趋近于l
l
的方向，若θ1≥θ2，则调整速度和航向趋向于l
r
的方向；
17.实时计算和障碍区域δ，如果已不在障碍区域δ内，则避障完成，其中，θ1＝θ
l
‑
θ，θ2＝θ
‑
θ
r
，θ为x轴与的夹角，θ
l
为l
l
与x轴的夹角，θ
r
为l
r
与x轴的夹角。
18.在一些可选的实施方案中，在进行局部避障时，根据航速法和/或航向法调整速度和航向完成避障。
19.在一些可选的实施方案中，对于航向法，在更靠近l
r
时，调整方向，控制本艇航向偏向于l
r
，在更靠近l
l
时，调整方向，控制本艇航向偏向于l
l
，当调整至时，已经偏出障碍区域δ，完成避障，其中，航向的调整幅度设置为δθ，其中，δθ＝min(θ1,θ2)，
20.在一些可选的实施方案中，对于航速法，在相对速度更靠近l
r
时，调整偏向l
r
驶出障碍区域δ，在相对速度更靠近l
l
时，调整偏向l
l
驶出障碍区域δ，当保持本艇航向，降低本艇速度至时，相对速度已不在障碍区域δ范围内，即完成避障，其中，已不在障碍区域δ范围内，即完成避障，其中，
21.在一些可选的实施方案中，进行局部避障，在采用航速法和航向法融合时，通过将本艇降至怠速，然后将舵角根据判定的偏向打至满舵，以快速避开障碍区域δ，完成避障。
22.总体而言，通过本发明所构思的以上技术方案与现有技术相比，能够取得下列有益效果：
23.无人艇航行区附近的障碍物可划分为静态和动态两类，静态障碍物为电子海图上固定的不可达区域，而动态障碍物为感知系统获取的移动目标。针对两类障碍物，分别通过全局避障和局部避障进行规避，通过采用两级避障策略，结合全局路径规划和局部动态障碍物避障，从全局和局部分别对静态和动态障碍物进行规避，为无人艇安全自主航行提供保障；该发明为一种简洁、易实现的避障方法，可用于任何船舶智能避碰系统；全局
‑
局部的结合，多重保障，极大降低了误碰的概率。
附图说明
24.图1是本发明实施例提供的一种水面无人艇避障方法的流程示意图；
25.图2是本发明实施例提供的一种局部避障示意图；
26.图3是本发明实施例提供的一种航向法示意图；
27.图4是本发明实施例提供的一种航速法示意图。
具体实施方式
28.为了使本发明的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以解释本发明，并不用于限定本发明。此外，下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
29.无论是在狭窄水域还是在宽阔水域，均存在静态障碍和动态障碍，常见的静态障碍物有礁石、浮标、锚泊的船只，而常见的动态障碍物有航行船舶、潜艇等。针对不同性质的障碍物，可以采用不同的避障方法进行规避。为完成静态避障，需要根据先验的电子海图，结合起始位置，完成路径规划；为完成动态避障，需要结合感知系统获取的动态障碍物，进行局部避障。如图1所示是本发明实施例提供的一种水面无人艇避障方法的流程示意图，在图1所示的方法中包括以下步骤：
30.s1：根据航行区域全局信息，考虑已知的障碍物，根据先验的电子海图，结合起始位置，完成路径规划；
31.s2：在航行过程中，获取动态障碍物，结合航行区本艇所在位置，完成局部避障。
32.在本实施例中，步骤s1可以通过以下方式实现：
33.根据无人艇实际航行区域，选择实际航行区域的电子海图z，将该电子海图z栅格化后提取实际航行区域的静态障碍物(如小岛、礁石、浅滩等)，并将实际航行区域中静态障碍物所在区域划分为不可达区域z1，其余区域划分为可达区域z0，得到二值化后的电子海图；
34.利用a*算法，结合二值化的电子海图，规划一条从起点p
n
到终点e
n
的目标路径p。
35.步骤s1涉及全局静态避障，路径规划按照规划范围可以分为全局路径规划和局部路径规划，根据静态障碍物趋于静止这一特征，作为先验信息，运用在路径规划中，将静态障碍物所在区域视为不可达区域，对静态障碍物进行规避。常见的该类型算法又可以分为基于图形法的路径规划算法和基于智能仿生的路径规划算法，基于智能仿生的路径规划算法耗时相对较长，而基于图形的路径规划算法中每种算法特性都各不相同，综合考虑计算效率和实现该算法的简易性，a*算法可以满足静态避障的需求。
36.a*算法是一种启发式搜索算法。相比于dijkstra、floyd等最优搜索，该方法因使用了启发函数，可以更加智能的向目标方向进行搜索，因此可以更快的搜索出一条局部最优路径。
37.a*算法流程如下：
38.1)输入起始点start和结束点end；初始化当前位置cur＝start；将cur放入open；判段open是否为空，若不为空，则重复2)至3),若为空，则路径寻找失败；程序结束；
39.2)从open取出f最小值min，cur＝min，判断min是否为end，若是，执行4)；若不是，将cur放入close；计算cur邻点nn的f、g、h，并记录nn的par；
40.3)判断nn点是否已经包含于open，若是则比较当前的g与nn的g的大小，取较小者更新par和g、f、h，若不是，则将点放进open；
41.4)根据终点路径的par去回溯整个path；程序结束。
42.其中，f表示从起点start到终点end的估算成本cost；g表示从start到当前位置cur的真实成本；h表示从cur到end的估值；f＝g h；open表示待收录到close的点point；
close表示已收录点point。
43.在本实施例中，步骤s2涉及局部动态避障，针对动态障碍物，需要结合航行区本艇所在位置，完成局部避障；采用动态路径搜索d*可以避开障碍物，但其规划的路径过于贴近障碍物，在动态避障的过程中，有着不可预测的安全风险，且动态路径搜索运算复杂度更高，实时性难以保证。在本实施例中，提出在靠近动态障碍物的过程中使用的局部避障法。
44.在本实施例中，步骤s2可以通过以下方式实现：
45.在无人艇根据目标路径p进行航行时，不间断的获取动态障碍物o
i
(i＝1～n)，n表示动态障碍物数量，并将动态障碍物o
i
定位于二值化的电子海图中，当某一动态障碍物o
j
(j∈1～n)与本艇的距离f小于预设安全距离f
s
，且本艇航向位于障碍区域δ时，进行局部避障。
46.如图2所示，设本艇的行驶速度为以本艇o0为坐标原点，建立直角坐标系，动态移动目标o1行驶速度为以o1为中心，进行半径为r的圆形膨胀c作为不可达区域，经o0做圆c的切线l
r
和l
l
，l
r
与l
l
的夹角范围作为障碍区域δ。
47.其中，r的大小可以根据实际情况确定，本实施例不做唯一性限定。
48.在本实施例中，为了判定是否进入动态避障，需要设置安全距离
s
，安全距离f
s
的设置需要考虑两船相对速度、水域类型、交通密度、船位数据可信度等，本艇位置a和障碍目标b圆心的实时距离f，当f
s
≤f时，开启动态避障功能。如图2所示，当o0与o1的距离小于f
s
时，本艇o0需开启避障功能。通过计算本艇与障碍目标的相对速度当在障碍区域δ内时，则开始执行避障，其中，
49.在本实施例中，可以通过以下方式进行局部避障：
50.当被认定需要执行局部避障后，需要指定策略，避开障碍区，首先分别计算计算与l
l
的夹角θ1，与l
r
的夹角θ2，比较θ1、θ2的大小，如果θ1<θ2，则调整速度和航向趋近于l
l
的方向，若θ1≥θ2，则调整速度和航向趋向于l
r
的方向，实时计算和障碍区域δ，如果已不在障碍区域δ内，则避障完成，其中，θ1＝θ
l
‑
θ，θ2＝θ
‑
θ
r
，θ为x轴与的夹角，θ
l
为l
l
与x轴的夹角，θ
r
为l
r
与x轴的夹角。
51.其中，对于航向航速的调整，可以采用航速法、航向法，由于其中，对于航向航速的调整，可以采用航速法、航向法，由于的速度大小和速度反向均是可控对象，直接调整航向，可以驶出障碍区域δ，而当本艇速度方向与目标船方向不为180
°
时，降低航速，也可以偏离障碍区域δ。
52.如图3所示，此时更靠近l
r
，则调整方向，控制本艇航向偏向于l
r
，当调整至时，已经偏出障碍区域δ，完成避障，为了保障能顺利完成避障，航向的调整幅度可以设置为δθ，其中，δθ＝min(θ1,θ2)，
53.其中，更靠近l
l
的航向调整方式与更靠近l
r
的航向调整方式类似，即调整方向，控制本艇航向偏向于l
l
，当调整至时，已经偏出障碍区域δ，完成避障，为了保
障能顺利完成避障，航向的调整幅度可以设置为δθ，其中，δθ＝min(θ1,θ2)，
54.如图4所示，在相对速度更靠近l
r
，调整偏向l
r
驶出障碍区域δ，当保持本艇航向，降低本艇速度至时，相对速度已不在障碍区域δ范围内，即完成避障，其中，已不在障碍区域δ范围内，即完成避障，其中，
55.其中，更靠近l
l
的航向调整方式与更靠近l
r
的航向调整方式类似，即调整偏向l
，
驶出障碍区域δ，当保持本艇航向，降低本艇速度至时，相对速度已不在障碍区域δ范围内，即完成避障，其中，碍区域δ范围内，即完成避障，其中，
56.在实际应用中，考虑到水面态势复杂，本艇受力难以预测，为保障能快速有效的完成避障，可将航速法和航向法融合，可以将本艇降至怠速，然后将舵角根据航向法中判定的偏向打至满舵，快速将船航向避开障碍区域，完成避障。
57.通过本发明在无人艇规划路径时，可以根据航行区域全局信息，考虑已知的障碍物，完成静态避障；而在航行过程中，动态障碍物会让态势发生转变，原规划路径的位置可能因为障碍物的闯入变为不可达区域，采用靠近动态障碍物的过程中使用的局部避障法，完成局部动态避障；最终通过全局
‑
局部的两级避障方法，保障无人艇的安全自主航行。
58.需要指出，根据实施的需要，可将本技术中描述的各个步骤/部件拆分为更多步骤/部件，也可将两个或多个步骤/部件或者步骤/部件的部分操作组合成新的步骤/部件，以实现本发明的目的。
59.本领域的技术人员容易理解，以上所述仅为本发明的较佳实施例而已，并不用以限制本发明，凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等，均应包含在本发明的保护范围之内。