CN113625709A - 一种水面无人艇避障方法 - Google Patents
一种水面无人艇避障方法 Download PDFInfo
- Publication number
- CN113625709A CN113625709A CN202110832332.6A CN202110832332A CN113625709A CN 113625709 A CN113625709 A CN 113625709A CN 202110832332 A CN202110832332 A CN 202110832332A CN 113625709 A CN113625709 A CN 113625709A
- Authority
- CN
- China
- Prior art keywords
- obstacle
- area
- boat
- local
- obstacle avoidance
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 62
- 230000003068 static effect Effects 0.000 claims abstract description 24
- 230000004888 barrier function Effects 0.000 claims abstract description 21
- 230000008569 process Effects 0.000 claims abstract description 10
- 238000004422 calculation algorithm Methods 0.000 claims description 14
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 9
- 238000004364 calculation method Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 230000006872 improvement Effects 0.000 description 2
- 239000004576 sand Substances 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 238000010845 search algorithm Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/0206—Control of position or course in two dimensions specially adapted to water vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种水面无人艇避障方法,属于水面无人艇自主任务决策技术领域,根据航行区域全局信息,考虑已知的障碍物,根据先验的电子海图,结合起始位置,完成路径规划;在航行过程中,获取动态障碍物,结合航行区本艇所在位置,完成局部避障。本发明通过采用两级避障策略,结合全局路径规划和局部动态障碍物避障,从全局和局部分别对静态和动态障碍物进行规避,为无人艇安全自主航行提供保障;该发明为一种简洁、易实现的避障方法,可用于任何船舶智能避碰系统;全局‑局部的结合,多重保障,极大降低了误碰的概率。
Description
技术领域
本发明属于水面无人艇自主任务决策技术领域,更具体地,涉及一种针对静态和动态障碍物进行避障的水面无人艇避障方法。
背景技术
水面无人艇作为一种水面无人装备,在执行危险任务时,具有独特优势,同时无人艇具有高航速、模块化等特点,通过换装任务载荷,可以适用不同的任务场景,因此水面无人艇的发展也越来越受到重视;自主避障是无人艇能进行自主航行的基础,水面障碍物类型多样,根据移动性可以将障碍物划分为静态和动态两类,因此,如何针对静态和动态障碍物进行路径规划和避障,为无人艇自主航行的安全提供保障是目前亟需解决的问题。
发明内容
针对现有技术的以上缺陷或改进需求,本发明提出了一种水面无人艇避障方法,针对水面艇航行区域附近出现的静态和/或动态障碍物,利用联合避障算法,支撑无人艇完成自主避障动作,为无人艇自主航行的安全提供保障。
为实现上述目的,本发明提供了一种水面无人艇避障方法,包括:
根据航行区域全局信息,考虑已知的障碍物,根据先验的电子海图,结合起始位置,完成路径规划;
在航行过程中,获取动态障碍物,结合航行区本艇所在位置,完成局部避障。
在一些可选的实施方案中,所述根据航行区域全局信息,考虑已知的障碍物,根据先验的电子海图,结合起始位置,完成路径规划,包括:
根据无人艇实际航行区域,选择实际航行区域的电子海图,将该电子海图栅格化后提取实际航行区域的静态障碍物,将静态障碍物所在区域视为不可达区域,其余区域划分为可达区域,得到二值化后的电子海图;
利用A*算法,结合二值化的电子海图,规划一条从起点到终点的目标路径。
在一些可选的实施方案中,所述在航行过程中,获取动态障碍物,结合航行区本艇所在位置,完成局部避障,包括:
在无人艇根据目标路径进行航行时,不间断的获取动态障碍物,并将动态障碍物定位于二值化的电子海图中,当某一动态障碍物与本艇的距离小于预设安全距离,且本艇航向位于障碍区域时,进行局部避障。
在一些可选的实施方案中,所述障碍区域的确定方式为:
设本艇的行驶速度为以本艇O0为坐标原点,建立直角坐标系,动态移动目标O1行驶速度为以O1为中心,进行半径为R的圆形膨胀C作为不可达区域,经O0做圆C的切线lr和ll,lr与ll的夹角范围作为障碍区域Δ。
在一些可选的实施方案中,所述进行局部避障,包括:
在一些可选的实施方案中,在进行局部避障时,根据航速法和/或航向法调整速度和航向完成避障。
在一些可选的实施方案中,对于航向法,在更靠近lr时,调整方向,控制本艇航向偏向于lr,在更靠近ll时,调整方向,控制本艇航向偏向于ll,当调整至时,已经偏出障碍区域Δ,完成避障,其中,航向的调整幅度设置为Δθ,其中,Δθ=min(θ1,θ2),
在一些可选的实施方案中,对于航速法,在相对速度更靠近lr时,调整偏向lr驶出障碍区域Δ,在相对速度更靠近ll时,调整偏向ll驶出障碍区域Δ,当保持本艇航向,降低本艇速度至时,相对速度已不在障碍区域Δ范围内,即完成避障,其中,
在一些可选的实施方案中,进行局部避障,在采用航速法和航向法融合时,通过将本艇降至怠速,然后将舵角根据判定的偏向打至满舵,以快速避开障碍区域Δ,完成避障。
总体而言,通过本发明所构思的以上技术方案与现有技术相比,能够取得下列有益效果:
无人艇航行区附近的障碍物可划分为静态和动态两类,静态障碍物为电子海图上固定的不可达区域,而动态障碍物为感知系统获取的移动目标。针对两类障碍物,分别通过全局避障和局部避障进行规避,通过采用两级避障策略,结合全局路径规划和局部动态障碍物避障,从全局和局部分别对静态和动态障碍物进行规避,为无人艇安全自主航行提供保障;该发明为一种简洁、易实现的避障方法,可用于任何船舶智能避碰系统;全局-局部的结合,多重保障,极大降低了误碰的概率。
附图说明
图1是本发明实施例提供的一种水面无人艇避障方法的流程示意图;
图2是本发明实施例提供的一种局部避障示意图;
图3是本发明实施例提供的一种航向法示意图;
图4是本发明实施例提供的一种航速法示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。此外,下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
无论是在狭窄水域还是在宽阔水域,均存在静态障碍和动态障碍,常见的静态障碍物有礁石、浮标、锚泊的船只,而常见的动态障碍物有航行船舶、潜艇等。针对不同性质的障碍物,可以采用不同的避障方法进行规避。为完成静态避障,需要根据先验的电子海图,结合起始位置,完成路径规划;为完成动态避障,需要结合感知系统获取的动态障碍物,进行局部避障。如图1所示是本发明实施例提供的一种水面无人艇避障方法的流程示意图,在图1所示的方法中包括以下步骤:
S1:根据航行区域全局信息,考虑已知的障碍物,根据先验的电子海图,结合起始位置,完成路径规划;
S2:在航行过程中,获取动态障碍物,结合航行区本艇所在位置,完成局部避障。
在本实施例中,步骤S1可以通过以下方式实现:
根据无人艇实际航行区域,选择实际航行区域的电子海图Z,将该电子海图Z栅格化后提取实际航行区域的静态障碍物(如小岛、礁石、浅滩等),并将实际航行区域中静态障碍物所在区域划分为不可达区域Z1,其余区域划分为可达区域Z0,得到二值化后的电子海图;
利用A*算法,结合二值化的电子海图,规划一条从起点PN到终点EN的目标路径P。
步骤S1涉及全局静态避障,路径规划按照规划范围可以分为全局路径规划和局部路径规划,根据静态障碍物趋于静止这一特征,作为先验信息,运用在路径规划中,将静态障碍物所在区域视为不可达区域,对静态障碍物进行规避。常见的该类型算法又可以分为基于图形法的路径规划算法和基于智能仿生的路径规划算法,基于智能仿生的路径规划算法耗时相对较长,而基于图形的路径规划算法中每种算法特性都各不相同,综合考虑计算效率和实现该算法的简易性,A*算法可以满足静态避障的需求。
A*算法是一种启发式搜索算法。相比于Dijkstra、Floyd等最优搜索,该方法因使用了启发函数,可以更加智能的向目标方向进行搜索,因此可以更快的搜索出一条局部最优路径。
A*算法流程如下:
1)输入起始点start和结束点end;初始化当前位置cur=start;将cur放入open;判段open是否为空,若不为空,则重复2)至3),若为空,则路径寻找失败;程序结束;
2)从open取出F最小值Min,cur=Min,判断Min是否为end,若是,执行4);若不是,将cur放入Close;计算cur邻点NN的F、G、H,并记录NN的Par;
3)判断NN点是否已经包含于Open,若是则比较当前的G与NN的G的大小,取较小者更新Par和G、F、H,若不是,则将点放进open;
4)根据终点路径的par去回溯整个path;程序结束。
其中,F表示从起点start到终点end的估算成本cost;G表示从start到当前位置cur的真实成本;H表示从cur到end的估值;F=G+H;Open表示待收录到close的点point;Close表示已收录点point。
在本实施例中,步骤S2涉及局部动态避障,针对动态障碍物,需要结合航行区本艇所在位置,完成局部避障;采用动态路径搜索D*可以避开障碍物,但其规划的路径过于贴近障碍物,在动态避障的过程中,有着不可预测的安全风险,且动态路径搜索运算复杂度更高,实时性难以保证。在本实施例中,提出在靠近动态障碍物的过程中使用的局部避障法。
在本实施例中,步骤S2可以通过以下方式实现:
在无人艇根据目标路径P进行航行时,不间断的获取动态障碍物Oi(i=1~n),n表示动态障碍物数量,并将动态障碍物Oi定位于二值化的电子海图中,当某一动态障碍物Oj(j∈1~n)与本艇的距离f小于预设安全距离fs,且本艇航向位于障碍区域Δ时,进行局部避障。
如图2所示,设本艇的行驶速度为以本艇O0为坐标原点,建立直角坐标系,动态移动目标O1行驶速度为以O1为中心,进行半径为R的圆形膨胀C作为不可达区域,经O0做圆C的切线lr和ll,lr与ll的夹角范围作为障碍区域Δ。
其中,R的大小可以根据实际情况确定,本实施例不做唯一性限定。
在本实施例中,为了判定是否进入动态避障,需要设置安全距离s,安全距离fs的设置需要考虑两船相对速度、水域类型、交通密度、船位数据可信度等,本艇位置A和障碍目标B圆心的实时距离f,当fs≤f时,开启动态避障功能。如图2所示,当O0与O1的距离小于fs时,本艇O0需开启避障功能。通过计算本艇与障碍目标的相对速度当在障碍区域Δ内时,则开始执行避障,其中,
在本实施例中,可以通过以下方式进行局部避障:
当被认定需要执行局部避障后,需要指定策略,避开障碍区,首先分别计算计算与ll的夹角θ1,与lr的夹角θ2,比较θ1、θ2的大小,如果θ1<θ2,则调整速度和航向趋近于ll的方向,若θ1≥θ2,则调整速度和航向趋向于lr的方向,实时计算和障碍区域Δ,如果已不在障碍区域Δ内,则避障完成,其中,θ1=θl-θ,θ2=θ-θr,θ为x轴与的夹角,θl为ll与x轴的夹角,θr为lr与x轴的夹角。
其中,对于航向航速的调整,可以采用航速法、航向法,由于 的速度大小和速度反向均是可控对象,直接调整航向,可以驶出障碍区域Δ,而当本艇速度方向与目标船方向不为180°时,降低航速,也可以偏离障碍区域Δ。
其中,更靠近ll的航向调整方式与更靠近lr的航向调整方式类似,即调整方向,控制本艇航向偏向于ll,当调整至时,已经偏出障碍区域Δ,完成避障,为了保障能顺利完成避障,航向的调整幅度可以设置为Δθ,其中,Δθ=min(θ1,θ2),
在实际应用中,考虑到水面态势复杂,本艇受力难以预测,为保障能快速有效的完成避障,可将航速法和航向法融合,可以将本艇降至怠速,然后将舵角根据航向法中判定的偏向打至满舵,快速将船航向避开障碍区域,完成避障。
通过本发明在无人艇规划路径时,可以根据航行区域全局信息,考虑已知的障碍物,完成静态避障;而在航行过程中,动态障碍物会让态势发生转变,原规划路径的位置可能因为障碍物的闯入变为不可达区域,采用靠近动态障碍物的过程中使用的局部避障法,完成局部动态避障;最终通过全局-局部的两级避障方法,保障无人艇的安全自主航行。
需要指出,根据实施的需要,可将本申请中描述的各个步骤/部件拆分为更多步骤/部件,也可将两个或多个步骤/部件或者步骤/部件的部分操作组合成新的步骤/部件,以实现本发明的目的。
本领域的技术人员容易理解,以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.一种水面无人艇避障方法,其特征在于,包括:
根据航行区域全局信息,考虑已知的障碍物,根据先验的电子海图,结合起始位置,完成路径规划;
在航行过程中,获取动态障碍物,结合航行区本艇所在位置,完成局部避障。
2.根据权利要求1所述的方法,其特征在于,所述根据航行区域全局信息,考虑已知的障碍物,根据先验的电子海图,结合起始位置,完成路径规划,包括:
根据无人艇实际航行区域,选择实际航行区域的电子海图,将该电子海图栅格化后提取实际航行区域的静态障碍物,将静态障碍物所在区域视为不可达区域,其余区域划分为可达区域,得到二值化后的电子海图;
利用A*算法,结合二值化的电子海图,规划一条从起点到终点的目标路径。
3.根据权利要求1或2所述的方法,其特征在于,所述在航行过程中,获取动态障碍物,结合航行区本艇所在位置,完成局部避障,包括:
在无人艇根据目标路径进行航行时,不间断的获取动态障碍物,并将动态障碍物定位于二值化的电子海图中,当某一动态障碍物与本艇的距离小于预设安全距离,且本艇航向位于障碍区域时,进行局部避障。
7.根据权利要求6所述的方法,其特征在于,在进行局部避障时,根据航速法和/或航向法调整速度和航向完成避障。
10.根据权利要求7所述的方法,其特征在于,进行局部避障,在采用航速法和航向法融合时,通过将本艇降至怠速,然后将舵角根据判定的偏向打至满舵,以快速避开障碍区域Δ,完成避障。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110832332.6A CN113625709A (zh) | 2021-07-22 | 2021-07-22 | 一种水面无人艇避障方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110832332.6A CN113625709A (zh) | 2021-07-22 | 2021-07-22 | 一种水面无人艇避障方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113625709A true CN113625709A (zh) | 2021-11-09 |
Family
ID=78380569
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110832332.6A Pending CN113625709A (zh) | 2021-07-22 | 2021-07-22 | 一种水面无人艇避障方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113625709A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114194342A (zh) * | 2021-12-29 | 2022-03-18 | 浙江大学湖州研究院 | 无人船以及无人船控制系统 |
CN115562311A (zh) * | 2022-11-11 | 2023-01-03 | 中国船舶集团有限公司第七一六研究所 | 一种关于无人艇在受限水域的规划避障方法及系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109460045A (zh) * | 2019-01-14 | 2019-03-12 | 哈尔滨工程大学 | 动态障碍在线感知下usv基于改进蚁群优化的避碰规划方法 |
CN109960262A (zh) * | 2019-03-25 | 2019-07-02 | 华中科技大学 | 一种基于几何法的无人艇动态避障方法和系统 |
CN110608740A (zh) * | 2019-09-06 | 2019-12-24 | 遵义师范学院 | 一种无人船舰路径规划方法 |
CN110837255A (zh) * | 2019-11-08 | 2020-02-25 | 哈尔滨工程大学 | 一种适用于高速水面无人艇的自主危险规避方法 |
CN111060109A (zh) * | 2020-01-03 | 2020-04-24 | 东南大学 | 一种基于改进a星算法的无人艇全局路径规划方法 |
-
2021
- 2021-07-22 CN CN202110832332.6A patent/CN113625709A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109460045A (zh) * | 2019-01-14 | 2019-03-12 | 哈尔滨工程大学 | 动态障碍在线感知下usv基于改进蚁群优化的避碰规划方法 |
CN109960262A (zh) * | 2019-03-25 | 2019-07-02 | 华中科技大学 | 一种基于几何法的无人艇动态避障方法和系统 |
CN110608740A (zh) * | 2019-09-06 | 2019-12-24 | 遵义师范学院 | 一种无人船舰路径规划方法 |
CN110837255A (zh) * | 2019-11-08 | 2020-02-25 | 哈尔滨工程大学 | 一种适用于高速水面无人艇的自主危险规避方法 |
CN111060109A (zh) * | 2020-01-03 | 2020-04-24 | 东南大学 | 一种基于改进a星算法的无人艇全局路径规划方法 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114194342A (zh) * | 2021-12-29 | 2022-03-18 | 浙江大学湖州研究院 | 无人船以及无人船控制系统 |
CN115562311A (zh) * | 2022-11-11 | 2023-01-03 | 中国船舶集团有限公司第七一六研究所 | 一种关于无人艇在受限水域的规划避障方法及系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112327885B (zh) | 一种无人船自适应全局-局部混合路径规划的方法 | |
CN107702716B (zh) | 一种无人驾驶路径规划方法、系统和装置 | |
CN110262492B (zh) | 一种无人艇的实时避碰和目标跟踪方法 | |
CN109597417B (zh) | 一种基于避碰准则的多usv群体协同避碰规划方法 | |
CN108445879B (zh) | 一种基于预测碰撞危险区域的无人艇避障方法 | |
CN106647769B (zh) | 基于a*提取引导点的agv路径跟踪与避障协调方法 | |
CN110361013B (zh) | 一种用于车辆模型的路径规划系统及方法 | |
CN111830979B (zh) | 一种轨迹优化方法和装置 | |
CN109324620A (zh) | 基于车道线平行偏移进行避障及超车的动态轨迹规划方法 | |
CN113625709A (zh) | 一种水面无人艇避障方法 | |
Li et al. | Toward time-optimal trajectory planning for autonomous ship maneuvering in close-range encounters | |
CN113296118B (zh) | 一种基于激光雷达与gps的无人驾驶绕障方法与终端 | |
CN110262473B (zh) | 一种基于改进Bi-RRT算法的无人艇自动避碰方法 | |
CN113830079A (zh) | 任意起始位姿的连续曲率泊车路径在线规划方法及系统 | |
CN113467476B (zh) | 考虑转角约束的无碰撞检测快速随机树全局路径规划方法 | |
CN112947494A (zh) | 一种基于模糊pid的船舶自动靠泊控制方法 | |
CN113515111B (zh) | 一种车辆避障路径规划方法及装置 | |
CN115407780A (zh) | 一种基于三阶段避障策略的无人船局部路径规划方法 | |
CN109916400B (zh) | 一种基于梯度下降算法与vo法相结合的无人艇避障方法 | |
CN117369441A (zh) | 一种考虑船舶运动学和CORLEGs的自适应智能船舶路径规划方法 | |
CN114995425B (zh) | 一种基于时间最优与能量最优的无人艇自主跟踪方法 | |
CN116430868A (zh) | 基于深度学习的自主导航与避障系统 | |
CN116430856A (zh) | 一种基于变前视距离los算法的船舶航迹控制方法 | |
JP7300068B2 (ja) | 車両制御装置、車両制御方法、及び車両制御システム | |
CN115755907A (zh) | 一种内河无人船自主避碰方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination |