[发明专利]一种光纤陀螺随机漂移实时滤波方法

说明书

技术领域

本发明涉及一种信号的消噪方法，尤其涉及一种应用于捷联航姿系统中的光纤陀螺随机漂移实时滤波方法。

背景技术

光纤陀螺其是以Sagnac效应为基础而发展起来的新型全固态陀螺仪,作为主要惯性敏感元件之一，由于其具有潜在的最好的性能、成本比而倍受青睐,已成为新一代中低精度捷联惯性导航、制导系统中的理想惯性器件。但是，由于原理、加工与装配工艺不完善等造成陀螺漂移，成为系统误差的主要来源，严重影响着惯导系统的初始对准精度及导航精度。

光纤陀螺的漂移包含两种成分：一种是具有确定性质的、有规律的、有系统性的漂移；另一种是由非确定性的随机性质干扰引起的随时间变化的随机漂移。对应前者，可以对这种确定性漂移进行建模,通过数学模型的软件补偿进行消除，这是比较容易做到的。而对于后者，目前采用较多的处理技术包括两种：一、对光纤陀螺的随机漂移进行时间序列建模，依据模型设计卡尔曼滤波器，通过卡尔曼滤波对随机漂移进行抑制；二、采用数字滤波器对光纤陀螺的漂移进行抑制，通过滤波器对光纤陀螺的漂移进行抑制。但实际情况中，由于光纤陀螺的输出受包括探测器噪声、光路噪声、电路噪声和环境变化引起的大量噪声影响,且这些噪声是时变的,故事先不能得到准确的误差统计特性，难以得到准确的漂移模型。因此，利用第一种方法无法得到理想的抑制效果。另外，由于随机漂移的频域特性不明确，增加了数字滤波器的设计难度，第二种方法也有其固有的缺陷。

针对光纤陀螺信号中的随机漂移和噪声，从抑制噪声的角度出发，消除噪声,对光纤陀螺的随机漂移也有抑制和补偿作用，是比较可行的一种方法。在实际系统中，为满足降噪的实时性要求，通常需要降噪的方法具有在线处理能力。因此，如何设计一种既优化了降噪效果，又提高了算法运算速度、简化了降噪处理过程的实时消噪方法，对光纤陀螺的不确定性随机漂移和噪声进行实时直接滤除，对捷联航姿系统精度的提高起着至关重要的作用。

发明内容

本发明的目的是要提供一种应用于捷联航姿系统中的光纤陀螺随机漂移实时滤波方法。

为达到上述目的，本发明是按照以下技术方案实施的：

本发明包括以下步骤：

步骤1：确定滑动数据窗宽度及预测器系数P和更新器系数U的维数，并离线求得系数P和系数U；

步骤2：捷联航姿系统预热结束后，采集光纤陀螺的输出数据，当采集数据量少于滑动数据窗宽度时，直接将之作为当前姿态解算的输入角速度信息ω_ib，解算后输出姿态信息（即开始采集数据后的小于第一个滑动数据窗宽度时间内的数据不作处理）；

步骤3：待采集陀螺数据量达到窗口宽度时，将第一段采集到的数据输入至去噪算法程序，进行降噪处理，在下一个采样点到来之前，输出降噪处理后的最后一个数据值，作为当前时刻陀螺信号的更新值；

步骤4：将更新后的当前采样点作为姿态实时解算的输入角速度信息ω_ib，进行姿态的实时结算，输出当前姿态信息；

步骤5：进入下一个采样周期，滑动数据窗实时地平移一个点，总包含最新的采样点作为窗口的最后一个值，重复步骤3、步骤4和步骤5，完成捷联航姿系统中光纤陀螺输出信号的实时降噪；

本发明所述步骤1中的离线求得预测器系数P、更新器系数U满足如下等式：

V^(M,M)P^(M,1)＝δ^(M,1)

W^(N,K)·Q^(K,N)·U^(N,1)＝δ^(N,1)

其中M和N为偶数，M_d＝M/2-1,N_d＝N/2-1,且有：

δ^(M,1)＝[100…0]^T

M₀＝2M_d+1,N₀＝2(M_d+N_d+1)

m＝0,1,…,M-1,n＝-M₀,-M₀+2,…,-M₀+2(M-1):V^(M,M)(m+1,(n+M₀)/2+1)＝n^mi＝1,2,…,2M-1:q(i)＝0;q(2+2M_d)＝1

i＝1,2,…,2M:q(2i-1)＝p(i)

L＝length(q)