[发明专利]一种炮击后陀螺零偏修正方法

摘要

本发明涉及弹载MEMS陀螺仪，具体是一种炮击后陀螺零偏修正方法。本发明解决了弹载MEMS陀螺仪的零偏导致弹体的姿态测量结果出现巨大误差的问题。一种炮击后陀螺零偏修正方法，该方法是采用如下步骤实现的：步骤S1：定义弹体出炮口20m处的时刻为零位修正时刻；步骤S2：对弹载惯导系统进行初始对准；步骤S3：根据弹载惯导系统中MEMS陀螺仪的实时输出，提取出弹体在零位修正时刻的偏航角ψ₁、俯仰角θ₁、滚转角γ₁；步骤S4：根据计算出弹体在零位修正时刻的俯仰角θ₂、滚转角γ₂；步骤S5：根据ψ₁、θ₁、γ₁、θ₂、γ₂，计算出MEMS陀螺仪在弹体发射前后的零位变化；步骤S6：计算出MEMS陀螺仪的准确实时输出。本发明适用于弹体的姿态测量。

主权项

1.一种炮击后陀螺零偏修正方法，其特征在于：该方法是采用如下步骤实现的：步骤S1：定义弹体的发射坐标系为导航坐标系，简称n系；定义弹体坐标系为载体坐标系，简称b系；惯性坐标系简称i系；定义弹体出炮口20m处的时刻为零位修正时刻；定义弹体从发射点到出炮口20m处的飞行时间为t；步骤S2：在弹体发射前，对弹载惯导系统进行初始对准；步骤S3：在弹体发射后，根据弹载惯导系统中MEMS陀螺仪的实时输出，提取出弹体在零位修正时刻的偏航角ψ1、俯仰角θ1、滚转角γ1；步骤S4：利用高精度三轴磁力仪获取n系三轴上的初始地磁场强度分量利用高精度三轴磁力仪实时获取地磁场强度在b系三轴上的分量，由此得出b系下的地磁场强度矢量H^b′并进行补偿；具体补偿公式如下：Hb＝(Hb′‑offset)(CfsCNO)‑1  (1)；式(1)中：Hb表示补偿后b系下的地磁场强度矢量；offset表示高精度三轴磁力仪的零点漂移矩阵；Cfs表示高精度三轴磁力仪的标度因数矩阵；CNO表示高精度三轴磁力仪的非正交矩阵；根据H^b，计算出弹体在零位修正时刻的俯仰角θ₂、滚转角γ₂；具体计算公式如下：式(2)中：分别表示H^b在b系三轴上的分量；步骤S5：根据ψ1、θ1、γ1、θ2、γ2，计算出MEMS陀螺仪在弹体发射前后的零位变化；具体计算公式如下：式(3)中：Δωx0表示MEMS陀螺仪在弹体发射前后的零位变化在x轴上的分量；Δωy0表示MEMS陀螺仪在弹体发射前后的零位变化在y轴上的分量；Δωz0表示MEMS陀螺仪在弹体发射前后的零位变化在z轴上的分量；步骤S6：根据MEMS陀螺仪在弹体发射前后的零位变化，计算出MEMS陀螺仪的准确实时输出；具体计算公式如下：式(4)中：ωx′表示MEMS陀螺仪的准确实时输出在x轴上的分量；ωy′表示MEMS陀螺仪的准确实时输出在y轴上的分量；ωz′表示MEMS陀螺仪的准确实时输出在z轴上的分量。