一种基于数据融合轨迹预测的船舶避碰决策方法与流程

1.本发明涉及船舶避让技术领域，具体涉及一种基于数据融合轨迹预测的船舶避碰决策方法。


背景技术：

2.随着海运行业发展，进出港的船舶数量日益增长，船舶在航行过程中，了解自己和目标船舶在特定时间跨度内的未来位置对于有效解决碰撞情况至关关键。实践表明，更可靠、更准确的信息，能在预测船舶轨迹和做出正确决策方面提供重要依据，极大程度上影响了港口船舶作业安全性。
3.近年来船舶碰撞事故发生率明显增长，人为失误是海上事故的主要原因之一，成为船舶安全航行作业的潜在风险，类似事件给船舶安全生产敲响了警钟，因此，船舶驾驶员在有全面准确了解掌握如何避免船舶避碰的需求日益迫切。如何效减少避碰过程中的人为因素，提高船舶智能航行的安全性以及可靠性，减少驾驶人员的负担，为驾驶人员提供一定的建议和参考，从而降低船舶碰撞事故的发生率，已成为目前行业内主流需求。
4.综上，现需要设计一种基于数据融合轨迹预测的船舶避碰决策方法来解决以上现有技术中的问题。


技术实现要素：

5.为解决上述现有技术中问题，本发明提供了一种基于数据融合轨迹预测的船舶避碰决策方法，通过数据融合，将多个双自主传感设备对船舶当前位置的测量考虑在内，增加了预测的可靠性和准确性；满足不同会遇局面下船舶转向避碰的安全性和经济型要求，大幅度降低了误检率，保证了正确率。
6.为达到上述目的，本发明采用如下技术方案：一种基于数据融合轨迹预测的船舶避碰决策方法，包括以下步骤：s1、采集并融合多个传感器的数据得到所述船舶的导航数据；s2、根据所述步骤s1中的导航数据构建自适应神经网络并确定运动参数预测值；s3、根据所述步骤s2中的运动参数预测值构建船舶间的运动几何关系；s4、对所述步骤s3中得到运动几何关系，设定碰撞危险的度量与目标函数，建立避碰角决策模型；s5、将所述步骤s2中的运动参数预测值作为已知量，输入限制条件和所述步骤s4中的目标函数，通过多目标优化算法对避碰角决策模型进行求解；其中，所述步骤s2中的运动参数预测值通过所述自适应神经网络的响应权重确定，所述响应权重ωi的计算公式为：其中，m为神经网络数量，
푖
为神经网络的编号，ωi为第
푖
个神经网络的响应权重，εi为第
푖
个神经网络预测误差，ε
min
为预测误差最小值，ε
max
为预测误差最大值；所述预测误差εi根据所述步骤s1中的导航数据确定。
7.在本发明的一些实施例中，所述步骤s1中的导航数据由加权平均值表示：其中，(为所述船舶在笛卡尔坐标中时刻t的位置融合值，(为所述船舶在笛卡尔坐标中时刻t的船速融合值，为融合权重矩阵，(为对于第i个传感器（1≤i≤n）在笛卡尔坐标中时刻t的位置融合值，(为对于第i个传感器（1≤i≤n）在笛卡尔坐标中时刻t的船速融合值。
8.在本发明的一些实施例中，所述融合权重矩阵a
l
(t)的计算公式为：其中，p
ij-1
(t)为第i个和第j个传感器之间的误差互协方差矩阵。
9.在本发明的一些实施例中，所述误差互协方差矩阵p
ij-1
(t)的计算公式为：其中，i4为矩阵，ki(t)和kj(t)分别为第i个和第j个传感器（1≤i≤n，1≤j≤n）在时刻t的滤波增益矩阵，h，φ为常数矩阵：，。
10.在本发明的一些实施例中，所述运动几何关系包括目标船与本船的相对航速νr、相对航速的方向φr、目标船与本船的距离r
t
、目标船相对于本船的方位α
t
。
11.在本发明的一些实施例中，所述目标船相对于本船的方位α
t
的计算公式为：式中，为确定目标船对于本船方位的辅助角，其大小根据本船与目标船的位置关系确定，即当时，，当时，，当当时，，当当时，；其中，为目标船在x轴坐标，为本船在x轴坐标，为目标船在y轴坐标，为本船在y轴坐标。
12.在本发明的一些实施例中，所述步骤s4中建立避碰角决策模型包括以下步骤：
s41、计算所述本船与所述目标船的会遇距离dcpa及到达会遇点的时间tcpa；s42、设定目标函数：；其中，l
cost
为避碰行动造成的航程损失。
13.在本发明的一些实施例中，所述避碰角决策模型进行求解过程包括以下步骤：s51、初始化种群和权重向量，并计算任意两个权重间的距离，以获得邻居；s52、为每个子问题分配权重向量；s53、根据聚合函数值更新父代种群；当达到停止条件则停止，输出最优解集，否则回到步骤s2重新为每个子问题分配权重向量。
14.在本发明的一些实施例中，所述聚合函数采用切比雪夫聚合函数，公式如下：其中，表示是目标的优化向量，x是待优化变量，z为参考点。
15.在本发明的一些实施例中，所述停止条件为目标迭代次数。
16.本发明的技术方案相对现有技术具有如下技术效果：通过将多个双自主传感器对船舶当前位置的测量数据进行融合，提高了预测的可靠性和准确性。为了最大限度地减少预测误差，设计一种算法利用了人工神经网络。同时，为了提高船舶智能避碰决策的效果与效率，建立以保障船舶航行安全为目标的避碰角决策模型，将船舶的运动参数预测值作为输入量，通过多目标优化算法对目标函数进行优化，计算出最优的转向避碰角和转向时机，满足不同会遇局面下船舶转向避碰的安全性和经济型要求，大幅度降低了误检率，保证了正确率，为船舶航行、航道监控等提供信息支持，减少船舶航行中的安全隐患。
附图说明
17.为了更清楚地说明本发明实施例的技术方案，下面将对实施例描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
18.图1为本发明船舶避碰决策方法流程图；图2为本发明通过两个传感器判断船舶位置以及融合产生的导航数据；图3为本发明中所述步骤s5的流程图；图4为本发明避碰决策模型最优解集；图5为本发明目标船仿真数据表；图6为本发明行进过程中本船与目标船间的距离。
具体实施方式
19.下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完
整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
20.在本发明的描述中，需要说明的是，除非另有明确的规定和限定，术语“安装”、“相连”、“连接”应做广义理解，例如，可以是固定连接，也可以是可拆卸连接，或一体地连接。对于本领域的普通技术人员而言，可以具体情况理解上述术语在本发明中的具体含义。在上述实施方式的描述中，具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
21.实施例1参照图1所示，一种基于数据融合轨迹预测的船舶避碰决策方法，包括以下步骤：s1、采集并融合多个传感器的数据得到所述船舶的导航数据；具体是基于多个传感器最优信息融合卡尔曼滤波，滤波后的信号通过误差互协方差矩阵加权，然后计算平均输出信号作为导航数据，该导航数据可用于在指定时间内预测船舶的运动轨迹；具体步骤包括：s11、由加权平均值表示从n个传感器进行测量中获得融合的导航数据：其中，(为所述船舶在笛卡尔坐标中时刻t的位置融合值，(为所述船舶在笛卡尔坐标中时刻t的船速融合值，为融合权重矩阵，(为对于第i个传感器（1≤i≤n）在笛卡尔坐标中时刻t的位置融合值，(为对于第i个传感器（1≤i≤n）在笛卡尔坐标中时刻t的船速融合值。
22.s12、所述融合权重矩阵a
l
(t)的计算公式为：其中，p
ij-1
(t)为第i个和第j个传感器之间的误差互协方差矩阵。
23.s13、确定滤波后的所述误差互协方差矩阵p
ij-1
(t)的计算公式为：其中，i4为矩阵，ki(t)和kj(t)分别为第i个和第j个传感器（1≤i≤n，1≤j≤n）在时刻t的滤波增益矩阵，h，φ为常数矩阵：，。
24.如图2所示，以传感器记录的船舶位置数据为依据，通过船舶在直线轨道运动进行预测，来自两个传感器的预测结果不在一条直线上，且在某些时刻，传感器1存在丢失信号的情况。因最小化了预测误差矩阵的轨迹，融合后的导航数据大致在一条直线上，证明导航数据融合过程为最优。
25.s2、根据所述步骤s1中的导航数据构建自适应神经网络并确定运动参数预测值；确定预测运动参数的值的具体步骤包括：s21：对s1中得到的导航数据，通过数据融合过程记录不同长度的字符串；s22：通过广义回归神经网络（grnn），采用大量由不同长度的数据串训练的神经网络，其结构包含四个功能多样化的层：输入层、模式层、求和层与输出层；其中，输入层神经元的数量等于训练数据的数量，模式层由两个神经元组成，输出层为一个；从短字符串中训练的神经网络近似为机动船舶的运动参数值，从长字符串训练的神经网络近似为非机动船舶运动参数值，运动参数预测值是根据各神经网络的响应权重而确定。
26.计算运动参数预测值的具体方法为：通过改变权重，为特定神经网络的响应正确分配权重（运动参数的预测），因各神经网络的权重值是根据预测误差计算的，预测误差为基于步骤s1数据融合过程，根据船舶的导航数据而确定，其次，确定导航数据的神经网络响应，最后，基于每个神经网络的响应权重确定运动参数预测值；其中，所述响应权重ωi的计算公式为：其中，m为神经网络数量，
푖
为神经网络的编号，ωi为第
푖
个神经网络的响应权重，εi为第
푖
个神经网络预测误差，ε
min
为预测误差最小值，ε
max
为预测误差最大值。
27.具体地，船舶轨迹预测基于三个神经网络，这些神经网络由步骤s1融合后数据字符串训练，长度分别为 5、10 和 15 个元素。
28.s3、根据所述步骤s2中的运动参数预测值构建船舶间的运动几何关系；所述运动几何关系包括目标船与本船的相对航速νr、相对航速的方向φr、目标船与本船的距离r
t
、目标船相对于本船的方位αr。
29.在笛卡尔直角坐标系中，本船s0的位置坐标为(x0，y0)，航向为φ0，航速为ν0，目标船s
t
的位置坐标为(x
t
，y
t
)，航向为φ
t
，航速为ν
t
，根据几何关系，本船与他船速度关系为：s32、本船与目标船的速度在各坐标轴上的速度分量为：s32、本船与目标船的速度在各坐标轴上的速度分量为：其中，ν
x0
为本船在x轴上的速度，ν
y0
为本船在y轴上的速度，ν
xt
为目标船在x轴上的速度，ν
yt
为目标船在y轴上的速度，ν0为本船航速，ν
t
为目标船航速；s33、相对航速νr在各坐标轴上的分量为：
ν
x0
为本船在x轴上的速度，ν
y0
为本船在y轴上的速度，ν
xt
为目标船在x轴上的速度，ν
yt
为目标船在y轴上的速度；s34、可得相对航速νr的大小为：其中，ν
xr
为相对航速在x轴的分量，ν
yr
为相对航速在y轴的分量；s35、可得相对航速的方向φr为：式中，为确定相对航速的方向的辅助角，其大小根据相对航速的正负值变化而变化，即：当时，，当时，，当时，，当时，；其中，为相对航速在x轴的分量，为相对航速在y轴的分量；s36、本船与目标船之间的距离r
t
为：其中，为目标船在x轴坐标，为本船在x轴坐标，为目标船在y轴坐标，为本船在y轴坐标；s37、所述目标船相对于本船的方位α
t
的计算公式为：式中，为确定目标船对于本船方位的辅助角，其大小根据本船与目标船的位置关系确定，即当时，，当时，，当当时，，当当时，；其中，为目标船在x轴坐标，为本船在x轴坐标，为目标船在y轴坐标，为本船在y轴坐标。
30.s4、对所述步骤s3中得到运动几何关系，设定碰撞危险的度量与目标函数，建立避碰角决策模型；在本发明的一些实施例中，所述步骤s4中建立避碰角决策模型包括以下步骤：s41、计算所述本船与所述目标船的会遇距离dcpa及到达会遇点的时间tcpa；其中，本船和目标船的最近会遇距离dcpa为：其中，其中，为本船与目标船之间的距离，为相对航速的方向，为目标船相对于本船方位；本船和目标船抵达最近会遇点所需的时间tcpa为：
其中，为本船与目标船之间的距离，为相对航速的方向，为目标船相对于本船方位，为相对航速；s42、两船会遇过程中的最小会遇距离应大于等于适合当时环境与情况的安全距离，即令目标船始终保持在安全距离上通过，本船转向避碰角为δc，行动时机为本船过最后一次观测点后到抵达转向点所经过的时间（这个时间段内本船保向保速行驶），为δt，则r
tlast
，ν
tlast
为本船过最后一次观测点时两船间的相对距离和相对航速，设定目标函数：；其中，l
cost
为避碰行动造成的航程损失。
31.s5、将所述步骤s2中的运动参数预测值作为已知量，输入限制条件和所述步骤s4中的目标函数，通过多目标优化算法对避碰角决策模型进行求解；参照图3所示，所述避碰角决策模型进行求解过程包括以下步骤：s51、初始化种群和权重向量，并计算任意两个权重间的距离，以获得邻居；s52、为每个子问题分配权重向量；s53、根据聚合函数值更新父代种群；当达到停止条件则停止，输出最优解集，否则回到步骤s2重新为每个子问题分配权重向量。
32.在本发明的一些实施例中，所述聚合函数采用切比雪夫聚合函数，公式如下：其中，表示是目标的优化向量，x是待优化变量，z为参考点。
33.在本发明的一些实施例中，所述停止条件为目标迭代次数，具体地，最大迭代次数为1000，种群个体数为30，邻居种群规模为10，决策变量数目为2。
34.对步骤s4和步骤s5，为验证方法有效性，以本船起点(0, 0)，初始航向045
°
，速度12kn，通过仿真，参见图4，最优解集中，参考线以下的解为所有dcpa≥d的解，选取该集合中航程损失最小的解为最优解，目标船仿真数据参见图5，行进过程中本船与目标船间的距离，参见图6，以上仿真表明本发明提出的避碰决策，可使两船在安全距离通过。
35.本发明的技术方案相对现有技术具有如下技术效果：通过将多个双自主传感器对船舶当前位置的测量数据进行融合，提高了预测的可靠性和准确性。为了最大限度地减少预测误差，设计一种算法利用了人工神经网络。同时，为了提高船舶智能避碰决策的效果与效率，建立以保障船舶航行安全为目标的避碰角决策模型，将船舶的运动参数预测值作为输入量，通过多目标优化算法对目标函数进行优化，计算出最优的转向避碰角和转向时机，满足不同会遇局面下船舶转向避碰的安全性和经济型要求，大幅度降低了误检率，保证了正确率，为船舶航行、航道监控等提供信息支持，减少船舶航行中的安全隐患。
36.在上述实施方式的描述中，具体特征、结构、材料或者特点可以在任何的一个或多
个实施例或示例中以合适的方式结合。
37.以上仅为本发明的具体实施方式，但本发明的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本发明揭露的技术范围内，可轻易想到的变化或替换，都应涵盖在本发明的保护范围之内。因此，本发明的保护范围应以权利要求的保护范围为准。