本发明涉及弹载MEMS陀螺仪,具体是一种炮击后陀螺零偏修正方法。
背景技术:
随着MEMS技术的发展,MEMS陀螺仪以其体积小、重量轻、功耗低、可靠性高等传统陀螺仪无法比拟的优点广泛应用于武器装备系统。弹载惯导系统中的MEMS陀螺仪(简称弹载MEMS陀螺仪)作为系统的核心元件,其精度和性能在弹体的姿态测量中起着至关重要的作用。在实际应用中,当弹体发射时,弹载MEMS陀螺仪会受到较大的过载作用,由此导致弹载MEMS陀螺仪发生零偏(即弹载MEMS陀螺仪的零位发生显著偏移),从而导致弹体的姿态测量结果出现巨大误差。基于此,有必要发明一种对弹载MEMS陀螺仪的零偏进行在线修正的方法,以解决弹载MEMS陀螺仪的零偏导致弹体的姿态测量结果出现巨大误差的问题。
技术实现要素:
本发明为了解决弹载MEMS陀螺仪的零偏导致弹体的姿态测量结果出现巨大误差的问题,提供了一种炮击后陀螺零偏修正方法。
本发明是采用如下技术方案实现的:
一种炮击后陀螺零偏修正方法,该方法是采用如下步骤实现的:
步骤S1:定义弹体的发射坐标系为导航坐标系,简称n系;定义弹体坐标系为载体坐标系,简称b系;惯性坐标系简称i系;定义弹体出炮口20m处的时刻为零位修正时刻;定义弹体从发射点到出炮口20m处的飞行时间为t;
步骤S2:在弹体发射前,对弹载惯导系统进行初始对准;
步骤S3:在弹体发射后,根据弹载惯导系统中MEMS陀螺仪的实时输出,提取出弹体在零位修正时刻的偏航角ψ1、俯仰角θ1、滚转角γ1;
步骤S4:利用高精度三轴磁力仪获取n系三轴上的初始地磁场强度分量利用高精度三轴磁力仪实时获取地磁场强度在b系三轴上的分量,由此得出b系下的地磁场强度矢量Hb′并进行补偿;具体补偿公式如下:
Hb=(Hb′-offset)(CfsCNO)-1 (1);
式(1)中:Hb表示补偿后b系下的地磁场强度矢量;offset表示高精度三轴磁力仪的零点漂移矩阵;Cfs表示高精度三轴磁力仪的标度因数矩阵;CNO表示高精度三轴磁力仪的非正交矩阵;
根据Hb,计算出弹体在零位修正时刻的俯仰角θ2、滚转角γ2;具体计算公式如下:
式(2)中:分别表示Hb在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轴上的分量。
本发明所述的一种炮击后陀螺零偏修正方法通过有效利用弹体在空中的运动特性及三维磁测信息(即高精度三轴磁力仪获取的信息),实现了对弹载MEMS陀螺仪的零偏进行在线修正,由此大幅提高了弹体的姿态测量精度。
本发明有效解决了弹载MEMS陀螺仪的零偏导致弹体的姿态测量结果出现巨大误差的问题,适用于弹体的姿态测量。
附图说明
图1是本发明中弹体的发射时刻和零位修正时刻的示意图。
具体实施方式
一种炮击后陀螺零偏修正方法,该方法是采用如下步骤实现的:
步骤S1:定义弹体的发射坐标系为导航坐标系,简称n系;定义弹体坐标系为载体坐标系,简称b系;惯性坐标系简称i系;定义弹体出炮口20m处的时刻为零位修正时刻;定义弹体从发射点到出炮口20m处的飞行时间为t;
步骤S2:在弹体发射前,对弹载惯导系统进行初始对准;
步骤S3:在弹体发射后,根据弹载惯导系统中MEMS陀螺仪的实时输出,提取出弹体在零位修正时刻的偏航角ψ1、俯仰角θ1、滚转角γ1;
步骤S4:利用高精度三轴磁力仪获取n系三轴上的初始地磁场强度分量利用高精度三轴磁力仪实时获取地磁场强度在b系三轴上的分量,由此得出b系下的地磁场强度矢量Hb′并进行补偿;具体补偿公式如下:
Hb=(Hb′-offset)(CfsCNO)-1 (1);
式(1)中:Hb表示补偿后b系下的地磁场强度矢量;offset表示高精度三轴磁力仪的零点漂移矩阵;Cfs表示高精度三轴磁力仪的标度因数矩阵;CNO表示高精度三轴磁力仪的非正交矩阵;
根据Hb,计算出弹体在零位修正时刻的俯仰角θ2、滚转角γ2;具体计算公式如下:
式(2)中:分别表示Hb在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轴上的分量。