[发明专利]捷联惯导光纤陀螺系统级误差参数现场标定方法

权利要求书

1.捷联惯导光纤陀螺系统级误差参数现场标定方法，其特征是：

(1)将需标定的光纤陀螺捷联惯性导航系统与现场提供的姿态测量辅助器件通过数据传输电缆相联通，确保光纤陀螺输出角速度测量值与姿态测量辅助器件输出的载体姿态角一致，并能够被计算机保存；

(2)光纤陀螺捷联惯导系统进行初始对准，确定陀螺所在坐标系的初始姿态，得到姿态四元数的初始值；

(3)将光纤陀螺捷联惯导系统和姿态测量辅助设备按预先设定好的标定路径进行转动，采集陀螺输出和姿态测量辅助设备的输出值；

(4)利用光纤陀螺出厂时提供的标度因数，将光纤陀螺输出值转换为陀螺所在坐标系相对于惯性系的角速度

(5)将带入捷联惯导方程中，得到光纤陀螺相对当地地理坐标系的转换矩阵

(6)根据姿态测量辅助设备提供的实时姿态角，得到真实的姿态转换矩阵T；

(7)通过与T的乘积，得到姿态误差矩阵

利用系统姿态误差角与姿态矩阵的关系

得到系统实时姿态误差角Z＝[φ_E φ_N φ_u]^T。

(8)将带入光纤陀螺系统级标定kalman滤波的状态方程中

X‾·(t)=A(t)X‾(t)+G(t)W‾(t)]]>

=A1(t)A2(t)O12×15X‾0TX‾gT+G(t)W‾(t)]]>

其中

A1=0ωiesinL-ωiecosL-ωiesinL00ωiecosL00,]]>L为标定场地的经度值，ωie为地球自转角速度，

A2=C11C12C13C11ωibxbC12ωibybC13ωibzbC11ωibyb-C11ωibzb-C12ωibxbC12ωibzbC13ωibxb-C13ωibybC21C22C23C21ωibxbC22ωibybC23ωibzbC21ωibyb-C21ωibzb-C22ωibxbC22ωibzbC23ωibxb-C23ωibybC31C32C33C31ωibxbC32ωibybC33ωibzbC31ωibyb-C31ωibzb-C32ωibxbC32ωibzbC33ωibxb-C33ωibyb,]]>

X_O＝[φ_E φ_N φ_u]^T，

X_g＝[b_gx b_gy b_gz S_gx S_gy S_gz Δ_xy Δ_xz Δ_yx Δ_yz Δ_zx Δ_zy]，为待标定的光纤陀螺误差参数，b_g为陀螺零漂，S_g为陀螺标度因数误差，Δ为陀螺安装误差，

G(t)=CbnO12×3,]]>

W‾(t)=δϵxbδϵybδϵzbT]]>陀螺产生的随机噪声干扰；

将Z＝[φ_E φ_N φ_u]^T带入滤波器观测方程中：

Z(t)＝HX(t)+V(t)

V(t)=σγσθσψ]]>为系统观测白噪声；

利用kalman滤波器原理，对X_g中各项误差参数进行估计，完成对光纤陀螺各项误差参数的辨识。