一种残膜回收机防缠绕挑膜装置的制 一种秧草收获机用电力驱动行走机构

开阔水域船舶自主避碰方法、系统、设备及存储介质与流程

2021-12-04 02:02:00 来源:中国专利 TAG:


1.本技术涉及船舶避碰技术领域,尤其是涉及一种开阔水域船舶自主避碰方法、系统、设备及存储介质。


背景技术:

2.随着海上运输的迅速发展,海上船舶也向着大型化和快速化发展。尽管现代导航设备取得了许多进步,但在繁忙的航道上,船舶碰撞仍然频繁发生。船舶碰撞事故在各种海上交通事故中占主导地位,并造成了严重的后果。因此,为降低人为因素造成的船舶航行风险,进一步提高海上运输的智能化水平,国际海事组织一直致力于无人船和无人水面艇相关技术研究。而自主避碰决策技术作为无人船和无人水面艇研发中起着至关重要的作用。而现有研究多集中在避碰决策算法上,尽管有部分研究开发了避碰决策系统但其完备性和实时性还不够,不能或不够符合航海实践,比如未考虑或部分考虑避碰规则、船舶操纵性良好船艺等要求。因此,为了减少海上碰撞事故和提高航行安全,开发更智能、更安全的避碰决策方法或避碰决策系统是十分必要的。


技术实现要素:

3.有鉴于此,本技术提供一种开阔水域船舶自主避碰方法、系统、设备及存储介质,开发更智能、更安全的自主避碰决策方法和系统。
4.为了解决上述问题,第一方面,本技术提供一种开阔水域船舶自主避碰方法,所述方法包括:获取本船与多个目标船的ais信息和雷达信息,将所述ais信息和所述雷达信息进行数据融合处理,得到所述目标船相对所述本船的融合信息;根据所述融合信息计算所述本船与目标船的相关避碰参数;根据速度障碍法判断所述本船和目标船是否存在碰撞风险,当存在碰撞风险时,基于所述相关避碰参数计算不同会遇局面下的评估指标值,并利用构建的基于灰云模型的船舶碰撞危险度评估模型对船舶间碰撞危险度进行评估,得到所述本船相对各个目标船的碰撞风险值;所述会遇局面包括对遇、交叉和追越局面;将碰撞风险值大于预设阈值的目标船作为危险船舶,针对所述危险船舶,利用改进的速度障碍法计算本船改向变速幅度,确定避碰决策方案;通过控制系统控制所述本船的航向和航速,以实现自主避碰。
5.可选的,所述基于相关避碰参数计算不同会遇局面下的评估指标值,并利用构建的基于灰云模型的船舶碰撞危险度评估模型对船舶间碰撞危险度进行评估,得到本船相对各个目标船的碰撞风险值,包括:定义所述船舶碰撞危险度评估模型中的数字特征峰值、左右边界值、熵以及超熵参数为:
数学期望为:将目标船作为评估对象,将目标船相对本船的碰撞危险度及基于相关避碰参数计算的评估指标划分灰类;构建非对称灰云白化权函数并计算白化权值;根据预设的指标权重及白化权值计算综合聚类系数;根据综合聚类系数计算碰撞风险值。
6.可选的,所述将目标船作为评估对象,将目标船相对本船的碰撞危险度及基于相关避碰参数计算的评估指标划分灰类,包括:确定评估对象各评估指标属于灰类的点作为该评估指标对应灰类的中心点,根据各个指标取值范围划分s个灰类;评估对象碰撞危险度划分为低风险、较低风险、中等风险、较高风险和高风险五个等级;所述构建非对称灰云白化权函数并计算白化权值,包括:以第k个灰类参数的左边界点和中心点构建以为峰值点的左单侧正态灰云模型,以其右边界点和中心点构建以为峰值点的右单侧正态灰云模型,得到指标j关于灰类k的正态灰云白化权函数:取n次求平均值作为最终的白化权值:
计算归一化后白化权值:所述根据预设的指标权重及白化权值计算综合聚类系数,包括:计算第i个对象关于第k个灰类的综合聚类系数如下:其中:为指标j关于对象i的分类权重;所述根据综合聚类系数计算碰撞风险值,包括:计算得到对象i的综合聚类系数向量为所属灰类:假设将分别赋给从低风险到高风险的五个等级值;其对应的区间值分别为[0,0.2],[0.2,0.4],[0.4,0.6],[0.6,0.8]和[0.8,1];考虑到综合聚类系数的最大值通常分布在[0.2,0.6]区间内,可以通过以下函数计算碰撞风险值:。
[0007]
可选的,所述针对危险船舶计算本船改向变速幅度,确定避碰决策方案,包括:设定为本船os相对目标船舶ts的相对速度,,为矢量方向上的射线,为危险船舶ts以r为半径的圆形船舶领域,本船与目标船舶发生碰撞的条件为:设定射线与构成的相对碰撞区rcc,在本船相对目标船舶的任意速度时,本船与目标船舶将发生碰撞:速度障碍区间为:其中,为闵可夫斯基矢量和运算;计算本船在给定时间区间内能改变的速度矢量:
其中,为本船目前速度,本船加速度;计算在给定时间区间内本船可以转向的角度:其中,为本船当前航向角,为本船当前的角速度,为本船当前的角加速度;将本船在给定时间内可以改变的速度大小和航向角度, 离散化m个速度和n个航向角,得到速度矢量集合为,并确定本船的改向变速避让区间为:根据避碰规则取避让区间中间值,即在给定

t时间内改向变速避让区间的中间值作为改向变速的最终避碰决策方案。
[0008]
可选的,所述融合信息包括所述目标船相对所述本船的方位、航速、航向、距离信息;所述将所述ais信息和所述雷达信息进行数据融合处理,包括:对ais信息和arpa雷达信息进行数据融合,融合航迹关联,设定时间粗关联公式:其中,为预设时间阀值,为ais探测到目标ai的时刻,为雷达探测到目标rj的时刻,若满足时间粗关联公式,则判定为符合时间粗关联;设定距离粗关联公式:其中,为预设距离阀值,为ais在t时刻探测到目标ai的距离,为在t时刻雷达探测到目标rj的距离,若满足距离粗关联公式,则判定为符合距离粗关联;若ais探测到的目标ai与雷达探测到的目标rj既符合时间粗关联又符合距离粗关联,则采取基于模糊因素判断的双门限细关联算法:
其中,分别为方位、航速、航向、距离的关联度,分别为方位、航速、航向、距离的调整系数,分别为方位、航速、航向、距离的欧式距离,分别为ais设备在方位、航速、航向、距离上的方差;bij为最终关联度,分别为方位、航速、航向、距离的权重;若满足预设门限阈值,判定为符合细关联,用加权融合算法对ai和rj目标进行位置信息的数据融合:其中,为ais的位置信息,为雷达的位置信息,和分别为其对应权值系数;为ais设备位置方差,为雷达设备位置方差,最后得到的x为融合信息。
[0009]
可选的,所述相关避碰参数包括最近会遇距离dcpa、最近会遇时间tcpa、两船间距离d、相对方位b和速度比k,所述根据所述融合信息计算所述本船与目标船的相关避碰参数,包括:计算本船和目标船的相对速度:其中,和分别为相对速度vr在x轴和y轴上速度分量,和分别为本船和目标船的速度,和分别为本船和目标船的航向;计算相对速度航向角:
其中,,且取值根据目标船相对于本船的相对速度在x轴及y轴上分量方向所设定;计算目标船相对于本船的方位角:计算两船间相对距离为:计算最近会遇距离dcpa和最近会遇时间tcpa为:计算最近会遇距离dcpa和最近会遇时间tcpa为:。
[0010]
可选的,所述通过控制系统控制所述本船的航向和航速,包括:利用船舶运动模型mmg和pid航向控制系统执行避碰决策方案,按照预定的速度和航向控制本船实现避碰。
[0011]
第二方面,本技术提供一种开阔水域船舶自主避碰系统,所述系统包括:信息融合模块,用于获取本船与多个目标船的ais信息和雷达信息,将所述ais信息和所述雷达信息进行数据融合处理,得到所述目标船相对所述本船的融合信息;避碰信息处理模块,用于根据所述融合信息实时计算所述本船与目标船的相关避碰参数;碰撞风险评估模块,用于根据速度障碍法判断所述本船和目标船是否存在碰撞风险,当存在碰撞风险时,基于所述相关避碰参数计算不同会遇局面下的评估指标值,并利用构建的基于灰云模型的船舶碰撞危险度评估模型对船舶间碰撞危险度进行评估,得到所述本船相对各个目标船的碰撞风险值;所述会遇局面包括对遇、交叉和追越局面;避碰决策模块,用于将碰撞风险值大于预设阈值的目标船作为危险船舶,针对所述危险船舶,利用改进的速度障碍法计算本船改向变速幅度,确定避碰决策方案;控制执行模块,用于通过控制系统控制所述本船的航向和航速,以实现自主避碰。
[0012]
第三方面,本技术提供的一种计算机设备,采用如下的技术方案:一种计算机设备,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现所述开阔水域船舶自主避碰方法的步骤。
[0013]
第四方面,本技术提供的一种计算机可读存储介质,采用如下的技术方案:一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,所述计算机程序被处理器执行时实现所述开阔水域船舶自主避碰方法的步骤。
[0014]
采用上述实施例的有益效果是:通过将本船与多个目标船的ais信息和雷达arpa信息进行融合,根据所述融合信息计算本船与目标船的相关避碰参数;在根据速度障碍法判断本船和目标船存在碰撞风险时,基于相关避碰参数计算不同会遇局面下的评估指标值,并利用构建的基于灰云模型的船舶碰撞危险度评估模型对船舶间碰撞危险度进行评估,得到本船相对各个目标船的碰撞风险值;将碰撞风险值大于预设阈值的目标船作为危险船舶,针对危险船舶利用改进的速度障碍法计算本船改向变速幅度,确定避碰决策方案,根据控制系统控制本船的航向和航速,以实现自主避碰。
[0015]
本发明中的数据融合算法可以将ais和雷达的数据进行融合,提高了信息的准确性,也具有了较好的故障容错率。提出的碰撞危险度评估模型可以有效地实现不同会遇局面下船舶碰撞风险的识别和量化。具有可以表示不确定概念的模糊性和随机性及其关系,它适用于处理不确定信息,可以对碰撞风险进行精确评估的优点。提出的自主避碰决策模型充分考虑了船舶的操纵性、船舶会遇局面、碰撞危险度、良好船艺和colregs,可以实时得到避碰决策方案并通过控制执行模块按照预定的速度和航向控制船舶,实现有效避碰得目的。此外,本发明可以有效避免船舶在航行过程中因驾驶员人为失误,提高船舶航行风险。
附图说明
[0016]
图1为本技术提供的开阔水域船舶自主避碰方法一实施例的方法流程图;图2为本技术提供的开阔水域船舶自主避碰方法一实施例中典型会遇局面下两船运动参数示意图;图3为本技术提供的开阔水域船舶自主避碰方法一实施例中基于避碰规则下的船舶会遇局面划分示意图;图4为本技术提供的开阔水域船舶自主避碰方法一实施例中速度障碍算法的原理示意图;图5为本技术提供的开阔水域船舶自主避碰方法一实施例中模糊自适应pid控制器的示意图;图6为本技术提供的开阔水域船舶自主避碰系统一实施例的原理框图;图7为本技术提供的计算机设备一实施例的原理框图。
具体实施方式
[0017]
下面结合附图来具体描述本技术的优选实施例,其中,附图构成本技术一部分,并与本技术的实施例一起用于阐释本技术的原理,并非用于限定本技术的范围。
[0018]
在本技术的描述中,“多个”的含义是两个或两个以上,除非另有明确具体的限定。
[0019]
在本文中提及“实施例”意味着,结合实施例描述的特定特征、结构或特性可以包含在本技术的至少一个实施例中。在说明书中的各个位置出现该短语并不一定均是指相同的实施例,也不是与其它实施例互斥的独立的或备选的实施例。本领域技术人员显式地和隐式地理解的是,本文所描述的实施例可以与其它实施例相结合。
[0020]
本技术提供了一种开阔水域船舶自主避碰方法、系统、设备及存储介质,以下分别进行详细说明。
[0021]
参照图1为本技术提供的开阔水域船舶自主避碰方法一种实施例的方法流程图,该开阔水域船舶自主避碰方法,包括下述步骤:s101,获取本船与多个目标船的ais信息和雷达信息,将所述ais信息和所述雷达信息进行数据融合处理,得到所述目标船相对所述本船的融合信息;s102,根据所述融合信息实时计算所述本船与目标船的相关避碰参数;s103,根据速度障碍法判断所述本船和目标船是否存在碰撞风险,当存在碰撞风险时,基于所述相关避碰参数计算不同会遇局面下的评估指标值;s104,利用构建的基于灰云模型的船舶碰撞危险度评估模型对船舶间碰撞危险度进行评估,得到所述本船相对各个目标船的碰撞风险值;所述会遇局面包括对遇、交叉和追越局面;s105,将碰撞风险值大于预设阈值的目标船作为危险船舶,针对所述危险船舶,利用改进的速度障碍法计算本船改向变速幅度,确定避碰决策方案;s106,通过控制系统控制所述本船的航向和航速,以实现自主避碰。
[0022]
本实施例通过将本船与多个目标船的ais信息和雷达arpa信息进行数据融合处理得到融合信息,根据所述融合信息计算本船与目标船的相关避碰参数;在根据速度障碍法判断本船和目标船存在碰撞风险时,基于相关避碰参数计算不同会遇局面下的评估指标值,并利用构建的基于灰云模型的船舶碰撞危险度评估模型对船舶间碰撞危险度进行评估,得到本船相对各个目标船的碰撞风险值;将碰撞风险值大于预设阈值的目标船作为危险船舶,针对危险船舶计算本船改向变速幅度,确定避碰决策方案,根据避碰决策方案控制本船的航向和航速,以实现自主避碰。由于能将ais和雷达的数据进行融合得到更全面更精确的数据,提高了最终避碰的安全性,而且,提出的船舶碰撞危险度评估模型可以有效地实现不同会遇局面下船舶碰撞风险的识别和量化,可以对碰撞风险进行精确评估。提出的船舶自主避碰方法更加准确和智能,从而提高船舶航行的安全性。
[0023]
具体地,在一种可选的实施方式中,获取船舶运行参数信息及环境状态信息,对船舶的ais信息和雷达信息并进行数据融合,融合航迹关联为:(1)(2)上式(1)中为时间阀值,为ais探测到目标ai的时刻,为arpa/雷达探测到目标rj的时刻,若满足式(1),则判定为符合时间粗关联。
[0024]
上式(2中)为距离阀值,为ais在t时刻探测到目标ai的距离,为在t时刻arpa/雷达探测到目标rj的距离,若满足式(2),则判定为符合距离粗关联。
[0025]
(3)其中,粗关联门限值为catt,cafm为判定因子,其cafm初始值为0,若在ki时刻,ais探测到的目标ai与arpa/雷达探测到的目标rj既符合时间粗关联又符合距离粗关联,则
cafm值增加1。若cafm值符合如式(3)所示条件则认为满足粗关联准则。
[0026]
为使得每条ais信息都能找到唯一相对应的arpa/雷达信息,下面采取基于模糊因素判断的双门限细关联算法:(4)(5)式(4)中,分别为方位、航速、航向、距离的关联度,分别为方位、航速、航向、距离的调整系数,分别为方位、航速、航向、距离的欧式距离,分别为ais设备在方位、航速、航向、距离上的方差;bij为最终关联度,分别为方位、航速、航向、距离的权重。
[0027]
双门限细关联判定准则为:与粗关联判定准则类似,首先制定细关联的第一门限fat1和第二门限fat2,用细关联判定因子fm来代表细关联程度,且fm初始值为0。若在ki时刻满足,则fm值增加1,若fm满足fm>fat2,则判定为符合细关联准则。
[0028]
下面用加权融合算法对ai和rj目标进行位置信息的数据融合:下面用加权融合算法对ai和rj目标进行位置信息的数据融合:上式中为ais的位置信息,为arpa/雷达的位置信息,和分别为其对应权值系数。为ais设备位置方差,为arpa/雷达设备位置方差。
[0029]
更进一步地,计算本船和目标船舶间相关避碰参数,两船相对速度为:
上式中和分别为在x轴和y轴上速度分量,和分别为本船和目标船的速度,和分别为本船和目标船的航向。
[0030]
相对速度航向角:式中,且取值由来船相对于本船的相对速度在x轴及 y轴上分量方向所决定。
[0031]
目标船相对于本船的方位角:两船间相对距离为:最近会遇距离dcpa和最近会遇时间tcpa为:。
[0032]
例如,在一种可选的实施方式中,参照图2,图2为本技术提供的开阔水域船舶自主避碰方法一实施例中典型会遇局面下两船运动参数示意图。
[0033]
进一步地,根据速度障碍法判断本船和各目标船间是否存在碰撞风险,具体为:以本船为中心划分为包括绝对碰撞区、潜在碰撞区和安全区三个区域,对于存在潜在碰撞区内的船舶进行碰撞危险判断。
[0034]
两船相对速度为:设为本船和目标船的速度障碍区,如果满足下式,则认为本船和目标船
存在碰撞风险:其中,为两船相对速度。
[0035]
进一步地,如存在碰撞风险则采用构建的基于灰云模型的船舶碰撞危险度评估模型计算目标船和本船碰撞危险度大小,并对大于阈值的船舶碰撞危险度进行排序,具体为:选取最近会遇距离(dcpa)、最近会遇时间(tcpa)、两船间距离(d)、相对方位(b)和速度比(k)五个指标作为碰撞危险度评价指标,根据三种不同会遇局面分别构建船舶碰撞危险度评估模型。所述三种不同会遇局面包括对遇、交叉和追越局面。参照图3,图3为本技术提供的开阔水域船舶自主避碰方法一实施例中基于避碰规则下的船舶会遇局面划分示意图。
[0036]
灰云模型各数字特征峰值、左右边界值、熵以及超熵等数值来表征为:表征为:表征为:数学期望为:s1.将评估指标和评估对象划分为5个灰类。
[0037]
根据需要确定待评估对象a需要划分的灰类数,确定待评估对象各评估指标最属于灰类的点作为该指标对应灰类的中心点,根据各个指标取值范围划分s个灰类。
[0038]
s2.构建非对称灰云白化权函数并计算白化权值。
[0039]
以第k个灰类参数的左边界点和中心点构建以为峰值点的左单侧正态灰云模型,以其右边界点和中心点构建以为峰值点的右单侧正态灰云模型,得到指标j关于灰类k的正态灰云白化权函数。
[0040]
为了使较小每次计算的白化权值的随机性导致判断结果的误差,此处取100次求平均值作为最终的白化权值。
[0041]
最后得到归一化后白化权值。
[0042]
s3.确定指标权重。在一种可选的实施方式中,本实施例中对应各个指标权重为(0.400,0.367,0.167,0.033,0.033)。
[0043]
s4. 计算综合聚类系数。
[0044]
第i个对象关于第k个灰类的综合聚类系数如下:其中:为指标j关于对象i的分类权重。
[0045]
s5. 计算碰撞风险值。
[0046]
得到对象i的综合聚类系数向量为所属灰类假设将分别赋给从低风险到高风险的五个等级值。这里给出的区间值分别为[0,0.2],[0.2,0.4],[0.4,0.6],[0.6,0.8]和[0.8,1]。通常综合聚类系数的最大值通常分布在[0.2,0.6]区间内,因此可以通过以下函数计算碰撞风险值:设置碰撞危险度阈值为0.6,计算潜在碰撞区内船舶碰撞危险度,对超过阈值的船舶碰撞危险度进行排序,对碰撞危险度最大的船舶优先进行避让。
[0047]
例如,在一种可选的实施方式中,在追越、交叉和对遇这三种不同会遇局面下各评
估指标的评分标准分别如下表1、表2、表3所示:表1indexs d0 d1 d2 d3 d4 d5 d6 dcpa(nm)
ꢀ‑ꢀ
3 2 1.5 0.8 0.5 0 tcpa(min)
ꢀ‑ꢀ
18 12 10 8 5 0 d(nm)
ꢀ‑ꢀ
3 2.5 2 1.5 1 0 b(
°
) 247.5 210 180 150 120 115 112.5 k 1.1 1.2 1.5 1.8 2 2.4 2.5 表2indexs d0 d1 d2 d3 d4 d5 d6 dcpa(nm)
ꢀ‑ꢀ
3 2 1.5 0.8 0.5 0 tcpa(min)
ꢀ‑ꢀ
20 18 12 8 5 0 d(nm)
ꢀ‑ꢀ
4 3.5 2.2 1.5 1 0 b(
°
) 112.5 100 90 67.5 40 10 5 k 0.3 0.5 0.8 1.0 1.5 2.2 2.5 表3indexs d0 d1 d2 d3 d4 d5 d6 dcpa(nm)
ꢀ‑ꢀ
2.8 1.8 1.2 0.6 0.4 0 tcpa(min)
ꢀ‑ꢀ
20 16 12 10 8 0 d(nm)
ꢀ‑ꢀ
5 4 3 2 1.5 0 b(
°
) 5 4 3 2 1 0.5 0 k 0.3 0.5 0.8 1.2 1.8 2.2 2.5 进一步地,参照图4,图4为本技术提供的开阔水域船舶自主避碰方法一实施例中速度障碍算法的原理示意图。本实施例中,利用改进的速度障碍算法计算本船改向变速幅度确定避碰决策方案,具体为:速度障碍法是指当运动物体与障碍物保持当前运动状态不变时,使运动物体与障碍物发生碰撞的速度矢量集合,即该运动物体的速度障碍区。图4中,为本船os相对目标船舶ts的相对速度,,为其矢量方向上的射线,为危险船舶ts以r为半径的圆形船舶领域,本船与目标船舶发生碰撞的条件为:假设射线与构成的相对碰撞区rcc(relative collision cone),当本船相对目标船舶的任意速度时,本船与目标船舶将发生碰撞:速度障碍区间为:上式中为闵可夫斯基矢量和运算
考虑到船舶运动过程是一系列非线性变化的运动过程,在一定时间内船舶速度和方向不会有太大的改变, 因此非速度障碍区的速度矢量集合在规定时间内很难实现。因此,考虑船舶操纵性特性,计算船舶在给定时间区间内能改变的速度矢量:上式中,为本船目前速度,本船加速度。
[0048]
在给定时间区间内本船可以转向角度为:式中:为本船当前航向角,为本船当前的角速度,为本船当前的角加速度。
[0049]
通过以上公式可计算得到本船在给定

t时间内可以改变的速度大小和航向角度, 但是考虑到速度和航向变化都是连续的,为了计算方便,将其二者离散化m个速度和n个航向角,速度矢量集合为。如果

t时间内速度矢量集合满足上述公式则会与障碍物发生碰撞,相反如果

t时间内速度矢量集合不满足上述公式则不会与障碍物发生碰撞。那么,此时本船的改向变速避让区间为:对于求取的避让区间rrc集合,本实施例中根据避碰规则取避让区间中间值,即在给定

t时间内改向变速避让区间rrc的中间值作为改向变速变向的最终避碰决策方案。
[0050]
进一步地,利用船舶运动模型mmg和pid航向控制系统执行避碰决策方案时,按照预定的速度和航向控制船舶,具体为:三自由度船舶操纵运动(mmg)模型为:式中,,分别是船舶横向、纵向附加质量;u、v、r分别是船舶沿x轴、y轴的速度和转向角速度;分别是船舶沿x轴、y轴的加速度和转向角加速度;、分别是首摇转动惯量和附加转动惯量;x、y、n分别是横向、纵向和首摇方向上的力和力矩,h、p、r分别是船体、螺旋桨和舵上的力和力矩。
[0051]
进一步地,参照图5,图5为本技术提供的开阔水域船舶自主避碰方法一实施例中模糊自适应pid控制器的示意图。模糊pid模糊控制器采用两个输入三个输出的类型,分别以航向偏差e,航向偏差变化率 ec 作为模糊控制的输入,以pid 参数kp、ki、kd 作为模糊控制器输出;利用模糊控制规则实时对pid 三个参数p、i、d 进行调节,从而实现在不同航向偏差和航向偏差变化率下对 pid 参数自整定,使被控对象有良好的动、静态性能。具体设计步骤为:s1、确定变量模糊子集。设各输入、输出变量的量化等级均为 7 级,模糊子集语言值均取{正大(pb),正中(pm),正小(ps),零(zo),负小(ns),负中(nm),负大(nb)};模糊集基
本论域均为{

6,6}。各输入、输出实际取值范围为:航向偏差 e : [

90
°
,90
°
];航向偏差 ecs :[

0.04
°
/ s,0.04
°
/ s] ;pid 控制比例系数 p: [180,180 ];pid 控制积分系数 i : [24,24 ];pid 控制微分系数 d: [0.3,0.3]。
[0052]
则其量化因子分别为 ke=,kec=150,kp=30,ki=4,kd=1/20。
[0053]
s2、隶属度函数确定。
[0054]
式中,为模糊集的均值,为模糊集的方差,。各输入、输出模糊语言集中元素均值u的取值为:e={

6,

3,

1,0,1,3,6}; ec={

6,

4,

2,0,2,4,6}; p={

6,

4,

2,0,2,4,6}; i={

6,

4,

2,0,2,4,6}; d={

6,

4,

2,0,2,4,6}.s3、模糊规则确定。由于参数 p 控制系统响应速度,i 控制系统稳态误差,d 控制系统动态特性。因此根据各参数对系统控制的作用,同时考虑系统的稳定性、超调量和响应时间等因素的影响以及现有研究成果,将船舶操纵人员的操舵经验加以总结并经过人工修正后,可得到如下49条模糊规则:模糊规则的含义为:当为(正大),为(正大)时,即期望航向与真实航向的差距在逐渐增大时,此时应向右操大舵角()。其他规则同理。每一条规则都是并列的,他们之间是“或”的逻辑关系。将其整理成如下控制规则表:表4模糊控制规则表s4、推理方法的确定。在k时刻,若e和ec经模糊处理后的模糊子集为和,选用mamdani推理法:推理结果为一个模糊集,需再进行清晰化处理。本发明清晰化处理方法选用重心法,该方法通过求取隶属度函数曲线与横坐标所围面积的形心坐标值作为精确输出量作用于被控对象。
[0055]
本实施例中,获取本船与多个目标船的ais信息和雷达信息,将所述ais信息和所述雷达信息进行数据融合处理;;计算本船和目标船舶间相关避碰参数,包括最近会遇距离(dcpa)、最近会遇时间(tcpa)、两船间距离(d)、相对方位(b)、速度比(k)等信息;利用速度障碍法判断本船和各目标船间是否存在碰撞风险,如果不存在碰撞风险则本船保向保速航向,若存在碰撞风险则转向下一步;采用基于灰云模型的船舶碰撞危险度评估模型计算本船和目标船碰撞危险度大小,并对大于阈值的船舶碰撞危险度进行排序,选择碰撞风险值最高的船舶优先采取避碰行动;计算本船改向变速幅度确定避碰决策方案,在避碰决策过程继续计算船舶碰撞危险度,如大于设置阈值则再次计算确定避碰决策方案,直至全部目标船舶驶过让清为止。
[0056]
本实施例可以将ais和雷达的数据进行融合得到更全面更精确的数据。且多设备的信息融合后,系统抗干扰能力得到加强,扩大了空间和时间的监测范围,提高了信息的准确性,也具有了较好的故障容错率,为自主避碰决策提供了良好的数据基础。本实施例提出的碰撞危险度评估模型可以有效地实现不同会遇局面下船舶碰撞风险的识别和量化。提出的灰云评估模型可以表示不确定概念的模糊性和随机性及其关系,它适用于处理不确定信息,可以对碰撞风险进行精确评估。本实施例提出的自主避碰决策方案充分考虑了船舶的操纵性、船舶会遇局面、碰撞危险度、良好船艺和colregs。可以实时得到避碰决策方案并通过控制执行模块按照预定的速度和航向控制船舶,实现有效避碰得目的。此外,本实施例可以有效避免船舶在航行过程中因驾驶员人为失误,提高船舶航行风险。
[0057]
应理解,上述实施例中各步骤的序号的大小并不意味着执行顺序的先后,各过程的执行顺序应以其功能和内在逻辑确定,而不应对本技术实施例的实施过程构成任何限定。
[0058]
本实施例还提供一种开阔水域船舶自主避碰系统,该开阔水域船舶自主避碰系统与上述实施例中开阔水域船舶自主避碰方法一一对应。如图6所示,该开阔水域船舶自主避碰系统包括信息融合模块601、计算模块602、碰撞风险评估模块603、避碰决策模块604、控制执行模块605。各功能模块详细说明如下:信息融合模块601,用于获取本船与多个目标船的ais信息和雷达信息,将所述ais信息和所述雷达信息进行数据融合处理,得到所述目标船相对所述本船的融合信息;避碰信息处理模块602,用于根据所述融合信息实时计算所述本船与目标船的相关避碰参数;碰撞风险评估模块603,用于根据速度障碍法判断所述本船和目标船是否存在碰撞风险,当存在碰撞风险时,基于所述相关避碰参数计算不同会遇局面下的评估指标值,并利用构建的基于灰云模型的船舶碰撞危险度评估模型对船舶间碰撞危险度进行评估,得到所述本船相对各个目标船的碰撞风险值;所述会遇局面包括对遇、交叉和追越局面;避碰决策模块604,用于将碰撞风险值大于预设阈值的目标船作为危险船舶,针对所述危险船舶,利用改进的速度障碍法计算本船改向变速幅度,确定避碰决策方案;控制执行模块605,用于通过控制系统控制所述本船的航向和航速,以实现自主避碰。
[0059]
关于开阔水域船舶自主避碰系统各个模块的具体限定可以参见上文中对于开阔水域船舶自主避碰方法的限定,在此不再赘述。上述开阔水域船舶自主避碰系统中的各个
模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于计算机设备中的处理器中,也可以以软件形式存储于计算机设备中的存储器中,以便于处理器调用执行以上各个模块对应的操作。
[0060]
参照图7,本实施例还提供了一种计算机设备,该计算机设备可以是移动终端、桌上型计算机、笔记本、掌上电脑及服务器等计算设备。该计算机设备包括处理器10、存储器20及显示器30。图7仅示出了计算机设备的部分组件,但是应理解的是,并不要求实施所有示出的组件,可以替代的实施更多或者更少的组件。
[0061]
存储器20在一些实施例中可以是计算机设备的内部存储单元,例如计算机设备的硬盘或内存。存储器20在另一些实施例中也可以是计算机设备的外部存储设备,例如计算机设备上配备的插接式硬盘,智能存储卡(smart media card, smc),安全数字(secure digital, sd)卡,闪存卡(flash card)等。进一步地,存储器20还可以既包括计算机设备的内部存储单元也包括外部存储设备。存储器20用于存储安装于计算机设备的应用软件及各类数据,例如安装计算机设备的程序代码等。存储器20还可以用于暂时地存储已经输出或者将要输出的数据。在一实施例中,存储器20上存储有开阔水域船舶自主避碰计算机程序40。
[0062]
处理器10在一些实施例中可以是一中央处理器(central processing unit, cpu),微处理器或其他数据处理芯片,用于运行存储器20中存储的程序代码或处理数据,例如执行开阔水域船舶自主避碰方法等。
[0063]
显示器30在一些实施例中可以是led显示器、液晶显示器、触控式液晶显示器以及oled(organic light

emitting diode,有机发光二极管)触摸器等。显示器30用于显示在计算机设备的信息以及用于显示可视化的用户界面。计算机设备的部件10

30通过系统总线相互通信。
[0064]
在一实施例中,当处理器10执行存储器20中开阔水域船舶自主避碰计算机程序40时实现以下步骤:获取本船与多个目标船的ais信息和雷达信息,将所述ais信息和所述雷达信息进行数据融合处理,得到所述目标船相对所述本船的融合信息;根据所述融合信息计算所述本船与目标船的相关避碰参数;根据速度障碍法判断所述本船和目标船是否存在碰撞风险,当存在碰撞风险时,基于所述相关避碰参数计算不同会遇局面下的评估指标值,并利用构建的基于灰云模型的船舶碰撞危险度评估模型对船舶间碰撞危险度进行评估,得到所述本船相对各个目标船的碰撞风险值;所述会遇局面包括对遇、交叉和追越局面;将碰撞风险值大于预设阈值的目标船作为危险船舶,针对所述危险船舶,利用改进的速度障碍法计算本船改向变速幅度,确定避碰决策方案;通过控制系统控制所述本船的航向和航速,以实现自主避碰。
[0065]
本实施例还提供了一种计算机可读存储介质,其上存储有开阔水域船舶自主避碰计算机程序,计算机程序被处理器执行时实现以下步骤:获取本船与多个目标船的ais信息和雷达信息,将所述ais信息和所述雷达信息进行数据融合处理,得到所述目标船相对所述本船的融合信息;根据所述融合信息计算所述本船与目标船的相关避碰参数;
根据速度障碍法判断所述本船和目标船是否存在碰撞风险,当存在碰撞风险时,基于所述相关避碰参数计算不同会遇局面下的评估指标值,并利用构建的基于灰云模型的船舶碰撞危险度评估模型对船舶间碰撞危险度进行评估,得到所述本船相对各个目标船的碰撞风险值;所述会遇局面包括对遇、交叉和追越局面;将碰撞风险值大于预设阈值的目标船作为危险船舶,针对所述危险船舶,利用改进的速度障碍法计算本船改向变速幅度,确定避碰决策方案;通过控制系统控制所述本船的航向和航速,以实现自主避碰。
[0066]
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的计算机程序可存储于一非易失性计算机可读取存储介质中,该计算机程序在执行时,可包括如上述各方法的实施例的流程。
[0067]
本技术所提供的各实施例中所使用的对存储器、存储、数据库或其它介质的任何引用,均可包括非易失性和/或易失性存储器。非易失性存储器可包括只读存储器(rom)、可编程rom(prom)、电可编程rom(eprom)、电可擦除可编程rom(eeprom)或闪存。易失性存储器可包括随机存取存储器(ram)或者外部高速缓冲存储器。作为说明而非局限,ram以多种形式可得,诸如静态ram(sram)、动态ram(dram)、同步dram(sdram)、双数据率sdram(ddrsdram)、增强型sdram(esdram)、同步链路(synchlink)、dram(sldram)、存储器总线(rambus)直接ram(rdram)、直接存储器总线动态ram(drdram)、以及存储器总线动态ram(rdram)等。
[0068]
以上所述,仅为本技术较佳的具体实施方式,但本技术的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本技术揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本技术的保护范围之内。
再多了解一些

本文用于企业家、创业者技术爱好者查询,结果仅供参考。

发表评论 共有条评论
用户名: 密码:
验证码: 匿名发表

相关文献