[发明专利]捷联惯导系统晃动基座条件下杆臂效应的估计和补偿方法

权利要求书

1.一种捷联惯导系统晃动基座条件下杆臂效应的估计和补偿方法，其特征是在晃动基座条件下，估计杆臂效应对捷联惯导系统的影响并进行补偿，包括以下步骤：

1)捷联惯导系统开机预热，采集惯性测量组件的输出数据；

2)进行粗对准，得到粗略的初始姿态矩阵

3)在粗对准基础上分两个阶段完成精对准过程；

31)建立扩展变量的参数辨识法精对准数学模型，构造系统方程和观测方程；扩展变量的参数辨识法精对准数学模型：

ΔVe=(▿e-g.φn0)t-t22gun+t36gωieuesinL+Vde+VseΔVn=(▿n+g.φe0)t+t22gue+t36gωie(unsinL-uucosL)+Vdn++Vsn]]>

其中ue=φn0ωiesinL-φu0ωiecosL-ϵeun=-φe0ωiesinL-ϵnuu=φe0ωiecosL-ϵu]]>

式中：分别表示加速度计等效东向和北向的常值偏置；φ_e0、φ_n0、φ_u0表示初始失准角；ε_e、ε_n、ε_u表示等效东、北、天向陀螺常值漂移；ω_ie表示地球自转角速率；L表示当地纬度；g表示地球重力加速度；V_se、V_sn分别表示东向和北向随机干扰速度，V_de、V_dn表示东向和北向残余干扰速度，为常值；ΔV_e、ΔV_n分别表示东向和北向速度误差，是捷联惯导系统解算的速度剔除杆臂速度后的值与外部基准提供的速度值之差，在晃动基座条件下，外部基准提供的速度为0m/s，从捷联惯导系统解算的速度中剔除杆臂速度的过程即为杆臂速度的实时补偿，由杆臂效应引起的杆臂速度根据杆臂速度模型计算得到：

δvg=ωibb×r=ωibyb·rz-ωibzb·ryωibzb·rx-ωibxb·rzωibxb·ry-ωibyb·rx]]>

式中：δv_g表示杆臂速度；r＝(r_x、r_y、r_z)表示杆臂长度矢量，该值根据运载体的设计结构和导航系统安装位置预先计算并装定入系统，实际应用中，杆臂长度矢量会因为运载体挠曲变形、载荷分布变化等因素偏离该值；表示三个方向上的陀螺仪输出角速率；

所述残余干扰速度包括：系统存在的随机干扰速度；因杆臂长度测量不准确、载体存在挠曲变形、陀螺仪测量的角速率存在干扰等因素导致的杆臂速度计算误差；在晃动基座条件下，捷联解算初始时刻的速度中存在杆臂速度，运行捷联解算算法时，初始速度按0m/s处理，造成的残余速度；粗对准后，初始的姿态矩阵存在误差，运行捷联解算算法时，带来的速度误差；

根据扩展变量的参数辨识法数学模型，构造系统方程和观测方程为：

以捷联惯导系统中速度误差为观测量，把扩展变量的参数辨识法数学模型改写成如下形式：

ΔVe=a1e(KT)+a2e(KT)2+a3e(KT)3+Vde+VseΔVn=a1n(KT)+a2n(KT)2+a3n(KT)3+Vdn+Vsn,K=0,1,2,···]]>

式中：T为捷联惯导系统的传感器数据采样周期；

a1e=(▿e-g.φn0),a2e=-12gun,a3e=16gωieuesinLa1n=(▿n+g.φe0),a2n=12gue,a3n=16gωie(unsinL-uucosL)]]>

把东向和北向速度误差ΔV_e、ΔV_e作为观测量，a_1e、a_2e、a_3e、V_de、a_1n、a_2n、a_3n、V_dn作为待辨识参数，构造系统方程和观测方程：

定义待辨识参数，即系统状态变量为：

Xe=a1ea2ea3eVde,]]>Xn=a1na2na3nVdn]]>

列出系统方程和观测方程：

Xe(k+1)=Xe(k)ΔVe(k)=H(k)Xe(k)+Vge(k),]]>Xn(k+1)=Xn(k)ΔVn(k)=H(k)Xn(k)+Vgn(k)]]>

式中：观测矩阵H(k)＝[kT，(kT)²，(kT)³，V_ge(k)、V_gn(k)表示东向和北向的速度观测噪声，其方差强度为R_e、R_n；

32)精对准第一阶段，根据粗对准结果，运行捷联解算程序，进行杆臂速度的实时补偿，同时根据步骤31)建立的系统方程和观测方程估计系统状态变量，状态变量的第四个分量即为残余干扰速度；

33)精对准第二阶段：对残余干扰速度进行一次补偿；而后，继续运行精对准第一阶段的杆臂速度实时补偿以及对系统状态变量的估计算法，并进行初始失准角估计，待估计的初始失准角收敛后，将估计值φ_e0、φ_n0、φ_u0代入失准角变化规律模型中计算当前时刻的失准角φ_e、φ_n、φ_u；利用当前时刻的失准角信息对粗对准结果进行一步修正，获得当前时刻的姿态矩阵通过姿态矩阵提取方位角H、纵摇角P和横摇角R，精对准完成；

其中，根据步骤32)估计得到的状态变量计算u_e、u_n、u_u、φ_e0、φ_n0和φ_u0：

ue=2a2ng,]]>un=-2a2eg,]]>uu=-6a3ngωiecosL-2a2egtanL]]>

φe0=a1ng,]]>φn0=-a1eg,]]>φu0=φn0.tanL-ueωiecosL]]>

根据初始失准角和失准角变化规律模型计算当前时刻失准角：

φe=φe0+ue.t+t22.ωie(unsinL-uucosL)φn=φn0+un.t-t22.ωieuesinLφu=φu0+uu.t+t22.ωieuecosL]]>

对粗对准结果的一步修正为：

Cbn=Cn′nCbn′=[I+(φ×)]Cbn′,]]>其中Cn′n=I+(φ×)=0-φuφnφu0-φe-φnφe0]]>

4)导航解算阶段，进行杆臂速度的实时补偿，根据步骤33)得到的姿态矩阵运行捷联解算算法，提供导航结果。