发明名称 一种在单轴旋转捷联惯导系统中刻度因数误差的补偿方法
摘要 本发明提供的是一种在单轴旋转捷联惯导系统中对刻度因数误差进行补偿的方法。对于单轴四位置旋转方案下的光纤捷联惯导系统,在其采集陀螺仪输出和加速度计输出的基础上,利用罗经回路原理,完成捷联惯导系统的对准过程;建立新的刻度因数误差模型,并建立含刻度因数误差的状态变量的卡尔曼滤波状态方程及以速度误差为观测量的量测方程;对刻度因数误差进行估计并补偿,消除刻度因数误差的影响。本发明对于单轴四位置旋转方案下的高精度捷联惯导系统来说,克服了在有刻度因数误差的情况下,陀螺漂移估计不准的缺点,在不提高惯性器件精度的条件下,提高了对准精度;与普通模型相比,克服了刻度因数误差不能补偿的缺点,在不增加系统成本的条件下,可以较高幅度的提高系统的精度。
申请公布号 CN103256943A 申请公布日期 2013.08.21
申请号 CN201310156770.0 申请日期 2013.04.26
申请人 哈尔滨工程大学 发明人 高伟;张亚;奔粤阳;孙骞;周广涛;张勇刚;徐博;黄平;王伟;吴磊
分类号 G01C25/00(2006.01)I 主分类号 G01C25/00(2006.01)I
代理机构 代理人
主权项 1.一种在单轴旋转捷联惯导系统中刻度因数误差的补偿方法,其特征包括以下步骤:(1)光纤陀螺捷联惯导系统预热后采集光纤陀螺仪和石英挠性加速度计输出的数据。(2)根据加速度计的输出与重力加速度的关系以及陀螺仪输出与地球旋转角速率的关系初步确定此时的姿态信息(纵摇角θ,横摇角γ和航向角ψ),完成捷联惯导系统的粗对准。(3)以粗对准给出的姿态信息作为初始值,利用罗经回路原理,建立载体坐标系b和计算地理坐标系n′之间的转换矩阵,完成捷联惯导系统的精对准。(4)建立新的刻度因数误差模型,并建立以位置误差、速度误差、失准角、加速度计零偏、陀螺漂移和刻度因数误差为状态变量的卡尔曼滤波状态方程及以速度误差为观测量的量测方程。(5)利用步骤(4)所建立的卡尔曼滤波方程,对z轴的陀螺刻度因数误差δK<sub>z</sub>进行滤波估计。(6)将估计出的δK<sub>z</sub>按下式进行补偿:<maths num="0001"><![CDATA[<math><mrow><msub><mi>&omega;</mi><mi>ib</mi></msub><mo>=</mo><msub><mover><mi>&omega;</mi><mo>^</mo></mover><mi>ib</mi></msub><mo>-</mo><mi>&delta;</mi><msub><mi>&omega;</mi><mrow><mo>(</mo><mi>&delta;K</mi><mo>)</mo></mrow></msub><mo>=</mo><mfrac><msub><mover><mi>&omega;</mi><mo>^</mo></mover><mi>ib</mi></msub><mrow><mn>1</mn><mo>+</mo><mi>&delta;K</mi></mrow></mfrac></mrow></math>]]></maths>其中,ω<sub>ib</sub>为陀螺的理论输出值;<img file="FSA00000889920500012.GIF" wi="58" he="57" />为陀螺的实际输出值;δω<sub>(δK)</sub>是由刻度因数误差造成的陀螺输出误差,δK为陀螺三个轴向的刻度因数误差,记为δK=[δK<sub>x</sub> δK<sub>y</sub> δK<sub>z</sub>]<sup>T</sup>。这样刻度因数误差的影响就被补偿掉,此时陀螺输出值中已经不再包含刻度因数误差的影响。
地址 150001 黑龙江省哈尔滨市南岗区南通大街145号