CN112820150B - 一种基于ais的船舶避碰决策方法 - Google Patents

一种基于ais的船舶避碰决策方法 Download PDF

Info

Publication number
CN112820150B
CN112820150B CN202110042841.9A CN202110042841A CN112820150B CN 112820150 B CN112820150 B CN 112820150B CN 202110042841 A CN202110042841 A CN 202110042841A CN 112820150 B CN112820150 B CN 112820150B
Authority
CN
China
Prior art keywords
ship
ships
meeting
collision avoidance
point
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.)
Active
Application number
CN202110042841.9A
Other languages
English (en)
Other versions
CN112820150A (zh
Inventor
朱金善
张飞宇
贺仕琪
曲凯
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Dalian Maritime University
Original Assignee
Dalian Maritime University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Dalian Maritime University filed Critical Dalian Maritime University
Publication of CN112820150A publication Critical patent/CN112820150A/zh
Application granted granted Critical
Publication of CN112820150B publication Critical patent/CN112820150B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G3/00Traffic control systems for marine craft
    • G08G3/02Anti-collision systems

Landscapes

  • Engineering & Computer Science (AREA)
  • Ocean & Marine Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Traffic Control Systems (AREA)

Abstract

本发明公开了一种基于AIS的船舶避碰决策方法,包括:运用真运动作图法建立二维笛卡尔坐标系,根据解析几何原理以及AIS信息计算本船和他船的速度分量以及两船会遇时的最近会遇距离DCPA和最小会遇时间TCPA;根据最近会遇距离DCPA和最小会遇时间TCPA判断碰撞危险;基于最近会遇距离DCPA和最小会遇时间TCPA通过对坐标进行相应变换以转化为新的位置向量,判断本船和他船的会遇局面;根据最近会遇距离DCPA和最小会遇时间TCPA计算转向点和船舶避碰的转向角度;在采取避碰行动之后重新根据AIS信息确定避碰行动的有效性;根据整个避碰过程中他船相对本船的各个位置坐标确定航向复原点、航线复原点及复航时的转向角度。

Description

一种基于AIS的船舶避碰决策方法
技术领域
本发明涉及船舶避碰技术领域,尤其涉及一种基于AIS的船舶避碰决策方法。
背景技术
目前在大多数船舶智能避碰研究中,其所需避碰信息的来源主要有雷达、船舶自识别系统(AIS)及电子海图(ECDIS)等,其中,动态信息主要靠前两者获取,而ECDIS则主要提供通航水域的静态信息(如水深、礁石等),雷达早在上世纪中后期就逐渐普遍应用于航海,基于雷达信号的自动雷达标绘(ARPA)能够方便地求出来船的DCPA(两船间的最近会遇距离)和TCPA(到达最近会遇点所需时间),进而判断两船是否存在碰撞危险,因而现有的避碰决策多基于雷达信号;然而,雷达对小物标的探测能力较差,雨雪及大风浪天气时存在杂波干扰,且物标较多时还存在回波重叠、目标丢失或假跟踪等问题。因此,对于船舶智能避碰而言,有必要寻求基本多源信息、多种手段的避碰决策,从而为实现智能避碰决策奠定基础;而且这也正是《国际海上避碰规则》的要求(《规则》第五、七条分别要求采取一切可用手段获取避碰信息、判断是否存在碰撞危险)。
综上,利用AIS信息确定船舶避碰决策十分必要。其不仅对船舶智能避碰领域本身而言是一项创新,而且在海上安全保障及航海实践中具有较强的实用价值;还可为后续改进其他算法等工作奠定基础。
发明内容
根据现有技术存在的问题,本发明公开了一种基于AIS的船舶避碰决策方法,具体包括如下步骤:
运用真运动作图法建立二维笛卡尔坐标系,根据解析几何原理以及AIS信息计算本船和他船的速度分量以及两船会遇时的最近会遇距离DCPA和最小会遇时间TCPA;
根据最近会遇距离DCPA和最小会遇时间TCPA判断碰撞危险;
基于最近会遇距离DCPA和最小会遇时间TCPA通过对坐标进行相应变换以转化为新的位置向量,并判断本船和他船的会遇局面;
根据最近会遇距离DCPA和最小会遇时间TCPA计算转向点和船舶避碰的转向角度;
在采取避碰行动之后重新根据AIS信息以确定避碰行动的有效性;
根据整个避碰过程中他船相对本船的各个位置坐标确定航向复原点和航线复原点。
进一步的,建立二维笛卡尔坐标系xoy,将本船和他船的速度向量分解为x轴和y轴上的分量,根据本船的位置(xO1,yO1)、航速vO以及AIS信号中获取的他船位置(xT1,yT1)和航速vT计算最近会遇距离DCPA和最小会遇时间TCPA;
Figure BDA0002896576830000021
Figure BDA0002896576830000022
其中:vOx1,vTx1分别为本船和他船在x轴的速度分量,vOy1,vTy1分别为本船和他船在y轴的速度分量。
进一步的,在判断碰撞危险时,如果两船的最近会遇距离DCPA小于安全会遇距离,则计算最小会遇时间TCPA的值,如果最小会遇时间TCPA较大,则需持续观测两船的动态,经过一段时间后如果最近会遇距离DCPA仍小于安全会遇距离且最小会遇时间TCPA也小于安全值,则已构成碰撞危险。
进一步的,判断会遇局面时:将AIS获得的他船位置和航向信息对已知的本船及他船位置坐标做出相应变换,将其转化为新的位置向量,从而计算两船航向夹角Δ,根据两船航向夹角Δ的余弦值所在范围,确定两船所属的会遇局面。
进一步的,获取船舶避碰的转向角度时:
确定本船从起始点到转向点所用时间t1,利用所述时间t1和本船速度vo确定转向点位置O3,此时他船到达T3位置,两船相距为D,根据安全会遇距离R,避让时两船距离D以及转向后相对速度方向与他船速度方向夹角θ确定本船从位置O3到位置O4所用时间t2,以本船的转向点位置为O3圆心,vot2为半径作圆,以他船的位置T4为圆心,R为半径作圆,根据几何关系确定本船转向角ΔC。
进一步的,在采取避碰行动之后,重新根据他船的AIS信息再次求算新的最近会遇距离DCPA,只要新的最近会遇距离DCPA等于或接近等于安全会遇距离则证明避碰行动有效。
进一步的,确定航向复原点和航线复原点时:以转向避让方向的反方向转过ΔC+10°的角度作为恢复航线的转向角来计算复航点,设定航向复原点O5和航线复原点O6,计算避碰过程各阶段他船相对本船的位置坐标,确定航向复原点O5,根据本船在转向点后的速度分量,计算航线复原点O6。
由于采用了上述技术方案,本发明提供的一种基于AIS的船舶避碰决策方法,该方法不仅可以在正常情况下判断两船之间的会遇局面,获得拟采取的避让行动以及航线复原的时机,解决了在全面遵守《规则》前提下的避碰全过程的决策问题;还可以在恶劣天气条件下,如雨雪及大风浪天气时做出有效的完整避碰决策。
附图说明
为了更清楚地说明本申请实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请中记载的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明方法的决策流程图;
图2为坐标转换关系示意图;
图3(a)(b)(c)为三种会遇局面避碰行动示意图;
图4为航向复原与航线复原关系示意图;
图5为本船避让及回到原航线示意图。
具体实施方式
为使本发明的技术方案和优点更加清楚,下面结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚完整的描述:
如图1所示的一种基于AIS的船舶避碰决策方法,具体包括如下步骤:
S1:运用真运动作图法,建立二维笛卡尔坐标系,根据解析几何原理以及AIS信息,计算本船和他船的速度分量大小,并计算出最近会遇距离DCPA和最小会遇时间TCPA的大小;
S2:基于S1得出的计算结果,判断碰撞危险;
S3:基于S1和S2得出的计算结果,通过对本船和他船坐标进行相应变换以转化为新的位置向量,判断会遇局面;
S4:基于S1、S2和S3得出的结算结果,计算转向点和转向角度;
S5:在采取基于S4的避碰行动之后,重新利用AIS信息执行S2,确定出避碰行动的有效性;
S6:根据基于S4的避碰行动过程中他船相对本船的各个位置坐标,确定航线复原点。
进一步的,S1中具体采用如下方式:
S11:建立二维笛卡尔坐标系xoy,选取地球表面任意一点为坐标原点,真北方向为y轴的正向,正东方向为x轴的正向;
S12:本船和他船的速度向量分解为x轴和y轴上的分量vOx1,vOy1,vTx1,vTy1,知本船初始位置为pO1=(xO1,yO1),速度为vO,航向为Φ1;由AIS信息可知,他船初始位置为pT1=(xT1,yT1),速度为vT,他船航向为Φ2。则本船和他船的速度大小可分别表示为:
Figure BDA0002896576830000041
Figure BDA0002896576830000042
S13:取转向避让时两船的距离为D,两船间的安全会遇距离为R;
S14:根据S11,S12和S13得出的结果计算出最近会遇距离DCPA和最小会遇时间TCPA
Figure BDA0002896576830000043
Figure BDA0002896576830000044
S2中具体采用如下方式:
S21:基于S1得出的最近会遇距离DCPA和最小会遇时间TCPA,如果最近会遇距离DCPA小于安全值R,最小会遇时间TCPA也小于设定的安全值,则判断构成碰撞危险。
S3中具体采用如下方式:
S31:基于S1得出的船舶相关数据,得出船相对本船的初始位置坐标可表示为pr1=(xr1,yr1)=(xT1-xO1,yT1-yO1),利用图3所示的坐标转换关系,将pr1=(xr1,yr1)转换为
Figure BDA0002896576830000051
S32:根据S1所得本船的初始速度向量为vO=(vOx1,vOy1),他船的初始速度向量vT=(vTx1,vTy1),计算出两船航向夹角Δ的余弦为:
Figure BDA0002896576830000052
S33:基于S32所得结果,判断属于哪种会遇局面。
若cos67.5°<cosΔ≤1且满足y′r1<0,
Figure BDA0002896576830000053
则两船处于追越局面;
若-1≤cosΔ<cos174°且满足y′r1>0,
Figure BDA0002896576830000054
或y′r1=0,则两船处于对遇局面;
若有cos174°<cosΔ<cos67.5°,且满足y′r1>0,
Figure BDA0002896576830000055
(或y′r1<0,
Figure BDA0002896576830000056
),则两船处于交叉相遇局面。
S4中具体采用如下方式:
S41:基于S1和S3所得结果,设本船从起始点到转向点(两船相距D)时
所用时间为t1,t1的计算方式如下:
Figure BDA0002896576830000061
S42:确定转向点为O3=(xO3,yO3)=(xO1+t1vOx1,yO1+t1vOy1);
S43:基于S41和S42所得结果,以及图3,当本船到达O3位置,他船达到T3位置时,两船相距为D,本船作为让路船或负有同等避让责任的船舶需要进行转向避让,转向后本船到达O4位置,他船到达T4位置,此时,两船相距为R。确定本船从O3位置到达O4位置所需时间为t2,则
Figure BDA0002896576830000062
其中θ是转向后相对速度方向与他船速度方向的夹角,其表达式为
Figure BDA0002896576830000063
S44:基于S41,S42和S43所得结果,以本船的位置O3为圆心,vOt2为半径作圆Q;以他船的位置T4为圆心,R为半径作圆G;设圆Q与圆G相交于A,B两点故本船转向点(O3)与B点的连线即为本船的新航向线,确定转向角(ΔC)为:
Figure BDA0002896576830000064
其中,xO4,yO4为B点的横、纵坐标。
S5中具体采用如下方式:
S51:基于S4所得结果采取避碰行动后,重新根据S1和S2步骤判断是否存在碰撞危险,即只要新的DCPA等于或接近等于安全会遇距离即说明避碰行动有效。
根据整个避碰过程中他船相对本船的各个位置坐标,确定航向复原点。
S6中具体采用如下方式:
S61基于S4确定避碰角度,如图4所示,设定航向复原点O5和航线复原点O6;
S62基于S4确定的避碰过程,计算各阶段他船相对本船的位置坐标,根据图5几何关系,确定航向复原点O5;
S63设定船舶以小角度转向(不超过10°为宜)逐渐回到原航线上,以转向避让方向的反方向转过ΔC+10°的角度作为恢复航线的转向角,计算复航点。基于S62所得结果以及本船转向后的速度分量,计算出转向复原点O6。
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,根据本发明的技术方案及其发明构思加以等同替换或改变,都应涵盖在本发明的保护范围之内。

Claims (1)

1.一种基于AIS的船舶避碰决策方法,包括如下步骤:
S1:运用真运动作图法,建立二维笛卡尔坐标系,根据解析几何原理以及AIS信息,计算本船和他船的速度分量大小,并计算出最近会遇距离DCPA和最小会遇时间TCPA的大小;
S2:基于S1得出的计算结果,判断碰撞危险;
S3:基于S1和S2得出的计算结果,通过对本船和他船坐标进行相应变换以转化为新的位置向量,判断会遇局面;
S4:基于S1、S2和S3得出的结算结果,计算转向点和转向角度;
S5:在采取基于S4的避碰行动之后,重新利用AIS信息执行S2,确定出避碰行动的有效性;
S6:根据基于S4的避碰行动过程中他船相对本船的各个位置坐标,确定航线复原点;
S1中具体采用如下方式:
S11:建立二维笛卡尔坐标系xoy,选取地球表面任意一点为坐标原点,真北方向为y轴的正向,正东方向为x轴的正向;
S12:本船和他船的速度向量分解为x轴和y轴上的分量vOx1,vOy1,vTx1,vTy1,知本船初始位置为pO1=(xO1,yO1),速度为vO,航向为Φ1;由AIS信息可知,他船初始位置为pT1=(xT1,yT1),速度为vT,他船航向为Φ2,则本船和他船的速度大小可分别表示为:
Figure DEST_PATH_IMAGE002
Figure DEST_PATH_IMAGE004
S13:取转向避让时两船的距离为D,两船间的安全会遇距离为R;
S14:根据S11,S12和S13得出的结果计算出最近会遇距离DCPA和最小会遇时间TCPA
Figure DEST_PATH_IMAGE006
Figure DEST_PATH_IMAGE008
S2中具体采用如下方式:
S21:基于S1得出的最近会遇距离DCPA和最小会遇时间TCPA,如果最近会遇距离DCPA小于安全值R,最小会遇时间TCPA也小于设定的安全值,则判断构成碰撞危险;
S3中具体采用如下方式:
S31:基于S1得出的船舶相关数据,得出船相对本船的初始位置坐标可表示为pr1=(xr1,yr1)=(xT1-xO1,yT1-yO1),将pr1=(xr1,yr1)转换为
Figure DEST_PATH_IMAGE010
S32:根据S1所得本船的初始速度向量为vO=(vOx1,vOy1),他船的初始速度向量vT=(vTx1,vTy1),计算出两船航向夹角Δ的余弦为:
Figure DEST_PATH_IMAGE012
S33:基于S32所得结果,判断属于哪种会遇局面;
若cos67.5°<cosΔ≤1且满足y'r1<0,
Figure DEST_PATH_IMAGE014
则两船处于追越局面;
若-1≤cosΔ<cos174°且满足y'r1>0,
Figure DEST_PATH_IMAGE016
或y'r1=0,则两船处于对遇局面;
若有cos174°<cosΔ<cos67.5°,且满足y'r1>0,
Figure DEST_PATH_IMAGE018
或y'r1<0,
Figure DEST_PATH_IMAGE020
则两船处于交叉相遇局面;
S4中具体采用如下方式:
S41:基于S1和S3所得结果,设本船从起始点到转向点, 两船相距D时
所用时间为t1,t1的计算方式如下:
Figure DEST_PATH_IMAGE022
S42:确定转向点为O3=(xO3,yO3)=(xO1+t1vOx1,yO1+t1vOy1);
S43: 基于S41和S42所得结果,当本船到达O3位置,他船达到T3位置时,两船相距为D,本船作为让路船或负有同等避让责任的船舶需要进行转向避让,转向后本船到达O4位置,他船到达T4位置,此时,两船相距为R;确定本船从O3位置到达O4位置所需时间为t2,则
Figure DEST_PATH_IMAGE024
其中θ是转向后相对速度方向与他船速度方向的夹角,其表达式为
Figure DEST_PATH_IMAGE026
S44:基于S41,S42和S43所得结果,以本船的位置O3为圆心,vOt2为半径作圆Q;以他船的位置T4为圆心,R为半径作圆G;设圆Q与圆G相交于A, B两点故本船转向点O3与B点的连线即为本船的新航向线,确定转向角ΔC为:
Figure DEST_PATH_IMAGE028
其中,xO4,yO4为B点的横、纵坐标;
S5中具体采用如下方式:
S51:基于S4所得结果采取避碰行动后,重新根据S1和S2步骤判断是否存在碰撞危险,即只要新的DCPA等于或接近等于安全会遇距离即说明避碰行动有效;
根据整个避碰过程中他船相对本船的各个位置坐标,确定航向复原点;
S6中具体采用如下方式:
S61:基于S4确定避碰角度,设定航向复原点O5和航线复原点O6;
S62:基于S4确定的避碰过程,计算各阶段他船相对本船的位置坐标,确定航向复原点O5;
S63:设定船舶以小角度转向,转向不超过10°为宜,逐渐回到原航线上,以转向避让方向的反方向转过ΔC+10°的角度作为恢复航线的转向角,计算复航点;基于S62所得结果以及本船转向后的速度分量,计算出转向复原点O6。
CN202110042841.9A 2020-12-29 2021-01-13 一种基于ais的船舶避碰决策方法 Active CN112820150B (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202011599303 2020-12-29
CN2020115993031 2020-12-29

Publications (2)

Publication Number Publication Date
CN112820150A CN112820150A (zh) 2021-05-18
CN112820150B true CN112820150B (zh) 2023-03-17

Family

ID=75869143

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110042841.9A Active CN112820150B (zh) 2020-12-29 2021-01-13 一种基于ais的船舶避碰决策方法

Country Status (1)

Country Link
CN (1) CN112820150B (zh)

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113687658B (zh) * 2021-09-24 2023-11-24 大连海事大学 一种面向多船实时自动避碰的模型预测控制方法
CN114970936A (zh) * 2022-03-01 2022-08-30 江苏恒澄交科信息科技股份有限公司 一种用于内河循迹航行船舶的会遇时空预测方法
CN114999231A (zh) * 2022-05-27 2022-09-02 武汉理工大学 一种基于ais数据的多船会遇场景侦测方法、系统及平台
CN115273557A (zh) * 2022-07-01 2022-11-01 中远海运科技股份有限公司 一种基于ais的在航船舶碰撞风险检测及预警方法和系统
CN115995164B (zh) * 2022-11-21 2024-05-14 广州航海学院 一种确定船舶转向避让时紧迫局面距离与碰撞距离的方法
CN116564136B (zh) * 2023-05-20 2024-03-19 广西综合交通大数据研究院 基于ais的船舶碰撞预测方法

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2020044934A (ja) * 2018-09-18 2020-03-26 東京計器株式会社 船舶用航行支援装置
CN111445086A (zh) * 2020-04-17 2020-07-24 集美大学 一种基于pidvca预测复航时间的方法

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
PL389638A1 (pl) * 2009-11-26 2010-06-21 Akademia Morska W Szczecinie Sposób i układ wspomagania decyzji nawigacyjnych, w procesie bezpiecznego prowadzenia obiektu pływającego
CN103730031B (zh) * 2014-01-14 2015-09-30 武汉理工大学 内河桥区船载航行主动避碰系统及避碰方法
CN110400491A (zh) * 2019-06-10 2019-11-01 北京海兰信数据科技股份有限公司 一种宽水域多目标辅助避碰决策方法及决策系统
CN111243339A (zh) * 2020-01-14 2020-06-05 武汉理工大学 具有避碰预警功能的渡船专用ais系统及方法
CN111260963B (zh) * 2020-03-11 2021-02-26 武汉理工大学 一种多船会遇避碰方法
CN111833657B (zh) * 2020-06-28 2022-03-15 武汉理工大学 船舶避碰方法、系统和存储介质

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2020044934A (ja) * 2018-09-18 2020-03-26 東京計器株式会社 船舶用航行支援装置
CN111445086A (zh) * 2020-04-17 2020-07-24 集美大学 一种基于pidvca预测复航时间的方法

Also Published As

Publication number Publication date
CN112820150A (zh) 2021-05-18

Similar Documents

Publication Publication Date Title
CN112820150B (zh) 一种基于ais的船舶避碰决策方法
CN108445879B (zh) 一种基于预测碰撞危险区域的无人艇避障方法
CN110362074B (zh) 一种基于航迹重规划的水面无人艇动态避碰方法
CN110262492B (zh) 一种无人艇的实时避碰和目标跟踪方法
CN108073175B (zh) 基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法
CN109597417B (zh) 一种基于避碰准则的多usv群体协同避碰规划方法
CN108803313A (zh) 一种基于海流预测模型的路径规划方法
CN109460035A (zh) 一种无人艇高速状态下的二级自主避障系统及避障方法
CN115515851A (zh) 船舶的自动导向方法、船舶的自动导向程序、船舶的自动导向系统及船舶
CN111290410A (zh) 一种基于毫米波雷达的船舶自动离靠泊系统及方法
CN110849370A (zh) 一种基于水面无人艇的动态航线规划方法
CN114326702B (zh) 一种基于模型预测控制的内河无人船避碰方法
CN114061565B (zh) 一种无人船舶slam及其应用方法
WO2023064384A1 (en) Context-dependent generation of navigational chart comprising hazards
WO2023073164A1 (en) Collision avoidance for marine vessels
CN109916400B (zh) 一种基于梯度下降算法与vo法相结合的无人艇避障方法
CN110618685A (zh) 一种无人水面艇障碍物探测误差修正及安全避碰方法
CN110580045A (zh) 一种无人艇避障方法
CN110796142B (zh) 一种基于船舶集群态势的船间相对领域获取方法
CN110456786B (zh) 基于地形特征提取的uuv海底地形跟踪系统及跟踪方法
CN110414042B (zh) 一种冲突会遇局面下船舶集群态势分析方法
CN111984006B (zh) 融合海流及尺度差异影响的无人艇多目标会遇避碰方法
CN115407780A (zh) 一种基于三阶段避障策略的无人船局部路径规划方法
CN114610046A (zh) 一种考虑动态水深的无人艇动态安全轨迹规划方法
Zhang et al. Collision avoidance path planning of open water ships based on velocity obstacle method

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