基于事件触发和混杂逻辑动态模型的船舶轨迹的跟踪方法技术

本发明专利技术公开了一种基于事件触发和混杂逻辑动态模型的船舶轨迹的跟踪方法，包括以下步骤：对舵角进行档位划分，并结合船舶MMG模型，构建不同舵角档位下的船舶螺旋桨转速与船舶运动的动力学模型；构建事件夹角的定义，定义事件夹角为船舶速度方向与目标轨迹点方向的夹角，并设置夹角阈值作为事件触发机制；根据船舶MMG模型，船舶螺旋桨转速与船舶运动的动力学模型与事件触发机制，构建混杂逻辑动态模型；以混杂逻辑动态模型作为预测模型，对船舶轨迹跟踪控制。本发明专利技术可在保证轨迹控制精度前提下，减小船舶控制不必要资源损耗并提高控制实时性。实时性。实时性。

【技术实现步骤摘要】
基于事件触发和混杂逻辑动态模型的船舶轨迹的跟踪方法


[0001]本专利技术属于船舶航行控制
，具体涉及一种基于事件触发和混杂逻辑动态模型的船舶轨迹的跟踪方法。

技术介绍

[0002]随着船舶智能化不断提升，船舶运动控制研究逐渐成为热点，船舶轨迹跟踪控制作为一种重要的船舶运动控制方式，也受到了广泛关注，随着水上任务的多样化和复杂化的发展，对于船舶轨迹跟踪控制的要求也越来越高。
[0003]目前针对船舶轨迹跟踪控制研究提出了PID控制、模型预测控制、自适应控制、滑模控制等控制方法，为消除外界干扰的影响，控制器通常需要频繁操纵螺旋桨和舵机以保证对目标轨迹的稳定跟踪，但在实际的航行驾驶中，通常会避免频繁的操纵以减少不必要的能耗以及机械磨损，且在轨迹控制过程中螺旋桨与舵存在耦合作用，同时连续变化会增加轨迹控制的难度并降低控制的实时性。
[0004]目前针对船舶轨迹跟踪控制领域提出了许多方法且研究开展大多是在开放水域进行，在开放水域中，洋流、海浪和风等干扰及航速与装载的变化都会对船舶航行轨迹产生一定的影响，这就意味着船舶驾驶员需要频繁操纵螺旋桨和舵且它们之间存在较为复杂的关系，因此目前的研究大多以力和力矩为控制输入，而不考虑螺旋桨的控制过程，但是螺旋桨转速控制系统是一个由离散系统和连续系统组合构成的混杂统，这导致忽略了实际航行中螺旋桨速度控制过程的大惯性。因此在现有的设计方法中主要存在以下两点缺点：控制系统内模型关系复杂，给实时计算带来困难，模型的求解也变得困难。在控制系统存在模型不确定和外界海洋环境干扰下，控制器执行机构需要进行频繁动作，这将会减少执行机构的使用寿命。

技术实现思路

[0005]本专利技术的目的在于，提供一种基于事件触发和混杂逻辑动态模型的船舶轨迹的跟踪方法，可在保证轨迹控制精度前提下，减小船舶控制不必要资源损耗并提高控制实时性。
[0006]为解决上述技术问题，本专利技术的技术方案为：基于事件触发和混杂逻辑动态模型的船舶轨迹的跟踪方法，包括以下步骤：
[0007]S1、对舵角进行档位划分，并结合船舶MMG模型，构建不同舵角档位下的船舶螺旋桨转速与船舶运动的动力学模型；
[0008]S2、构建事件夹角的定义，并设置夹角阈值作为事件触发机制；事件夹角为船舶速度方向与目标轨迹点方向的夹角；
[0009]S3、根据船舶MMG模型，船舶螺旋桨转速与船舶运动的动力学模型与事件夹角及其事件触发机制，构建混杂逻辑动态模型；
[0010]S4、以混杂逻辑动态模型作为预测模型，对船舶轨迹跟踪控制。
[0011]S1中舵角的档位划分具体为：
[0012]根据实际航行需要，设置舵角档位g，其中g∈{1，2，3，4}，利用逻辑变量进行编码后档位g表示为：
[0013]g(k)＝1+ξ1(k)+2ξ2(k)
[0014]其中ξ1(k),ξ2(k)为逻辑变量且ξ1(k)，ξ2(k)∈{0，1}，每个档位对应固定舵角值。
[0015]S1中船舶螺旋桨转速与船舶运动的动力学模型的构建方法为：以船舶MMG模型为基础，结合划分的舵角档位，以不同档位舵角值作为模型参数，将船舶MMG模型转化为以螺旋桨转速为单输入，以船舶轨迹和姿态为输出，得到船舶螺旋桨转速与船舶运动的动力学模型表示为：
[0016][0017]其中，u、v、r分别表示船舶的纵向速度、横向速度及艏向角速度,ψ、分别表示船首向与侧倾角，x、y分别表示船舶的横向位置和纵向位置，δ、n分别表示舵角与船舶螺旋桨转速；U、L分别表示船舶合速度与船长；X、Y、K、N表示所受各种合外力及力矩：X表示船体在横向方向的运动力，包括紊流阻力、风阻力与摩擦阻力等多个因素；Y表示船体在纵向方向的运动力，包括浮力、重力、推进力等多个因素；K表示船体在转向方向的运动力矩，包括侧推器、舵面、螺旋桨等各种舵力因素；N表示船体在侧倾方向的运动力矩，包括侧推器、舵面、螺旋桨、地球引力等因素；detM＝m
22
·
m
33
·
m
44
‑
m
32
·
m
44
‑
m
42
·
m
33
，m
11
＝(m+m
x
)，m
22
＝(m+m
y
)，m
32
＝
‑
m
y
·
I
y
，m
42
＝m
y
·
α
y
，m
33
＝(I
x
+J
x
)，m
44
＝(I
z
+J
z
)；
[0018]m
11
、m
22
、m
33
、m
44
、m
32
、m
42
，这些系数表示刚体在三维空间中的质量和惯性矩：m
11
表示刚体自身质量和x轴上附加质量的总和；m
22
表示刚体自身质量和y轴上附加质量的总和；m
33
表示刚体绕x轴的惯性矩，表示刚体绕该轴旋转运动阻力的量度；m
44
表示刚体绕z轴的惯性矩，它是刚体绕该轴旋转运动的阻力的量度，包括自身绕该轴的惯性矩以及在z轴上的额外惯性矩；m
32
为在y轴上的附加质量与该质量沿y轴距质心距离的乘积；m
42
表示在y轴上的附加质量与该质量沿z轴到质心的距离的乘积。
[0019]S2中事件触发机制具体为：设置夹角阈值为10
°
，当时间t∈[t
k
，t
k+1
)时，事件触发机制算法表示为：
[0020]τ(t
k
)＝(CB)
‑1{
‑
CF(γ(t
k
)，η
q
(t
k
))}
[0021]其中，C为触发条件的权重矩阵，γ(t
k
)为触发时刻的角度误差值，t
k
为事件触发时刻，为期望轨迹，当|γ(t
k
)|＞10时，达到触发条件。
[0022]S3中混杂逻辑动态模型具体为：
[0023]x(m+1)＝Ax(m)+B1u(m)+B2δ(m)+B3z(m)
[0024]y(m)＝Cx(m)+D1u(m)+D2δ(m)+D3z(m)
[0025]E2δ(m)+E3z(m)≤E4x(m)+E1u(m)+E5[0026]其中，A、B、C、D均为矩阵参数，A为状态转移矩阵，描述系统状态随时间演化情况，B1、B2、B3均为输入转移矩阵，C为输出转移矩阵，描述状态映射到输出的状况，D1、D2、D3分别表本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.基于事件触发和混杂逻辑动态模型的船舶轨迹的跟踪方法，其特征在于，包括以下步骤：S1、对舵角进行档位划分，并结合船舶MMG模型，构建不同舵角档位下的船舶螺旋桨转速与船舶运动的动力学模型；S2、构建事件夹角的定义，并设置夹角阈值作为事件触发机制；事件夹角为船舶速度方向与目标轨迹点方向的夹角；S3、根据船舶MMG模型，船舶螺旋桨转速与船舶运动的动力学模型与事件夹角及其事件触发机制，构建混杂逻辑动态模型；S4、以混杂逻辑动态模型作为预测模型，对船舶轨迹跟踪控制。2.根据权利要求1所述的基于事件触发和混杂逻辑动态模型的船舶轨迹的跟踪方法，其特征在于，S1中舵角的档位划分具体为：根据实际航行需要，设置舵角档位g，其中g∈{1，2，3，4}，利用逻辑变量进行编码后档位g表示为：g(k)＝1+ξ1(k)+2ξ2(k)其中ξ1(k)，ξ2(k)为逻辑变量且ξ1(k)，ξ2(k)∈{0，1}，每个档位对应固定舵角值。3.根据权利要求1所述的基于事件触发和混杂逻辑动态模型的船舶轨迹的跟踪方法，其特征在于，S1中船舶螺旋桨转速与船舶运动的动力学模型的构建方法为：以船舶MMG模型为基础，结合划分的舵角档位，以不同档位舵角值作为模型参数，将船舶MMG模型转化为以螺旋桨转速为单输入，以船舶轨迹和姿态为输出，得到船舶螺旋桨转速与船舶运动的动力学模型表示为：其中，u、v、r分别表示船舶的纵向速度、横向速度及艏向角速度，ψ、分别表示船首向与侧倾角，x、y分别表示船舶的横向位置和纵向位置，δ、n分别表示舵角与船舶螺旋桨转速；U、L分别表示船舶合速度与船长；X、Y、K、N表示所受各种合外力及力矩，具体为：X表示船体在横向方向的运动力，包括紊流阻力、风阻力与摩擦阻力；Y表示船体在纵向方向的运动力，包括浮力、重力、推进力；K表示船体在转向方向的运动力矩，包括侧推器、舵面、螺旋桨受到的舵力；N表示船体在侧倾方向的运动力矩，包括侧推器、舵面、螺旋桨受到的舵力以及地球引力；detM＝m
22
·
m
33
·
m
44
‑
m
322
·
m
44
‑
m
422
，m
33
，m
11
＝(m+m
x
)，m
22
＝(m+m
y
)，m
32
＝
‑
m
y
·
I
y
，m
42
＝m
y
·
α
y
，m
33
＝(I
x
+J
x
)，m44＝(I
z
+J
z
)；m
11
、m
22
、m
33
、m
44
、m
32
、m
42
表示刚体在三维空间中的质量和惯性矩，具体为：m
11
表示刚体自身质量和x轴上附加质量的总和；m
22
表示刚体自身质量和y轴上附加质量的总和；m
33
表示刚体绕x轴的惯性矩，表示刚体绕该轴旋转运动阻力的量度；m
44
表示刚体绕z轴的惯性矩，其作为刚体绕该轴旋转运动的阻力的量度，包括自身绕该轴的
惯性矩以及在z轴上的额外惯性矩；m
32
为在y轴上的附加质量与该质量沿y轴距质心距离的乘积；...

【专利技术属性】
技术研发人员：柳晨光，李泰隆，吴文祥，初秀民，吴勇，王晨光，赖龙华，张康，
申请(专利权)人：武汉理工大学，
类型：发明
国别省市：