基于扩展卡尔曼滤波器的动力定位船舶波频模型参数估计系统的制作方法
【专利摘要】基于扩展卡尔曼滤波器的动力定位船舶波频模型参数估计系统，本发明涉及基于动力定位船舶波频模型参数估计系统。本发明的目的是，通过所提出的基于扩展卡尔曼滤波器的动力定位船舶波频模型参数估计系统，获取动力定位船舶波频模型的参数。波频模型参数估计系统(2)包括：波频模型参数估计功能启动模块(4)、时间窗提取模块(5)、测量信息序列提取模块(6)、主导频率预估器(7)、高通滤波器(8)、扩展卡尔曼滤波器(9)、数据处理分析功能模块(10)、波频模型参数估计结束模块(11)、模型更新系统(12)，完成波频模型的更新功能。本发明适用于动力定位船舶波频模型参数估计。
【专利说明】
基于扩展卡尔曼滤波器的动力定位船舶波频模型参数估计 系统
技术领域
[0001 ]本发明涉及基于动力定位船舶波频模型参数估计系统。
【背景技术】
[0002] 随着技术的发展，人们的活动范围也逐渐从沿岸和近海扩展到深远海海域。各项 海洋工程都需要装有动力定位的船舶保障和支持。动力定位系统采用推力器来提供抵抗 风、浪、流等作用在船上的环境力，从而使船尽可能地保持在海平面上要求的位置上。随着 海上油气资源的开发不断向深海拓展，传统的锚泊定位方式正逐渐被动力定位所取代，依 靠海洋结构物的自身动力进行定位已经成为深海油气生产设施的主要选择。其定位成本不 会随着水深增加而增加，并且操作也比较方便，因此动力定位技术成为深海开发的关键技 术之一，广泛应用于海洋钻井船、平台支持船、潜水器支持船、管道和电缆敷设船、科学考察 船、深海救生船等船舶上。
[0003] 动力定位船舶工作时受到风、浪、流和推力器的作用而产生运动，其中风、二阶低 频浪、流和推进器引起的运动属于低频运动，其频率范围为0~0.25rad/s，而一阶浪和高频 浪引起的运动属于波频运动，其频率范围为0.3~1.6rad/s，处于船舶控制带宽的边界或者 外界，但处于船舶执行机构的响应带宽范围之内。实际的动力定位控制系统采集到的信号 为综合信息，含有低频运动分量、波频运动分量和测量噪声分量。动力定位控制系统的目标 是控制船舶的低频运动，因此需要对进入控制环路的反馈状态变量进行滤波处理，将其高 频运动分量过滤掉。滤波的性能依赖于模型参数的准确度，尤其是波频模型参数的精度。因 此如何获取动力定位船舶波频模型的参数成为动力定位的关键技术之一。
【发明内容】
[0004] 本发明的目的是，通过所提出的基于扩展卡尔曼滤波器的动力定位船舶波频模型 参数估计系统，获取动力定位船舶波频模型的参数。
[0005] 上述的发明目的是通过以下技术方案实现的：
[0006] 基于扩展卡尔曼滤波器的动力定位船舶波频模型参数估计系统，其特征在于波频 模型参数估计系统包括:波频模型参数估计功能启动模块、时间窗提取模块、测量信息序列 提取模块、主导频率预估器、高通滤波器、扩展卡尔曼滤波器、数据处理分析功能模块、波频 模型参数估计结束模块；
[0007] 波频模型参数估计功能启动模块，用于实现波频模型参数估计系统的数据初始 化；
[0008] 时间窗提取模块，用于从船舶动力定位控制系统数据库里提取一段时间的数据；
[0009] 测量信息序列提取模块，用于从时间窗里提取动力定位船舶的位置和艏向测量信 息η;
[0010] 主导频率预估器，用于从时间窗内取出动力定位船舶位置和艏向的测量信息η，并 对其进行快速傅里叶变换，获取测量信息的频谱曲线并确定初始波频模型参数；
[0011]高通滤波器，用于对艏向的测量信息η进行滤波，估计出波频运动分量?# ;
[0012] 扩展卡尔曼滤波器使用高通滤波器估计出的波频运动分量对实际波频模型参 数进行估计;估计出对应的波频模型参数.§和波频运动估计;
[0013] 数据处理分析功能模块判断所估计波频模型参数§是否合理，并影响船舶动力定 位控制系统（1)中的模型更新系统；
[0014] 波频模型参数估计结束模块，用于将波频模型参数§传递出去；
[0015] 波频模型参数估计系统将波频模型参数§返回给船舶动力定位控制系统中的模型 更新系统，完成波频模型的更新功能。
[0016] 发明效果
[0017] 通过本发明基于扩展卡尔曼滤波器的动力定位船舶波频模型参数估计系统，可以 实时地估计出船舶的波频运动状态，并将其分离开来，进而得到控制器需要的状态信息。解 决了实际的海洋环境是变化的海浪滤波问题，提高了状态估计的精度。而且利用本发明进 行波频模型参数估计，所估计的波频模型参数收敛到了真值附近，证明波频模型参数估计 系统估计成功。从图2a、2b和2c可以看出波频模型的参数估计值从初值开始收敛到真值附 近，因此可以得出结论，本仿真试验验证了基于EKF的波频模型参数估计方法的有效性。
【附图说明】
[0018] 图1为基于扩展卡尔曼滤波器的动力定位船舶波频模型参数估计系统的结构图，1 为船舶动力定位控制系统;2为波频模型参数估计系统;3为模型更新逻辑系统;4为波频模 型参数估计功能启动;5为时间窗提取;6为测量信息序列提取;7为主导频率预估器;8为高 通滤波器;9为扩展卡尔曼滤波器;10为数据处理分析功能；11为波频模型参数估计结束；12 为模型更新系统；
[0019] 图2为波频模型参数仿真真值和参数估计值对比图，其中，图2a为纵向主导频率对 比图，图2b为横向主导频率对比图，图2c为艏向上的主导频率对比图；。
【具体实施方式】
【具体实施方式】 [0020] 一:船舶动力定位控制系统1中模型更新逻辑系统3的参数需要经过 波频模型参数估计系统2进行估计，然后将所得波频模型参数返回给船舶动力定位控制系 统1的模型更新系统12,完成波频模型的更新功能。本发明的波频模型参数估计系统2为基 于扩展卡尔曼滤波器的动力定位船舶波频模型参数估计系统。动力定位船舶波频模型参数 估计示意图如图1所示。
[0021] 结合图1说明本实施方式，本实施方式的一种基于扩展卡尔曼滤波器的动力定位 船舶波频模型参数估计系统，其特征在于波频模型参数估计系统2包括：
[0022] 波频模型参数估计功能启动模块4、时间窗提取模块5、测量信息序列提取模块6、 主导频率预估器7、高通滤波器8、扩展卡尔曼滤波器9、数据处理分析功能模块10、波频模型 参数估计结束模块11;
[0023] 波频模型参数估计功能启动模块4,用于实现波频模型参数估计系统2的数据初始 化；
[0024] 时间窗提取模块5,用于从船舶动力定位控制系统1数据库里提取一段时间的数 据；
[0025] 测量信息序列提取模块6,用于从时间窗里提取动力定位船舶的位置和艏向测量 信息η;
[0026] 主导频率预估器7,用于从时间窗内取出动力定位船舶位置和艏向的测量信息II， 并对其进行快速傅里叶变换，获取测量信息的频谱曲线并确定初始波频模型参数；
[0027] 高通滤波器8，用于对艏向的测量信息II进行滤波，估计出波频运动分量·?^,;
[0028] 扩展卡尔曼滤波器9)使用高通滤波器8估计出的波频运动分量对实际波频模 型参数进行估计;估计出对应的波频模型参数§和波频运动估计_1.
[0029] 数据处理分析功能模块10判断所估计波频模型参数§是否合理，并影响船舶动力 定位控制系统1中的模型更新系统12;
[0030] 波频模型参数估计结束模块11，用于将波频模型参数§传递出去，并将船舶动力定 位控制系统1中的模型更新逻辑设为假，完成波频模型参数估计；
[0031] 波频模型参数估计系统2将波频模型参数后返回给船舶动力定位控制系统1中的模 型更新系统12，完成波频模型的更新功能。
[0032] 基于基于扩展卡尔曼滤波器的动力定位船舶波频模型参数估计系统进行参数估 计，波频模型参数估计系统2将所得波频模型参数返回给船舶动力定位控制系统1的过程如 下：
[0033] 当船舶动力定位控制系统1中的模型更新逻辑系统3逻辑为真时，波频模型参数估 计功能启动模块4启动，对波频模型参数估计系统2的数据进行初始化;如确定时间窗长度 等;时间窗提取模块5从船舶动力定位控制系统1数据库里提取一段时间的数据;然后测量 信息序列提取模块6从时间窗里提取动力定位船舶的位置和艏向测量信息；主导频率预估 器7从数据时间窗内取出动力定位船舶位置和艏向的测量信息η并对其进行快速傅里叶变 换，获取测量信息的频谱曲线并确定初始波频模型参数;高通滤波器8对测量信息η进行滤 波，估计出波频运动分量％ 扩展卡尔曼滤波器9使用高通滤波器8所估计的波频运动分量 对波频模型参数进行估计;数据处理分析功能模块10)判断所估计波频模型参数§是否 合理，并影响船舶动力定位控制系统1中的模型更新系统12;波频模型参数估计结束模块11 将波频模型参数传递出去，并将模型更新逻辑设为假，完成波频模型参数估计;至此，波频 模型参数估计系统2将所得波频模型参数返回给船舶动力定位控制系统1的模型更新系统 12,完成波频模型的更新功能。
[0034]
【具体实施方式】二:本实施方式与【具体实施方式】一不同的是:所述的波频模型参数 估计功能启动模块4进行数据初始化时将时间窗长度确定为600秒并调用数据库纪录的内 容。
[0035] 其它步骤及参数与【具体实施方式】一相同。
[0036]
【具体实施方式】三:本实施方式与【具体实施方式】一或二不同的是:所述的主导频率 预估器7,用于从时间窗内取出动力定位船舶位置和艏向的测量信息II，并对其进行快速傅 里叶变换，获取测量信息的频谱曲线选取合理的频谱曲线数据段进行曲线拟合，获取所拟 合曲线的极大值，并从极大值里选取最大值，其对应的频率作为预估主导频率向量00。
[0037]其它步骤及参数与【具体实施方式】一或二相同。
[0038]【具体实施方式】四：本实施方式与【具体实施方式】一至三之一不同的是:所述的高通 滤波器8的设计过程如下：
[0039] 高通滤波器（11)从数据时间窗内取出动力定位船舶位置和艏向的测量信息n，通 过高通滤波器，估计出波频运动分量
[0040] 根据船舶推力响应特性和波频运动分量的特点，将高通滤波器的技术指标设为
[0042] 其中，H(e>)为滤波器的的幅频特性，j表示虚数，ω为圆频率(也称角频率），与频 率f的关系是
[0043] ω=2η? (2)
[0044] 信号的最高圆频率c〇max为
[0045] comax = jrrad/s (3)
[0046] 根据奈奎斯特定理和高通滤波器的技术指标，动力定位控制系统的最低采样圆频 率为
[0047] ωs min = 23Trad/s (4)
[0048] 对应的采样周期为Ts max=ls;
[0049] 实际动力定位控制系统在进行设计时，考虑到工程需要留一个设计裕量，取为
[0050] Ts = 0.5s (5)
[0051] 在设计高通滤波器时，一般以原型低通滤波器为基础进行设计，然后通过映射变 换得到需要的高通滤波器；
[0052] 原型低通滤波器为归一化的原型低通滤波器，其截止频率为
[0053] ω 〇= 1 (6)
[0054] 原型低通滤波器的传递函数为
[0056] 式中，s是传递函数变量，η是传递函数阶数；参数bi-bn+i和ai-an+i，采用10阶 Butterworth逼近方法确定；
[0057]目标高通滤波器的截止频率为
[0058] ~(〇 =0.35 C8)
[0059]频率映射关系为
[0061 ]式中，s为传递函数变量，j表示虚数，s '为新的传递函数的变量；
[0062]得到高通滤波器系统函数
[0064]经过离散化，将上述高通滤波器系统函数转化为差分方程
[0066]式中，X为滤波系统的状态，下标k表示当前采样时刻，A、B、C、D为高通滤波器系统 函数对应的差分方程的参数，u为滤波器的输入；
[0067] 至此，高通滤波器公式（11)已由低通滤波器的归一化原型再经频率变换得到。 [0068]其它步骤及参数与【具体实施方式】一至三之一相同。
【具体实施方式】 [0069] 五:本实施方式与一至四之一不同的是:所述扩展卡 尔曼滤波器9使用高通滤波器8估计出的波频运动分量对实际波频模型参数进行估计； 估计出对应的波频模型参数谷：
[0070] 根据高通滤波器估计出的波频运动分量分_，基于给定的波频模型结构，估计出对 应的波频模型参数§和波频运动估计
[0071] 波频运动的仿真模型结构如下
[0074] 其中A4PCWS波频模型参数矩阵;ξ为波频模型状态;ξ为ξ的一阶导数，~为船舶的 波频运动分量，即波频模型的输出；ω为高斯白噪声；
[0075] 根据波频运动的仿真模型，得到波频运动的估计模型
[0077] 其中，上标&表示估计值，ξ为波频运动状态估计向量，Aw和Cw为波频模型参数矩阵， ε为估计残差向量，.为估计的波频运动分量;L为估计增益矩阵；
[0078] 上述波频模型中并没有白噪声驱动，原因在于，在估计波频模型参数时，波频模型 是由估计残差驱动的；
[0079]波频模型参数向量记为
[0080] θ = [ωχ ωγ ωψ]τ (13)
[0081] 式中，ωχωγωΦ分别表示纵向、横向和艏向上的主导频率;Τ为转置矩阵；
[0082]考虑到波频模型参数为缓慢变化变量，因此合理地假设
[0083] 0 = 〇 (14)
[0084] 式中4为波频模型参数向量Θ的一阶导数；
[0085] 波频模型在参数估计过程中的增广状态记为
[0086] χ=[θτ ξτ]τ (15)
[0087] 测量变量记为
[0088] y = (16)
[0089] 则增广估计模型可重构为
[0090] i = f(x) + L(y-Cx) (17)
[0091] 式中，i为增广状态的估计；
[0092]式（17)为抽象函数；
[0093] 假设采样时间为％，对增广估计模型进行一阶前向欧拉离散，则有
[0094] i(A: + l)二 F(i(A:)) + K(々}(>.(A：)-Ci(々)） Π 8)
[0095] 其中
[0096] F(i(t)) ?i(^) + r (f(x(A:))) (19)
[0097] K(k)=TsL(k) (20)
[0098] 对公式（18)进行线性化
[0099] i(A- + 1) = Φ(^)χ(/,) + K(/c)(y(^) -Cx(^)) (21)
[0100] 其中
[0102] 式中，I为单位阵；
[0103] 估计残差为
[0104] v.(k) = y(/〇-C\(/〇 (23)
[0105] 其中，C为输出矩阵；
[0106] 选取参数估计的性能指标为
[0108]基于扩展卡尔曼滤波算法，得到波频模型参数
[0110]扩展卡尔曼滤波算法如下：
[0111] 1)任意给定波频模型参数初值I。并初始化波频运动状态估计向量|;
[0112] 2)选取扩展卡尔曼滤波器(EKF)的设计参数Qident、Rident和Pident;
[0113] 3)预测扩展状态向量
[0114] x(/V) = F(x(/c-i)) (.26)
[0115] 4)预测协方差矩阵
[0116] p(^) = F(fe)p(fe -+Q(^) (27)
[0117] 5)估计残差
[0118] r.(/<) = _r(A)-Cx(/i) (2:8).
[0119] 6)计算残差的协方差矩阵
[0120] S(a) = Η(α· )Ρ(^)Η'(Α:)+ R(A-) (29)
[0121] 7)计算次优卡尔曼增益
[0122] K(A)-P(^)H'(A-)S-l(^) (30)
[0123] 8)估计扩展状态
[0124] χ(Α) = χ(/?)+Α'(Α)ε(/〇
[0125] 9)估计协方差矩阵
[0126] P(/c} = (I-Ka-)H(/c})P(Ai (32)
[0127] 10)将估计值i.(:/〇传送出去；
[0128] 11)判断是否需要终止滤波，若继续，转步骤3)，若终止，转步骤12);
[0129] 12)终止滤波。
[0130] 其它步骤及参数与【具体实施方式】一至四之一相同。
[0131 ]【具体实施方式】六:本实施方式与【具体实施方式】一至五之一不同的是:所述的数据 处理分析功能模块10判断所估计波频模型参数是否合理，并影响船舶动力定位控制系统 (1)中的模型更新系统12;具体过程为：
[0132] 判定所估计的波频模型参数§是否收敛于预估主导频率向量θ〇附近，即
[0133] <6 (33)
[0134] 其中，θ〇为预估主导频率向量，δ是一个值很小的向量，如其某元素值为〇. 2rad/s; 如果波频模型参数§收敛于预估主导频率向量，则将模型更新逻辑设为假，并记录所得波频 模型参数，如果波频模型参数§不收敛于预估主导频率向量，则模型更新逻辑不变，并放弃 所得波频模型参数。控制动力定位系统循环，直至满足收敛到预估主导频率的条件。
[0135] 其它步骤及参数与【具体实施方式】一至五之一相同。
【具体实施方式】 [0136] 七:本实施方式与一至六之一不同的是:所述的δ取值 为0.2rad/s。
[0137] 其它步骤及参数与【具体实施方式】一至六之一相同。
[0138] 采用以下实施例验证本发明的有益效果：
[0139] 实施例一：
[0140] 本实施例一种基于扩展卡尔曼滤波器的动力定位船舶波频模型参数估计系统具 体是按照以下步骤制备的：
[0141] 仿真试验
[0142] 为了验证本发明的波频模型辨识效果，设计了波频模型辨识仿真试验。试验的目 的为了验证本发明的波频模型辨识效果，因此要求仿真试验具有两个模型：仿真波频模型 和辨识波频模型。波频模型参数包括相对阻尼比和三个自由度上的主导频率。选取仿真模 型的相对阻尼比ζ = 〇 . 1，主导频率分别为ωχ=1.2、ωγ=1.〇和ωΦ=1.〇5。选取辨识模型的 相对阻尼ζ = 〇. 1，初始化主导频率分别*ωχ = 〇.4、ωγ = 〇.4和ωΦ = 〇.55。时间窗长度为 300秒，采样时间为0.5秒。测量噪声的特性矩阵心<^ = (^8([16-3 16-3 26-2])，过程噪声 的特性矩阵弘<1(^ =乜&8([56-3 56-3 56-2 56-156-116-186-186-116-1])，初始化协 方差矩阵Pident = diag([le3 le3 le6 le5 le5 le7 le5 le5 le7])。
[0143] 仿真过程中时间窗内记录的三个自由度上的测量值ri中即包含波频运动分量也包 括低频运动趋势。
[0144] 对上述取到的测量值进行快速傅里叶变换，获取三个自由度上测量信息的频谱特 性曲线。仿真模型的预估主导频率都为l.Orad/s左右。
[0145] 选取0.35rad/s作为高通滤波器的通带剪切频率，以此为基础设计的10阶 Butterworth高通滤波器的频响特性曲线，把频率较高的波频运动分量和频率较低的低频 运动分量分离开，滤出了船舶位姿的低频运动趋势，获得波频运动分量。
[0146] 测量信号经过高通滤波器后得到波频运动滤波值（然后对其进行扩展卡尔 曼滤波估计，得到波频模型参数估计值，所估计波频模型参数的曲线与仿真波频模型参数 的真值对比如图2a、2b和2c所示，可以看出波频模型的参数估计值从初值开始收敛到真值 附近，因此可以得出结论，本仿真试验验证了基于EKF的波频模型参数估计方法的有效性。
[0147] 本发明还可有其它多种实施例，在不背离本发明精神及其实质的情况下，本领域 技术人员当可根据本发明作出各种相应的改变和变形，但这些相应的改变和变形都应属于 本发明所附的权利要求的保护范围。
【主权项】
1. 基于扩展卡尔曼滤波器的动力定位船舶波频模型参数估计系统，其特征在于波频模 型参数估计系统（2)包括:波频模型参数估计功能启动模块(4)、时间窗提取模块(5)、测量 信息序列提取模块(6)、主导频率预估器(7)、高通滤波器(8)、扩展卡尔曼滤波器(9)、数据 处理分析功能模块(10)、波频模型参数估计结束模块(11); 波频模型参数估计功能启动模块(4)，用于实现波频模型参数估计系统(2)的数据初始 化； 时间窗提取模块（5)，用于从船舶动力定位控制系统（1)数据库里提取一段时间的数 据； 测量信息序列提取模块(6)，用于从时间窗里提取动力定位船舶的位置和艏向测量信 息η; 主导频率预估器(7)，用于从时间窗内取出动力定位船舶位置和艏向的测量信息ri，并 对其进行快速傅里叶变换，获取测量信息的频谱曲线并确定初始波频模型参数； 高通滤波器(8)，用于对艏向的测量信息II进行滤波，估计出波频运动分量％ 扩展卡尔曼滤波器(9)使用高通滤波器(8)估计出的波频运动分量马^对实际波频模型 参数进行估计;估计出对应的波频模型参数§和波频运动估计; 数据处理分析功能模块（10)判断所估计波频模型参数§是否合理，并影响船舶动力定 位控制系统（1)中的模型更新系统（12); 波频模型参数估计结束模块(11)，用于将波频模型参数§传递出去，并将船舶动力定位 控制系统（1)中的模型更新逻辑设为假，完成波频模型参数估计； 波频模型参数估计系统(2)将波频模型参数|返回给船舶动力定位控制系统（1)中的模 型更新系统（12)，完成波频模型的更新功能。2. 根据权利要求1所述基于扩展卡尔曼滤波器的动力定位船舶波频模型参数估计系 统，其特征在于:所述的波频模型参数估计功能启动模块(4)进行数据初始化时将时间窗长 度确定为600秒并调用数据库纪录的内容。3. 根据权利要求2所述基于扩展卡尔曼滤波器的动力定位船舶波频模型参数估计系 统，其特征在于:其特征在于所述的主导频率预估器(7)，用于从时间窗内取出动力定位船 舶位置和艏向的测量信息η，并对其进行快速傅里叶变换，获取测量信息的频谱曲线选取频 谱曲线数据段进行曲线拟合，获取所拟合曲线的极大值，并从极大值里选取最大值，其对应 的频率作为预估主导频率向量θ〇。4. 根据权利要求3所述基于扩展卡尔曼滤波器的动力定位船舶波频模型参数估计系 统，其特征在于:其特征在于所述的高通滤波器(8)的设计过程如下： 根据船舶推力响应特性和波频运动分量的特点，将高通滤波器的技术指标设为(1) 其中，H(e>)为滤波器的的幅频特性，j表示虚数，ω为圆频率(也称角频率）； 在设计高通滤波器时，以原型低通滤波器为基础进行设计，然后通过映射变换得到需 要的高通滤波器； (3) 原型低通滤波器为归一化的原型低通滤波器，其截止频率为 ω〇=1 (2) 原型低通滤波器的传递函数为 ~ --'ΙΓ. - 十 i 式中，S是传递函数变量，η是传递函数阶数;参数bi-bn+ι和ai_an+i采用10阶Butterworth 逼近方法确定； 目标高通滤波器的截止频率为 ω =0.35 (4) 频率映射关系为(5) 式中，s为传递函数变量，j表示虚数，s '为新的传递函数的变量； 得到高通滤波器系统函数(6) 经过离散化，将上述高通滤波器系统函数转化为差分方程(7) 式中，X为滤波系统的状态，下标k表示当前采样时刻，A、B、C、D为高通滤波器系统函数 对应的差分方程的参数，u为滤波器的输入； 至此，高通滤波器公式(11)已由低通滤波器的归一化原型再经频率变换得到。5.根据权利要求4所述基于扩展卡尔曼滤波器的动力定位船舶波频模型参数估计系 统，其特征在于:所述扩展卡尔曼滤波器(9)使用高通滤波器(8)估计出的波频运动分量 对实际波频模型参数进行估计;估计出对应的波频模型参数§ t 波频运动的仿真模型结构如下CwC 其中A4PCW为波频模型参数矩阵;ξ为波频模型状态;ru为船舶的波频运动分量，即波频 丰旲型的输出；ω为尚斯白噪声； 根据波频运动的仿真模型，得到波频运动的估计模型(8) 其中，上标'表示估计值，ξ为波频运动状态估计向量，Aw和Cw为波频模型参数矩阵，ε为 估计残差向量，为估计的波频运动分量;L为估计增益矩阵； 波频模型参数记为 θ = [ ωχ ωγ ωψ]τ (9) 式中，ωχ coy ωΦ分别表示纵向、横向和艏向上的主导频率;T为转置矩阵； 假设 θ = 〇 (10) 式中，?为波频模型参数Θ的一阶导数； 波频模型在参数估计过程中的增广状态记为 χ=[θτ ξτ]τ (11) 测量变量记为 y=%w, (12) 则增广估计模型可重构为(13) 式中，i为增广状态的估计； 假设采样时间为^，对增广估计模型进行一阶前向欧拉离散，则有 其中K(k)=TsL(k) (16) 对公式(18)进行线性化 其中式中，I为单位阵； 估计残差为其中，C为输出矩阵； 选取参数估计的性能指标为基于扩展卡尔曼滤波算法，得到波频模型参数扩展卡尔曼滤波算法如下： 1)任意给定波频模型参数初值并初始化波频运动状态估计向量.ξ_;_ 2 )选取扩展卡尔曼滤波器(EKF )的设计参数Qident、Rident和Pident; 3) 预测扩展状太4) 预测协方差矩阵 .........-, (23:)5) 估计残差 v,( k) = )(/<)-(；：\(?<) (24) 6) 计算残差的协方差矩阵(2S.) 7) 计算次优卡尔曼增益 …（26) 8) 估计扩展状态 \(k)=x(k)+ K(k)t(k ) (27) 9) 估计协方差矩阵(28) 1 〇)将估计值&传送出去； 11) 判断是否需要终止滤波，若继续，转步骤3)，若终止，转步骤12); 12) 终止滤波。6. 根据权利要求5所述基于扩展卡尔曼滤波器的动力定位船舶波频模型参数估计系 统，其特征在于:所述的数据处理分析功能模块（10)判断所估计波频模型参数§是否合理， 并影响船舶动力定位控制系统（1)中的模型更新系统（12);具体过程为：判定所估计的波廊爐县否收敛于预估主导频率向量θ〇,即 (2〇) 其中，θ〇为预估主导频率向量，δ是一个向量;如果波频模型参数§收敛于预估主导频率 向量，则将模型更新逻辑设为假，并记录所得波频模型参数，如果波频模型参数§不收敛于 预估主导频率向量，则模型更新逻辑不变，并放弃所得波频模型参数;控制动力定位系统循 环，直至满足收敛到预估主导频率的条件。7. 根据权利要求6所述基于扩展卡尔曼滤波器的动力定位船舶波频模型参数估计系 统，其特征在于所述的δ取值为0.2rad/s。
【文档编号】G05B17/02GK105867165SQ201610201150
【公开日】2016年8月17日
【申请日】2016年4月1日
【发明人】夏国清, 刘菊, 陈兴华, 绍兴超, 刘建旭
【申请人】哈尔滨工程大学