发明名称 一种标定捷联惯性组合加速度计组合的方法
摘要 本发明公开了一种标定捷联惯性组合加速度计组合的方法,将捷联惯性组合静置于18个位置,根据在一定测量时间内的脉冲输出值计算得到捷联惯性组合加速度计组合误差模型中的所有项系数,从而完成加速度计组合的标定。相比其他误差系数的标定方法,本发明完成了捷联惯性组合三个坐标轴加速度计的误差系数标定,实现了对加速度计二阶误差系数的标定,不仅提高了误差系数的标定精度,而且标定过程简单、所需时间短。
申请公布号 CN103868527A 申请公布日期 2014.06.18
申请号 CN201410073606.8 申请日期 2014.02.28
申请人 北京航天控制仪器研究所 发明人 魏宗康;刘璠;李念滨;赵龙;魏子寅
分类号 G01C25/00(2006.01)I 主分类号 G01C25/00(2006.01)I
代理机构 中国航天科技专利中心 11009 代理人 安丽
主权项 1.一种标定捷联惯性组合加速度计组合的方法,用于计算捷联惯性组合加速度计组合误差模型中的系数,捷联惯性组合加速度计组合误差模型为<maths num="0001"><![CDATA[<math><mfenced open='' close=''><mtable><mtr><mtd><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>A</mi><mi>xp</mi></msub></mtd></mtr><mtr><mtd><msub><mi>A</mi><mi>yp</mi></msub></mtd></mtr><mtr><mtd><msub><mi>A</mi><mi>zp</mi></msub></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>K</mi><mi>ax</mi></msub></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><msub><mi>K</mi><mi>ay</mi></msub></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><msub><mi>K</mi><mi>az</mi></msub></mtd></mtr></mtable></mfenced><mo>{</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>K</mi><mrow><mn>0</mn><mi>x</mi></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>K</mi><mrow><mn>0</mn><mi>y</mi></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>K</mi><mrow><mn>0</mn><mi>z</mi></mrow></msub></mtd></mtr></mtable></mfenced><mo>+</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mn>1</mn><mo>+</mo><msubsup><mi>&delta;K</mi><mi>ax</mi><mo>&prime;</mo></msubsup><mi>sign</mi><mrow><mo>(</mo><msub><mi>a</mi><mi>x</mi></msub><mo>)</mo></mrow></mtd><mtd><msub><mi>E</mi><mi>xy</mi></msub></mtd><mtd><msub><mi>E</mi><mi>xz</mi></msub></mtd></mtr><mtr><mtd><msub><mi>E</mi><mi>yx</mi></msub></mtd><mtd><mn>1</mn><mo>+</mo><msubsup><mi>&delta;K</mi><mi>ay</mi><mo>&prime;</mo></msubsup><mi>sign</mi><mrow><mo>(</mo><msub><mi>a</mi><mi>y</mi></msub><mo>)</mo></mrow></mtd><mtd><msub><mi>E</mi><mi>yz</mi></msub></mtd></mtr><mtr><mtd><msub><mi>E</mi><mi>zx</mi></msub></mtd><mtd><msub><mi>E</mi><mi>zy</mi></msub></mtd><mtd><mn>1</mn><mo>+</mo><msubsup><mi>&delta;K</mi><mi>ax</mi><mo>&prime;</mo></msubsup><mi>sign</mi><mrow><mo>(</mo><msub><mi>a</mi><mi>z</mi></msub><mo>)</mo></mrow></mtd></mtr></mtable></mfenced><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>a</mi><mi>x</mi></msub></mtd></mtr><mtr><mtd><msub><mi>a</mi><mi>y</mi></msub></mtd></mtr><mtr><mtd><msub><mi>a</mi><mi>z</mi></msub></mtd></mtr></mtable></mfenced></mtd></mtr><mtr><mtd><mo>+</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>K</mi><mrow><mn>2</mn><mi>x</mi></mrow></msub><mo>+</mo><msubsup><mi>&delta;K</mi><mrow><mn>2</mn><mi>x</mi></mrow><mo>&prime;</mo></msubsup><mi>sign</mi><mrow><mo>(</mo><msub><mi>a</mi><mi>x</mi></msub><mo>)</mo></mrow></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><msub><mi>K</mi><mrow><mn>2</mn><mi>y</mi></mrow></msub><mo>+</mo><msubsup><mi>&delta;K</mi><mrow><mn>2</mn><mi>y</mi></mrow><mo>&prime;</mo></msubsup><mi>sign</mi><mrow><mo>(</mo><msub><mi>a</mi><mi>y</mi></msub><mo>)</mo></mrow></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><msub><mi>K</mi><mrow><mn>2</mn><mi>z</mi></mrow></msub><mo>+</mo><msubsup><mi>&delta;K</mi><mrow><mn>2</mn><mi>z</mi></mrow><mo>&prime;</mo></msubsup><mi>sign</mi><mrow><mo>(</mo><msub><mi>a</mi><mi>z</mi></msub><mo>)</mo></mrow></mtd></mtr></mtable></mfenced><mfenced open='[' close=']'><mtable><mtr><mtd><msubsup><mi>a</mi><mi>x</mi><mn>2</mn></msubsup></mtd></mtr><mtr><mtd><msubsup><mi>a</mi><mi>y</mi><mn>2</mn></msubsup></mtd></mtr><mtr><mtd><msubsup><mi>a</mi><mi>z</mi><mn>2</mn></msubsup></mtd></mtr></mtable></mfenced></mtd></mtr><mtr><mtd><mtable><mtr><mtd><mrow><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>K</mi><mi>xy</mi></msub></mtd><mtd><msub><mi>K</mi><mi>xz</mi></msub></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><msub><mi>K</mi><mi>yx</mi></msub></mtd><mtd><mn>0</mn></mtd><mtd><msub><mi>K</mi><mi>yz</mi></msub></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><msub><mi>K</mi><mi>zx</mi></msub></mtd><mtd><msub><mi>K</mi><mi>zy</mi></msub></mtd></mtr></mtable></mfenced><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>a</mi><mi>x</mi></msub><msub><mi>a</mi><mi>y</mi></msub></mtd></mtr><mtr><mtd><msub><mi>a</mi><mi>x</mi></msub><msub><mi>a</mi><mi>z</mi></msub></mtd></mtr><mtr><mtd><msub><mi>a</mi><mi>y</mi></msub><msub><mi>a</mi><mi>z</mi></msub></mtd></mtr></mtable></mfenced><mo>}</mo></mrow></mtd></mtr></mtable></mtd></mtr></mtable></mfenced></math>]]></maths>其中,K<sub>ax</sub>、K<sub>ay</sub>、K<sub>az</sub>分别为X、Y、Z轴的标度因数,K<sub>0x</sub>、K<sub>0y</sub>、K<sub>0z</sub>分别为X、Y、Z轴的零值偏差,E<sub>xy</sub>为Y轴相对于X轴的安装误差角、E<sub>xz</sub>为Z轴相对于X轴的安装误差角、E<sub>yx</sub>为X轴相对于Y轴的安装误差角、E<sub>yz</sub>为Z轴相对于Y轴的安装误差角、E<sub>zx</sub>为X轴相对于Z轴的安装误差角、E<sub>zy</sub>为Y轴相对于Z轴的安装误差角,δK'<sub>ax</sub>、δK'<sub>ay</sub>、δK'<sub>az</sub>分别为X、Y、Z轴的标度因数不对称性相对误差,K<sub>2x</sub>、K<sub>2y</sub>、K<sub>2z</sub>分别为X、Y、Z轴的二次项误差系数,δK'<sub>2x</sub>、δK'<sub>2y</sub>、δK'<sub>2z</sub>分别为X、Y、Z轴的奇二次项系数误差,K<sub>xy</sub>为X、Y轴向乘积对X轴的交叉耦合项系数、K<sub>xz</sub>为X、Z轴向乘积对X轴的交叉耦合项系数、K<sub>yx</sub>为X、Y轴向乘积对Y轴的交叉耦合项系数、K<sub>yz</sub>为Y、Z轴向乘积对Y轴的交叉耦合项系数、K<sub>zx</sub>为X、Z轴向乘积对Z轴的交叉耦合项系数、K<sub>zy</sub>为Y、Z轴向乘积对Z轴的交叉耦合项系数;A<sub>xp</sub>、A<sub>yp</sub>、A<sub>zp</sub>分别为捷联惯性组合中X、Y、Z轴输出的脉冲频率,每一个位置的脉冲频率由该位置的测量时间和X、Y、Z轴输出的脉冲个数决定;a<sub>x</sub>、a<sub>y</sub>、a<sub>z</sub>分别为捷联惯性组合X、Y、Z轴向视加速度分量;其特征在于步骤如下:(1)将捷联惯性组合静置于18个不同的位置;(2)在第i个位置时,采集捷联惯性组合的X、Y、Z轴加速度计经过Δt秒输出的脉冲个数A<sub>x</sub>(i)、A<sub>y</sub>(i)和A<sub>z</sub>(i),其中i∈[1,18];(3)根据步骤(2)中经过测量时间Δt输出的脉冲个数,计算捷联惯性组合加速度计组合误差模型中的误差系数,包括标度因数、零值偏差、安装误差角、标度因数不对称性相对误差、二次项误差系数、奇二次项系数误差、交叉耦合项系数;(4)将通过步骤(3)得到的系数反馈到捷联惯性组合加速度计组合误差模型中,完成捷联惯性组合加速度计组合的标定。
地址 100854 北京市海淀区北京142信箱403分箱