摘要
针对海浪干扰下船舶控制系统存在的无效舵问题以及风、流干扰下观测器存在的静差问题,提出一种基于扩张状态卡尔曼原理的海浪滤波算法。该方法首先对船舶一阶Nomoto模型进行离散化,基于带遗忘因子的最小二乘法对模型中的参数进行辨识;以海浪二阶传递函数与一阶Nomoto模型建立用于海浪滤波的四阶状态方程,并以Nomoto模型中环境干扰与未建模动态组成的综合干扰项为扩张状态建立五阶状态方程,基于卡尔曼滤波算法设计海浪滤波器,在实现海浪滤波的同时消除干扰环境下状态观测静差问题。仿真结果表明,本文提出的海浪滤波算法能够有效的滤除船舶航向的高频信号并正确的估计出船舶的运动状态,显著减少了船舶航行时的无效舵问题。
To solve the problem of invalid rudder in ship control system under wave disturbance and static error of observer under wind and stream disturbance,a wave filtering algorithm based on extended state Kalman theory was proposed.Firstly,the 1-order Nomoto model of the ship was discretized,and the 4-order state equation for wave filtering was established.Then,the 5-order state equation was established based on the comprehensive disturbance term composed of environmental disturbance and unmodeled dynamic disturbance in Nomoto model,and the wave filter was designed based on kalman filter algorithm,to solve the wave filtering and observer's error.The simulation results showed that the wave filtering algorithm proposed in this paper can effectively filter the high frequency signal of the ship heading and correctly estimate th ship's motion state,and reduce the problem of invalid rudder significantly when the ship is sailing.
作者
周佳宇
韩俊庆
李伟
孟凡彬
ZHOU Jia-yu;HAN Jun-qing;LI Wei;MENG Fan-bin(Navy Military Representative Office in Jiujiang Area,Jiujiang 332007,China;Jiujiang Division,Tianjin Navigation Instruments Research Institute,Tianjin 300131,China)
出处
《舰船科学技术》
北大核心
2023年第7期62-65,共4页
Ship Science and Technology
