CN113110460A - 一种动态环境下获取水面无人艇艏向可行区间的方法 - Google Patents
一种动态环境下获取水面无人艇艏向可行区间的方法 Download PDFInfo
- Publication number
- CN113110460A CN113110460A CN202110424038.1A CN202110424038A CN113110460A CN 113110460 A CN113110460 A CN 113110460A CN 202110424038 A CN202110424038 A CN 202110424038A CN 113110460 A CN113110460 A CN 113110460A
- Authority
- CN
- China
- Prior art keywords
- region
- heading
- speed
- lambda
- unmanned
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 57
- 238000013507 mapping Methods 0.000 claims abstract description 4
- 239000004576 sand Substances 0.000 claims abstract description 4
- 230000004888 barrier function Effects 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 abstract description 3
- 238000010586 diagram Methods 0.000 description 56
- 230000001154 acute effect Effects 0.000 description 4
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 2
- 102100032040 Amphoterin-induced protein 2 Human genes 0.000 description 1
- 101000776165 Homo sapiens Amphoterin-induced protein 2 Proteins 0.000 description 1
- 206010063385 Intellectualisation Diseases 0.000 description 1
- KWYCPUNAAYFHAK-UHFFFAOYSA-N N-(2,6-Dimethylphenyl)-4-[[(diethylamino)acetyl]amino]benzamide Chemical compound C1=CC(NC(=O)CN(CC)CC)=CC=C1C(=O)NC1=C(C)C=CC=C1C KWYCPUNAAYFHAK-UHFFFAOYSA-N 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 230000003068 static effect Effects 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
本发明的一种动态环境下获取水面无人艇艏向可行区间的方法涉及多运动障碍物情况下的水面无人艇的自主危险规避方法,目的是为了克服现有水面无人艇避障方法计算耗时长,容易导致避障失败的问题,具体步骤如下:步骤一、获取无人艇的航速Vs和障碍物的航速Vo;障碍物的数量为至少一个;步骤二、构建无人艇和障碍物的速度障碍模型,并获得碰撞锥;步骤三、创建速度空间;并将碰撞锥映射到速度空间,对速度空间进行区域划分;步骤四、根据无人艇的航速、障碍物的航速和碰撞锥,计算障碍物的航速位于不同区域情况下的无人艇的艏向可行区间或艏向禁止区间。
Description
技术领域
本发明涉及多运动障碍物情况下的水面无人艇的自主危险规避方法。
背景技术
水面无人艇(unmanned surface vehicle,USV)是船舶、控制、信息、通信等技术深度融合的高科技载体,船舶智能化已经成为了船舶发展的一种必然趋势。与常规船舶相比,无人艇有着体积小、重量轻、经济性好等优点,因水面勘测、海上维权、军事作战等需求而在近年来快速发展。为保证水面无人艇能够圆满完成指定任务,要求水面无人艇能够对或静态或动态的障碍物进行自主避障。
航道、港口、码头等典型区域存在大量来往船只,属于一类复杂、拥挤的水面航行环境,需要对多运动障碍物同时实施有效避碰机动,当局部环境复杂度较高时,危险避碰应以最低成本(如航速或艏向改变小、航迹平稳)的避让机动实现动态避碰,即输出综合性能最优的避碰航迹。速度障碍法凭借其算法稳定性较高,规划避障路径准确度高的优点得到了极大的关注。
水面无人艇发现障碍物、进行计算、确定避让方案、进行避障操作这一过程需要一定时间,大多数发明将智能算法与速度障碍法结合进行船舶避障,由于智能算法需要迭代的次数非常多,使用智能算法往往会消耗较多时间,导致水面无人艇确定避障方案的时间较长,使水面无人艇避障失败可能性增大,由此可见,智能算法在局部路径规划领域的优势并不明显。
发明内容
本发明的目的是为了克服现有水面无人艇避障方法计算耗时长,容易导致避障失败的问题,提供了一种动态环境下获取水面无人艇艏向可行区间的方法。
本发明的一种动态环境下获取水面无人艇艏向可行区间的方法,具体步骤如下:
步骤一、获取无人艇的航速Vs和障碍物的航速Vo;障碍物的数量为至少一个;
步骤二、构建无人艇和障碍物的速度障碍模型,并获得碰撞锥;
步骤三、创建速度空间;并将碰撞锥映射到速度空间,对速度空间进行区域划分;
步骤四、根据无人艇的航速、障碍物的航速和碰撞锥,计算障碍物的航速位于不同区域情况下的无人艇的艏向可行区间或艏向禁止区间。
本发明的有益效果是:
本发明的一种动态环境下获取水面无人艇艏向可行区间的方法,针对复杂多变的动态海洋环境,提供了一种通过几何计算得到无人艇安全艏向区间的方法,能够迅速确定USV 航速一定时的可行艏向区间,保证安全性的同时极大地缩减了后续求解最优艏向的时间;同时,得到的航向稳定性高,能够同时规避多个运动障碍物,避免了不必要的航向调整。可以应对复杂局面下无人艇避障要求,实时性高,稳定性好。
附图说明
图1为本发明一种动态环境下获取水面无人艇艏向可行区间的方法中的速度障碍模型;
图2为本发明的方法中碰撞锥的角度小于90°的速度空间示意图;
图3为本发明的方法中碰撞锥的角度大于90°的速度空间示意图;
图4为本发明的方法中当反向矢量-Vo位于区域a1,VS<VO×sin(θ2-β)时,无人艇的艏向可行区间计算原理图;
图5为本发明的方法中当反向矢量-Vo位于区域a1,VS>VO×sin(θ2-β)且VS< VO×sin(β-θ1)时,无人艇的艏向可行区间计算原理图;
图6为本发明的方法中当反向矢量-Vo位于区域a1,VS>VO×sin(β-θ1)且VS<VO时,无人艇的艏向可行区间计算原理图;
图7为本发明的方法中当反向矢量-Vo位于区域a1,VS>VO时,无人艇的艏向禁止区间计算原理图;
图8为本发明的方法中当反向矢量-Vo位于区域a2,VS<VO×sin(β-θ2)时,无人艇的艏向可行区间计算原理图;
图9为本发明的方法中当反向矢量-Vo位于区域a2,VS>VO×sin(β-θ2)且VS< VO×sin(β-θ1)时,无人艇的艏向禁止区间计算原理图;
图10为本发明的方法中当反向矢量-Vo位于区域a2,VS>VO×sin(β-θ1)且VS<VO时,无人艇的艏向禁止区间计算原理图;
图11为本发明的方法中当反向矢量-Vo位于区域a2,VS>VO时,无人艇的艏向禁止区间计算原理图;
图12为本发明的方法中当反向矢量-Vo位于区域a3,VS<VO×sin(β-θ2)时,无人艇的艏向可行区间计算原理图;
图13为本发明的方法中当反向矢量-Vo位于区域a3,VS>VO×sin(β-θ2)且VS<VO时,无人艇的艏向禁止区间计算原理图;
图14为本发明的方法中当反向矢量-Vo位于区域a3,VS>VO时,无人艇的艏向禁止区间计算原理图;
图15为本发明的方法中当反向矢量-Vo位于区域a4或a5,VS<VO时,无人艇的艏向可行区间计算原理图;
图16为本发明的方法中当反向矢量-Vo位于区域a4或a5,VS>VO时,无人艇的艏向禁止区间计算原理图;
图17为本发明的方法中当反向矢量-Vo位于区域s1,VS<VO×sin(θ2-β)时,无人艇的艏向可行区间计算原理图;
图18为本发明的方法中当反向矢量-Vo位于区域s1,VS>VO×sin(θ2-β)且VS< VO×sin(β-θ1)时,无人艇的艏向可行区间计算原理图;
图19为本发明的方法中当反向矢量-Vo位于区域s1,VS>VO×sin(β-θ1)且VS<VO时,无人艇的艏向可行区间计算原理图;
图20为本发明的方法中当反向矢量-Vo位于区域s1,VS>VO且VS<b1时,无人艇的艏向禁止区间计算原理图;
图21为本发明的方法中当反向矢量-Vo位于区域s1,VS>b1时,无人艇的艏向可行区间计算原理图;
图22为本发明的方法中当反向矢量-Vo位于区域s2,VS<VO×sin(θ2-β)时,无人艇的艏向可行区间计算原理图;
图23为本发明的方法中当反向矢量-Vo位于区域s2,VS>VO×sin(θ2-β)且VS<VO时,无人艇的艏向可行区间计算原理图;
图24为本发明的方法中当反向矢量-Vo位于区域s2,VS>VO且VS<b2时,无人艇的艏向可行区间计算原理图;
图25为本发明的方法中当反向矢量-Vo位于区域s2,VS>b2时,无人艇的艏向禁止区间计算原理图;
图26为本发明的方法中当反向矢量-Vo位于区域s3,VS<VO×sin(β-θ2)时,无人艇的艏向可行区间计算原理图;
图27为本发明的方法中当反向矢量-Vo位于区域s3,VS>VO×sin(β-θ2)且VS<VO时,无人艇的艏向禁止区间计算原理图;
图28为本发明的方法中当反向矢量-Vo位于区域s3,VS>VO时,无人艇的艏向禁止区间计算原理图;
图29为本发明的方法中当反向矢量-Vo位于区域s4或s5,VS<VO时,无人艇的艏向可行区间计算原理图;
图30为本发明的方法中当反向矢量-Vo位于区域s4或s5,VS>VO时,无人艇的艏向禁止区间计算原理图。
具体实施方式
具体实施方式一,本实施方式的一种动态环境下获取水面无人艇艏向可行区间的方法,具体步骤如下:
步骤一、获取无人艇的航速Vs和障碍物的航速Vo;障碍物的数量为至少一个;
步骤二、构建无人艇和障碍物的速度障碍模型,并获得碰撞锥;
步骤三、创建速度空间;并将碰撞锥映射到速度空间,对速度空间进行区域划分;
步骤四、根据无人艇的航速、障碍物的航速和碰撞锥,计算障碍物的航速位于不同区域情况下的无人艇的艏向可行区间或艏向禁止区间。
进一步地,步骤二的具体步骤如下:
步骤二一、在绝对坐标系下,以方向竖直向下的射线作为极轴,以逆时针方向作为正方向,建立极坐标系;
步骤二二、将无人艇等效为一个点,该点作为无人艇的等效点,且该无人艇的等效点位于极点处;将障碍物等效为一个半径为R的圆,该圆作为障碍物的等效圆;
步骤二三、过无人艇的等效点向障碍物的等效圆做两条切线λ1和λ2,切线λ1和切线λ2之间的区域为碰撞锥;并且,碰撞锥的区域内包含障碍物的等效圆和无人艇相对于障碍物的相对速度ΔV,ΔV=Vs-Vo。
具体地,如图1所示,在绝对坐标系下定义,以竖直向下方向作为极轴,逆时针方向为正方向建立极坐标系。将无人艇简化为一个点且正以航速Vs前进,将障碍物简化为半径R的圆形且正以航速Vo前进,ΔV是Vs与-Vo的合速度,即无人艇相对于障碍物的速度。过无人艇向障碍物区域做两条切线,若ΔV的方向在这两条射线内部区域,则无人艇与障碍物将在某一时刻相碰撞,这一V形区域被称为碰撞锥。
进一步地,步骤三的具体步骤如下:
步骤三一、过极点做障碍物的航速Vo的反向矢量-Vo;再以反向矢量-Vo的末端端点为圆心,以无人艇的航速Vs的大小为半径做圆,创建速度空间;圆作为无人艇的艏向圆;
步骤三二、过极点对切线λ1做垂线l1,对切线λ2做垂线l2,以及做碰撞锥的角平分线 l3;
步骤三三、根据碰撞锥的角度,通过切线λ1和切线λ1的延长线、切线λ2和切线λ2的延长线、垂线l1、垂线l2和角平分线l3将速度空间分为十个区域;
且十个区域以角平分线l3及角平分线l3的延长线为对称轴对称。
具体地,如图2~图3所示,由于无人艇的艏向控制较航速控制简单迅速,因此首先考虑固定航速下改变艏向的避碰方式。
在速度空间内,在-Vo的矢量末端画一个以Vs的大小作为半径的圆,圆在碰撞锥内的部分即为无人艇艏向禁止区间,找出所有无人艇的艏向禁止区间或所有无人艇的艏向可行区间即可得到所有不改变航速下的无人艇的安全艏向。
故分别对碰撞锥为锐角的情况与碰撞锥为钝角的情况进行讨论,对碰撞锥的两条边做角平分线和垂线,将速度空间分成10个区域,10个区域的情况关于碰撞锥的角平分线对称,因此只需要讨论角平分线一侧的5种不同情况。
进一步地,步骤三三中,碰撞锥的角度小于90°;并且,
十个区域按逆时针方向分为:
角平分线l3与切线λ1之间的区域a1;切线λ1与垂线l2之间的区域a2;垂线l2与垂线l1之间的区域a3;垂线l1与切线λ2的延长线之间的区域a4;切线λ2的延长线与角平分线l3的延长线之间的区域a5;
角平分线l3的延长线与切线λ1的延长线之间的区域a6;切线λ1的延长线与垂线l2之间的区域a7;垂线l2与垂线l1之间的区域a8;垂线l1与切线λ2之间的区域a9;切线λ2与角平分线l3之间的区域a10;
并且,区域a1与区域a10,区域a2与区域a9,区域a3与区域a8,区域a4与区域a7,以及区域a5与区域a6均以角平分线l3及角平分线l3的延长线为对称轴对称。
具体地,如图2所示,设无人艇到障碍物中心的直线距离为D,则碰撞锥夹角μ为:
并且根据几何学,可以计算得到以角平分线l3及角平分线l3的延长线为对称轴,区域 a1与区域a10对称,区域a2与区域a9对称,区域a3与区域a8对称,区域a4与区域a7对称,以及区域a5与区域a6对称。
进一步地,步骤四的具体方法如下:
步骤四一、确定反向矢量-Vo位于区域a1~区域a10中的位置;
步骤四二、根据无人艇的航速Vs的大小,确定艏向圆与碰撞锥的位置关系,得到无人艇的艏向可行区间或艏向禁止区间。
具体地,如图4~图16所示,此实施例为在碰撞锥为锐角的情况下,其中β为反向矢量-v0与极轴之间的夹角,θ1为切线λ2极轴之间的夹角,θ2为切线λ1与极轴之间的夹角;
1、当确定反向矢量-Vo位于区域a1时,根据无人艇的速度大小进行分类讨论:
如图4所示,当VS<VO×sin(θ2-β)时,圆完全位于碰撞锥内,无人艇的艏向可行区间为空集;
如图5所示,当VS>VO×sin(θ2-β)且VS<VO×sin(β-θ1)时,艏向圆与碰撞锥交于A2和B2两点,则A2与B2间小于180°的夹角为无人艇的艏向可行区间;
如图6所示,当VS>VO×sin(β-θ1)且VS<VO时,艏向圆与碰撞锥交于A3、B3、 C3和D3四个点,则A3与B3间小于180°的夹角与C3与D3间小于180°的夹角的并集为无人艇的艏向可行区间;
如图7所示,当VS>VO时,艏向圆与碰撞锥交于A4和B4两点,则A4与B4间小于 180°的夹角为无人艇的艏向禁止区间。
2、当确定反向矢量-Vo位于区域a2时,根据无人艇的速度大小进行分类讨论:
如图8所示,当VS<VO×sin(β-θ2)时,无人艇的艏向可行区间为全集;
如图9所示,当VS>VO×sin(β-θ2)且VS<VO×sin(β-θ1)时,艏向圆与碰撞锥交于A2和B2两点,则A2与B2间小于180°的夹角为无人艇的艏向禁止区间;
如图10所示,当VS>VO×sin(β-θ1)且VS<VO时,艏向圆与碰撞锥交于A3、B3、 C3和D3四个点,则A3与B3间小于180°的夹角与C3与D3间小于180°的夹角的并集为无人艇的艏向禁止区间;
如图11所示,当VS>VO时,艏向圆与碰撞锥交于A4和B4两点,则A4与B4间小于 180°的夹角为无人艇的艏向禁止区间。
3、当确定反向矢量-Vo位于区域a3时,根据无人艇的速度大小进行分类讨论:
如图12所示,当VS<VO×sin(β-θ2)时,无人艇的艏向可行区间为全集;
如图13所示,当VS>VO×sin(β-θ2)且VS<VO时,艏向圆与碰撞锥交于A2和B2两点,则A2与B2间小于180°的夹角为无人艇的艏向禁止区间;
如图14所示,当VS>VO时,艏向圆与碰撞锥交于A3和B3两点,则A3与B3间小于 180°的夹角为无人艇的艏向禁止区间。
4、当确定反向矢量-Vo位于区域a4或a5时,根据无人艇的速度大小进行分类讨论,反向矢量-Vo位于区域a4或a5时除了角度的表示稍有不同,其余完全一致:
如图15所示,当VS<VO时,无人艇的艏向可行区间为全集;
如图16所示,当VS>VO时,艏向圆与碰撞锥交于A2和B2两点,则A2与B2间小于 180°的夹角为无人艇的艏向禁止区间。
上述情况中,艏向圆与碰撞锥相交或不相交,但是实际情况还会出现如当VS=VO×sin(β-θ2)时,艏向圆与碰撞锥的其中一条切线相切的情况,此时艏向圆与碰撞锥有一个切点,无论是艏向可行区间还是艏向禁行区间,均将该切点排除。
进一步地,步骤三三中,碰撞锥的角度大于90°;并且,
多个区域按逆时针方向分为:
角平分线l3与垂线l2之间的区域s1;垂线l2与切线λ1之间的区域s2;切线λ1与切线λ2的延长线之间的区域s3;切线λ2的延长线与垂线l1之间的区域s4;垂线l1与角平分线l3的延长线之间的区域s5;
角平分线l3的延长线与垂线l2之间的区域s6;垂线l2与切线λ1的延长线之间的区域s7;切线λ1的延长线与切线λ2之间的区域s8;切线λ2与垂线l1之间的区域s9;垂线l1与角平分线l3之间的区域s10;
并且,区域s1与区域s10,区域s2与区域s9,区域s3与区域s8,区域s4与区域s7,以及区域s5与区域s6分别以角平分线l3及角平分线l3的延长线为对称轴对称。
进一步地,步骤四的具体方法如下:
步骤四一、确定反向矢量-Vo位于区域s1~区域s10中的位置;
步骤四二、根据无人艇的航速Vs的大小,确定艏向圆与碰撞锥的位置关系,得到无人艇的艏向可行区间或艏向禁止区间。
具体地,如图17~图30所示,此实施例为在碰撞锥为钝角的情况下,其中β为反向矢量-vo与极轴之间的夹角,θ1为切线λ2极轴之间的夹角,θ2为切线λ1与极轴之间的夹角;
1、当确定反向矢量-Vo位于区域s1时,根据无人艇的速度大小进行分类讨论:
可以事先设置一个无人艇的速度临界值b1,该速度临界值b1可以表示为:
如图17所示,当VS<VO×sin(θ2-β)时,无人艇的艏向可行区间为空集;
如图18所示,当VS>Vo×sin(θ2-β)且VS<VO×sin(β-θ1)时,艏向圆与碰撞锥交于A2和B2两点,则A2与B2间小于180°的夹角为无人艇的艏向可行区间;
如图19所示,当VS>VO×sin(β-θ1)且VS<VO时,艏向圆与碰撞锥交于A3、B3、 C3、D3四个点,则A3与B3间小于180°的夹角与C3与D3间小于180°的夹角的并集为无人艇的艏向可行区间;
如图20所示,当VS>VO且VS<b1时,艏向圆与碰撞锥交于A4和B4两点,则A4与 B4间小于180°的夹角为无人艇的艏向禁止区间;
如图21所示,当VS>b1时,艏向圆与碰撞锥交于A5和B5两点,则A5与B5间小于 180°的夹角为无人艇的艏向可行区间。
2、当确定反向矢量-Vo位于区域s2时,根据无人艇的速度大小进行分类讨论:
可以事先设置一个无人艇的速度临界值b2,该速度临界值b2可以表示为:
如图22所示,当VS<Vo×sin(θ2-β)时,无人艇的艏向可行区间为空集;
如图23所示,当VS>VO×sin(θ2-β)且VS<VO时,艏向圆与碰撞锥交于A2和B2两点,则A2与B2间小于180°的夹角为无人艇的艏向可行区间;
如图24所示,当VS>VO且VS<b2时,艏向圆与碰撞锥交于A3和B3两点,则A3与 B3间小于180°的夹角为无人艇的艏向可行区间;
如图25所示,当VS>b2时,艏向圆与碰撞锥交于A4和B4两点,则A4与B4间小于 180°的夹角为无人艇的艏向禁止区间。
3、当确定反向矢量-Vo位于区域s3时,根据无人艇的速度大小进行分类讨论:
如图26所示,当VS<VO×sin(β-θ2)时,无人艇的艏向可行区间为全集;
如图27所示,当VS>VO×sin(β-θ2)且VS<VO时,艏向圆与碰撞锥交于A2和B2两点,则A2与B2间小于180°的夹角为无人艇的艏向禁止区间;
如图28所示,当VS>VO时,艏向圆与碰撞锥交于A3和B3两点,则A3与B3间小于 180°的夹角为无人艇的艏向禁止区间。
4、当确定反向矢量-Vo位于区域s4或s5时,根据无人艇的速度大小进行分类讨论,反向矢量-Vo位于区域s4或s5时,除了角度的表示稍有不同,其余完全一致:
如图29所示,当VS<VO时,无人艇的艏向可行区间为全集;
如图30所示,当VS>VO时,艏向圆与碰撞锥交于A2和B2两点,则A2与B2间小于 180°的夹角为无人艇的艏向禁止区间。
上述情况中,艏向圆与碰撞锥相交或不相交,但是实际情况还会出现如当VS=VO×sin(θ2-β)时,艏向圆与碰撞锥的其中一条切线相切的情况,此时艏向圆与碰撞锥有一个切点,无论是艏向可行区间还是艏向禁行区间,均将该切点排除。
另外,当碰撞锥的角度恰好等于90°时,就不再另外设置切线的垂线(即切线与垂线重合),因此相当于去掉了碰撞锥的角度为锐角的情况下的区域a2和a4;以及a7和a9。
同理,也相当于去掉了碰撞锥的角度为钝角的情况下的对应区域。
Claims (7)
1.一种动态环境下获取水面无人艇艏向可行区间的方法,其特征在于,具体步骤如下:
步骤一、获取无人艇的航速Vs和障碍物的航速Vo;所述障碍物的数量为至少一个;
步骤二、构建无人艇和障碍物的速度障碍模型,并获得碰撞锥;
步骤三、创建速度空间;并将所述碰撞锥映射到所述速度空间,对所述速度空间进行区域划分;
步骤四、根据所述无人艇的航速、障碍物的航速和碰撞锥,计算障碍物的航速位于不同区域情况下的无人艇的艏向可行区间或艏向禁止区间。
2.根据权利要求1所述的一种动态环境下获取水面无人艇艏向可行区间的方法,其特征在于,步骤二的具体步骤如下:
步骤二一、在绝对坐标系下,以方向竖直向下的射线作为极轴,以逆时针方向作为正方向,建立极坐标系;
步骤二二、将所述无人艇等效为一个点,该点作为无人艇的等效点,且该无人艇的等效点位于极点处;将所述障碍物等效为一个半径为R的圆,该圆作为障碍物的等效圆;
步骤二三、过所述无人艇的等效点向所述障碍物的等效圆做两条切线λ1和λ2,切线λ1和切线λ2之间的区域为碰撞锥;并且,所述碰撞锥的区域内包含障碍物的等效圆和无人艇相对于障碍物的相对速度ΔV,ΔV=Vs-Vo。
3.根据权利要求2所述的一种动态环境下获取水面无人艇艏向可行区间的方法,其特征在于,步骤三的具体步骤如下:
步骤三一、过极点做障碍物的航速vo的反向矢量-Vo;再以反向矢量-Vo的末端端点为圆心,以无人艇的航速Vs的大小为半径做圆,创建速度空间;所述圆作为无人艇的艏向圆;
步骤三二、过极点对切线λ1做垂线l1,对切线λ2做垂线l2,以及做碰撞锥的角平分线l3;
步骤三三、根据碰撞锥的角度,通过切线λ1和切线λ1的延长线、切线λ2和切线λ2的延长线、垂线l1、垂线l2和角平分线l3将所述速度空间分为十个区域;
且所述十个区域以角平分线l3及角平分线l3的延长线为对称轴对称。
4.根据权利要求3所述的一种动态环境下获取水面无人艇艏向可行区间的方法,其特征在于,步骤三三中,碰撞锥的角度小于90°;并且,
所述十个区域按逆时针方向分为:
角平分线l3与切线λ1之间的区域a1;切线λ1与垂线l2之间的区域a2;垂线l2与垂线l1之间的区域a3;垂线l1与切线λ2的延长线之间的区域a4;切线λ2的延长线与角平分线l3的延长线之间的区域a5;
角平分线l3的延长线与切线λ1的延长线之间的区域a6;切线λ1的延长线与垂线l2之间的区域a7;垂线l2与垂线l1之间的区域a8;垂线l1与切线λ2之间的区域a9;切线λ2与角平分线l3之间的区域a10;
并且,区域a1与区域a10,区域a2与区域a9,区域a3与区域a8,区域a4与区域a7,以及区域a5与区域a6均以角平分线l3及角平分线l3的延长线为对称轴对称。
5.根据权利要求4所述的一种动态环境下获取水面无人艇艏向可行区间的方法,其特征在于,步骤四的具体方法如下:
步骤四一、确定反向矢量-Vo位于区域a1~区域a10中的位置;
步骤四二、根据无人艇的航速Vs的大小,确定艏向圆与碰撞锥的位置关系,得到无人艇的艏向可行区间或艏向禁止区间。
6.根据权利要求3所述的一种动态环境下获取水面无人艇艏向可行区间的方法,其特征在于,步骤三三中,碰撞锥的角度大于90°;并且,
所述多个区域按逆时针方向分为:
角平分线l3与垂线l2之间的区域s1;垂线l2与切线λ1之间的区域s2;切线λ1与切线λ2的延长线之间的区域s3;切线λ2的延长线与垂线l1之间的区域s4;垂线l1与角平分线l3的延长线之间的区域s5;
角平分线l3的延长线与垂线l2之间的区域s6;垂线l2与切线λ1的延长线之间的区域s7;切线λ1的延长线与切线λ2之间的区域s8;切线λ2与垂线l1之间的区域s9;垂线l1与角平分线l3之间的区域s10;
并且,区域s1与区域s10,区域s2与区域s9,区域s3与区域s8,区域s4与区域s7,以及区域s5与区域s6分别以角平分线l3及角平分线l3的延长线为对称轴对称。
7.根据权利要求6所述的一种动态环境下获取水面无人艇艏向可行区间的方法,其特征在于,步骤四的具体方法如下:
步骤四一、确定反向矢量-Vo位于区域s1~区域s10中的位置;
步骤四二、根据无人艇的航速Vs的大小,确定艏向圆与碰撞锥的位置关系,得到无人艇的艏向可行区间或艏向禁止区间。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110424038.1A CN113110460B (zh) | 2021-04-20 | 2021-04-20 | 一种动态环境下获取水面无人艇艏向可行区间的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110424038.1A CN113110460B (zh) | 2021-04-20 | 2021-04-20 | 一种动态环境下获取水面无人艇艏向可行区间的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113110460A true CN113110460A (zh) | 2021-07-13 |
CN113110460B CN113110460B (zh) | 2022-09-02 |
Family
ID=76719340
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110424038.1A Active CN113110460B (zh) | 2021-04-20 | 2021-04-20 | 一种动态环境下获取水面无人艇艏向可行区间的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113110460B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115657682A (zh) * | 2022-11-11 | 2023-01-31 | 中国船舶集团有限公司第七一六研究所 | 一种关于无人艇在狭窄水道中安全航行的避碰决策方法 |
CN116088541A (zh) * | 2023-04-10 | 2023-05-09 | 武汉理工大学 | 一种辅助船舶远程驾驶的人机交互系统及辅助方法 |
Citations (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090315756A1 (en) * | 2004-02-04 | 2009-12-24 | Hayama Imazu | Vessel monitoring system |
RU2452655C1 (ru) * | 2010-12-09 | 2012-06-10 | Учреждение Российской академии наук Институт проблем управления им. В.А. Трапезникова РАН | Способ автоматического управления движением судна |
EP2482030A1 (en) * | 2009-09-24 | 2012-08-01 | Hitachi Automotive Systems, Ltd. | Obstacle detection device |
US20120265380A1 (en) * | 2011-04-13 | 2012-10-18 | California Institute Of Technology | Target Trailing with Safe Navigation with colregs for Maritime Autonomous Surface Vehicles |
JP2015191437A (ja) * | 2014-03-28 | 2015-11-02 | ダイハツ工業株式会社 | 運転支援装置 |
CN105022270A (zh) * | 2015-03-20 | 2015-11-04 | 武汉理工大学 | 基于速度矢量坐标系的船自动避碰方法 |
EP2958799A1 (en) * | 2013-02-25 | 2015-12-30 | Tecom AS | Method for operation of an unmanned ocean vessel |
CN105629975A (zh) * | 2016-02-05 | 2016-06-01 | 哈尔滨工程大学 | 一种基于虚拟膨化的uuv航行过程中的运动障碍的规避方法 |
CN106292287A (zh) * | 2016-09-20 | 2017-01-04 | 哈尔滨工程大学 | 一种基于自适应滑模控制的uuv路径跟踪方法 |
EP3427562A1 (en) * | 2016-03-09 | 2019-01-16 | Yanmar Co., Ltd. | Work vehicle and travel region specification device |
CN109597417A (zh) * | 2019-01-14 | 2019-04-09 | 哈尔滨工程大学 | 一种基于避碰准则的多usv群体协同避碰规划方法 |
CN109960262A (zh) * | 2019-03-25 | 2019-07-02 | 华中科技大学 | 一种基于几何法的无人艇动态避障方法和系统 |
CN110032184A (zh) * | 2019-03-12 | 2019-07-19 | 哈尔滨工程大学 | 一种基于遗传与滑动窗口法的水上无人艇避碰方法 |
CN110362074A (zh) * | 2019-06-18 | 2019-10-22 | 华南理工大学 | 一种基于航迹重规划的水面无人艇动态避碰方法 |
CN111158381A (zh) * | 2020-01-19 | 2020-05-15 | 中电科(宁波)海洋电子研究院有限公司 | 一种带长拖曳线阵列的无人船避障方法 |
CN112561232A (zh) * | 2020-11-10 | 2021-03-26 | 武汉理工大学 | 繁忙水域船舶交通冲突风险度量方法 |
CN112578793A (zh) * | 2020-11-24 | 2021-03-30 | 哈尔滨工程大学 | 一种快速运动水面艇的避障方法 |
-
2021
- 2021-04-20 CN CN202110424038.1A patent/CN113110460B/zh active Active
Patent Citations (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090315756A1 (en) * | 2004-02-04 | 2009-12-24 | Hayama Imazu | Vessel monitoring system |
EP2482030A1 (en) * | 2009-09-24 | 2012-08-01 | Hitachi Automotive Systems, Ltd. | Obstacle detection device |
RU2452655C1 (ru) * | 2010-12-09 | 2012-06-10 | Учреждение Российской академии наук Институт проблем управления им. В.А. Трапезникова РАН | Способ автоматического управления движением судна |
US20120265380A1 (en) * | 2011-04-13 | 2012-10-18 | California Institute Of Technology | Target Trailing with Safe Navigation with colregs for Maritime Autonomous Surface Vehicles |
EP2958799A1 (en) * | 2013-02-25 | 2015-12-30 | Tecom AS | Method for operation of an unmanned ocean vessel |
JP2015191437A (ja) * | 2014-03-28 | 2015-11-02 | ダイハツ工業株式会社 | 運転支援装置 |
CN105022270A (zh) * | 2015-03-20 | 2015-11-04 | 武汉理工大学 | 基于速度矢量坐标系的船自动避碰方法 |
CN105629975A (zh) * | 2016-02-05 | 2016-06-01 | 哈尔滨工程大学 | 一种基于虚拟膨化的uuv航行过程中的运动障碍的规避方法 |
EP3427562A1 (en) * | 2016-03-09 | 2019-01-16 | Yanmar Co., Ltd. | Work vehicle and travel region specification device |
CN106292287A (zh) * | 2016-09-20 | 2017-01-04 | 哈尔滨工程大学 | 一种基于自适应滑模控制的uuv路径跟踪方法 |
CN109597417A (zh) * | 2019-01-14 | 2019-04-09 | 哈尔滨工程大学 | 一种基于避碰准则的多usv群体协同避碰规划方法 |
CN110032184A (zh) * | 2019-03-12 | 2019-07-19 | 哈尔滨工程大学 | 一种基于遗传与滑动窗口法的水上无人艇避碰方法 |
CN109960262A (zh) * | 2019-03-25 | 2019-07-02 | 华中科技大学 | 一种基于几何法的无人艇动态避障方法和系统 |
CN110362074A (zh) * | 2019-06-18 | 2019-10-22 | 华南理工大学 | 一种基于航迹重规划的水面无人艇动态避碰方法 |
CN111158381A (zh) * | 2020-01-19 | 2020-05-15 | 中电科(宁波)海洋电子研究院有限公司 | 一种带长拖曳线阵列的无人船避障方法 |
CN112561232A (zh) * | 2020-11-10 | 2021-03-26 | 武汉理工大学 | 繁忙水域船舶交通冲突风险度量方法 |
CN112578793A (zh) * | 2020-11-24 | 2021-03-30 | 哈尔滨工程大学 | 一种快速运动水面艇的避障方法 |
Non-Patent Citations (7)
Title |
---|
DONG WANG 等: "A steering occasion strategy for local collision avoidance of an Unmanned Surface Vehicle in a complex environment", 《PROCEEDINGS OF THE 36TH CHINESE CONTROL CONFERENCE》 * |
DONG WANG 等: "Local Collision Avoidance Algorithm for a Unmanned Surface Vehicle Based on Steering Maneuver Considering COLREGs", 《IEEE ACCESS》 * |
JIAYUAN ZHUANG 等: "A Locking Sweeping Method Based Path Planning for Unmanned Surface Vehicles in Dynamic Maritime Environments", 《JOURNAL OF MAINE SCIENCE AND ENGINEERING》 * |
付杨: "水面无人艇的路径规划及避碰方法研究", 《中国优秀硕士学位论文全文数据库工程科技Ⅱ辑》 * |
朱骋 等: "基于改进视线法的欠驱动无人艇路径跟踪", 《哈尔滨工程大学学报》 * |
王引圭: "无人艇应对主动威胁的智能规避方法研究", 《中国优秀硕士学位论文全文数据库工程科技Ⅱ辑》 * |
王跃午: "基于快速行进法的无人艇编队路径规划技术研究", 《中国优秀硕士学位论文全文数据库工程科技Ⅱ辑》 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115657682A (zh) * | 2022-11-11 | 2023-01-31 | 中国船舶集团有限公司第七一六研究所 | 一种关于无人艇在狭窄水道中安全航行的避碰决策方法 |
CN116088541A (zh) * | 2023-04-10 | 2023-05-09 | 武汉理工大学 | 一种辅助船舶远程驾驶的人机交互系统及辅助方法 |
CN116088541B (zh) * | 2023-04-10 | 2023-07-14 | 武汉理工大学 | 一种辅助船舶远程驾驶的人机交互系统及辅助方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113110460B (zh) | 2022-09-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110083159B (zh) | 基于sbg和动态窗口约束的无人船自主动态避碰方法 | |
CN109597417B (zh) | 一种基于避碰准则的多usv群体协同避碰规划方法 | |
CN113110460B (zh) | 一种动态环境下获取水面无人艇艏向可行区间的方法 | |
CN110262492B (zh) | 一种无人艇的实时避碰和目标跟踪方法 | |
CN113759939B (zh) | 一种受限水域智能航行方法及装置 | |
CN111123903B (zh) | 一种基于圆形轨迹单元的无人艇避障方法 | |
CN110837255B (zh) | 一种适用于高速水面无人艇的自主危险规避方法 | |
CN110414042B (zh) | 一种冲突会遇局面下船舶集群态势分析方法 | |
CN115515851A (zh) | 船舶的自动导向方法、船舶的自动导向程序、船舶的自动导向系统及船舶 | |
CN108459602B (zh) | 多障碍复杂环境下欠驱动无人艇的自主靠泊方法 | |
CN110444046B (zh) | 一种受限水域非冲突会遇船舶集群态势分析方法 | |
CN112578793B (zh) | 一种快速运动水面艇的避障方法 | |
CN113671968A (zh) | 一种基于改进动态最优互惠避碰机制的无人水面艇实时避碰方法 | |
CN114384917A (zh) | 一种基于场论的船舶实时避碰方法 | |
CN109916400B (zh) | 一种基于梯度下降算法与vo法相结合的无人艇避障方法 | |
CN110618685A (zh) | 一种无人水面艇障碍物探测误差修正及安全避碰方法 | |
Mei et al. | COLREGs based navigation of riverine Autonomous Surface Vehicle | |
CN111679674B (zh) | 一种无人艇灵活会遇规避方法 | |
CN116974282A (zh) | 基于无人艇的海上搜寻区域覆盖路径规划方法 | |
CN110796142B (zh) | 一种基于船舶集群态势的船间相对领域获取方法 | |
CN110796899B (zh) | 一种受限水域基于船舶集群态势的船岸相对领域获取方法 | |
CN110928278A (zh) | 一种用于无人艇的自主安全航行方法和无人艇 | |
CN111984006B (zh) | 融合海流及尺度差异影响的无人艇多目标会遇避碰方法 | |
Zhang et al. | Collision avoidance path planning of open water ships based on velocity obstacle method | |
CN115344039B (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |