一种基于改进动态最优互惠避碰机制的无人水面艇实时避碰方法与流程

1.本发明涉及无人艇技术领域，具体而言，尤其涉及一种基于改进动态最优互惠避碰机制的无人水面艇实时避碰方法。


背景技术：

2.近年来，无人艇(unmanned surface vehicles)以安全性高、成本低、可控性强等优势，被广泛应用于气候变化、环境监测、水文测绘等科学领域；此外在商业和军事等领域对水面无人船舶领域也有较大的需求。然而，由于usv的诸多问题，例如复杂的海洋环境对控制稳定性的挑战，未知环境下的实时避障，部分海域存在的通信中断及信号屏蔽、干扰等，这些使得高性能、高速度的usv仍处于实践阶段，人们大多只能对usv进行半自动控制而不是完全自主控制。由此可见，为了最大限度达到自主控制目标，减少人为干预，亟需对无人水面船舶做进一步的研究。
3.无人艇自主航行的核心是航行控制，它分为制导、导航与控制三部分。目前控制方面已有许多先进的控制系统设计方案，而对规划领域的研究相对较少，路径规划可以划分为全局路径规划和局部路径规划，而避碰属于其中的局部路径规划范畴。目前应用于无人艇领域的避碰算法主要有人工势场法、动态窗口法、向量场直方图法、速度障碍法、蚁群算法等仿生学算法、神经网络等智能算法。具体说来，人工势场法因其原理简单、实时性好而被广泛应用，然而，由于该算法本身的缺陷，极易陷入局部极小，并且当斥力引力相同时将导致usv停滞不前；动态窗口法符合模型的动力学约束且不易陷入局部最优，该方法的缺点为运算量大，实时性较差；向量场直方图法通过计算运动速度与方向，在一定区域通过设立向量场描述空间状态，达到避障的目的，缺点为易陷入局部最优，且只能改变速度大小而无法改变速度方向；蚁群算法等相关算法作为基于群体智能的方法，不仅可以作为全局路径规划方法，亦可作用于局部路径规划；目前使用较多的还有新兴的人工智能算法诸如神经网络算法、深度强化学习算法等，但它们都要受到泛化性限制且需要提前进行训练的限制；速度障碍法作为一种传统的几何方法因其运算速度快、不易陷入局部最优、适应性强等特点被广泛应用于各种避障环境，本专利同样运用改进的速度障碍法对无人艇实施避障规划。
4.速度障碍法最早由fiorini由1998年提出，并成功应用于各个领域，近年来，针对速度障碍法(velocity obstacle)的一些不足，陆续提出了线性速度障碍法(linear velocity obstacle)、非线性速度障碍法(non
‑
linear velocity obstacle)、概率速度障碍法(probabilistic velocity obstacle)、互惠速度障碍法(reciprocal velocity obstacles)、基于椭圆的速度障碍法(ellipse
‑
based velocity obstacles)、联合障碍避碰(combine collision avoid)、最优互惠避碰(optimal reciprocal collision avoidance)、不确定非线性速度障碍法(uncertainty non
‑
linear velocity obstacles)等算法，速度障碍法大体分为线性与非线性两种算法，其中非线性算法需要对轨迹进行预
测，其避障准度与精度与轨迹预测准确程度有直接关系，但是在实际中很难通过获取其他障碍的精确信息进行轨迹预测，故本专利采用的是线性算法中基于改进的最优互惠避碰算法。
5.目前在无人艇避障领域已有很多方法，然而这些方法大多并没有考虑海上避碰规则，或只是简单将其应用于避碰。此外，当障碍物不遵守避碰规则时很容易造成碰撞或大幅度转角。虽然目前已有少部分避碰方法考虑了复杂情况下遵循海上避碰规则的问题，但往往只单独作为一个模块进行判断。


技术实现要素：

6.根据上述提出最优互惠避碰算法避碰责任划分的问题和最优速度选择代价函数单一的技术问题，提供一种基于改进动态最优互惠避碰机制的无人水面艇实时避碰方法。本发明设计了一种面向复杂海面情况下的海上会遇规则判断体系，并将其应用于避碰权重选择。在此基础上，进一步构建了新型最优速度代价函数，加入当前速度与当前角度两个评价标准，以减少算法带来的抖振和不必要的损耗，从而实现无人水面艇的高效、快速避障。
7.本发明采用的技术手段如下：
8.一种基于改进动态最优互惠避碰机制的无人水面艇实时避碰方法，包括如下步骤：
9.s1、构建无人艇运动学模型，并结合复杂海面环境构建运动约束条件；
10.s2、根据海上会遇规则遵守判断、碰撞可能性判断、意识并采取避碰手段判断一系列参数建立评价函数，并结合权重影响避碰责任划分；
11.s3、采用动态最优互惠避碰算法选择理想机动速度代价函数，在期望速度的基础上加入当前速度和当前角度代价，减少速度变化带来的抖振及损耗。
12.进一步地，所述步骤s1的具体实现过程如下：
13.s11、构建无人船运动学模型，如下：
[0014][0015]
其中，(x,y,ψ)表示无人船在地球坐标系的位置和航向，(u,v,r)分别表示在船体坐标系下无人船的前向、横向速度和航向角速度；
[0016]
s12、将无人船膨化为以船的中心为圆心的圆，半径与船长相关形成避障过程中不能与障碍物接触的安全范围d，保证无人船安全行驶，对于障碍物同样做膨化处理，安全范围定义如下：
[0017][0018]
其中，p
t
表示障碍物位置；p(t)表示己船在t时刻位置；d
o
为一固定常数，具体参数根据船长变化而变化。
[0019]
进一步地，所述步骤s2的具体实现过程如下：
[0020]
s21、引入速度障碍法：
[0021]
设受到控制的己船os的位置和速度为p
o
(t)和v
o
，目标船只ts的位置和速度设为p
t
(t)和v
t
，己船os相对于目标船只ts的相对速度设为v
ot
＝v
ot
‑
v
t
；
[0022]
将目标无人船进行膨化处理，设障碍物为半径为r
t
的圆，同时将己船os的半径r
o
加入到目标船中，将己船os作为质点，通过相对速度v
ot
将目标船视为静止，从己船os的位置p
o
(t)出发沿相对速度v
ot
方向与目标船只的膨化范围d(p,r)相交时无人船在时间τ内一定会碰撞，此时定义障碍速度空间如下：
[0023]
d(p,r)＝{q|||q
‑
p||＜r}
ꢀꢀꢀꢀꢀꢀꢀ
(3)
[0024]
其中，q表示障碍物位置；p表示己船位置；r表示位置常数，大小由己船与障碍物半径共同决定；
[0025][0026]
其中，表示避免碰撞速度集合；v表示己船速度；t表示有限时间；d表示速度集合区域；p
t
表示障碍物位置；p
o
表示己船位置；r
t
表示障碍物半径；r
o
表示己船半径；
[0027]
定义x与y的minkowski和如下：
[0028][0029]
对于任意速度v
t
,若v
t
∈v
t
，则a和b在当前速度下，至少在τ时间内是无碰撞的；因此，定义避碰速度集合如下：
[0030][0031]
其中，v
b
表示目标船速度集合；
[0032]
s22、基于速度障碍法，引入互惠速度障碍法：
[0033]
基于速度障碍法再次更新v
o
，具体更新机制如下：
[0034][0035]
其中，表示互惠速度障碍法避免碰撞速度集合；表示己船更新速度；vo
o|t
(v
t
)表示原避免碰撞速度集合；
[0036]
s23、基于引入的互惠速度障碍法，进一步引入最优互惠速度障碍法：
[0037]
在互惠速度障碍法的基础上再次优化因此进一步引入优化速度用于从可行解中选出最优解，具体的orca定义区域定义如下：
[0038][0039][0040]
其中，u是使点v
ot
‑
v
t
到速度障碍区边缘最近的向量，n是该点的法向量，表示每人承担一半的避碰责任；是一个被直线分隔的半平面，该直线通过点
方向垂直于n；是一个被直线分隔的半平面，该直线通过点方向垂直于n。
[0041]
s24、基于引入的最优互惠速度障碍法，进一步引入通常互惠速度障碍法，具体公式如下：
[0042][0043]
其中，η
o|t
表示常数，η
o|t
|(η
o|t
∈[0,1])与避碰责任相关联，σ为接近无穷小的数，用以确保避碰需要的时间；使点v
ot
‑
v
t
到速度障碍区边缘最近的向量，n是该点的法向量；
[0044]
s25、基于引入的通常互惠速度障碍法，进一步引入动态最优互惠速度障碍法，使用动态参数对避碰责任进行评价和细化，即：
[0045][0046]
其中，表示动态速度障碍法避免碰撞速度集合；β表示常数，β∈[0,1]，主要由三部分组成，分别为目标船只ts是否意识到避碰威胁并采取手段、避碰可能性、是否遵守海上会遇规则。
[0047]
进一步地，所述步骤s3的具体实现过程如下：
[0048]
s31、基于速度变化因子、避碰可能性因子以及海事规则因子，得到最佳避碰速度；
[0049]
s32、基于最佳避碰速度，采用代价函数获取v
new
，具体的代价函数c
v
表示如下：
[0050]
c
v
(k)＝(1
‑
β)(||v
d
(k)
‑
v
o
(k)||) β(||v
o
(k
‑
1)
‑
v
o
(k)||)
ꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(12)
[0051]
其中，v
d
(k)表示期望速度；v
o
(k)表示当前速度；v
o
(k
‑
1)表示上一时刻速度；代价函数的第一项在保证船向目标方向行驶的同时兼顾了避障时的安全性，第二项则避免船改变方向是带来的抖振。
[0052]
进一步地，所述步骤s31的具体实现过程如下：
[0053]
s311、速度变化因子：
[0054]
判断航向角ψ是否发生变化，再引入一个新的变量接近加速度a
t
，通过对最近三个时刻的位置差判断目标船是否采取积极手段，具体公式如下：
[0055]
a
t
(k)＝δp(k)
‑
δp(k
‑
1)
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(13)
[0056]
δp(k)＝|p
o
(k)
‑
p
t
(k)|
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(14)
[0057]
其中，δp(k)为k时刻己船与目标船距离，当(a
t
(k)＜a
t
(k
‑
1))∩(|δψ|＞5)时说明目标船只ts有避障能力且采取积极行动避障，同理可判断障碍物是否有避障能力且是否采取手段；
[0058]
s312、避碰可能性因子：
[0059]
基于接近船舶的估计最近位置cpa，得到避碰可能性结果，具体的表达式如下：
[0060]
[0061][0062][0063]
δp
x
＝p
tx
‑
p
ox
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(18)
[0064]
δv
x
＝v
ox
‑
v
tx
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(19)
[0065]
其中，dcpa为最小接近距离，tcpa为最小接近时间，p
tx
、p
ox
、v
ox
、v
tx
分别为己船与障碍物的位置与速度；因此，根据船长和cpa可将避碰可能性分为高中低三个级别，分别用h、m、l表示。
[0066]
s313、海事规则因子：
[0067]
根据目标船的相对位置θ
t
和海事规则判断是否遵守海上避碰规则，根据海上避碰规则将相遇问题分为追越、对遇和交叉三种，通常右舷为避碰责任方，避碰责任方应承担全部的避碰责任，交叉时从目标船后方绕行，相对位置θ
t
、无人船航向角目标船航向角障碍物相对方位角α
t
的具体关系如下：
[0068][0069][0070][0071][0072][0073]
若目标船处于应承担避碰责任范围并进行右舷避碰动作或非责任范围并直行，则判定符合避碰规则，反之则判定未遵守规则。
[0074]
较现有技术相比，本发明具有以下优点：
[0075]
1、本发明提供的基于改进动态最优互惠避碰机制的无人水面艇实时避碰方法，根据原最优互惠避碰算法并未考虑海事规则判断责任的问题，创新性的引入了动态权重判断责任机制，并在该机制中充分考虑了是否意识到冲突并采取积极手段、己船避碰可能性、目标是否遵守海上避碰规则等因素。
[0076]
2、本发明提供的基于改进动态最优互惠避碰机制的无人水面艇实时避碰方法，在最优速度评价函数加入当前速度与当前角度两个评价标准，进一步减少了算法带来的抖振
和不必要的损耗，从而使无人船安全且快速完成避障。
[0077]
3、本发明提供的基于改进动态最优互惠避碰机制的无人水面艇实时避碰方法，根据海上会遇规则遵守判断、碰撞可能性判断、意识并采取避碰手段判断等因素设立评价函数，进而通过权重影响避碰责任划分，以使得无人艇在更为合理地遵循海上会遇规则的同时兼顾碰撞风险。
[0078]
4、本发明提供的基于改进动态最优互惠避碰机制的无人水面艇实时避碰方法，针对动态最优互惠避碰算法(dorca)在选择理想机动速度代价函数时存在速度变化过快的问题，在期望速度的基础上引入当前速度和当前角度代价，以减少速度变化带来的抖振及损耗。
[0079]
5、本发明提供的基于改进动态最优互惠避碰机制的无人水面艇实时避碰方法，其局部路径规划机制的应用使用约束符合无人船的实际运动特性。
[0080]
基于上述理由本发明可在无人艇等领域广泛推广。
附图说明
[0081]
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图做以简单地介绍，显而易见地，下面描述中的附图是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动性的前提下，还可以根据这些附图获得其他的附图。
[0082]
图1为本发明方法流程图。
[0083]
图2为本发明实施例提供的速度障碍法图例。
[0084]
图3为本发明实施例提供的速度障碍法图例。
[0085]
图4为本发明实施例提供的海上会遇规则示意图。
[0086]
图5为本发明实施例提供的各航向角关系示意图。
[0087]
图6为本发明实施例提供的权重判断示意图。
[0088]
图7为本发明实施例提供的dorca左舷会遇图。
[0089]
图8为本发明实施例提供的ts直行碰撞风险对比图。
[0090]
图9为本发明实施例提供的ts直行速度变化对比图。
[0091]
图10为本发明实施例提供的dwa左舷会遇图。
[0092]
图11为本发明实施例提供的dorca右舷会遇图。
[0093]
图12为本发明实施例提供的dorca对遇图。
具体实施方式
[0094]
为了使本技术领域的人员更好地理解本发明方案，下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分的实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都应当属于本发明保护的范围。
[0095]
需要说明的是，本发明的说明书和权利要求书及上述附图中的术语“第一”、“第二”等是用于区别类似的对象，而不必用于描述特定的顺序或先后次序。应该理解这样使用
的数据在适当情况下可以互换，以便这里描述的本发明的实施例能够以除了在这里图示或描述的那些以外的顺序实施。此外，术语“包括”和“具有”以及他们的任何变形，意图在于覆盖不排他的包含，例如，包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元，而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
[0096]
如图1所示，本发明提供了一种基于改进动态最优互惠避碰机制的无人水面艇实时避碰方法，包括如下步骤：
[0097]
s1、构建无人艇运动学模型，并结合复杂海面环境构建运动约束条件；
[0098]
s2、根据海上会遇规则遵守判断、碰撞可能性判断、意识并采取避碰手段判断一系列参数建立评价函数，并结合权重影响避碰责任划分；
[0099]
s3、采用动态最优互惠避碰算法选择理想机动速度代价函数，在期望速度的基础上加入当前速度和当前角度代价，减少速度变化带来的抖振及损耗。
[0100]
具体实施时，作为本发明优选的实施方式，所述步骤s1的具体实现过程如下：
[0101]
s11、构建无人船运动学模型，如下：
[0102][0103]
其中，(x,y,ψ)表示无人船在地球坐标系的位置和航向，(u,v,r)分别表示在船体坐标系下无人船的前向、横向速度和航向角速度；
[0104]
注1：对于欠驱动无人船，存在前向偏航动力的限制，其横向速度v有界，故在动力学约束情况下，只需约束横向速度和航向角速度即可，二者限制范围将于仿真中给出。
[0105]
s12、将无人船膨化为以船的中心为圆心的圆，半径与船长相关形成避障过程中不能与障碍物接触的安全范围d，保证无人船安全行驶，对于障碍物同样做膨化处理，安全范围定义如下：
[0106][0107]
其中，p
t
表示障碍物位置；p(t)表示己船在t时刻位置；d
o
为一固定常数，具体参数根据船长变化而变化。
[0108]
具体实施时，作为本发明优选的实施方式，所述步骤s2的具体实现过程如下：
[0109]
s21、引入速度障碍法：
[0110]
如图2所示，为常规速度障碍法，设受到控制的己船os的位置和速度为p
o
(t)和v
o
，目标船只ts的位置和速度设为p
t
(t)和v
t
，己船os相对于目标船只ts的相对速度设为v
ot
＝v
ot
‑
v
t
；
[0111]
将目标无人船进行膨化处理，设障碍物为半径为r
t
的圆，同时将己船os的半径r
o
加入到目标船中，将己船os作为质点，通过相对速度v
ot
将目标船视为静止，从己船os的位置p
o
(t)出发沿相对速度v
ot
方向与目标船只的膨化范围d(p,r)相交时无人船在时间τ内一定会碰撞，此时定义障碍速度空间如下：
[0112]
d(p,r)＝{q|||q
‑
p||＜r}
ꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(3)
[0113]
其中，q表示障碍物位置；p表示己船位置；r表示位置常数，大小由己船与障碍物半
径共同决定；
[0114][0115]
其中，表示避免碰撞速度集合；v表示己船速度；t表示有限时间；d表示速度集合区域；p
t
表示障碍物位置；p
o
表示己船位置；r
t
表示障碍物半径；r
o
表示己船半径；
[0116]
定义x与y的minkowski和如下：
[0117][0118]
对于任意速度v
t
,若v
t
∈v
t
，则a和b在当前速度下，至少在τ时间内是无碰撞的；因此，定义避碰速度集合如下：
[0119][0120]
其中，v
b
表示障碍物速度集合；
[0121]
s22、基于速度障碍法，引入互惠速度障碍法：
[0122]
传统速度障碍法要求v
o
应处于之外，由于速度障碍法提供的是可行解而非最优解，因而当两个具备同样算法的无人船行进时易在速度选择时产生振荡。为了解决这个问题引入了互惠速度障碍法，基于速度障碍法再次更新v
o
，具体更新机制如下：
[0123][0124]
其中，表示互惠速度障碍法避免碰撞速度集合；表示己船更新速度；vo
o|t
(v
t
)表示原避免碰撞速度集合；
[0125]
s23、基于引入的互惠速度障碍法，进一步引入最优互惠速度障碍法：
[0126]
通过改变区域更新的v
o
扩大了碰撞区域，从而消除了振荡，然而最优互惠避碰算法需要在互惠速度障碍法的基础上再次优化因此进一步引入优化速度用于从可行解中选出最优解，如图3所示，具体的orca定义区域定义如下：
[0127][0128][0129]
其中，u是使点v
ot
‑
v
t
到速度障碍区边缘最近的向量，n是该点的法向量，表示每人承担一半的避碰责任；是一个被直线分隔的半平面，该直线通过点方向垂直于n；是一个被直线分隔的半平面，该直线通过点方向垂直于n。
[0130]
s24、基于引入的最优互惠速度障碍法，进一步引入通常互惠速度障碍法，值得提出的是互惠速度障碍法的有效性是基于双方都有避碰能力的基础之上，并且更多应用于多
无人船避碰及协同问题中。基于此zhao等人提出改进的gorca算法，将其与海上避碰规则结合判断权重，具体公式如下：
[0131][0132]
其中，其中，η
o|t
表示常数，η
o|t
|(η
o|t
∈[0,1])与避碰责任相关联，σ为接近无穷小的数，用以确保避碰需要的时间；使点v
ot
‑
v
t
到速度障碍区边缘最近的向量，n是该点的法向量；
[0133]
s25、基于引入的通常互惠速度障碍法，进一步引入动态最优互惠速度障碍法，使用动态参数对避碰责任进行评价和细化，即：
[0134][0135]
其中，表示动态速度障碍法避免碰撞速度集合；β表示常数，β∈[0,1]，主要由三部组成，分别为目标船只ts是否意识到避碰威胁并采取手段、避碰可能性、是否遵守海上会遇规则。其中是否意识到冲突并采取手段规则根据两方面判断。
[0136]
具体实施时，作为本发明优选的实施方式，所述步骤s3的具体实现过程如下：
[0137]
s31、基于速度变化因子、避碰可能性因子以及海事规则因子，得到最佳避碰速度；
[0138]
s32、基于最佳避碰速度，采用代价函数获取v
new
，具体的代价函数c
v
表示如下：
[0139]
c
v
(k)＝(1
‑
β)(||v
d
(k)
‑
v
o
(k)||) β(||v
o
(k
‑
1)
‑
v
o
(k)||)
ꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(12)
[0140]
其中，v
d
(k)表示期望速度；v
o
(k)表示当前速度；v
o
(k
‑
1)表示上一时刻速度；代价函数的第一项在保证船向目标方向行驶的同时兼顾了避障时的安全性，第二项则避免船改变方向是带来的抖振。
[0141]
具体实施时，作为本发明优选的实施方式，所述步骤s31的具体实现过程如下：
[0142]
s311、速度变化因子：
[0143]
判断航向角ψ是否发生变化，再引入一个新的变量接近加速度a
t
，通过对最近三个时刻的位置差判断目标船是否采取积极手段，具体公式如下：
[0144]
a
t
(k)＝δp(k)
‑
δp(k
‑
1)
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(13)
[0145]
δp(k)＝|p
o
(k)
‑
p
t
(k)|
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(14)
[0146]
其中，δp(k)为k时刻己船与目标船距离，当(a
t
(k)＜a
t
(k
‑
1))∩(|δψ|＞5)时说明目标船只ts有避障能力且采取积极行动避障，同理可判断障碍物是否有避障能力且是否采取手段；
[0147]
s312、避碰可能性因子：
[0148]
避碰可能性由目前广泛使用的方法基于接近点(cpa)来决定，cpa是接近船舶的估计最近位置，通常采用距离(dcpa)和时间(tcpa)两个指标进行判断，当这些指标小于一定的阈值时就会给出碰撞警告，这种方法目前已经嵌入到机载雷达系统故可实现性极强。
[0149]
基于接近船舶的估计最近位置cpa，得到避碰可能性结果，具体的表达式如下：
[0150]
[0151][0152][0153]
δp
x
＝p
tx
‑
p
ox
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(18)
[0154]
δv
x
＝v
ox
‑
v
tx
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(19)
[0155]
其中，dcpa为最小接近距离，tcpa为最小接近时间，p
tx
、p
ox
、v
ox
、v
tx
分别为己船与障碍物的位置与速度；因此，根据船长和cpa可将避碰可能性分为高中低三个级别，分别用h、m、l表示。
[0156]
s313、海事规则因子：
[0157]
根据目标船的相对位置θ
t
和海事规则判断是否遵守海上避碰规则，根据海上避碰规则将相遇问题分为追越、对遇和交叉三种，通常右舷为避碰责任方，避碰责任方应承担全部的避碰责任，交叉时从目标船后方绕行，具体规则如图4所示，相对位置θ
t
、无人船航向角目标船航向角障碍物相对方位角α
t
的具体关系如图5所示，表达式如下：
[0158][0159][0160][0161][0162][0163]
若目标船处于应承担避碰责任范围并进行右舷避碰动作或非责任范围并直行，则判定符合避碰规则，反之则判定未遵守规则。
[0164]
结合式(12
‑
23)是否意识到避碰威胁并采取手段、避碰可能性、是否遵守海上会遇规则三个评价标准对目前海域情况进行判定，判定结果所对应的α将给出相应参数以进一步影响避碰承担责任。具体判定逻辑及影响因素判断如图6所示。可以看出，通过对参数的改变达到了在遵守海事规则的基础上最大程度保证安全性的避碰要求。
[0165]
为了检验dorca方法的有效性使用matlab对此方法进行仿真验证了方法的有效性，同时与其他方法相对比突入了方法的优越性，具体仿真如图7
‑
12所示。
[0166]
最后应说明的是：以上各实施例仅用以说明本发明的技术方案，而非对其限制；尽
管参照前述各实施例对本发明进行了详细的说明，本领域的普通技术人员应当理解：其依然可以对前述各实施例所记载的技术方案进行修改，或者对其中部分或者全部技术特征进行等同替换；而这些修改或者替换，并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。