CN111897326A - 一种基于循迹航行的自主驾驶船舶避碰时机确定方法 - Google Patents

一种基于循迹航行的自主驾驶船舶避碰时机确定方法 Download PDF

Info

Publication number
CN111897326A
CN111897326A CN202010648200.3A CN202010648200A CN111897326A CN 111897326 A CN111897326 A CN 111897326A CN 202010648200 A CN202010648200 A CN 202010648200A CN 111897326 A CN111897326 A CN 111897326A
Authority
CN
China
Prior art keywords
ship
dynamic target
point
track
collision 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
Application number
CN202010648200.3A
Other languages
English (en)
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.)
Navigation Brilliance Qingdao Technology Co Ltd
Original Assignee
Navigation Brilliance Qingdao Technology Co Ltd
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 Navigation Brilliance Qingdao Technology Co Ltd filed Critical Navigation Brilliance Qingdao Technology Co Ltd
Priority to CN202010648200.3A priority Critical patent/CN111897326A/zh
Publication of CN111897326A publication Critical patent/CN111897326A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • 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

Abstract

本发明提供一种基于循迹航行的自主驾驶船舶避碰时机确定方法，包括：基于电子海图利用路径规划算法确定多航段构成的初始航线，根据多航段确定包含有多个航迹点的航迹点集合；在沿初始航线进行循迹航行的过程中，获取动态目标信息集合，包含至少一个动态目标的信息；通过遍历动态目标信息集合中的动态目标的信息，分别计算本船避碰至少一个动态目标的最晚时间，确定本船避碰动态目标集合的最晚时间；如本船避碰动态目标集合的最晚时间大于0，且至少一个动态目标与本船间的距离小于安全会遇距离，则基于本船避碰动态目标集合的最晚时间确定避碰时机。本发明基于循迹航行确定避碰时机，能准确确定本船未来航行轨迹，避碰准确性更高。

Description

一种基于循迹航行的自主驾驶船舶避碰时机确定方法
技术领域
本发明涉及无人船舶航行技术领域，尤其涉及一种基于循迹航行的 自主驾驶船舶避碰时机确定方法。
背景技术
随着航运业的发展，船舶数量迅速增长，海上交通事故时有发生， 造成了人员伤亡、财产损失和海洋环境污染等巨大损失，因此，船舶避 碰决策系统的研究受到了航海界的高度重视。在船舶避碰决策中，如何 确定船舶避让时机是一个备受关注的问题。驾驶员若过早采取避让行动， 会造成本船偏离航线较多，浪费航程，从经济的角度考虑，是没有必要 的。若采取避让行动较晚，就可能会造成紧迫局面、紧迫危险甚至碰撞 事故。《1972年国际海上避碰规则》中规定让路船要“及早的”采取大 幅度的行动，但是这一规定是比较模糊的。不少专家学者致力于在遵守 规则的前提下将此问题量化，建立船舶避让时机决策模型，取得了一定 进展，但是尚无令航海人员普遍满意的成果。
为了船舶领域不被“侵犯”，驾驶员应提前采取行动，因此，有必 要确定动界。动界模型的逻辑是：当未来情况是本船领域受到来船“侵 犯”时，来船到达船舶动界边界时本船采取避碰行动。日本的长泽明用 类似的方法建立了避让开始时机模型，其方法是：如果来船的相对运动 线穿过本船的避让领域，则本船在来船到达避让开始领域边界时采取避 让行动。
但是现有技术中的动界仅仅是一个距离概念，避让规划中未考虑 TCPA、相对运动速度等时间因素对避让时机的影响，而实际场景下自主 驾驶船舶根据规划路径循迹航行时可能存在多航迹段变化，传统技术无 法直接应用于自主驾驶船舶。
上述缺陷是本领域技术人员期望克服的。
发明内容
(一)要解决的技术问题
为了解决现有技术的上述问题，本发明提供一种基于循迹航行的自 主驾驶船舶避碰时机确定方法，解决现有技术中无法充分利用自主驾驶 船舶优势导致决策时考虑因素不够全面，避碰时机不符合航海实际情况 的问题。
(二)技术方案
为了达到上述目的，本发明采用的主要技术方案包括：
本发明提供一种基于循迹航行的自主驾驶船舶避碰时机确定方法， 包括：
S10、基于电子海图利用路径规划算法确定多航段构成的初始航线， 根据所述多航段确定包含有多个航迹点的航迹点集合；
S20、在沿初始航线进行循迹航行的过程中，获取动态目标信息集合， 所述动态目标信息集合中包含至少一个动态目标的信息；
S30、通过遍历动态目标信息集合中的动态目标的信息，分别计算本 船避碰至少一个动态目标的最晚时间，确定本船避碰动态目标集合的最 晚时间；
S40、如果所述本船避碰动态目标集合的最晚时间大于0，且动态目 标集合中至少有一个动态目标与本船之间的距离小于安全会遇距离，则 基于所述本船避碰动态目标集合的最晚时间确定避碰时机。
在本发明的一种示例性实施例中，所述多个航迹段均已避开静态障 碍物。
在本发明的一种示例性实施例中，所述航迹点集合中包含n个航迹 点，起始点、终止点及其之间的n-2个航迹点形成的多个航迹段编号用 index表示，且index＝1,2,3,...n。
在本发明的一种示例性实施例中，所述动态目标的信息包括动态目 标的位置、航速和航向。
在本发明的一种示例性实施例中，所述动态目标集合中包括m个动 态目标。
在本发明的一种示例性实施例中，步骤S30中包括：
S31、循迹航行中获取本船的当前位置所在的航迹段编号index；
S32、基于本船的当前位置所在的航迹段编号index遍历航迹点集合 中的各个航迹点，计算本船开始避碰每一动态目标的最晚时间，得到m 个最晚时间计算值perTime；
S33、如果最晚时间计算值perTime小于最晚时间设定值，则更新最 晚时间设定值后转至步骤S34；如果最晚时间计算值perTime大于或等于 最晚时间设定值，则直接转至步骤S34；
S34、判断是否满足动态目标遍历结束的预设条件，如果满足则转至 步骤S40，如果不满足则重复步骤S31～S33。
在本发明的一种示例性实施例中，步骤S32包括：
S321、获取指定航迹段的起始航迹点坐标s(sx,sy)和终止航迹点坐标 e(ex,ey)；
s＝trackPoints(i)
e＝trackPoints(i+1)
其中，i为航迹点遍历迭代器，i＝index,index+1,…,n；
S322、计算航迹段方向cog；
Figure BDA0002573896430000031
S323、根据动态目标的信息计算最近会遇时间tcpa、相对航速Vr、相对 速度的方向
Figure BDA0002573896430000032
Figure BDA0002573896430000033
Figure BDA0002573896430000034
Figure BDA0002573896430000035
其中，Vxr为动态目标相对于本船在x轴的速度分量，Vyr为动态目标 相对于本船在y轴的速度分量，Rt为动态目标与本船之间的距离，
Figure BDA0002573896430000036
为相 对速度的方向，αT为动态目标相对于本船的真方位；
S324、根据本船的航速计算本船在tcpa的时间内将会前进的距离 forwardDis；
forwardDis＝tcpa*sog
其中sog为本船的航速；
S325、根据本船在tcpa的时间内将会前进的距离计算最近会遇点 naPt(naPtx,naPty)；
naPtx＝ptx+forwardDis*sin(cog)
naPty＝pty+forwardDis*cos(cog)
其中，pt(ptx,pty)为本船的当前位置；
S326、计算指定航迹段上离最近会遇点最近的点np；
S327、基于本船位置和离最近会遇点最近的点np计算本船到达np所 需时间nearT；
Figure BDA0002573896430000041
S328、计算本船到达np时，动态目标obsVessels(j)与本船之间的距离 nearD；
Figure BDA0002573896430000046
Figure BDA0002573896430000047
Figure BDA0002573896430000042
S329、更新本船开始避碰动态目标obsVessels(j)的最晚时间perTime；
Figure BDA0002573896430000043
Figure BDA0002573896430000044
Figure BDA0002573896430000045
其中，j为动态目标遍历迭代器，j＝0,1,2,…,m，SDA为安全会遇距离；
S3210、如果满足nearD＜SDA或满足循迹点遍历结束的预设条件，则 跳出航迹点遍历循环，转至步骤S33；否则继续航迹点遍历，返回S321。
在本发明的一种示例性实施例中，步骤S326包括：
情况一、如果最近会遇点位于指定航迹段的延长线上，且靠近指定航迹 段的起始航迹点本船的当前位置，则将指定航迹段的起始航迹点本船的当前 位置作为最近会遇点最近的点np；
情况二、如果最近会遇点位于指定航迹段的延长线上，且靠近指定航迹 段的终止航迹点，则将指定航迹段的终止航迹点作为最近会遇点最近的点 np；
其他情况下，将最近会遇点到指定航迹段所在直线的垂足作为最近 会遇点最近的点np。
在本发明的一种示例性实施例中，最晚时间计算值perTime的初始值 为0，最晚时间设定值的初始值为无穷大。
在本发明的一种示例性实施例中，步骤S20中基于本船上的感知系 统获取动态目标的信息。
(三)有益效果
本发明的有益效果是：本发明实施例提供的基于循迹航行的自主驾 驶船舶避碰时机确定方法，对于航线分为多个航迹段考虑而非单一的一 条直线，基于循迹航行来确定避碰时机，更加符合航海的实际情况，能 够准确确定本船的未来航行轨迹，避碰准确性更高。
附图说明
图1为本发明一实施例提供的一种基于循迹航行的自主驾驶船舶避 碰时机确定方法的流程图；
图2为本发明一实施例中实现基于循迹航行的自主驾驶船舶避碰时 机确定方法的整体流程图。
具体实施方式
为了更好的解释本发明，以便于理解，下面结合附图，通过具体实 施方式，对本发明作详细描述。
本文所使用的所有的技术和科学术语与属于本发明的技术领域的技 术人员通常理解的含义相同。本文中在本发明的说明书中所使用的术语 只是为了描述具体的实施例的目的，不是旨在于限制本发明。本文所使 用的术语“和/或”包括一个或多个相关的所列项目的任意的和所有的组 合。
本发明提出的一种基于循迹航行的自主驾驶船舶避碰时机确定方 法，具有稳健性和准确度高等优点，更加符合航海的实际情况，为实现 自主驾驶船舶安全航行决策提供依据。该方法可以解决以下技术问题： 第一，动界不再只考虑距离，而是将距离和最近会遇时间、相对运动速 度等时间因素共同作为确定避碰时机的影响因素；第二，获取指定航迹段上距离最近会遇点最近的点；第三，确定本船开始避碰的临界条件， 即最晚避碰时间。
图1为本发明一实施例提供的一种基于循迹航行的自主驾驶船舶避 碰时机确定方法的流程图，如图1所示，具体包括以下步骤：
步骤S10、基于电子海图利用路径规划算法确定多航段构成的初始航 线，根据所述多航段确定包含有多个航迹点的航迹点集合；
步骤S20、在沿初始航线进行循迹航行的过程中，获取动态目标信息 集合，所述动态目标信息集合中包含至少一个动态目标的信息；
步骤S30、通过遍历动态目标信息集合中的动态目标的信息，分别计 算本船避碰至少一个动态目标的最晚时间，确定本船避碰动态目标集合 的最晚时间；
步骤S40、如果所述本船避碰动态目标集合的最晚时间大于0，且动 态目标集合中至少有一个动态目标与本船之间的距离小于安全会遇距 离，则基于所述本船避碰动态目标集合的最晚时间确定避碰时机。
在本发明的一种示例性实施例中，步骤S10中多个航迹段均已避开 静态障碍物，对于航迹段避开静态障碍物可以按照传统方法实现，在本 文不做具体限定。
在本发明的一种示例性实施例中，步骤S20中动态目标的信息包括 动态目标的位置、航速和航向。该步骤中基于本船上的感知系统获取动 态目标的信息，船端的感知系统包括但不限于风速风向仪、雷达、声呐、 AIS、GPS、测深仪等，可以直接获得或计算得到动态目标的位置、航速 和航向。
另外，本发明中动态目标信息集合如果为空集，则结束处理，不进 行后续步骤，本文是以动态目标信息集合为非空集的情况下如何基于动 态目标的信息进行避碰决策为主进行介绍。
在本发明的一种示例性实施例中，步骤S40中将动态目标集合中的 每个动态目标与本船的距离都与安全会遇距离进行比较，集合中只要有 一个或多个动态目标到本船的距离小于安全会遇距离就需要进行避碰时 机的规划，确定最晚避碰时间，且最晚避碰时间不等于避碰时间最晚， 本发明中所涉及的均是最晚避碰时间。
以下对图1所示方法进行详细介绍，图2为本发明一实施例中实现 基于循迹航行的自主驾驶船舶避碰时机确定方法的整体流程图，如图2 所示，具体包括如下步骤：
步骤S1、根据电子海图数据，使用路径规划算法获得一条避开静态障 碍物的多航迹段航线，得航迹点集合trackPoints，获取航迹点个数n；
步骤S2、根据所述航迹点集合trackPoints循迹航行开始后，通过本船的 感知系统获取动态目标信息集合obsVessels，获取动态目标个数m；
步骤S3、根据所述动态目标信息集合obsVessels，遍历动态目标的信息， 计算本船开始避碰每一个动态目标的最晚时间，得到本船开始避碰动态目标 集合的最晚时间Time(Time初始值为无穷大)。
步骤S3中具体包括以下步骤：
步骤S31、获取本船的当前位置所在航迹段编号index，index＝1,2,3,...n， 其中，n为航迹点个数，航迹点集合中包含n个航迹点，起始点、终止点及 其之间的n-2个航迹点；
步骤S32、根据所述航迹点集合trackPoints和本船的当前位置所在航迹段 编号index，遍历航迹点，计算本船开始避碰每一个动态目标的最晚时间 perTime(perTime初始值为0)，步骤S32具体包括以下步骤：
步骤S321、获取指定航迹段起始航迹点坐标s(sx,sy)和终止航迹点坐标 e(ex,ey)；
s＝trackPoints(i)
e＝trackPoints(i+1)
其中，i为航迹点遍历迭代器，i＝index,index+1,…,n。
步骤S322、计算航迹段方向cog；
Figure BDA0002573896430000081
步骤S323、根据动态目标的信息计算最近会遇时间tcpa、相对航速Vr、 相对速度的方向
Figure BDA0002573896430000082
Figure BDA0002573896430000083
Figure BDA0002573896430000084
Figure BDA0002573896430000085
其中，Vxr为动态目标相对于本船在x轴的速度分量，Vyr为动态目标相 对于本船在y轴的速度分量，Rt为动态目标与本船之间的距离，
Figure BDA0002573896430000086
为相对速 度的方向，αT为动态目标相对于本船的真方位。
步骤S324、根据本船的航速计算本船在tcpa的时间内，将会前进的距离forwardDis；
forwardDis＝tcpa*sog
其中，sog为本船的航速；
步骤S325、根据本船在tcpa的时间内将会前进的距离计算最近会遇点 naPt(naPtx,naPty)；
naPtx＝ptx+forwardDis*sin(cog)
naPty＝pty+forwardDis*cos(cog)
其中，pt(ptx,pty)为本船的当前位置。
步骤S326、计算指定航迹段上离最近会遇点最近的点np；
情况一、如果最近会遇点位于所述线段的延长线上，且靠近指定航迹段 的起始航迹点本船的当前位置，则将指定航迹段的起始航迹点作为最近会遇 点最近的点np，即np＝pt；
情况二、如果最近会遇点位于所述线段的延长线上，且靠近所述指定航 迹段终止航迹点，则将本船的当前位置作为最近会遇点最近的点np，即 np＝e；
其他情况下，将最近会遇点到指定航迹段所在直线的垂足作为将本船的 当前位置作为最近会遇点最近的点np。
步骤S327、基于本船位置和离最近会遇点最近的点np计算本船到达所 述np所需时间nearT；
Figure BDA0002573896430000091
步骤S328、计算本船到达np时，动态目标obsVessels(j)与本船之间的距 离nearD；
Figure BDA0002573896430000096
Figure BDA0002573896430000097
Figure BDA0002573896430000092
步骤S329、更新本船开始避碰动态目标obsVessels(j)的最晚时间perTime；
Figure BDA0002573896430000093
Figure BDA0002573896430000094
Figure BDA0002573896430000095
其中，j为动态目标遍历迭代器，j＝0,1,2,…,m；SDA为安全会遇距离。
步骤S3210、如果nearD＜SDA或满足循迹点遍历结束条件(即不满足i ＜n的条件)，则跳出航迹点遍历循环，执行步骤S33；否则继续航迹点遍历， 返回步骤S321。
步骤S33、如果最晚时间计算值perTime小于最晚时间设定值，即 perTime＜Time，则更新最晚时间设定值，即本船开始避碰动态目标集合的最 晚时间Time＝perTime，转到步骤S34；否则(即perTime≥Time)，直接转到步 骤S34。
步骤S34、如果满足动态目标遍历结束条件，则转到步骤S4；否则，返 回步骤S31开始重复步骤S31～S33。
步骤S4、如果本船开始避碰动态目标集合的最晚时间大于1，即Time>0， 并且nearD<SDA，则需要采取避碰措施，基于所述本船避碰动态目标集合的 最晚时间确定避碰时机且开始避碰的最晚时间为Time；否则，不需要采取避 碰措施，继续循迹航行即可。
综上所述，采用本发明实施例提供的基于循迹航行的自主驾驶船舶避碰 时机确定方法，具有如下效果：
(1)由于基于循迹航行来确认避碰时机，更加符合航海的实际情况，能 够更准确的获取船舶的未来轨迹；
(2)通过将航迹段上与最近会遇点的最短距离和到达航迹段上与动态目 标距离为安全会遇距离的位置所需要的时间作为确认避碰时机的影响因素， 这样在循迹航行中综合考虑时间因素和相对运动速度等时间因素，考虑因素 更全面，能够更加准确的确定避碰时机
(3)对于航线分为多个航迹段考虑而非单一的一条直线，考虑多航迹 段变化，可以避免非必要的避碰判定，减少不必要的计算量。
应当注意，尽管在上文详细描述中提及了用于动作执行的设备的若 干模块或者单元，但是这种划分并非强制性的。实际上，根据本发明的 实施方式，上文描述的两个或更多模块或者单元的特征和功能可以在一 个模块或者单元中具体化。反之，上文描述的一个模块或者单元的特征 和功能可以进一步划分为由多个模块或者单元来具体化。
本领域技术人员在考虑说明书及实践这里公开的发明后，将容易想 到本发明的其它实施方案。本申请旨在涵盖本发明的任何变型、用途或 者适应性变化，这些变型、用途或者适应性变化遵循本发明的一般性原 理并包括本发明未公开的本技术领域中的公知常识或惯用技术手段。说 明书和实施例仅被视为示例性的，本发明的真正范围和精神由下面的权 利要求指出。
应当理解的是，本发明并不局限于上面已经描述并在附图中示出的 精确结构，并且可以在不脱离其范围进行各种修改和改变。本发明的范 围仅由所附的权利要求来限制。

Claims (10)

1.一种基于循迹航行的自主驾驶船舶避碰时机确定方法，其特征在于，其包括：
S10、基于电子海图利用路径规划算法确定多航段构成的初始航线，根据所述多航段确定包含有多个航迹点的航迹点集合；
S20、在沿初始航线进行循迹航行的过程中，获取动态目标信息集合，所述动态目标信息集合中包含至少一个动态目标的信息；
S30、通过遍历动态目标信息集合中的动态目标的信息，分别计算本船避碰至少一个动态目标的最晚时间，确定本船避碰动态目标集合的最晚时间；
S40、如果所述本船避碰动态目标集合的最晚时间大于0，且动态目标集合中至少有一个动态目标与本船之间的距离小于安全会遇距离，则基于所述本船避碰动态目标集合的最晚时间确定避碰时机。
2.如权利要求1所述的基于循迹航行的自主驾驶船舶避碰时机确定方法，其特征在于，所述多个航迹段均已避开静态障碍物。
3.如权利要求1所述的基于循迹航行的自主驾驶船舶避碰时机确定方法，其特征在于，所述航迹点集合中包含n个航迹点，起始点、终止点及其之间的n-2个航迹点形成的多个航迹段编号用index表示，且index＝1,2,3,...n。
4.如权利要求1所述的基于循迹航行的自主驾驶船舶避碰时机确定方法，其特征在于，所述动态目标的信息包括动态目标的位置、航速和航向。
5.如权利要求1所述的基于循迹航行的自主驾驶船舶避碰时机确定方法，其特征在于，所述动态目标集合中包括m个动态目标。
6.如权利要求5所述的基于循迹航行的自主驾驶船舶避碰时机确定方法，其特征在于，步骤S30中包括：
S31、循迹航行中获取本船的当前位置所在的航迹段编号index；
S32、基于本船的当前位置所在的航迹段编号index遍历航迹点集合中的各个航迹点，计算本船开始避碰每一动态目标的最晚时间，得到m个最晚时间计算值perTime；
S33、如果最晚时间计算值perTime小于最晚时间设定值，则更新最晚时间设定值后转至步骤S34；如果最晚时间计算值perTime大于或等于最晚时间设定值，则直接转至步骤S34；
S34、判断是否满足动态目标遍历结束的预设条件，如果满足则转至步骤S40，如果不满足则重复步骤S31～S33。
7.如权利要求6所述的基于循迹航行的自主驾驶船舶避碰时机确定方法，其特征在于，步骤S32包括：
S321、获取指定航迹段的起始航迹点坐标s(sx,sy)和终止航迹点坐标e(ex,ey)；
s＝trackPoints(i)
e＝trackPoints(i+1)
其中，i为航迹点遍历迭代器，i＝index,index+1,…,n；
S322、计算航迹段方向cog；
Figure FDA0002573896420000021
S323、根据动态目标的信息计算最近会遇时间tcpa、相对航速Vr、相对速度的方向
Figure FDA0002573896420000022
Figure FDA0002573896420000023
Figure FDA0002573896420000024
Figure FDA0002573896420000025
其中，Vxr为动态目标相对于本船在x轴的速度分量，Vyr为动态目标相对于本船在y轴的速度分量，Rt为动态目标与本船之间的距离，
Figure FDA0002573896420000026
为相对速度的方向，αT为动态目标相对于本船的真方位；
S324、根据本船的航速计算本船在tcpa的时间内将会前进的距离forwardDis；
forwardDis＝tcpa*sog
其中sog为本船的航速；
S325、根据本船在tcpa的时间内将会前进的距离计算最近会遇点naPt(naPtx,naPty)；
naPtx＝ptx+forwardDis*sin(cog)
naPty＝pty+forwardDis*cos(cog)
其中，pt(ptx,pty)为本船的当前位置；
S326、计算指定航迹段上离最近会遇点最近的点np；
S327、基于本船位置和离最近会遇点最近的点np计算本船到达np所需时间nearT；
Figure FDA0002573896420000031
S328、计算本船到达np时，动态目标obsVessels(j)与本船之间的距离nearD；
Figure FDA0002573896420000032
Figure FDA0002573896420000033
Figure FDA0002573896420000034
S329、更新本船开始避碰动态目标obsVessels(j)的最晚时间perTime；
Figure FDA0002573896420000035
Figure FDA0002573896420000036
Figure FDA0002573896420000037
其中，j为动态目标遍历迭代器，j＝0,1,2,…,m，SDA为安全会遇距离；
S3210、如果满足nearD＜SDA或满足循迹点遍历结束的预设条件，则跳出航迹点遍历循环，转至步骤S33；否则继续航迹点遍历，返回S321。
8.如权利要求7所述的基于循迹航行的自主驾驶船舶避碰时机确定方法，其特征在于，步骤S326包括：
情况一、如果最近会遇点位于指定航迹段的延长线上，且靠近指定航迹段的起始航迹点，则将指定航迹段的起始航迹点作为最近会遇点最近的点np；
情况二、如果最近会遇点位于指定航迹段的延长线上，且靠近指定航迹段的终止航迹点，则将指定航迹段的终止航迹点作为最近会遇点最近的点np；
其他情况下，将最近会遇点到指定航迹段所在直线的垂足作为最近会遇点最近的点np。
9.如权利要求6所述的基于循迹航行的自主驾驶船舶避碰时机确定方法，其特征在于，最晚时间计算值perTime的初始值为0，最晚时间设定值的初始值为无穷大。
10.如权利要求1-9中任一项所述的基于循迹航行的自主驾驶船舶避碰时机确定方法，其特征在于，步骤S20中基于本船上的感知系统获取动态目标的信息。
CN202010648200.3A 2020-07-07 2020-07-07 一种基于循迹航行的自主驾驶船舶避碰时机确定方法 Pending CN111897326A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010648200.3A CN111897326A (zh) 2020-07-07 2020-07-07 一种基于循迹航行的自主驾驶船舶避碰时机确定方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010648200.3A CN111897326A (zh) 2020-07-07 2020-07-07 一种基于循迹航行的自主驾驶船舶避碰时机确定方法

Publications (1)

Publication Number Publication Date
CN111897326A true CN111897326A (zh) 2020-11-06

Family

ID=73191693

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010648200.3A Pending CN111897326A (zh) 2020-07-07 2020-07-07 一种基于循迹航行的自主驾驶船舶避碰时机确定方法

Country Status (1)

Country Link
CN (1) CN111897326A (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116312063A (zh) * 2023-05-23 2023-06-23 中国船舶集团有限公司第七〇七研究所 一种船舶避让决策方法、装置、设备及介质

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2011065848A1 (en) * 2009-11-26 2011-06-03 Akademia Morska W Szczecinie A method and system of navigational decision support in the process of safe vessel navigation
CN103823466A (zh) * 2013-05-23 2014-05-28 电子科技大学 一种动态环境下移动机器人路径规划方法
CN110083155A (zh) * 2019-04-19 2019-08-02 集美大学 一种实现船舶拟人智能避碰决策的机器学习方法
CN110377037A (zh) * 2019-07-12 2019-10-25 中海电信有限公司 一种开阔水域船舶应急避碰系统
CN111186549A (zh) * 2020-01-15 2020-05-22 大连海事大学 一种具有船舶避碰功能的航向自动舵控制系统

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2011065848A1 (en) * 2009-11-26 2011-06-03 Akademia Morska W Szczecinie A method and system of navigational decision support in the process of safe vessel navigation
CN103823466A (zh) * 2013-05-23 2014-05-28 电子科技大学 一种动态环境下移动机器人路径规划方法
CN110083155A (zh) * 2019-04-19 2019-08-02 集美大学 一种实现船舶拟人智能避碰决策的机器学习方法
CN110377037A (zh) * 2019-07-12 2019-10-25 中海电信有限公司 一种开阔水域船舶应急避碰系统
CN111186549A (zh) * 2020-01-15 2020-05-22 大连海事大学 一种具有船舶避碰功能的航向自动舵控制系统

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
冯爱国，等: "无人艇导航与控制系统设计与实现", 《火力与指挥控制》, vol. 42, no. 42, 31 August 2017 (2017-08-31), pages 150 - 154 *
刘冬冬;史国友;李伟峰;陈作桓;江健;: "基于最短避碰距离和碰撞危险度的避碰决策支持", 上海海事大学学报, no. 01, 31 March 2018 (2018-03-31) *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116312063A (zh) * 2023-05-23 2023-06-23 中国船舶集团有限公司第七〇七研究所 一种船舶避让决策方法、装置、设备及介质

Similar Documents

Publication Publication Date Title
CN108692734B (zh) 一种路径规划方法和装置
CN113759939B (zh) 一种受限水域智能航行方法及装置
CN109753068A (zh) 一种考虑通信情况的多usv群体协同避碰规划方法
CN104020771A (zh) 一种基于动态虚拟小船制导算法的欠驱动船舶路径跟踪规划方法
JP2021181301A (ja) 船舶の自動誘導方法、船舶の自動誘導プログラム、船舶の自動誘導システム、及び船舶
KR20110113608A (ko) 조종가능 플랫폼용의 자율 항해 시스템 및 방법
Wang et al. A distributed model predictive control using virtual field force for multi-ship collision avoidance under COLREGs
CN114387824A (zh) 一种符合国际海上避碰规则的避碰转向判定方法
CN111897326A (zh) 一种基于循迹航行的自主驾驶船舶避碰时机确定方法
CN115903800A (zh) 一种基于领导者协同的多无人船编队的严格安全控制方法
Shokri-Manninen et al. Formal verification of COLREG-based navigation of maritime autonomous systems
JP6686249B2 (ja) 船舶の自動操縦システム、船舶、及び船舶の自動操縦方法
CN113126492B (zh) 动力定位船舶自动路径跟踪方法
CN117369441A (zh) 一种考虑船舶运动学和CORLEGs的自适应智能船舶路径规划方法
JPH07304495A (ja) 避航支援装置
CN116430856A (zh) 一种基于变前视距离los算法的船舶航迹控制方法
EP3538845B1 (en) Method for supporting the approach maneuver of a boat to the mooring site within a port area and system thereof
CN116029554A (zh) 基于受限水域船舶风险评估模型参数校正的风险评估方法
CN116300906A (zh) 一种智能船的避障路径规划方法及系统
CN110928278A (zh) 一种用于无人艇的自主安全航行方法和无人艇
CN115373394A (zh) 一种狭水道无人艇避碰局部路径规划方法
CN114690772A (zh) 用于海域非循迹航行船舶的会遇时空预测方法及系统
Okazaki et al. Development of maneuvering support system for ship docking
CN113104053A (zh) 一种自动掉头循迹方法及无人车
CN114489091B (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