发明名称 一种基准不确定情况下陀螺仪组合误差系数标定方法
摘要 本发明涉及一种误差系数标定方法,尤其涉及一种基准不确定情况下陀螺仪组合误差系数标定方法,属于捷联惯性组合标定技术领域,可用于标定捷联惯性组合中陀螺仪组合的场合。本发明在基准不确定情况下也能将陀螺仪组合误差系数进行标定,提高外场标定效率,并提高标定系数的精度。本发明的方法测试位置多,包含更多的信息,这能够提高标定结果的精度和可靠性;本发明的方法测试耗时少、计算简单,能够快速完成惯性组合陀螺仪组合的标定。仅利用多位置静态测试就标定出陀螺仪组合的误差系数,大大简化了标定流程。进行标定时可以采用的双轴旋转机构可以为双轴精密转台、三轴精密转台或者其他可实现双轴旋转的装置,降低了对测试设备的要求。
申请公布号 CN104596543A 申请公布日期 2015.05.06
申请号 CN201510016565.3 申请日期 2015.01.13
申请人 北京航天控制仪器研究所 发明人 魏宗康;黄超;刘璠
分类号 G01C25/00(2006.01)I 主分类号 G01C25/00(2006.01)I
代理机构 中国航天科技专利中心 11009 代理人 张丽娜
主权项 一种基准不确定情况下陀螺仪组合误差系数标定方法,其特征在于:该方法用于在基准不确定情况下计算捷联惯性组合中陀螺仪组合误差模型的系数,在基准不确定情况下,安装在双轴旋转机构上的捷联惯性组合陀螺仪组合误差模型为<maths num="0001" id="cmaths0001"><math><![CDATA[<mfenced open='' close='u'><mtable><mtr><mtd><mfenced open='[' close=']'><mtable><mtr><mtd><msup><msub><mi>&omega;</mi><mi>x</mi></msub><mo>&prime;</mo></msup></mtd></mtr><mtr><mtd><msup><msub><mi>&omega;</mi><mi>y</mi></msub><mo>&prime;</mo></msup></mtd></mtr><mtr><mtd><msup><msub><mi>&omega;</mi><mi>z</mi></msub><mo>&prime;</mo></msup></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mn>1</mn><mo>+</mo><msub><mi>&delta;k</mi><mi>gx</mi></msub></mtd><mtd><msub><mi>&delta;E</mi><mi>YX</mi></msub></mtd><mtd><msub><mi>&delta;E</mi><mi>ZX</mi></msub></mtd></mtr><mtr><mtd><msub><mi>&delta;E</mi><mi>XY</mi></msub></mtd><mtd><mn>1</mn><mo>+</mo><msub><mi>&delta;k</mi><mi>gy</mi></msub></mtd><mtd><msub><mi>&delta;E</mi><mi>ZY</mi></msub></mtd></mtr><mtr><mtd><msub><mi>&delta;E</mi><mi>XZ</mi></msub></mtd><mtd><msub><mi>&delta;E</mi><mi>YZ</mi></msub></mtd><mtd><mn>1</mn><mo>+</mo><msub><mi>&delta;k</mi><mi>gz</mi></msub></mtd></mtr></mtable></mfenced><mfenced open='[' close=']'><mtable><mtr><mtd><mi>cos</mi><mi>&alpha;</mi></mtd><mtd><mi>sin</mi><mi></mi><mi>&alpha;</mi><mi>cos</mi><mi>&beta;</mi></mtd><mtd><mi>sin</mi><mi></mi><mi>&alpha;</mi><mi>sin</mi><mi>&beta;</mi></mtd></mtr><mtr><mtd><mo>-</mo><mi>sin</mi><mi>&alpha;</mi></mtd><mtd><mi>cos</mi><mi></mi><mi>&alpha;</mi><mi>cos</mi><mi>&beta;</mi></mtd><mtd><mi>cos</mi><mi></mi><mi>&alpha;</mi><mi>sin</mi><mi>&beta;</mi></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mo>-</mo><mi>sin</mi><mi>&beta;</mi></mtd><mtd><mi>cos</mi><mi>&beta;</mi></mtd></mtr></mtable></mfenced></mtd></mtr><mtr><mtd><mo>&times;</mo><mtable><mtr><mtd><mrow><mfenced open='[' close=']'><mtable><mtr><mtd><mrow><mo>(</mo><mi>sin</mi><mi></mi><mi>&psi;</mi><mi>cos</mi><mi>&gamma;</mi><mo>+</mo><mi>sin</mi><mi></mi><mi>&gamma;</mi><mi>sin</mi><mi></mi><mi>&theta;</mi><mi>cos</mi><mi>&psi;</mi><mo>)</mo></mrow><msub><mi>&Omega;</mi><mi>n</mi></msub><mo>-</mo><mi>sin</mi><mi>&gamma;</mi><mi>cos</mi><mi>&theta;</mi><msub><mi>&Omega;</mi><mi>u</mi></msub></mtd></mtr><mtr><mtd><mi>cos</mi><mi></mi><mi>&theta;</mi><mi>cos</mi><mi>&psi;</mi><msub><mi>&Omega;</mi><mi>n</mi></msub><mo>+</mo><mi>sin</mi><mi>&theta;</mi><msub><mi>&Omega;</mi><mi>u</mi></msub></mtd></mtr><mtr><mtd><mrow><mo>(</mo><mi>sin</mi><mi></mi><mi>&psi;</mi><mi>sin</mi><mi>&gamma;</mi><mo>-</mo><mi>sin</mi><mi></mi><mi>&theta;</mi><mi>cos</mi><mi></mi><mi>&gamma;</mi><mi>cos</mi><mi>&psi;</mi><mo>)</mo></mrow><msub><mi>&Omega;</mi><mi>n</mi></msub><mo>+</mo><mi>cos</mi><mi></mi><mi>&theta;</mi><mi>cos</mi><mi>&gamma;</mi><msub><mi>&Omega;</mi><mi>u</mi></msub></mtd></mtr></mtable></mfenced></mrow></mtd></mtr></mtable><mo>+</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>&delta;D</mi><mrow><mn>0</mn><mi>x</mi></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>&delta;D</mi><mrow><mn>0</mn><mi>y</mi></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>&delta;D</mi><mrow><mn>0</mn><mi>z</mi></mrow></msub></mtd></mtr></mtable></mfenced></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000655650580000011.GIF" wi="1602" he="523" /></maths>其中:Ω<sub>n</sub>=ω<sub>ie</sub>cosL,Ω<sub>n</sub>为地球转速投影到地理坐标系中的北向分量;Ω<sub>u</sub>=ω<sub>ie</sub> sinL,Ω<sub>u</sub>为地球转速投影到地理坐标系中的天向分量;ω<sub>ie</sub>为地球自转角速度;L为测试地点地球纬度;ω<sub>x</sub>′、ω<sub>y</sub>′和ω<sub>z</sub>′分别为经补偿得到的捷联惯性组合X、Y、Z轴角速度;δD<sub>0x</sub>、δD<sub>0y</sub>和δD<sub>0z</sub>分别为X、Y、Z轴陀螺仪的零次项偏差;δk<sub>gx</sub>、δk<sub>gy</sub>和δk<sub>gz</sub>分别为X、Y、Z轴陀螺仪的标度因数偏差;δE<sub>YX</sub>为X轴相对于Y轴的安装误差角偏差;δE<sub>ZX</sub>为X轴相对于Z轴的安装误差角偏差;δE<sub>XY</sub>为Y轴相对于X轴的安装误差角偏差;δE<sub>ZY</sub>为Y轴相对于Z轴的安装误差角偏差;δE<sub>XZ</sub>为Z轴相对于X轴的安装误差角偏差;δE<sub>YZ</sub>为Z轴相对于Y轴的安装误差角偏差;α为双轴旋转机构内框架的旋转角;β为双轴旋转机构外框架的旋转角;ψ为捷联惯性组合第一个测量位置的姿态方位角、θ为捷联惯性组合第一个测量位置的姿态俯仰角,γ为捷联惯性组合第一个测量位置的姿态滚转角;步骤如下:(1)将捷联惯性组合安装在双轴旋转机构上,调节双轴旋转机构使捷联惯性组合静置于16个不同的位置;(2)在第i位置时,采集捷联惯性组合X、Y、Z轴加速度计经过Δt秒输出的脉冲数N<sub>ax</sub>(i)、N<sub>ay</sub>(i)和N<sub>az</sub>(i),采集捷联惯性组合X、Y、Z轴陀螺仪经过Δt输出的脉冲数N<sub>gx</sub>(i)、N<sub>gy</sub>(i)和N<sub>gz</sub>(i)并且记录该位置双轴旋转机构内外框架的旋转角α(i)和β(i),计算X、Y、Z轴加速度计的脉冲数输出频率A<sub>x</sub>(i)、A<sub>y</sub>(i)和A<sub>z</sub>(i)及X、Y、Z轴陀螺仪组合的脉冲数输出频率G<sub>x</sub>(i)、G<sub>y</sub>(i)和G<sub>z</sub>(i),其中i=1,2,3...16,Δt的取值范围为60‑90秒;(3)根据步骤(2)得到的十六个位置的陀螺仪组合和加速度计组合的脉冲数输出频率,并结合已知的误差系数经多次测量取得的均值,计算得到各位置经补偿的捷联惯性组合X、Y、Z轴加速度a<sub>bX</sub>′(i)、a<sub>bY</sub>′(i)、a<sub>bZ</sub>′(i)和角速度ω<sub>x</sub>′(i)、ω<sub>y</sub>′(i)、ω<sub>z</sub>′(i);其中,已知的误差系数包括加速度计组合的零次项、标度因数、安装误差角、标度因数不对称项误差以及陀螺仪组合的零次项、标度因数、安装误差角;(4)计算得到捷联惯性组合在第一个位置的初始俯仰角θ<sub>0</sub>、初始滚转角γ<sub>0</sub>和初始方位角ψ<sub>0</sub>;(5)根据步骤(2)中得到的十六个位置内外框架旋转角、步骤(3)中计算得到的陀螺仪组合经过补偿后得到的角速度、步骤(4)中计算所得的初始姿态角以及加速度计组合输出的精确的初始俯仰角和初始滚转角,计算捷联惯性组合陀螺仪组合误差模型中的误差系数偏差,包括标度因数偏差、零次项偏差、安装误差角偏差、初始方位角误差;(6)令方位角为初始方位角与其对应误差之和,代入步骤(5)中进行重新计算,得到新的方位角误差;多次重复计算后得到双轴旋转机构在第1位置处精确的方位角,同时可得陀螺仪组合各误差系数偏差的值;(7)将通过步骤(6)得到的误差系数偏差与已知的陀螺仪组合的零次项、标度因数、安装误差角对应求和,得到陀螺仪组合的误差系数精确值,实现基准不确定情况下陀螺仪组合误差系数标定。
地址 100854 北京市海淀区北京142信箱403分箱