CN106228850A - 基于滚动规划策略的船舶轨迹实时预测方法 - Google Patents

Abstract

本发明涉及一种基于滚动规划策略的船舶轨迹实时预测方法，包括如下几个步骤，首先通过海面雷达获得船舶的实时和历史位置信息并做初步处理；然后在每一采样时刻对船舶轨迹数据预处理，然后在每一采样时刻对船舶轨迹数据聚类，再而在每一采样时刻对船舶轨迹数据利用隐马尔科夫模型进行参数训练，然后在每一采样时刻依据隐马尔科夫模型参数，采用Viterbi算法获取当前时刻观测值所对应的隐状态q，最后在每一采样时刻通过设定预测时域W，基于船舶当前时刻的隐状态q，获取未来时段船舶的位置预测值O，从而在每一采样时刻滚动推测到未来时段内船舶的轨迹。本发明滚动实时对船舶轨迹进行预测，准确性较好，从而为后续船舶冲突解脱提供有力保障。

Description

基于滚动规划策略的船舶轨迹实时预测方法

本申请是申请号为：2014108415648，发明创造名称为《一种船舶轨迹实时预测方 法》，申请日为：2014年12月30日的发明专利申请的分案申请。

技术领域

本发明涉及一种海域交通管制方法，尤其涉及一种基于滚动规划策略的船舶轨迹实时预测方法。

背景技术

随着全球航运业的快速发展，部分繁忙海域内的交通愈加拥挤。在船舶交通流密集复杂海域，针对船舶间的冲突情形仍然采用航行计划结合人工间隔调配的管制方式已不能适应航运业的快速发展。为保证船舶间的安全间隔，实施有效的冲突调配就成为海域交通管制工作的重点。船舶冲突解脱是航海领域中的一项关键技术，安全高效的解脱方案对于增加海域船舶流量以及确保海运安全具有重大意义。

为了提高船舶的航行效率，船用雷达自动标绘仪目前已经被广泛应用到船舶监控和避碰中，该设备通过提取船舶相关信息为船舶间冲突情形的判定提供参考依据。尽管此类设备极大降低了人工监控的负荷，但它并不具备船舶自动冲突解脱功能。而船舶冲突解脱是基于对船舶轨迹的预测的基础上，在船舶实际航行中，受气象条件、导航设备以及驾驶员操作等各种因素的影响，它的运行状态往往不完全属于某一特定的运动状态，在船舶轨迹预测过程中需要考虑各种随机因素的影响，通过获取各类随机因素的最新特性对其未来轨迹实施滚动预测并增强其轨迹预测的鲁棒性。

发明内容

本发明要解决的技术问题是提供一种鲁棒性较好的基于滚动规划策略的船舶轨迹实时预测方法，该方法的船舶轨迹预测精度较高。

实现本发明目的的技术方案是提供一种基于滚动规划策略的船舶轨迹实时预测方法，包括如下几个步骤：

①通过海面雷达获得船舶的实时和历史位置信息，各船舶的位置信息为离散二维位置序列x'＝[x₁',x₂',...,x_n']和y'＝[y₁',y₂',...,y_n']，通过应用小波变换理论对原始离散二维位置序列x'＝[x₁',x₂',...,x_n']和y'＝[y₁',y₂',...,y_n']进行初步处理，从而获取船舶的去噪离散二维位置序列x＝[x₁,x₂,...,x_n]和y＝[y₁,y₂,...,y_n]；

②在每一采样时刻对船舶轨迹数据预处理，依据所获取的船舶原始离散二维位置序列x＝[x₁,x₂,...,x_n]和y＝[y₁,y₂,...,y_n]，采用一阶差分方法对其进行处理获取新的船舶离散位置序列Δx＝[Δx₁,Δx₂,...,Δx_n-1]和Δy＝[Δy₁,Δy₂,...,Δy_n-1]，其中Δx_i＝x_i+1-x_i,Δy_i＝y_i+1-y_i(i＝1,2,...,n-1)；

③在每一采样时刻对船舶轨迹数据聚类，对处理后新的船舶离散二维位置序列Δx和Δy，通过设定聚类个数M'，采用K-means聚类算法分别对其进行聚类；

④在每一采样时刻对船舶轨迹数据利用隐马尔科夫模型进行参数训练，通过将处理后的船舶运行轨迹数据Δx和Δy视为隐马尔科夫过程的显观测值，通过设定隐状态数目N和参数更新时段τ'，依据最近的T'个位置观测值并采用B-W算法滚动获取最新隐马尔科夫模型参数λ'；

⑤在每一采样时刻依据隐马尔科夫模型参数，采用Viterbi算法获取当前时刻观测值所对应的隐状态q；

⑥在每一采样时刻，通过设定预测时域W，基于船舶当前时刻的隐状态q，获取未来时段船舶的位置预测值O，从而在每一采样时刻滚动推测到未来时段内船舶的轨迹。

进一步的，所述步骤①中，通过应用小波变换理论对原始离散二维位置序列x'＝[x₁',x₂',...,x_n']和y'＝[y₁',y₂',...,y_n']进行初步处理，从而获取船舶的去噪离散二维位置序列x＝[x₁,x₂,...,x_n]和y＝[y₁,y₂,...,y_n]：对于给定的原始二维序列数据x'＝[x₁',x₂',...,x_n']，利用如下形式的线性表达式分别对其进行近似：

$\tilde{f}\left(x^{\′}\right)=\underset{\∀K}{\underset{\∀J}{\Σ}}{c}_{J,K}{\mathrm{\ψ}}_{J,K}\left(x^{\′}\right),$

其中：

f'(x')表示对数据平滑处理后得到的函数表达式，ψ(x')表示母波，δ、J和K均为小波变换常数，ψ_J,K(x')表示母波的转换形式，c_J,K表示由小波变换过程得到的函数系数，它体现了子波ψ_J,K(x')对整个函数近似的权重大小，若此系数很小，那么它意味着子波ψ_J,K(x')的权重也较小，因而可以在不影响函数主要特性的前提下，从函数近似过程中将子波ψ_J,K(x')除去；在实际数据处理过程中，通过设定阈值χ来实施“阈值转换”，当c_J,K<χ时，设定c_J,K＝0；阈值函数的选取采用如下两种方式：

和

对于y'＝[y₁',y₂',...,y_n']，也采用上述方法进行去噪处理。

进一步的，所述步骤④中确定航迹隐马尔科夫模型参数λ'＝(π,A,B)的过程如下：

4.1)变量赋初值：应用均匀分布给变量π_i，a_ij和b_j(o_k)赋初值和并使其满足约束条件：和由此得到λ₀＝(π₀,A₀,B₀)，其中o_k表示某一显观测值，π₀、A₀和B₀分别是由元素和构成的矩阵，令参数l＝0，o＝(o_t-T'+1,...,o_t-1,o_t)为当前时刻t之前的T'个历史位置观测值；

4.2)执行E-M算法：

4.2.1)E-步骤：由λ_l计算ξ_e(i,j)和γ_e(s_i)；

变量那么

其中s表示某一隐状态；

4.2.2)M-步骤：运用分别估计π_i，a_ij和b_j(o_k)并由此得到λ_l+1；

4.2.3)循环：l＝l+1，重复执行E-步骤和M-步骤，直至π_i、a_ij和b_j(o_k)收敛，即

|P(o|λ_l+1)-P(o|λ_l)|<ε，其中参数ε＝0.00001，返回步骤4.2.4)；

4.2.4)：令λ'＝λ_l+1，算法结束。

进一步的，所述步骤⑤中确定船舶航迹最佳隐状态序列的迭代过程如下：

5.1)变量赋初值：令g＝2，β_T'(s_i)＝1(s_i∈S)，δ₁(s_i)＝π_ib_i(o₁)，ψ₁(s_i)＝0，其中，

${\mathrm{\&delta;}}_g\left(s_i\right)=\underset{q_1,q_2,...,q_{g-1}}{max}P(q_1,q_2,...,q_{g-1},q_g=s_i,o_1,o_2,...,o_g|{\mathrm{\&lambda;}}^{\&prime;})$ ，

其中变量ψ_g(s_j)表示使变量δ_g-1(s_i)a_ij取最大值的船舶航迹隐状态s_i，参数S表示隐状态的集合；

5.2)递推过程：

5.3)时刻更新：令g＝g+1，若g≤T'，返回步骤5.2)，否则迭代终止并转到步骤5.4)；

5.4)转到步骤5.5)；

5.5)最优隐状态序列获取：

5.5.1)变量赋初值：令g＝T'-1；

5.5.2)后向递推：

5.5.3)时刻更新：令g＝g-1，若g≥1，返回步骤5.5.2)，否则终止。

进一步的，所述步骤③中，聚类个数M'的值为4。

进一步的，所述步骤④中，状态数目N的值为3，参数更新时段τ'为30秒，T'为10。

进一步的，所述步骤⑥中，预测时域W为300秒。

本发明具有积极的效果：(1)本发明在船舶轨迹实时预测的过程中，融入了随机因素的影响，所采用的滚动轨迹预测方案能够及时提取外界随机因素的变化状况，提高了船舶轨迹预测的准确性。

(2)本发明基于不同性能指标，其船舶轨迹实时预测结果可以为存在冲突的多个船舶提供解脱轨迹规划方案，提高船舶运行的经济性和海域资源的利用率。

附图说明

图1为本发明中的船舶运行短期轨迹生成流程示意图。

具体实施方式

(实施例1)

见图1，本实施例的一种基于滚动规划策略的船舶轨迹实时预测方法包括如下几个步骤：

①通过海面雷达获得船舶的实时和历史位置信息，各船舶的位置信息为离散二维位置序列x'＝[x₁',x₂',...,x_n']和y'＝[y₁',y₂',...,y_n']，通过应用小波变换理论对原始离散二维位置序列x'＝[x₁',x₂',...,x_n']和y'＝[y₁',y₂',...,y_n']进行初步处理，从而获取船舶的去噪离散二维位置序列x＝[x₁,x₂,...,x_n]和y＝[y₁,y₂,...,y_n]：y＝[y₁,y₂,...,y_n]：对于给定的原始二维序列数据x'＝[x₁',x₂',...,x_n']，利用如下形式的线性表达式分别对其进行近似：

其中：

f'(x')表示对数据平滑处理后得到的函数表达式，ψ(x')表示母波，δ、J和K均为小波变换常数，ψ_J,K(x')表示母波的转换形式，c_J,K表示由小波变换过程得到的函数系数，它体现了子波ψ_J,K(x')对整个函数近似的权重大小，若此系数很小，那么它意味着子波ψ_J,K(x')的权重也较小，因而可以在不影响函数主要特性的前提下，从函数近似过程中将子波ψ_J,K(x')除去；在实际数据处理过程中，通过设定阈值χ来实施“阈值转换”，当c_J,K<χ时，设定c_J,K＝0；阈值函数的选取采用如下两种方式：

和

对于y'＝[y₁',y₂',...,y_n']，也采用上述方法进行去噪处理；

②在每一采样时刻对船舶轨迹数据预处理，依据所获取的船舶原始离散二维位置序列x＝[x₁,x₂,...,x_n]和y＝[y₁,y₂,...,y_n]，采用一阶差分方法对其进行处理获取新的船舶离散位置序列Δx＝[Δx₁,Δx₂,...,Δx_n-1]和Δy＝[Δy₁,Δy₂,...,Δy_n-1]，其中Δx_i＝x_i+1-x_i,Δy_i＝y_i+1-y_i(i＝1,2,...,n-1)；

③在每一采样时刻对船舶轨迹数据聚类，对处理后新的船舶离散二维位置序列Δx和Δy，通过设定聚类个数M'，采用K-means聚类算法分别对其进行聚类；

④在每一采样时刻对船舶轨迹数据利用隐马尔科夫模型进行参数训练，通过将处理后的船舶运行轨迹数据Δx和Δy视为隐马尔科夫过程的显观测值，通过设定隐状态数目N和参数更新时段τ'，依据最近的T'个位置观测值并采用B-W算法滚动获取最新隐马尔科夫模型参数λ'；确定航迹隐马尔科夫模型参数λ'＝(π,A,B)的过程如下：

4.1)变量赋初值：应用均匀分布给变量π_i，a_ij和b_j(o_k)赋初值和并使其满足约束条件：和由此得到λ₀＝(π₀,A₀,B₀)，其中o_k表示某一显观测值，π₀、A₀和B₀分别是由元素和构成的矩阵，令参数l＝0，o＝(o_t-T'+1,...,o_t-1,o_t)为当前时刻t之前的T'个历史位置观测值；

4.2)执行E-M算法：

4.2.1)E-步骤：由λ_l计算ξ_e(i,j)和γ_e(s_i)；

变量那么

其中s表示某一隐状态；

4.2.2)M-步骤：运用分别估计π_i，a_ij和b_j(o_k)并由此得到λ_l+1；

4.2.3)循环：l＝l+1，重复执行E-步骤和M-步骤，直至π_i、a_ij和b_j(o_k)收敛，即

|P(o|λ_l+1)-P(o|λ_l)|<ε，其中参数ε＝0.00001，返回步骤4.2.4)；

4.2.4)：令λ'＝λ_l+1，算法结束。

⑤在每一采样时刻依据隐马尔科夫模型参数，采用Viterbi算法获取当前时刻观测值所对应的隐状态q：

5.1)变量赋初值：令g＝2，β_T'(s_i)＝1(s_i∈S)，δ₁(s_i)＝π_ib_i(o₁)，ψ₁(s_i)＝0，其中，

，

其中变量ψ_g(s_j)表示使变量δ_g-1(s_i)a_ij取最大值的船舶航迹隐状态s_i，参数S表示隐状态的集合；

5.2)递推过程：

5.3)时刻更新：令g＝g+1，若g≤T'，返回步骤5.2)，否则迭代终止并转到步骤5.4)；

5.4)转到步骤5.5)；

5.5)最优隐状态序列获取：

5.5.1)变量赋初值：令g＝T'-1；

5.5.2)后向递推：

5.5.3)时刻更新：令g＝g-1，若g≥1，返回步骤5.5.2)，否则终止。。

⑥在每一采样时刻，通过设定预测时域W，基于船舶当前时刻的隐状态q，获取未来时段船舶的位置预测值O。

上述聚类个数M'的值为4，，状态数目N的值为3，参数更新时段τ'为30秒，T'为10，预测时域W为300秒。

(应用例、航海交通管制方法)

本实施例的航海交通管制方法包括如下几个步骤：

步骤A、根据实施例1得到的基于滚动规划策略的船舶轨迹实时预测方法获得船舶在每一采样时刻推测到的未来时段内船舶的轨迹；

步骤B、在每一采样时刻，基于船舶当前的运行状态和历史位置观察序列，获取海域风场变量的数值，其具体过程如下：

B.1)设定船舶的停靠位置为轨迹参考坐标原点；

B.2)在船舶处于直线运行状态和匀速转弯运行状态时，构建海域风场线性滤波模型；

B.3)根据所构建的滤波模型获取风场变量的数值。

步骤C、在每一采样时刻，基于各船舶的运行状态和设定的船舶在海域内运行时需满足的安全规则集，当船舶间有可能出现违反安全规则的状况时，对其动态行为实施监控并为海上交通控制中心提供及时的告警信息；

步骤D、当告警信息出现时，在满足船舶物理性能和海域交通规则的前提下，通过设定优化指标函数以及融入风场变量数值，采用模型预测控制理论方法对船舶避撞轨迹进行滚动规划，并将规划结果传输给各船舶执行，其具体过程如下：

D.1)设定船舶避撞轨迹规划的终止参考点位置P、避撞策略控制时域Θ、轨迹预测时域

D.2)设定在给定优化指标函数的前提下，基于合作式避撞轨迹规划思想，通过给各个船舶赋予不同的权重以及融入实时风场变量滤波数值，得到各个船舶的避撞轨迹和避撞控制策略并将规划结果传输给各船舶执行，且各船舶在滚动规划间隔内仅实施其第一个优化控制策略；

D.3)在下一采样时刻，重复步骤5.2)直至各船舶均到达其解脱终点。

上述终止参考点位置P设定为船舶位置冲突点的下一个航道点，避撞策略控制时域Θ为300秒；轨迹预测时域为300秒。

显然，上述实施例仅仅是为清楚地说明本发明所作的举例，而并非是对本发明的实施方式的限定。对于所属领域的普通技术人员来说，在上述说明的基础上还可以做出其它不同形式的变化或变动。这里无需也无法对所有的实施方式予以穷举。而这些属于本发明的精神所引伸出的显而易见的变化或变动仍处于本发明的保护范围之中。

Claims (1)

1.一种基于滚动规划策略的船舶轨迹实时预测方法，其特征在于包括如下几个步骤：

①通过海面雷达获得船舶的实时和历史位置信息，各船舶的位置信息为离散二维位置序列x'＝[x₁',x₂',...,x_n']和y'＝[y₁',y₂',...,y_n']，通过应用小波变换理论对原始离散二维位置序列x'＝[x₁',x₂',...,x_n']和y'＝[y₁',y₂',...,y_n']进行初步处理，从而获取船舶的去噪离散二维位置序列x＝[x₁,x₂,...,x_n]和y＝[y₁,y₂,...,y_n]；

②在每一采样时刻对船舶轨迹数据预处理，依据所获取的船舶原始离散二维位置序列x＝[x₁,x₂,...,x_n]和y＝[y₁,y₂,...,y_n]，采用一阶差分方法对其进行处理获取新的船舶离散位置序列△x＝[△x₁,△x₂,...,△x_n-1]和△y＝[△y₁,△y₂,...,△y_n-1]，其中△x_i＝x_i+1-x_i,△y_i＝y_i+1-y_i，i＝1,2,...,n-1；

③在每一采样时刻对船舶轨迹数据聚类，对处理后新的船舶离散二维位置序列△x和△y，通过设定聚类个数M'，采用K-means聚类算法分别对其进行聚类；

④在每一采样时刻对船舶轨迹数据利用隐马尔科夫模型进行参数训练，通过将处理后的船舶运行轨迹数据△x和△y视为隐马尔科夫过程的显观测值，通过设定隐状态数目N和参数更新时段τ'，依据最近的T'个位置观测值并采用B-W算法滚动获取最新隐马尔科夫模型参数λ'；

⑤在每一采样时刻依据隐马尔科夫模型参数，采用Viterbi算法获取当前时刻观测值所对应的隐状态q；

⑥在每一采样时刻，通过设定预测时域W，基于船舶当前时刻的隐状态q，获取未来时段船舶的位置预测值O，从而在每一采样时刻滚动推测到未来时段内船舶的轨迹；

所述步骤⑤中确定船舶航迹最佳隐状态序列的迭代过程如下：

5.1)变量赋初值：令g＝2，β_T'(s_i)＝1(s_i∈S)，δ₁(s_i)＝π_ib_i(o₁)，ψ₁(s_i)＝0，其中，其中变量ψ_g(s_j)表示使变量δ_g-1(s_i)a_ij取最大值的船舶航迹隐状态s_i，参数S表示隐状态的集合；

5.2)递推过程：

5.3)时刻更新：令g＝g+1，若g≤T'，返回步骤5.2)，否则迭代终止并转到步骤5.4)；

5.4)转到步骤5.5)；

5.5)最优隐状态序列获取：

5.5.1)变量赋初值：令g＝T'-1；

5.5.2)后向递推：

5.5.3)时刻更新：令g＝g-1，若g≥1，返回步骤5.5.2)，否则终止。