1.一种航海交通管制方法,其特征是包括如下几个步骤:
①通过海面雷达获得船舶的实时和历史位置信息,各船舶的位置信息为离散二维位置序列x'=[x1',x2',...,xn']和y'=[y1',y2',...,yn'],通过应用小波变换理论对原始离散二维位置序列x'=[x1',x2',...,xn']和y'=[y1',y2',...,yn']进行初步处理,从而获取船舶的去噪离散二维位置序列x=[x1,x2,...,xn]和y=[y1,y2,...,yn];
②在每一采样时刻,依据步骤①得到的船舶的实时和历史位置信息滚动推测未来时段内船舶的轨迹,其具体过程如下:
2.1)船舶轨迹数据预处理,依据所获取的船舶去噪离散二维位置序列x=[x1,x2,...,xn]和y=[y1,y2,...,yn],采用一阶差分方法对其进行处理获取新的船舶离散位置序列△x=[△x1,△x2,...,△xn-1]和△y=[△y1,△y2,...,△yn-1],其中△xi=xi+1-xi,△yi=yi+1-yi,i=1,2,...,n-1;
2.2)对船舶轨迹数据聚类,对处理后新的船舶离散二维位置序列△x和△y,通过设定聚类个数M',采用遗传聚类算法分别对其进行聚类;
2.3)在每一采样时刻对船舶轨迹数据利用隐马尔科夫模型进行参数训练,通过将处理后的船舶运行轨迹数据△x和△y视为隐马尔科夫过程的显观测值,通过设定隐状态数目N和参数更新时段τ',依据最近的T'个位置观测值并采用B-W算法滚动获取最新隐马尔科夫模型参数λ';
2.4)依据隐马尔科夫模型参数,采用Viterbi算法获取当前时刻观测值所对应的隐状态q;
2.5)在每一采样时刻,通过设定预测时域W,基于船舶当前时刻的隐状态q,获取未来时段船舶的位置预测值O;
③在每一采样时刻,基于船舶当前的运行状态和历史位置观察序列,获取海域风场变量的数值;
④在每一采样时刻,基于各船舶的运行状态和设定的船舶在海域内运行时需满足的安全规则集,当船舶间有可能出现违反安全规则的状况时,对其动态行为实施监控并为海上交通控制中心提供及时的告警信息;
⑤当告警信息出现时,在满足船舶物理性能和海域交通规则的前提下,通过设定优化指标函数以及融入风场变量数值,采用自适应控制理论方法对船舶避撞轨迹进行滚动规划,并将规划结果传输给各船舶执行,其具体过程如下:
5.1)设定船舶避撞轨迹规划的终止参考点位置P、避撞策略控制时域Θ、轨迹预测时域W;
5.2)设定在给定优化指标函数的前提下,基于合作式避撞轨迹规划思想,通过给各个船舶赋予不同的权重以及融入实时风场变量滤波数值,得到各个船舶的避撞轨迹和避撞控制策略并将规划结果传输给各船舶执行,且各船舶在滚动规划间隔内仅实施其第一个优化控制策略;
5.3)在下一采样时刻,重复步骤5.2)直至各船舶均到达其解脱终点。
航海交通管制方法
技术领域
[0001] 本发明涉及一种海域交通管制方法,尤其涉及一种基于滚动规划策略的海域交通管制方法。
背景技术
[0002] 随着全球航运业的快速发展,部分繁忙海域内的交通愈加拥挤。在船舶交通流密集复杂海域,针对船舶间的冲突情形仍然采用航行计划结合人工间隔调配的管制方式已不能适应航运业的快速发展。为保证船舶间的安全间隔,实施有效的冲突调配就成为海域交通管制工作的重点。船舶冲突解脱是航海领域中的一项关键技术,安全高效的解脱方案对于增加海域船舶流量以及确保海运安全具有重大意义。
[0003] 为了提高船舶的航行效率,船用雷达自动标绘仪目前已经被广泛应用到船舶监控和避碰中,该设备通过提取船舶相关信息为船舶间冲突情形的判定提供参考依据。尽管此类设备极大降低了人工监控的负荷,但它并不具备船舶自动冲突解脱功能。针对船舶冲突解脱问题,目前的处理方式主要包括几何式确定性算法和启发式智能算法两大类方案,相关文献研究主要集中在无约束条件下两船舶间的冲突避让规划算法并且多以“离线形式”为存在冲突的船舶规划解脱轨迹,由此造成各个船舶解脱轨迹的动态适应性和鲁棒性较差。此外,在船舶实际航行中,受气象条件、导航设备以及驾驶员操作等各种因素的影响,它的运行状态往往不完全属于某一特定的运动状态,在船舶轨迹预测过程中需要考虑各种随机因素的影响,通过获取各类随机因素的最新特性对其未来轨迹实施滚动预测并增强其轨迹预测的鲁棒性。
发明内容
[0004] 本发明要解决的技术问题是提供一种鲁棒性较好的航海交通管制方法,该方法的船舶轨迹预测精度较高且可有效防止船舶运行冲突。
[0005] 实现本发明目的的技术方案是提供一种航海交通管制方法,包括如下几个步骤:
[0006] ①通过海面雷达获得船舶的实时和历史位置信息,各船舶的位置信息为离散二维位置序列x'=[x1',x2',...,xn']和y'=[y1',y2',...,yn'],通过应用小波变换理论对原始离散二维位置序列x'=[x1',x2',...,xn']和y'=[y1',y2',...,yn']进行初步处理,从而获取船舶的去噪离散二维位置序列x=[x1,x2,...,xn]和y=[y1,y2,...,yn];
[0007] ②在每一采样时刻,依据步骤①得到的船舶的实时和历史位置信息滚动推测未来时段内船舶的轨迹,其具体过程如下:
[0008] 2.1)船舶轨迹数据预处理,依据所获取的船舶去噪离散二维位置序列x=[x1,x2,...,xn]和y=[y1,y2,...,yn],采用一阶差分方法对其进行处理获取新的船舶离散位置序列Δx=[Δx1,Δx2,...,Δxn-1]和Δy=[Δy1,Δy2,...,Δyn-1],其中Δxi=xi+1-xi,Δyi=yi+1-yi(i=1,2,...,n-1);
[0009] 2.2)对船舶轨迹数据聚类,对处理后新的船舶离散二维位置序列△x和△y,通过设定聚类个数M',采用遗传聚类算法分别对其进行聚类;
[0010] 2.3)在每一采样时刻对船舶轨迹数据利用隐马尔科夫模型进行参数训练,通过将处理后的船舶运行轨迹数据△x和△y视为隐马尔科夫过程的显观测值,通过设定隐状态数目N和参数更新时段τ',依据最近的T'个位置观测值并采用B-W算法滚动获取最新隐马尔科夫模型参数λ';
[0011] 2.4)依据隐马尔科夫模型参数,采用Viterbi算法获取当前时刻观测值所对应的隐状态q;
[0012] 2.5)在每一采样时刻,通过设定预测时域W,基于船舶当前时刻的隐状态q,获取未来时段船舶的位置预测值O;
[0013] ③在每一采样时刻,基于船舶当前的运行状态和历史位置观察序列,获取海域风场变量的数值;
[0014] ④在每一采样时刻,基于各船舶的运行状态和设定的船舶在海域内运行时需满足的安全规则集,当船舶间有可能出现违反安全规则的状况时,对其动态行为实施监控并为海上交通控制中心提供及时的告警信息;
[0015] ⑤当告警信息出现时,在满足船舶物理性能和海域交通规则的前提下,通过设定优化指标函数以及融入风场变量数值,采用自适应控制理论方法对船舶避撞轨迹进行滚动规划,并将规划结果传输给各船舶执行,其具体过程如下:
[0016] 5.1)设定船舶避撞轨迹规划的终止参考点位置P、避撞策略控制时域Θ、轨迹预测时域W;
[0017] 5.2)设定在给定优化指标函数的前提下,基于合作式避撞轨迹规划思想,通过给各个船舶赋予不同的权重以及融入实时风场变量滤波数值,得到各个船舶的避撞轨迹和避撞控制策略并将规划结果传输给各船舶执行,且各船舶在滚动规划间隔内仅实施其第一个优化控制策略;
[0018] 5.3)在下一采样时刻,重复步骤5.2)直至各船舶均到达其解脱终点。
[0019] 进一步的,所述步骤①中,通过应用小波变换理论对原始离散二维位置序列x'=[x1',x2',...,xn']和y'=[y1',y2',...,yn']进行初步处理,从而获取船舶的去噪离散二维位置序列x=[x1,x2,...,xn]和y=[y1,y2,...,yn]:对于给定的原始二维序列数据x'=[x1',x2',...,xn'],利用如下形式的线性表达式分别对其进行近似:
[0020] 其中:
[0021] f'(x')表示对数据平滑处理后得到的函数表达式,ψ(x')表示母波,δ、J和K均为小波变换常数,ψJ,K(x')表示母波的转换形式,cJ,K表示由小波变换过程得到的函数系数,它体现了子波ψJ,K(x')对整个函数近似的权重大小,若此系数很小,那么它意味着子波ψJ,K(x')的权重也较小,因而可以在不影响函数主要特性的前提下,从函数近似过程中将子波ψJ,K(x')除去;在实际数据处理过程中,通过设定阈值χ来实施“阈值转换”,当cJ,K<χ时,设定cJ,K=0;阈值函数的选取采用如下两种方式:
[0022]
[0023] 对于y'=[y1',y2',...,yn'],也采用上述方法进行去噪处理。
[0024] 进一步的,所述步骤②中,步骤2.3)中确定航迹隐马尔科夫模型参数λ'=(π,A,B)的过程如下:
[0025] 2.3.1)变量赋初值:应用均匀分布给变量πi,aij和bj(ok)赋初值 和 并使其满足约束条件: 和 由此得
到λ0=(π0,A0,B0),其中ok表示某一显观测值,π0、A0和B0分别是由元素 和 构成的矩阵,令参数l=0,o=(ot-T'+1,...,ot-1,ot)为当前时刻t之前的T'个历史位置观测值;
[0026] 2.3.2)执行E-M算法:
[0027] 2.3.2.1)E-步骤:由λl计算ξe(i,j)和γe(si);
[0028] 变量 那么
[0029] 其中s表示某一隐状态;
[0030] 2.3.2.2)M-步骤:运用 分别
估计πi,aij和bj(ok)并由此得到λl+1;
[0031] 2.3.2.3)循环:l=l+1,重复执行E-步骤和M-步骤,直至πi、aij和bj(ok)收敛,即[0032] |P(o|λl+1)-P(o|λl)|<ε,其中参数ε=0.00001,返回步骤2.3.2.4);
[0033] 2.3.2.4):令λ'=λl+1,算法结束。
[0034] 更进一步的,所述步骤②中,步骤2.4)确定船舶航迹最佳隐状态序列的迭代过程如下:
[0035] 2.4.1)变量赋初值:令g=2,βT’(si)=1(si∈S),δ1(si)=πibi(o1),ψ1(si)=0,其中,
[0036]
[0037] ,其中变量ψg(sj)表示使变量δg-1(si)aij取最大值的船舶航迹隐状态si,参数S表示隐状态的集合;
[0038] 2.4.2)递推过程:
[0039] 2.4.3)时刻更新:令g=g+1,若g≤T',返回步骤2.4.2),否则迭代终止并转到步骤
2.4.4);
[0040] 2.4.4) 转到步骤2.4.5);
[0041] 2.4.5)最优隐状态序列获取:
[0042] 2.4.5.1)变量赋初值:令g=T'-1;
[0043] 2.4.5.2)后向递推:
[0044] 2.4.5.3)时刻更新:令g=g-1,若g≥1,返回步骤2.4.5.2),否则终止。
[0045] 进一步的,所述步骤②中,聚类个数M'的值为4,隐状态数目N的值为3,参数更新时段τ'为30秒,T'为10,预测时域W为300秒。
[0046] 进一步的,所述步骤③获取海域风场变量的数值的具体过程如下:
[0047] 3.1)设定船舶的停靠位置为轨迹参考坐标原点并在水平面上建立横坐标轴和纵坐标轴;
[0048] 3.2)在船舶处于直线运行状态和匀速转弯运行状态时,构建海域风场线性滤波模型x1(t+Δt)=F(t)x1(t)+w(t)和z(t)=H(t)x1(t)+v(t)获取风场变量数值,其中Δt表示采样间隔,x1(t)表示t时刻的状态向量,z(t)表示t时刻的观测向量,且x1(t)=[x(t),y(t),vx(t),vy(t),wx(t),wy(t)]T,其中x(t)和y(t)分别表示t时刻船舶位置在横坐标轴和纵坐标轴上的分量,vx(t)和vy(t)分别表示t时刻船舶速度在横坐标轴和纵坐标轴上的分量,wx(t)和wy(t)分别表示t时刻风场数值在横坐标轴和纵坐标轴上的分量,F(t)和H(t)分别表示状态转移矩阵和输出测量矩阵,w(t)和v(t)分别表示系统噪声向量和测量噪声向量:
[0049]
[0050]
[0051] 在船舶处于变速转弯运行状态时,构建海域风场非线性滤波模型x1(t+Δt)=Ψ(t,x1(t),u(t))+w(t)、z(t)=Ω(t,x1(t))+v(t)和u(t)=[ωa(t),γa(t)]T,其中Ψ(·)和Ω(·)分别表示状态转移矩阵和输出测量矩阵,ωa(t)和γa(t)分别表示转弯率和加速率:
[0052]
[0053] 其中:Δt表示采样时间间隔,
[0054]
[0055]
[0056] 3.3)根据所构建的滤波模型获取风场变量的数值。
[0057] 进一步的,所述步骤④中对各船舶的动态行为实施监控并为海上交通控制中心提供及时的告警信息的具体过程如下:
[0058] 4.1)构造船舶在海域内运行时需满足的安全规则集Dmr(t)≥Dmin,其中Dmr(t)表示任意两个船舶m和船舶r在t时刻的距离,Dmin表示船舶间的最小安全距离;
[0059] 4.2)依据采样时间,建立由船舶连续运行状态至离散采样状态的观测器Λ:Γ→Ξ,其中Γ表示船舶的连续运行状态,Ξ表示船舶的离散采样状态;
[0060] 4.3)当船舶m和r的观测器Λm和Λr的离散观测数值Ξm和Ξr在t时刻表明该向量不在安全规则集中时,即关系式Dmr(t)≥Dmin不成立时,立刻向海上交通控制中心发出告警信息。
[0061] 进一步的,步骤⑤中,步骤5.2)的具体过程是:令
[0062] 其中 表示t时刻船舶R当前所在位置和下一航道点间的距离的平方,PR(t)=(xRt,yRt), 那么t时刻船舶R的优先级指数可设定为:
[0063]
[0064] 其中Zt表示t时刻海域内存在冲突的船舶数目,由优先级指数的含义可知,船舶距离其下一航道点越近,其优先级越高;
[0065] 设定优化指标
[0066]
[0067] ,其中R∈I(t)表示船舶代码且I(t)={1,2,...,Zt}PR(t+hΔt)表示船舶在时刻(t+hΔt)的位置向量, 表示船舶R的解脱终止点,uR表示待优化的船舶R的最优控制序列,QRt为正定对角矩阵,其对角元素为船舶R在t时刻的优先级指数LRt,并且
[0068] 进一步的,所述步骤⑤中终止参考点位置P设定为船舶运行的下一个航道点,避撞策略控制时域Θ为300秒;轨迹预测时域W为300秒。
[0069] 本发明具有积极的效果:(1)本发明在船舶轨迹实时预测的过程中,融入了随机因素的影响,所采用的滚动轨迹预测方案能够及时提取外界随机因素的变化状况,提高了船舶轨迹预测的准确性。
[0070] (2)本发明在船舶冲突解脱过程中,融入了海域内风场的影响,所采用的滚动解脱轨迹规划方案能够根据海域内风场的变化及时调整解脱轨迹,提高了船舶冲突解脱的鲁棒性。
[0071] (3)本发明基于不同性能指标,可以为存在冲突的多个船舶提供解脱轨迹规划方案,提高船舶运行的经济性和海域资源的利用率。
附图说明
[0072] 图1为本发明中的船舶运行短期轨迹生成流程示意图;
[0073] 图2为本发明中的风场滤波方法流程示意图;
[0074] 图3为本发明中的船舶运行态势监控流程示意图;
[0075] 图4为本发明中的船舶避撞轨迹优化方法流程示意图。
具体实施方式
[0076] (实施例1)
[0077] 本实施例的航海交通管制方法包括如下几个步骤:
[0078] ①通过海面雷达获得船舶的实时和历史位置信息,各船舶的位置信息为离散二维位置序列x'=[x1',x2',...,xn']和y'=[y1',y2',...,yn'],通过应用小波变换理论对原始离散二维位置序列x'=[x1',x2',...,xn']和y'=[y1',y2',...,yn']进行初步处理,从而获取船舶的去噪离散二维位置序列x=[x1,x2,...,xn]和y=[y1,y2,...,yn]:对于给定的原始二维序列数据x'=[x1',x2',...,xn'],利用如下形式的线性表达式分别对其进行近似:
[0079]
[0080] 其中:
[0081] f'(x')表示对数据平滑处理后得到的函数表达式,ψ(x')表示母波,δ、J和K均为小波变换常数,ψJ,K(x')表示母波的转换形式,cJ,K表示由小波变换过程得到的函数系数,它体现了子波ψJ,K(x')对整个函数近似的权重大小,若此系数很小,那么它意味着子波ψJ,K(x')的权重也较小,因而可以在不影响函数主要特性的前提下,从函数近似过程中将子波ψJ,K(x')除去;在实际数据处理过程中,通过设定阈值χ来实施“阈值转换”,当cJ,K<χ时,设定cJ,K=0;阈值函数的选取采用如下两种方式:
[0082] 和
[0083] 对于y'=[y1',y2',...,yn'],也采用上述方法进行去噪处理。
[0084] ②在每一采样时刻,依据步骤①得到的船舶的实时和历史位置信息滚动推测未来时段内船舶的轨迹,见图1,其具体过程如下:
[0085] 2.1)船舶轨迹数据预处理,依据所获取的船舶去噪离散二维位置序列x=[x1,x2,...,xn]和y=[y1,y2,...,yn],采用一阶差分方法对其进行处理获取新的船舶离散位置序列Δx=[Δx1,Δx2,...,Δxn-1]和Δy=[Δy1,Δy2,...,Δyn-1],其中Δxi=xi+1-xi,Δyi=yi+1-yi(i=1,2,...,n-1);
[0086] 2.2)对船舶轨迹数据聚类,对处理后新的船舶离散二维位置序列△x和△y,通过设定聚类个数M',采用遗传聚类算法分别对其进行聚类;
[0087] 2.3)在每一采样时刻对船舶轨迹数据利用隐马尔科夫模型进行参数训练,通过将处理后的船舶运行轨迹数据△x和△y视为隐马尔科夫过程的显观测值,通过设定隐状态数目N和参数更新时段τ',依据最近的T'个位置观测值并采用B-W算法滚动获取最新隐马尔科夫模型参数λ';确定航迹隐马尔科夫模型参数λ'=(π,A,B)的过程如下:
[0088] 2.3.1)变量赋初值:应用均匀分布给变量πi,aij和bj(ok)赋初值 和 并使其满足约束条件: 和 由此得
到λ0=(π0,A0,B0),其中ok表示某一显观测值,π0、A0和B0分别是由元素 和 构成的矩阵,令参数l=0,o=(ot-T'+1,...,ot-1,ot)为当前时刻t之前的T'个历史位置观测值;
[0089] 2.3.2)执行E-M算法:
[0090] 2.3.2.1)E-步骤:由λl计算ξe(i,j)和γe(si);
[0091] 变量 那么
[0092] 其中s表示某一隐状态;
[0093] 2.3.2.2)M-步骤:运用 分别
估计πi,aij和bj(ok)并由此得到λl+1;
[0094] 2.3.2.3)循环:l=l+1,重复执行E-步骤和M-步骤,直至πi、aij和bj(ok)收敛,即[0095] |P(o|λl+1)-P(o|λl)|<ε,其中参数ε=0.00001,返回步骤2.3.2.4);
[0096] 2.3.2.4):令λ'=λl+1,算法结束。
[0097] 2.4)依据隐马尔科夫模型参数,采用Viterbi算法获取当前时刻观测值所对应的隐状态q;确定船舶航迹最佳隐状态序列的迭代过程如下:
[0098] 2.4.1)变量赋初值:令g=2,βT'(si)=1(si∈S),δ1(si)=πibi(o1),ψ1(si)=0,其中,
[0099]
[0100] ,其中变量ψg(sj)表示使变量δg-1(si)aij取最大值的船舶航迹隐状态si,参数S表示隐状态的集合;
[0101] 2.4.2)递推过程:
[0102] 2.4.3)时刻更新:令g=g+1,若g≤T',返回步骤2.4.2),否则迭代终止并转到步骤
2.4.4);
[0103] 2.4.4) 转到步骤2.4.5);
[0104] 2.4.5)最优隐状态序列获取:
[0105] 2.4.5.1)变量赋初值:令g=T'-1;
[0106] 2.4.5.2)后向递推:
[0107] 2.4.5.3)时刻更新:令g=g-1,若g≥1,返回步骤2.4.5.2),否则终止。
[0108] 2.5)在每一采样时刻,通过设定预测时域W,基于船舶当前时刻的隐状态q,获取未来时段船舶的位置预测值O。
[0109] 上述聚类个数M'的值为4,隐状态数目N的值为3,参数更新时段τ'为30秒,T'为10,预测时域W为300秒。
[0110] ③在每一采样时刻,基于船舶当前的运行状态和历史位置观察序列,获取海域风场变量的数值,见图2,其具体过程如下:
[0111] 3.1)设定船舶的停靠位置为轨迹参考坐标原点并在水平面上建立横坐标轴和纵坐标轴;
[0112] 3.2)在船舶处于直线运行状态和匀速转弯运行状态时,构建海域风场线性滤波模型x1(t+Δt)=F(t)x1(t)+w(t)和z(t)=H(t)x1(t)+v(t)获取风场变量数值,其中Δt表示采样间隔,x1(t)表示t时刻的状态向量,z(t)表示t时刻的观测向量,且x1(t)=[x(t),y(t),vx(t),vy(t),wx(t),wy(t)]T,其中x(t)和y(t)分别表示t时刻船舶位置在横坐标轴和纵坐标轴上的分量,vx(t)和vy(t)分别表示t时刻船舶速度在横坐标轴和纵坐标轴上的分量,wx(t)和wy(t)分别表示t时刻风场数值在横坐标轴和纵坐标轴上的分量,F(t)和H(t)分别表示状态转移矩阵和输出测量矩阵,w(t)和v(t)分别表示系统噪声向量和测量噪声向量:
[0113]
[0114]
[0115] 在船舶处于变速转弯运行状态时,构建海域风场非线性滤波模型x1(t+Δt)=Ψ(t,x1(t),u(t))+w(t)、z(t)=Ω(t,x1(t))+v(t)和u(t)=[ωa(t),γa(t)]T,其中Ψ(·)和Ω(·)分别表示状态转移矩阵和输出测量矩阵,ωa(t)和γa(t)分别表示转弯率和加速率:
[0116]
[0117] 其中:Δt表示采样时间间隔,
[0118]
[0119]
[0120] 3.3)根据所构建的滤波模型获取风场变量的数值。
[0121] ④在每一采样时刻,基于各船舶的运行状态和设定的船舶在海域内运行时需满足的安全规则集,当船舶间有可能出现违反安全规则的状况时,对其动态行为实施监控并为海上交通控制中心提供及时的告警信息,见图3,其具体过程如下:
[0122] 4.1)构造船舶在海域内运行时需满足的安全规则集Dmr(t)≥Dmin,其中Dmr(t)表示任意两个船舶m和船舶r在t时刻的距离,Dmin表示船舶间的最小安全距离;
[0123] 4.2)依据采样时间,建立由船舶连续运行状态至离散采样状态的观测器Λ:Γ→Ξ,其中Γ表示船舶的连续运行状态,Ξ表示船舶的离散采样状态;
[0124] 4.3)当船舶m和r的观测器Λm和Λr的离散观测数值Ξm和Ξr在t时刻表明该向量不在安全规则集中时,即关系式Dmr(t)≥Dmin不成立时,立刻向海上交通控制中心发出告警信息。
[0125] ⑤当告警信息出现时,在满足船舶物理性能和海域交通规则的前提下,通过设定优化指标函数以及融入风场变量数值,采用自适应控制理论方法对船舶避撞轨迹进行滚动规划,并将规划结果传输给各船舶执行,见图4,其具体过程如下:
[0126] 5.1)设定船舶避撞轨迹规划的终止参考点位置P、避撞策略控制时域Θ、轨迹预测时域W;
[0127] 5.2)设定在给定优化指标函数的前提下,基于合作式避撞轨迹规划思想,通过给各个船舶赋予不同的权重以及融入实时风场变量滤波数值,得到各个船舶的避撞轨迹和避撞控制策略并将规划结果传输给各船舶执行,且各船舶在滚动规划间隔内仅实施其第一个优化控制策略:令
[0128] 其中 表示t时刻船舶R当前所在位置和下一航道点间的距离的平方,PR(t)=(xRt,yRt), 那么t时刻船舶R的优先级指数可设定为:
[0129]
[0130] 其中Zt表示t时刻海域内存在冲突的船舶数目,由优先级指数的含义可知,船舶距离其下一航道点越近,其优先级越高;
[0131] 设定优化指标
[0132]
[0133] ,其中R∈I(t)表示船舶代码且I(t)={1,2,...,Zt},PR(t+hΔt)表示船舶在时刻(t+hΔt)的位置向量, 表示船舶R的解脱终止点,uR表示待优化的船舶R的最优控制序列,QRt为正定对角矩阵,其对角元素为船舶R在t时刻的优先级指数LRt,并且
[0134] 5.3)在下一采样时刻,重复步骤5.2)直至各船舶均到达其解脱终点。
[0135] 上述终止参考点位置P设定为船舶运行的下一个航道点,避撞策略控制时域Θ为
300秒;轨迹预测时域W为300秒。
[0136] 显然,上述实施例仅仅是为清楚地说明本发明所作的举例,而并非是对本发明的实施方式的限定。对于所属领域的普通技术人员来说,在上述说明的基础上还可以做出其它不同形式的变化或变动。这里无需也无法对所有的实施方式予以穷举。而这些属于本发明的精神所引伸出的显而易见的变化或变动仍处于本发明的保护范围之中。