[发明专利]一种基于环境估计的实时环境最优艏向船舶动力定位控制方法

权利要求书

1.一种基于环境估计的实时环境最优艏向船舶动力定位控制方法，其特征在于：

(1)通过测量系统测量船舶的位置和艏向；

(2)利用卡尔曼滤波器滤除掉波浪的高频干扰和量测传感器在测量船舶位置和艏向过程中产生的测量噪声，将得到的船舶真实的位置和艏向信息发送给系统PID控制器；

(3)基于环境最优艏向动力定位控制器,用环境估计算法对外界环境干扰进行估计,并计算环境最优艏向；

(4)将计算得到的最优艏向发送给船舶PID控制器：

(5)控制器向推进器发送指令,将船舶移动到最优艏向位置。

2.根据权利要求1所述的一种基于环境估计的实时环境最优艏向船舶动力定位控制方法，其特征在于：步骤(3)中环境估计算法为：

τ^env(t)=β+K0Mν]]>

为环境作用估计，分别是环境干扰的合力对船舶的纵向作用力、横向作用力和艏摇力矩，K₀是整定对称常矩阵，β是中间辅助变量，M是系统惯性矩阵，ν是船舶运动速度向量，

β·=-K0β-K0(-D(ν)ν-μ+τ+K0Mν)]]>

环境作用的估计偏差：τ_env为实际环境干扰的合力，为估计环境干扰的合力，环境作用估计的微分为τ^·env=β·+K0Mν·=K0τ~env,τ~·env=τ·env-τ^·env=τ·env-K0τ~env.]]>