发明名称 一种惯性稳定平台系统加速度计组合误差标定和补偿方法
摘要 本发明公开了一种惯性稳定平台系统加速度计组合误差标定和补偿方法,在惯性稳定平台系统处于静基座的状态下,平台台体相对于惯性空间实现6个正交位置,通过对加速度计组合的数据进行处理后可标定和分离出15个误差系数,并经过误差补偿后可显著减小拟合残差。相比其他误差系数的标定方法,本发明完成了惯性稳定平台系统三个坐标轴加速度计的误差系数标定和补偿,不仅提高了误差系数的标定精度,而且标定过程简单、所需时间短。
申请公布号 CN105371868A 申请公布日期 2016.03.02
申请号 CN201510779607.9 申请日期 2015.11.13
申请人 北京航天控制仪器研究所 发明人 魏宗康;赵长山;周元
分类号 G01C25/00(2006.01)I;G01C21/16(2006.01)I;G01P21/00(2006.01)I;G01P15/18(2013.01)I;G01P15/02(2013.01)I 主分类号 G01C25/00(2006.01)I
代理机构 中国航天科技专利中心 11009 代理人 范晓毅
主权项 一种惯性稳定平台系统加速度计组合误差标定和补偿方法,其特征在于包括以下步骤:(1)、在静基座条件下,将惯性稳定平台系统的平台台体分别静置在六个相正交的位置,使得稳定平台系统在六个位置上的X、Y、Z轴向视加速度分量的取值分别为:第一组取值:a<sub>x</sub>=0、a<sub>y</sub>=1、a<sub>z</sub>=0;第二组取值:a<sub>x</sub>=1、a<sub>y</sub>=0、a<sub>z</sub>=0;第三组取值:a<sub>x</sub>=0、a<sub>y</sub>=‑1、a<sub>z</sub>=0;第四组取值:a<sub>x</sub>=‑1、a<sub>y</sub>=0、a<sub>z</sub>=0;第五组取值:a<sub>x</sub>=0、a<sub>y</sub>=0、a<sub>z</sub>=‑1;第六组取值:a<sub>x</sub>=0、a<sub>y</sub>=0、a<sub>z</sub>=1;其中,a<sub>x</sub>、a<sub>y</sub>、a<sub>z</sub>分别为惯性稳定平台系统在X、Y、Z轴向视加速度分量;(2)、在步骤(1)确定的每个位置上采集惯性稳定平台系统的X、Y、Z轴加速度计的输出数据,并分别对所述输出数据求取平均值,得到X轴加速度测量值A<sub>x</sub>、Y轴加速度测量值A<sub>y</sub>、Z轴加速度测量值A<sub>z</sub>;(3)、将步骤(1)中六个位置上的视加速度分量取值,以及步骤(2)中测量得到的六个位置上的加速度测量值,代入到设定的惯性稳定平台系统加速度计组合误差数学模型中,计算得到所述数学模型中的误差系数;所述误差模型数学模型如下:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><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><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><msub><mi>K</mi><mrow><mi>a</mi><mi>x</mi></mrow></msub></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><msub><mi>K</mi><mrow><mi>a</mi><mi>y</mi></mrow></msub></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><msub><mi>K</mi><mrow><mi>a</mi><mi>z</mi></mrow></msub></mtd></mtr></mtable></mfenced><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><mn>1</mn><mo>+</mo><msubsup><mi>&delta;K</mi><mrow><mi>a</mi><mi>x</mi></mrow><mo>&prime;</mo></msubsup><mi>s</mi><mi>i</mi><mi>g</mi><mi>n</mi><mrow><mo>(</mo><msub><mi>a</mi><mi>x</mi></msub><mo>)</mo></mrow></mrow></mtd><mtd><msub><mi>E</mi><mrow><mi>x</mi><mi>y</mi></mrow></msub></mtd><mtd><msub><mi>E</mi><mrow><mi>x</mi><mi>z</mi></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>E</mi><mrow><mi>y</mi><mi>x</mi></mrow></msub></mtd><mtd><mrow><mn>1</mn><mo>+</mo><msubsup><mi>&delta;K</mi><mrow><mi>a</mi><mi>y</mi></mrow><mo>&prime;</mo></msubsup><mi>s</mi><mi>i</mi><mi>g</mi><mi>n</mi><mrow><mo>(</mo><msub><mi>a</mi><mi>y</mi></msub><mo>)</mo></mrow></mrow></mtd><mtd><msub><mi>E</mi><mrow><mi>y</mi><mi>z</mi></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>E</mi><mrow><mi>z</mi><mi>x</mi></mrow></msub></mtd><mtd><msub><mi>E</mi><mrow><mi>z</mi><mi>y</mi></mrow></msub></mtd><mtd><mrow><mn>1</mn><mo>+</mo><msubsup><mi>&delta;K</mi><mrow><mi>a</mi><mi>z</mi></mrow><mo>&prime;</mo></msubsup><mi>s</mi><mi>i</mi><mi>g</mi><mi>n</mi><mrow><mo>(</mo><msub><mi>a</mi><mi>z</mi></msub><mo>)</mo></mrow></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><mo>;</mo></mrow>]]></math><img file="FDA0000846751930000011.GIF" wi="1909" he="239" /></maths>其中,所述误差系数包括:X、Y、Z轴的标度因数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>;Y轴相对于X轴的安装误差角E<sub>xy</sub>;Z轴相对于X轴的安装误差角E<sub>xz</sub>;X轴相对于Y轴的安装误差角E<sub>yx</sub>;Z轴相对于Y轴的安装误差角E<sub>yz</sub>;X轴相对于Z轴的安装误差角E<sub>zx</sub>;Y轴相对于Z轴的安装误差角E<sub>zy</sub>;X、Y、Z轴的标度因数不对称性相对误差δK'<sub>ax</sub>、δK'<sub>ay</sub>、δK'<sub>az</sub>;(4)、将步骤(3)计算得到的误差系数反馈到惯性稳定平台系统加速度计组合误差补偿模型中,对各加速度计的测量数据进行补偿计算,得到惯性稳定平台系统在X、Y、Z轴向视加速度分量a<sub>x</sub>、a<sub>y</sub>、a<sub>z</sub>。
地址 100854 北京市海淀区北京142信箱403分箱