[发明专利]一种船舶动力定位卡尔曼滤波方法无效
申请号: | 201310141292.6 | 申请日: | 2013-04-22 |
公开(公告)号: | CN103217160A | 公开(公告)日: | 2013-07-24 |
发明(设计)人: | 林孝工;谢业海 | 申请(专利权)人: | 哈尔滨工程大学 |
主分类号: | G01C21/20 | 分类号: | G01C21/20 |
代理公司: | 暂无信息 | 代理人: | 暂无信息 |
地址: | 150001 黑龙江省哈尔滨市南岗区*** | 国省代码: | 黑龙江;23 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: |
本发明涉及动力定位控制领域,具体涉及一种船舶动力定位系统中的滤波方法。本发明包括如下步骤:(1)测量船舶的位置和加速度,并将数据转化到统一的坐标系下;(2)建立包含高频加速度的船舶模型;(3)建立可以对位置、速度、加速度进行估计的卡尔曼滤波器;(4)基于测量的船舶位置和加速度,利用卡尔曼滤波器滤掉高频干扰并得到船舶动力定位系统需要的低频船舶位置 |
||
搜索关键词: | 一种 船舶 动力 定位 卡尔 滤波 方法 | ||
【主权项】:
1.一种船舶动力定位卡尔曼滤波方法,其特征在于,包括如下步骤:(1)测量船舶的位置和加速度,并将数据转化到统一的坐标系下;(2)建立包含高频加速度的船舶模型ξ · = A pw ξ + E pw w 1 a · = A aw a + E aw w 2 η · p = v M v · + Dv = b p + τ + w 3 b p = w 4 η w = C pw ξ y 1 = η p + η w + v 1 y 2 = γ v · + C aw a , ]]> 其中ηp是与北东坐标系的平行坐标系下的船舶低频位置,ηw为平行坐标下高频作用引起的船舶位置,v为船舶速度,y1和y2为船舶观测位置和观测加速度,映射矩阵γ = 1 0 0 0 1 0 ; ]]> R(ψ)为旋转矩阵,R ( ψ ) = cos ψ - sin ψ 0 sin ψ cos ψ 0 0 0 1 , ]]> ψ为船舶艏向角;τ是控制器输入向量;偏差
是平行坐标系下未建模的环境力和力矩;
i=1,2,3,4是模型零均值高斯白噪声向量,
是零均值高斯白噪声测量向量;ξ为在纵荡、横荡和艏摇3个自由度上的高频作用产生的位置和速度向量;式中
为高频作用下的横向、纵向线加速度和横摇、纵摇角加速度;质量矩阵M和阻尼矩阵D定义如下:M = m - X u · 0 0 0 m - Y v · m x G - Y r · 0 m x G - N v · I z - N r · , ]]>D = - X u 0 0 0 - Y v - Y r 0 - N v - N r ]]> 其中Xu,
Yv,
Yr,
Nv,
Nr,
Iz为水动力参数,m为刚体质量,xG为刚体重心在x方向的坐标;![]()
为高频位置系统矩阵,![]()
为高频加速度系统矩阵、![]()
为位置和加速度的转换矩阵,具体形式如下:A jw = 0 I - Ω j - Λ j , ]]>E jw = 0 n yj × n yj I n yj × n yj , ]]>C jw = 0 n yj × n yj I n yj × n yj , ]]> j=p,a,其中Ω j = diag ( ω j , 1 2 , · · · ω j , n yj 2 ) , ]]>Λ j = diag ( 2 ζ j , 1 ω j , 1 , · · · 2 ζ j , n yi ω j , n yj ) , ]]> nyp=3,nya=2;
为海浪峰值频率;
为相对阻尼系数;(3)建立可以对位置、速度、加速度进行估计的卡尔曼滤波器:z ^ · = A z ^ + Bu + P C T R - 1 ( y - C z ^ ) P · = AP + P A T + GQ G T - P C T R - 1 CP ]]> 其中状态矩阵![]()
P为最优估计方差矩阵,Q(t)=QT(t)>0是模型白噪声向量的协方差矩阵,R(t)=RT(t)>0是测量噪声的协方差矩阵;其它系统矩阵如下:A = A pw 0 64 0 63 0 63 0 63 0 46 A aw 0 43 0 43 0 43 0 36 0 34 0 33 0 33 I 33 0 36 0 34 0 33 0 33 0 33 0 36 0 34 0 33 M - 1 - M - 1 D , ]]>B = 0 63 0 43 0 33 0 33 M - 1 , ]]>G = E pw 0 64 0 63 0 63 0 43 E aw 0 43 0 43 0 33 0 34 I 33 0 33 0 33 0 34 0 33 M - 1 , ]]>C = C pw 0 34 I 33 0 33 0 33 0 33 C aw 0 33 M - 1 M - 1 D ]]> (4)基于测量的船舶位置和加速度,利用卡尔曼滤波器滤掉高频干扰并得到船舶动力定位系统需要的低频船舶位置
速度
和加速度
将数据发送给动力定位系统。
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于哈尔滨工程大学,未经哈尔滨工程大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/201310141292.6/,转载请声明来源钻瓜专利网。