一种船舶动力定位卡尔曼滤波方法技术

本发明专利技术涉及动力定位控制领域，具体涉及一种船舶动力定位系统中的滤波方法。本发明专利技术包括如下步骤：（1）测量船舶的位置和加速度，并将数据转化到统一的坐标系下；（2）建立包含高频加速度的船舶模型；（3）建立可以对位置、速度、加速度进行估计的卡尔曼滤波器；（4）基于测量的船舶位置和加速度，利用卡尔曼滤波器滤掉高频干扰并得到船舶动力定位系统需要的低频船舶位置速度和加速度将数据发送给动力定位系统。该方法可以估计出船舶所需要的船舶低频位置速度和加速度这样通过对位置和加速度进行综合滤波估计可以获得更加精确的船舶位置、速度和加速度信息。

【技术实现步骤摘要】

本专利技术涉及动力定位控制领域，具体涉及一种船舶动力定位系统中的滤波方法。
技术介绍
滤波是船舶动力定位系统需要考虑的重要问题。船舶动力定位系统利用状态观测器或滤波器从含有噪声的位置和艏向测量值中重构低频运动部分，其功能在于确保推进器系统只对慢变干扰力进行抵抗，而将一阶波浪力引起的高频振荡运动排除在反馈控制回路之外，从而降低机械结构磨损。目前船舶动力定位系统的滤波方法都是认为船舶速度和加速度是不可测量的，如船舶非线性无源观测器、反步观测器。上述滤波方法可以对测量的船舶位置数据进行滤波并能分离出船舶所需要的低频位置，其中在对船舶速度的估计中，它们是通过对位置进行积分运算来获得不可测量的船舶速度。由于这些滤波方法只依靠单一的位置数据进行估计，因此在一定程度上限制了滤波器的性能，可见，如果可以利用船舶位置和其它测量数据共同对船舶速度进行估计，将会一定程度上提高滤波器的性能。随着深海资源的不断开发和发现，海上作业对船舶动力定位系统的定位精度要求越来越高，如果滤波器的滤波性能如果能够得到改善，将会在一定程度上提高动力定位系统的定位精度。目前惯性导航元件的精确性得到了不断的提高，船舶加速度信息已经可以得到精确的测量。如果滤波器可以利用测量的位置和加速度信息对船舶运动速度进行综合估计，将会在一定程度上提高动力定位系统的定位性能，因此急需专利技术一种能够利用测量的船舶位置和加速度量去综合估计船舶低频位置、速度和加速度的滤波方法。
技术实现思路
本专利技术的目的在于提供一种依靠船舶位置和加速度信息去综合估计位置、速度和加速度的滤波方法。 本专利技术的目的是这样实现的:本专利技术包括如下步骤:(I)测量船舶的位置和加速度，并将数据转化到统一的坐标系下；(2)建立包含高频加速度的船舶模型本文档来自技高网...

【技术保护点】
一种船舶动力定位卡尔曼滤波方法，其特征在于，包括如下步骤：（1）测量船舶的位置和加速度，并将数据转化到统一的坐标系下；（2）建立包含高频加速度的船舶模型ξ·=Apwξ+Epww1a·=Aawa+Eaww2η·p=vMv·+Dv=bp+τ+w3bp=w4ηw=Cpwξy1=ηp+ηw+v1y2=γv·+Cawa,其中ηp是与北东坐标系的平行坐标系下的船舶低频位置，ηw为平行坐标下高频作用引起的船舶位置，v为船舶速度，y1和y2为船舶观测位置和观测加速度，映射矩阵γ=100010;R(ψ)为旋转矩阵，R(ψ)=cosψ-sinψ0sinψcosψ0001,ψ为船舶艏向角；τ是控制器输入向量；偏差是平行坐标系下未建模的环境力和力矩；i＝1,2,3,4是模型零均值高斯白噪声向量，是零均值高斯白噪声测量向量；ξ为在纵荡、横荡和艏摇3个自由度上的高频作用产生的位置和速度向量；式中为高频作用下的横向、纵向线加速度和横摇、纵摇角加速度；质量矩阵M和阻尼矩阵D定义如下：M=m-Xu·000m-Yv·mxG-Yr·0mxG-Nv·Iz-Nr·,D=-Xu000-Yv-Yr0-Nv-Nr其中Xu，Yv，Yr，Nv，Nr，Iz为水动力参数，m为刚体质量，xG为刚体重心在x方向的坐标；为高频位置系统矩阵，为高频加速度系统矩阵、为位置和加速度的转换矩阵，具体形式如下：Ajw=0I-Ωj-Λj,Ejw=0nyj×nyjInyj×nyj,Cjw=0nyj×nyjInyj×nyj,j＝p,a，其中Ωj=diag(ωj,12,···ωj,nyj2),Λj=diag(2ζj,1ωj,1,···2ζj,nyiωj,nyj),nyp＝3，nya＝2；为海浪峰值频率；为相对阻尼系数；（3）建立可以对位置、速度、加速度进行估计的卡尔曼滤波器：z^·=Az^+Bu+PCTR-1(y-Cz^)P·=AP+PAT+GQGT-PCTR-1CP其中状态矩阵P为最优估计方差矩阵，Q(t)＝QT(t)＞0是模型白噪声向量的协方差矩阵，R(t)＝RT(t)＞0是测量噪声的协方差矩阵；其它系统矩阵如下：A=Apw064063063063046Aaw043043043036034033033I33036034033033033036034033M-1-M-1D,B=063043033033M-1,G=Epw064063063043Eaw043043033034I33033033034033M-1,C=Cpw034I33033033033Caw033M-1M-1D（4）基于测量的船舶位置和加速度，利用卡尔曼滤波器滤掉高频干扰并得到船舶动力定位系统需要的低频船舶位置速度和加速度将数据发送给动力定位系统。FDA00003084852700014.jpg,FDA00003084852700015.jpg,FDA00003084852700016.jpg,FDA00003084852700017.jpg,FDA000030848527000122.jpg,FDA000030848527000121.jpg,FDA000030848527000120.jpg,FDA000030848527000123.jpg,FDA000030848527000119.jpg,FDA000030848527000110.jpg,FDA000030848527000111.jpg,FDA000030848527000112.jpg,FDA000030848527000113.jpg,FDA000030848527000114.jpg,FDA000030848527000115.jpg,FDA00003084852700023.jpg,FDA00003084852700024.jpg,FD...

【技术特征摘要】
1.一种船舶动力定位卡尔曼滤波方法，其特征在于，包括如下步骤: (1)测量船舶的...

【专利技术属性】
技术研发人员：林孝工，谢业海，
申请(专利权)人：哈尔滨工程大学，
类型：发明
国别省市：