首页> 中国专利> 一种船用罗经光纤陀螺噪声在线估计系统及估计方法

一种船用罗经光纤陀螺噪声在线估计系统及估计方法

摘要

本发明一种船用罗经光纤陀螺噪声在线估计系统及估计方法。在线估计系统包括三个光纤陀螺仪,三个加速度计,信号采集部分,DSP导航解算部分,电源部分和信息显示部分。信号采集部分完成对陀螺仪和加速度计的输出信号实时采集;将采集到的陀螺仪和加速度计的输出数据进行滤波处理,消除掉舰船运动对采集数据的干扰影响,只留下光纤陀螺仪的噪声干扰项;建立系统状态方程和量测方程,采用指数加权平均算法,实现了实时的参数估计;利用非线性自适应卡尔曼滤波实现对Allan方差系数进行有效估计。本发明提出线噪声估计方法能实现光纤罗经噪声误差项的实时更新,提高了罗经航向和姿态输出精度。

著录项

  • 公开/公告号CN103940448A

    专利类型发明专利

  • 公开/公告日2014-07-23

    原文格式PDF

  • 申请/专利权人 哈尔滨工程大学;

    申请/专利号CN201410145935.9

  • 申请日2014-04-11

  • 分类号G01C25/00(20060101);G06F19/00(20110101);G01C21/18(20060101);

  • 代理机构

  • 代理人

  • 地址 150001 黑龙江省哈尔滨市南岗区南通大街145号哈尔滨工程大学科技处知识产权办公室

  • 入库时间 2023-12-17 00:45:42

法律信息

  • 法律状态公告日

    法律状态信息

    法律状态

  • 2023-03-17

    未缴年费专利权终止 IPC(主分类):G01C25/00 专利号:ZL2014101459359 申请日:20140411 授权公告日:20161207

    专利权的终止

  • 2016-12-07

    授权

    授权

  • 2014-08-20

    实质审查的生效 IPC(主分类):G01C25/00 申请日:20140411

    实质审查的生效

  • 2014-07-23

    公开

    公开

说明书

技术领域

本发明涉及在舰船动态条件下的一种船用罗经光纤陀螺噪声在线估计系统及估计方法。

背景技术

近年来,随着光纤陀螺仪的精度和稳定性的逐渐提高,以光纤陀螺为核心的船用光纤罗 经因其体积小,功耗低,价格便宜等一系列优点已经逐步开始在舰船上得到广泛的应用。然 而,目前应用最广泛的构成舰船用光纤罗经最核心部分的闭环干涉式光纤陀螺仪是由长达一 千米的光纤环组成的。在舰船的使用环境中由于温湿度的变化,以及周围磁场和电场的影响, 对于长期工作的光纤罗经有很大的影响。特别会给光纤陀螺引入不同程度的随机噪声。而这 些随机噪声的引入会给光纤陀螺的输出值产生很大的影响,进而影响光纤罗经的姿态和航向 输出精度,这样就使得系统的可靠性得不到保证。因此,为了保证系统长期工作的可靠性, 增强系统长时间高精度工作的能力,提出一种能在舰船航向条件下实时在线对光纤陀螺的噪 声项进行有效的估计方法已成为必然要求。

发明内容

本发明的目的是提供能够实时估计罗经光纤陀螺的随机噪声的一种船用罗经光纤陀螺噪 声在线估计系统,本发明的目的还包括提出具有高精度的一种船用罗经光纤陀螺噪声在线估 计系统及估计方法。

本发明是通过以下技术方案实现的:

一种船用罗经光纤陀螺噪声在线估计系统,包括三个光纤陀螺仪,三个加速度计,信号采 集部分,DSP导航解算部分,电源部分和信息显示部分;

光纤陀螺仪用来测量运载体的角速率,进而计算出在一定的时间间隔内运载体的姿态变化 角和航向变化角,然后传送给信号采集部分;

加速度计用于测量运载体相对于惯性空间线性加速度和重力角速度,进而得到当前时刻运 载体的航向和姿态信息,然后传送给信号采集部分;

信号采集部分完成对光纤陀螺仪和加速度计的输出信号采集及滤波处理,然后传送给DSP 导航解算部分;

DSP导航解算部分完成对航向角和姿态角的实时结算,再传送给信息显示部分,显示部分 实现航向角和姿态角信息的实时显示;

电源部分分别与光纤陀螺仪、加速度计、信号采集部分、DSP导航解算部分、信息显示部 分相连。

本发明一种船用罗经光纤陀螺噪声在线估计方法还可以包括以下几个步骤:

步骤一:系统初始化;

步骤二:信号采集部分实时采集陀螺仪和加速度计的输出信号;

步骤三:将步骤二采集到的陀螺仪和加速度计的输出数据进行滤波处理;

步骤四:消除掉舰船运动对采集数据的干扰影响,只留下光纤陀螺仪的噪声干扰项;

在时间间隔t内光纤陀螺仪的角增量输出值为:

θFOG=θREALbFOGnFOG

其中:θFOG是光纤陀螺仪输出的角增量,θREAL是舰船真实的姿态角增量,θbFOG是陀螺仪零偏 值,θnFOG是光纤陀螺仪输出的噪声量;

在时间间隔t的起始时刻t1,由加速度计的输出值经过解算可以得到舰船的姿态值为:

θACCt1=θREALt1bACCt1nACCt1

在时间间隔t的终止时刻t2,由加速度计的输出值得到舰船的姿态值为:

θACCt2=θREALt2bACCt2nACCt2

θACCti表示加速度计输出的姿态值,θREALti表示角速度计输出的载体的真实姿态值,θbACCti表示加 速度计输出的零偏值,θnACCti表示加速度计输出值的噪声量,其中i=1表示在t1时刻,i=2表 示在t2时刻;

在与陀螺仪相同的时间间隔t=t2-t1内加速度计输出的姿态增量为:

ΔθACC=θACCt2ACCt1

=θREALt2REALt1bACCt2bACCt1nACCt2nACCt1

θREAL=θREALt2REALt1是舰船在时间间隔t内的真实姿态增量;θbACCt2bACCt1和θnACCt2nACCt1为加速 度计在时间间隔t内的零偏变化量和噪声变化量;

在时间间隔t内光纤陀螺仪的角增量输出值与加速度计输出的姿态增量做差消除掉舰船 运动对采集数据的干扰影响,并且选择t的值消除零偏变化量和噪声变化量,只留下光纤陀 螺仪的噪声干扰项;

θ=θFOG-ΔθACC

=θbFOGnFOGbACCt1bACCt2nACCt1nACCt2

步骤五:建立系统状态方程和量测方程,确定光纤陀螺的噪声参量;

建立系统状态方程模型:

xk+1=RKBNQk+1T=xk+δk

其中xk是k时刻的状态向量,δk是k时刻的零均值高斯白噪声,R为速率斜坡,K为速率随 机游走,B为零偏稳定性,N为角度随机游走,Q为量化噪声,这五个参数为光纤陀螺的噪 声参量;

建立系统的量测方程:

2τ2×σ2(τ)=(θk+2m-2θk+m+θk)2=R2τ4+2K2τ33+41n2B2τ2π+2N2τ+6Q2

其中,τ是数据族长度,σ2(τ)是Allan方差,θk是k时刻的角度输出值,<>是计算整体均值, 速率斜坡R、速率随机游走K、零偏稳定性B、角度随机游走N和量化噪声Q为Allan方差 系数;

采用下式简化系统量测方程的计算:

A(z)=αz-1A(z)+(1-α)x(z)

其中,A(z)是数字均值输出,α是权重系数,且(0<α<1),x(z)是(θk+2m-2θk+mk)2在k时刻 的输出值;α值决定了光纤陀螺数字输出均值的精度和带宽;

步骤六:利用非线性自适应卡尔曼滤波实现对光纤陀螺的噪声参量进行有效估计;

用y(τ)来表示系统的量测方程左边的项,h(x(τ),τ)表示系统的量测方程右边的项,通过泰 勒级数展开并完成线性化处理后可得:

其中H.O.T.表示了泰勒级数展开式中的高阶项;并且得到一个线性的测量方程:

yk=Hkxk+zkk

Hk=hx^k,k-1=h(x,k)x|x=x^k,k-1

φk=H.O.T.

Hk为量测矩阵,zk为一步预测观测阵,φk为噪声阵;

采用非线性自适应卡尔曼滤波的方法来估计出光纤陀螺的噪声参量:

x^k+1=x^k+1,k+Kk+1ϵk+1

x^k+1,k=x^k+q^k

ϵk+1=yk+1-h(x^k,k-1,k+1)-r^k

Kk+1=Pk+1,kHkT[Hk+1Pk+1,kHk+1T+R^k]-1

Pk+1,k=[In-Kk+1Hk+1]Pk+1,k

q^k=q^k-1+dk-1Q^k-1Dkϵk

Qk=Qk-1+dk-1Q^k-1Dk[ϵkϵkT-HkPk,k-1HkT-R^k-1]DkTQ^k-1

r^k=r^k-1+dk-1[Im-HkKk]ϵk

R^k=(1-dk-1)R^k-1+dk-1{[Im-HkKk]ϵkϵkT[Im-HkKk]T+HkPkHkT}

Dk+1=Hk+1T[Hk+1Pk+1Hk+1T+R]-1

dk-1=(1-b)(1-bk),0<b<1

其中,是最优估计向量,是由用状态模型推算获得的k+1时刻的预测状态向量,Kk+1是增益矩阵,εk+1是误差矩阵;是k时刻的状态预测变量;是输出误差调节系数;Pk+1,k是 由k时刻转移到k+1时刻的预测误差方差阵,为量测噪声方差阵;dk-1是噪声调节系数,是系统干扰方差阵;Dk+1是系统干扰矩阵;b是遗忘因子,b的范围是从0.95到0.998;完成 对光纤陀螺的噪声参量的在线实时估计。

本发明的有益效果:

1.本专利所提出的方法保留了Allan方差分析法的本质,即能分析任何仪器的噪声研究。也 就是说,只要运用得当,本专利所提出的噪声动态在线实时估计方法也能够运用在任何仪 器的动态噪声研究中去,大大的扩宽了Allan方差分析方法的运用范围;

2.本专利所提出的动态条件下Allan方差在线噪声估计方法能实现光纤罗经噪声误差项的 实时更新,提高了罗经航向和姿态输出精度;

3.在线的噪声实时估计方法能实时诊断因光纤陀螺噪声误差引起的系统灾难性误差,为系统 的故障诊断和重构提供新的角度,这也减少了因罗经系统故障带来的损失;

4.本发明的方法能够解决以往在罗经运行一段时间之后需要对系统进行拆卸重调的过程,罗 经组成部分因环境变化会逐渐老化,系统的相关参数会在原先的均值附近大幅波动,甚至 偏离均值发散。采用本专利使用的方法能降低系统运行维修的成本;

5.本专利所使用的方法不需要外部信息源的辅助,所有的信息均来源于罗经系统本身,有利 于运载体的保密,能够实现在深海长航时、远航程条件下的高精度航姿输出。

附图说明

图1闭环干涉式光纤陀螺仪基本原理图;

图2舰船用光纤罗经系统组成框图;

图3舰船运动隔离示意图;

图4舰船用光纤罗经陀螺随机噪声在线估计程序流程图。

具体实施方式:

下面将根据附图对本发明进行详细说明。

本发明是这样实现的:首先从目前普遍采用的分析光纤陀螺随机噪声误差项的方法 —Allan方差法的运用范围角度出发。通过比较发现要完成动态条件下的在线估计必须要解 决三个问题,第一个是经典的Allan方法分析法所采用的数据必须是在防震动的隔离基座上 采集的纯静态数据,为此,在动态条件下采用Allan方差方法必须消除与舰船运动相关的参 数,只剩下光纤陀螺的噪声项系数。第二个是经典的Allan方差分析方法必须存储大量的数 据,通过分析大量数据的统计特性来的出相关参数项,这样就导致了参数的实时性很难满足。 为此必须采用相关方法来解决这个问题,以实现随机噪声误差项的实时在线估计。第三个是 经典的Allan方差分析方法是以最小二乘的方法来绘制对数坐标曲线图,而参数的确定是在 绘制完相关的Allan方差标准差对数曲线图之后,再用画图的方法手工绘制出相关的参数, 自动化程度很低,更要重的破坏了噪声参数的实时性。为此必须采用更好的参数估计方法, 用自动的方式来实现Allan方差误差参数的辨识。通过解决上述问题来实现对光纤罗经中光 纤陀螺的实时在线估计,具体的解决过程如下:

首先是实现对舰船运动的隔离问题:

在时间间隔t内光纤陀螺仪的角增量输出值为:

θFOG=θREALbFOGnFOG    (1)

其中:θFOG是光纤陀螺仪输出的角增量,θREAL是舰船真实的姿态角增量信息,θbFOG是陀 螺仪零偏值,可以通过标定的方法计算出,θnFOG是光纤陀螺仪输出的噪声量。

与此同时,在时间间隔t的起始时刻t1由加速度计的输出值经过一定的解算可以得到舰 船的姿态信息为:

θACCt1=θREALt1bACCt1nACCt1    (2)

在时间间隔t的终止时刻t2由加速度计的输出值可以得到载体的姿态信息为:

θACCt2=θREALt2bACCt2nACCt2    (3)

(2)式和(3)式中:θACCti表示在不同时刻加速度计输出的姿态值,θREALti表示在不同时刻角 速度计输出的载体的真实姿态值,θbACCti表示加速度计在不同时刻输出的零偏值,θnACCti表示在 不同时刻加速度计输出值的噪声量。

因此,在与陀螺仪相同的时间间隔t=t2-t1内加速度计输出的姿态增量信息为:

ΔθACC=θACCt2ACCt1

=θREALt2REALt1bACCt2bACCt1nACCt2nACCt1    (4)

其中:θREAL=θREALt2REALt1是舰船在时间间隔t内的真实姿态增量,分别可由陀螺仪输出增 量表示和加速度计在不同时刻输出值计算出来的。θbACCt2bACCt1和θnACCt2nACCt1为加速度计在时 间间隔t内的零偏变化量和噪声变化量,当t足够小时,我们可以假定这两项几乎趋于零。

由(4)式减去(1)式可得:

θ=θFOG-ΔθACC

=θbFOGnFOGbACCt1bACCt2nACCt1nACCt2    (5)

(5)式消除了舰船真实姿态信息,只留下了陀螺仪零偏和噪声项。但与此同时,也引入了 不同时刻之间加速度计零偏差值项和角速度计的噪声差值误差项。一方面,目前中高精度的 加速度计噪声项相对于陀螺仪的噪声项来说数量级相差非常大,在中高精度的航姿系统中是 不予考虑的,因此我们在计算时可以忽略不计。另一方面,在计算两个不同时刻的加速度计 零偏和噪声项时,当时间间隔t足够小时,我们可以认为这两个量是几乎不变的,所以它们 的差值是趋于零的。

接下来是少量数据存储,提高实时性问题的解决:

在消除了加速度计的零偏误差项和噪声误差项之后,因为从(5)式的输出数据在减去陀螺 仪零偏之后,我们可以将其认为只有陀螺仪的实际噪声误差项。而其中所含有的加速度计噪 声项我们是可以忽略不计的。

Allan方差是一组影响陀螺性能的随机过程噪声统计特性的表现。如果陀螺性能足够稳 定,那么Allan方差系数随着时间是不会改变的。然而,在实际情形中,由于存在统计误差 的存在,Allan方差系数是在真实值附近上下波动的。为了更好的进行研究,我们假定Allan 方差系数是由真值和零均值高斯白噪声组成的。

xk+1=RKBNQk+1T=xk+δk---(6)

其中xk是k时刻的状态向量,δk是k时刻的零均值高斯白噪声。R为速率斜坡,K为速 率随机游走,B为零偏稳定性,N为角度随机游走,Q为量化噪声,这五个参数就表征了光 纤陀螺的噪声参量。

另外,从通过查阅相关的参考文献可知Allan方差能够用另外一种形式表现出来:

2τ2×σ2(τ)=(θk+2m-2θk+m+θk)2=R2τ4+2K2τ33+41n2B2τ2π+2N2τ+6Q2---(7)

其中,τ是数据族长度,σ2(τ)是Allan方差,θk是k时刻的角度输出值,<>是计算整体 均值。(6)式和(7)式分别表示了光纤陀螺的随机噪声的状态方程和测量方程。

(7)式表示了Allan方差系数的测量方程。而且这个方程是统计性的,需要大量可存储的 数据进行整体平均计算。为了计算当光纤陀螺仪性能下降且用更少量的可存储数据,此处提 出了指数加权平均算法来计算:

A(z)=αz-1A(z)+(1-α)x(z)    (8)

其中,A(z)是数字均值输出,α是权重系数,且(0<α<1),x(z)是(θk+2m-2θk+mk)2在k 时刻的输出值。

α值决定了光纤陀螺数字输出均值的精度和带宽。实际仿真时可以根据选择不同的α值 来平衡系统的精度和带宽。一般来说,光纤陀螺输出精度越高,α值越接近于1.

最后解决相关噪声参数自动获取问题:

从上面的(7)式我们可以发现,R,K,B,N和Q都是非线性的,而且δk是未知的。因 此我们不能运用传统的Kalman滤波到公式(6)和(7)去估计陀螺仪的噪声误差项。

用y(τ)来表示(7)式左边的项,h(x(τ),τ)表示(7)式右边的项,通过泰勒级数展开并完成线 性化处理后可得:

其中H.O.T.表示了泰勒级数展开式中的高阶项。方程(9)表示了一个线性的测量方程,也 就是:

yk=Hkxk+zkk    (10)

Hk=hx^k,k-1=h(x,k)x|x=x^k,k-1---(11)

φk=H.O.T.    (13)

(10)-(13)式中,Hk为量测矩阵,zk为一步预测观测阵,φk为噪声阵。为了消除(6)式和 (7)式中的未知统计噪声,此处采用了鲁棒扩展卡尔曼滤波的方法来估计出Allan方差系数, 具体过程如下:

x^k+1=x^k+1,k+Kk+1ϵk+1---(14)

x^k+1,k=x^k+q^k---(15)

ϵk+1=yk+1-h(x^k,k-1,k+1)-r^k---(16)

Kk+1=Pk+1,kHkT[Hk+1Pk+1,kHk+1T+R^k]-1---(17)

Pk+1,k=[In-Kk+1Hk+1]Pk+1,k    (18)

q^k=q^k-1+dk-1Q^k-1Dkϵk---(19)

Qk=Qk-1+dk-1Q^k-1Dk[ϵkϵkT-HkPk,k-1HkT-R^k-1]DkTQ^k-1

r^k=r^k-1+dk-1[Im-HkKk]ϵk---(21)

R^k=(1-dk-1)R^k-1+dk-1{[Im-HkKk]ϵkϵkT[Im-HkKk]T+HkPkHkT}---(22)

Dk+1=Hk+1T[Hk+1Pk+1Hk+1T+R]-1---(23)

dk-1=(1-b)(1-bk),0<b<1    (24)

其中式(14)-(24)中,是最优估计向量,是由用状态模型推算获得的k+1时刻 的预测状态向量,Kk+1是增益矩阵,εk+1是误差矩阵;是k时刻的状态预测变量;是输出 误差调节系数;Pk+1,k是由k时刻转移到k+1时刻的预测误差方差阵,为量测噪声方差阵;dk-1是噪声调节系数,是系统干扰方差阵;Dk+1是系统干扰矩阵。b是遗忘因子,通常b的范 围是从0.95到0.998,而且在慢时变统计噪声中b因更接近于1。这样,通过上面的非线性 自适应卡尔曼滤波就可以完成对Allan方差噪声项系数的在线实时估计。

结合图1,针对目前主要装备于光纤罗经的闭环干涉式光纤陀螺基本组成原理及光纤陀 螺仪各部分引入的系统随机噪声。光纤陀螺主要由光纤光源,耦合器,Y波导,保偏光纤环 和探测器等光路部分,以及A/D转换器,D/A转换器,时序控制,数字滤波和数字闭环控制 信号处理部分等电路部分。这两大部分中最易受环境影响的是光路部分,仅仅是保偏光纤环 就是由长达一千米的保偏光纤组成。由光纤陀螺的基本原理sagnac效应可知,从光纤光源发 出的光,在经过耦合器和Y波导一分为二后,然后分别在保偏光纤环中逆向运行,在分别走 完整个光纤环后,最后回到耦合器被光路探测器监测出两路光线的光强度。探测器所检测出 的光线强度经过A/D转换到达数字闭环信号处理部分,解算出对应两束光之间的光程差。通 过光程差的大小我们就可以知道光纤陀螺仪所敏感出的运动载体相对于惯性空间的旋转角速 率。而闭环光纤陀螺仪会将数字闭环信号处理部分解算出的光程差通过反馈的方式来控制Y 波导,使得最后输出的光程差为零,通过主动控制的方式来实现对敏感角速率的实时检测。

为了实现电路部分信号处理的同步性和实时性,所有与电路相关的部分都是在同一个时 序下控制的。

结合图2,船用光纤罗经系统组成框图说明船用光纤罗经的组成及其简单的工作原理。 系统主要由光纤陀螺仪,加速度计,信号采集部分,DSP导航解算部分,电源部分和信息显 示部分等组成。光纤陀螺仪用来敏感运载体的角速率,通过其对时间的积分可以计算出在一 定的时间间隔内运载体的姿态变化角和航向变化角。加速度计用于敏感运载体相对于惯性空 间线性加速度和敏感重力角速度项。而对于舰船来说,在大部分航行的时间内,舰船都处于 匀速运动状态或者系泊状态的,加速度计敏感项中主要是重力加速度,通过重力加速度在光 纤罗经不同轴加速度计分量的输出中可以计算出当前时刻舰船的航向和姿态信息。信号采集 部分主要完成对陀螺仪和加速度计的信号采集及滤波处理,信号采集电路根据陀螺仪和加速 度计的输出信号类型而选择合理的电子器件及相应的采集方法。DSP导航解算部分主要完成 对信号采集部分的有效控制,采集实时有效的惯性传感器数据,并通过相应的处理,在得到 需要的航姿解算信息后通过解算算法完成航向角和姿态角的实时解算。最后通过有效的通信 方式将解算出的航姿信息传递给信息显示部分,实现航姿信息的实时显示。值得注意的是, 罗经系统的所有部分都离不开电源部分的能量支持,电源部分是保证系统能正常工作的首要 条件。

结合图3,说明在舰船运动条件下,对光纤陀螺仪输出值进行噪声实时在线估计时多舰 船运动的隔离。此处采用了加速度计的输出值在与陀螺仪输出角度增量相同的时间间隔内, 运用加速度计在相同时间间隔的起始时刻和终止时刻输出值经过一定的解算得出在这段时间 内舰船的姿态角和航向角变化值。最后通过这两种不同传感器敏感出的角度增量值作差就可 以消除舰船运动姿态角和航向角变化。从加速度计和陀螺仪的输出值,首先经过滤波处理排 除大干扰对输出数据的影响。然后在陀螺仪输出的角速率值经过在时间t内的积分就可以得 出在时间t内角度值的变化量,这其中包含了舰船真实的姿态和航向角度变化,以及陀螺仪 的零偏值和陀螺仪的噪声部分。与此同时,通过计算时间间隔段t的起始时刻t1加速度计的 输出值与重力加速度之间的关系可以得出当前时刻舰船的姿态和航向角度值,然后计算在t 时间间隔末尾时刻t2加速度计的输出值与重力加速度之间的关系可以得出此时刻舰船的姿 态和航向角度值。将不同时刻得出的舰船姿态和航向角作差值就可以计算出在此时间段t内 舰船姿态角和航向角的变化量。这其中也分别包含了加速度计在不同时刻的舰船真实姿态和 航向角信息,加速度计的零偏值以及加速度计的噪声项。

虽然引入加速度计作为辅助隔离舰船的运动信息后,引入了加速度计的零偏值和加速度 计的噪声项。但我们只要选择足够小的时间间隔,那么在很短的时间间隔内加速度计噪声和 零偏的变化量是可以忽略不计的。除此之外,加速度计的零偏值是可以通过标定的方法得到 的,而且在目前的导航解算过程中,由于加速度计的精度已经做得非常高,其噪声在大多数 情况下是忽略不计的。所以最后经过舰船运动隔离后的数据中,唯一需要分析的就是陀螺仪 的噪声项,这在很大程度上影响了高精度舰船用罗经的进一步发展。

结合图4,对该舰船用罗经光纤陀螺噪声在线实时估计方法的程序流程图进行详细阐述, 具体过程如下:

步骤1,系统初始化,通过系统的上电完成初始化过程,包括系统的启动和初始对准过 程,进入步骤2;

步骤2,通过系统的信号采集部分完成对陀螺仪和加速度计的信号实时采集,并保持数 据采集部分各部分信号的同步性,便于后面的有效处理和解算,进入步骤3;

步骤3,将前一步采集到的陀螺仪和加速度计数据进行滤波处理,主要是消除掉因数据 采集过程中所引入的其他外部噪声干扰项,尽量降低噪声对系统的影响,进入步骤4;

步骤4,舰船运动的隔离,通过图3所示的详细计算过程消除掉舰船运动对输出采集数 据的干扰影响,只留下光纤陀螺仪的噪声干扰项,用于后面的建模和参数估计,进入步骤5;

步骤5,系统状态方程和量测方程建模,以所需要的估计参数项为状态变量建立系统状 态方程模型如公式(6)所示,以系统的Allan方差输出为输出量建立系统的量测方程如公式(7) 所示。这些模型的建立为后面Allan方差噪声项系数的估计奠定基础,进入步骤6;

步骤6,指数加权平均算法,为了实现实时的参数估计,降低系统参数估计所需要的数 据量,采用指数加权平均算法,进入步骤7;

步骤7,运用非线性自适应卡尔曼滤波实现对Allan方差系数的有效估计,根据所需要 估计参数的非线性特性,在传统的卡尔曼滤波方法的基础上进行改进,提出适用于Allan方 差参数在线估计的滤波算法对其进行实时估计,进入步骤8;

步骤8,估计出所有参数后,结束程序运行。

去获取专利,查看全文>

相似文献

  • 专利
  • 中文文献
  • 外文文献
获取专利

客服邮箱:kefu@zhangqiaokeyan.com

京公网安备:11010802029741号 ICP备案号:京ICP备15016152号-6 六维联合信息科技 (北京) 有限公司©版权所有
  • 客服微信

  • 服务号