发明名称 一种恒加速度和振动复合输入情况下的线加速度计校准方法
摘要 本发明公开了一种恒加速度和振动复合输入情况下的线加速度计校准方法,包括以下几个步骤:步骤一、获取恒加速度与振动复合的标准加速度;步骤二、获得线加速度计的整流误差模型;步骤三、确定线加速度计的整流误差模型中的参数,完成校准。本发明为线加速度计的校准提供一种新的方法,能够实现对恒加速度和振动复合输入的线加速度计校准,完善线加速度计性能的测试,提高线加速度计在实际使用当中的精度。
申请公布号 CN104655876A 申请公布日期 2015.05.27
申请号 CN201510046780.8 申请日期 2015.01.29
申请人 北京航空航天大学 发明人 孟晓风;董雪明;关伟
分类号 G01P21/00(2006.01)I 主分类号 G01P21/00(2006.01)I
代理机构 北京永创新实专利事务所 11121 代理人 赵文颖
主权项 一种恒加速度和振动复合输入情况下的线加速度计校准方法,包括以下几个步骤:步骤一、获取恒加速度与振动复合的标准加速度,其向量形式用公式(2)表示;a=a<sub>c</sub>+a<sub>v</sub>+g   (2)其中,a是恒加速度与振动复合的标准加速度向量,a<sub>c</sub>是恒加速度向量,a<sub>v</sub>是振动向量,g是重力加速度向量;标准加速度向量a在加速度计输入轴、输出轴和摆轴上的投影表示为:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>a</mi><mi>i</mi></msub><mo>=</mo><msub><mi>a</mi><mi>vi</mi></msub><mi>sin</mi><mi>&omega;t</mi><mo>+</mo><msub><mi>a</mi><mi>ci</mi></msub><mo>+</mo><msub><mi>g</mi><mi>i</mi></msub></mtd></mtr><mtr><mtd><msub><mi>a</mi><mi>o</mi></msub><mo>=</mo><msub><mi>a</mi><mi>vo</mi></msub><mi>sin</mi><mi>&omega;t</mi><mo>+</mo><msub><mi>a</mi><mi>co</mi></msub><mo>+</mo><msub><mi>g</mi><mi>o</mi></msub></mtd></mtr><mtr><mtd><msub><mi>a</mi><mi>p</mi></msub><mo>=</mo><msub><mi>a</mi><mi>vp</mi></msub><mi>sin</mi><mi>&omega;t</mi><mo>+</mo><msub><mi>a</mi><mi>cp</mi></msub><mo>+</mo><msub><mi>g</mi><mi>p</mi></msub></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000663842400000011.GIF" wi="1412" he="292" /></maths>其中,a<sub>i</sub>、a<sub>o</sub>和a<sub>p</sub>分别是标准加速度向量a在输入轴、输出轴和摆轴方向的投影;相应地,a<sub>vi</sub>、a<sub>vo</sub>和a<sub>vp</sub>分别是振动向量a<sub>v</sub>在输入轴、输出轴和摆轴方向的投影;a<sub>ci</sub>、a<sub>co</sub>和a<sub>cp</sub>是恒加速度向量a<sub>c</sub>在输入轴、输出轴和摆轴方向的投影;g<sub>i</sub>、g<sub>o</sub>和g<sub>p</sub>是重力加速度向量g在输入轴、输出轴和摆轴方向的投影;ω是振动的角速率;t表示振动对应的时刻,即:<img file="FDA0000663842400000012.GIF" wi="167" he="117" />其中,T表示振动的周期;N表示振动周期内的振动的采样点数量;n表示采样点的序号,0≤n≤N;步骤二、获得线加速度计的整流误差模型;具体操作步骤为:步骤2.1:建立加速度计静态误差模型,如公式(4)所示;Y=K<sub>0</sub>+K<sub>i</sub>a<sub>i</sub>+K<sub>ii</sub>a<sub>i</sub><sup>2</sup>+K<sub>iii</sub>a<sub>i</sub><sup>3</sup>+K<sub>io</sub>a<sub>i</sub>a<sub>o</sub>+K<sub>ip</sub>a<sub>i</sub>a<sub>p</sub>+ε   (4)其中,Y是线加速度计的输出量,K<sub>0</sub>是零位偏置,K<sub>i</sub>是标度因数,K<sub>ii</sub>是二阶非线性系数,K<sub>iii</sub>是三阶非线性系数,K<sub>ip</sub>是输入轴和摆轴的交叉耦合系数;K<sub>io</sub>是输入轴和输出轴的交叉耦合系数;ε为包含其他随机误差项;步骤2.2:将步骤一得到的标准加速度向量a在加速度计输入轴、输出轴和摆轴上的投影a<sub>i</sub>、a<sub>o</sub>和a<sub>p</sub>带入到公式(4),通过对线加速度计的校准,得到零位偏置K<sub>0</sub>和标度因数K<sub>i</sub>的值;步骤2.3:将整个测试的时间长度为3mT,T为振动的周期,m为正整数,且m∈[20,50];在测试的时间长度3mT内,将公式(4)对应的加速度计的输出量进行算术平均,如公式(5)所示:<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><mfenced open='' close=''><mtable><mtr><mtd><mover><mi>Y</mi><mo>&OverBar;</mo></mover><mo>=</mo><msub><mi>K</mi><mn>0</mn></msub><mo>+</mo><msub><mi>K</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>a</mi><mi>ci</mi></msub><mo>+</mo><msub><mi>g</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>+</mo><msub><mi>K</mi><mi>ii</mi></msub><mo>[</mo><mfrac><msubsup><mi>a</mi><mi>vi</mi><mn>2</mn></msubsup><mn>2</mn></mfrac><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>a</mi><mi>ci</mi></msub><mo>+</mo><msub><mi>g</mi><mi>i</mi></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>]</mo></mtd></mtr><mtr><mtd><mo>+</mo><msub><mi>K</mi><mi>iii</mi></msub><mo>[</mo><mfrac><msubsup><mrow><mn>3</mn><mi>a</mi></mrow><mi>vi</mi><mn>2</mn></msubsup><mn>2</mn></mfrac><mrow><mo>(</mo><msub><mi>a</mi><mi>ci</mi></msub><mo>+</mo><msub><mi>g</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>a</mi><mi>ci</mi></msub><mo>+</mo><msub><mi>g</mi><mi>i</mi></msub><mo>)</mo></mrow><mn>3</mn></msup><mo>]</mo><mo>+</mo><msub><mi>K</mi><mi>io</mi></msub><mo>[</mo><mfrac><mrow><msub><mi>a</mi><mi>vi</mi></msub><msub><mi>a</mi><mi>vo</mi></msub></mrow><mn>2</mn></mfrac><mo>+</mo><mrow><mo>(</mo><msub><mi>a</mi><mi>ci</mi></msub><mo>+</mo><msub><mi>g</mi><mi>i</mi></msub><mo>)</mo></mrow><mrow><mo>(</mo><msub><mi>a</mi><mi>co</mi></msub><mo>+</mo><msub><mi>g</mi><mi>o</mi></msub><mo>)</mo></mrow><mo>]</mo></mtd></mtr><mtr><mtd><mo>+</mo><msub><mi>K</mi><mi>ip</mi></msub><mo>[</mo><mfrac><mrow><msub><mi>a</mi><mi>vi</mi></msub><msub><mi>a</mi><mi>vp</mi></msub></mrow><mn>2</mn></mfrac><mo>+</mo><mrow><mo>(</mo><msub><mi>a</mi><mi>ci</mi></msub><mo>+</mo><msub><mi>g</mi><mi>i</mi></msub><mo>)</mo></mrow><mrow><mo>(</mo><msub><mi>a</mi><mi>cp</mi></msub><mo>+</mo><msub><mi>g</mi><mi>p</mi></msub><mo>)</mo></mrow><mo>]</mo><mo>+</mo><mover><mi>&epsiv;</mi><mo>&OverBar;</mo></mover></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000663842400000021.GIF" wi="1732" he="495" /></maths>其中,<img file="FDA0000663842400000022.GIF" wi="49" he="72" />表示测试的时间长度3mT内加速度计的输出量的算术平均值,<img file="FDA0000663842400000023.GIF" wi="48" he="58" />表示其他随机误差项ε在测试时间长度3mT内的算术平均值;步骤2.4:通过公式(6)得到只有恒加速度作用时,整个测试的时间长度3mT内线加速度计的输出量的算术平均值<img file="FDA0000663842400000024.GIF" wi="91" he="76" /><maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><mfenced open='' close=''><mtable><mtr><mtd><mover><msub><mi>Y</mi><mn>0</mn></msub><mo>&OverBar;</mo></mover><mo>=</mo><msub><mi>K</mi><mn>0</mn></msub><mo>+</mo><msub><mi>K</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>a</mi><mi>ci</mi></msub><mo>+</mo><msub><mi>g</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>+</mo><msub><mi>K</mi><mi>ii</mi></msub><mo>[</mo><msup><mrow><mo>(</mo><msub><mi>a</mi><mi>ci</mi></msub><mo>+</mo><msub><mi>g</mi><mi>i</mi></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>]</mo></mtd></mtr><mtr><mtd><mo>+</mo><msub><mi>K</mi><mi>iii</mi></msub><mo>[</mo><msup><mrow><mo>(</mo><msub><mi>a</mi><mi>ci</mi></msub><mo>+</mo><msub><mi>g</mi><mi>i</mi></msub><mo>)</mo></mrow><mn>3</mn></msup><mo>]</mo><mo>+</mo><msub><mi>K</mi><mi>io</mi></msub><mo>[</mo><mrow><mo>(</mo><msub><mi>a</mi><mi>ci</mi></msub><mo>+</mo><msub><mi>g</mi><mi>i</mi></msub><mo>)</mo></mrow><mrow><mo>(</mo><msub><mi>a</mi><mi>co</mi></msub><mo>+</mo><msub><mi>g</mi><mi>o</mi></msub><mo>)</mo></mrow><mo>]</mo></mtd></mtr><mtr><mtd><mo>+</mo><msub><mi>K</mi><mi>ip</mi></msub><mo>[</mo><mrow><mo>(</mo><msub><mi>a</mi><mi>ci</mi></msub><mo>+</mo><msub><mi>g</mi><mi>i</mi></msub><mo>)</mo></mrow><mrow><mo>(</mo><msub><mi>a</mi><mi>cp</mi></msub><mo>+</mo><msub><mi>g</mi><mi>p</mi></msub><mo>)</mo></mrow><mo>]</mo><mo>+</mo><mover><mi>&epsiv;</mi><mo>&OverBar;</mo></mover></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>6</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000663842400000025.GIF" wi="1421" he="339" /></maths>其中,<img file="FDA0000663842400000026.GIF" wi="47" he="61" />表示其他随机误差项ε在测试时间长度3mT内的算术平均值;步骤2.5:用公式(5)减公式(6)得到初步整流误差表达式,如公式(7)所示:<maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><mi>&Delta;</mi><mrow><mo>(</mo><mi>dc</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>&Delta;K</mi><mn>0</mn></msub><mo>+</mo><msub><mi>K</mi><mi>ii</mi></msub><mfrac><msubsup><mi>a</mi><mi>vi</mi><mn>2</mn></msubsup><mn>2</mn></mfrac><mo>+</mo><msub><mi>K</mi><mi>iii</mi></msub><mfrac><msubsup><mrow><mn>3</mn><mi>a</mi></mrow><mi>vi</mi><mn>2</mn></msubsup><mn>2</mn></mfrac><mrow><mo>(</mo><msub><mi>a</mi><mi>ci</mi></msub><mo>+</mo><msub><mi>g</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>+</mo><msub><mi>K</mi><mi>io</mi></msub><mfrac><mrow><msub><mi>a</mi><mi>vi</mi></msub><msub><mi>a</mi><mi>vo</mi></msub></mrow><mn>2</mn></mfrac><mo>+</mo><msub><mi>K</mi><mi>ip</mi></msub><mfrac><mrow><msub><mi>a</mi><mi>vi</mi></msub><msub><mi>a</mi><mi>vp</mi></msub></mrow><mn>2</mn></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>7</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000663842400000027.GIF" wi="1571" he="148" /></maths>其中,Δ(dc)是初步整流误差,ΔK<sub>0</sub>是零位偏置在振动状态下与静止状态下的差值;步骤2.6:经过数据拟合,对零位偏置在振动状态下与静止状态下的差值ΔK<sub>0</sub>进行消除,得到无零位偏置的整流误差E<sub>rec</sub>,如公式(8)所示;<maths num="0005" id="cmaths0005"><math><![CDATA[<mrow><msub><mi>E</mi><mi>rec</mi></msub><mo>=</mo><mi>&Delta;</mi><mrow><mo>(</mo><mi>dc</mi><mo>)</mo></mrow><mo>-</mo><msub><mi>&Delta;K</mi><mn>0</mn></msub><mo>=</mo><msub><mi>K</mi><mi>ii</mi></msub><mfrac><msubsup><mi>a</mi><mi>vi</mi><mn>2</mn></msubsup><mn>2</mn></mfrac><mo>+</mo><msub><mi>K</mi><mi>iii</mi></msub><mfrac><msubsup><mi>a</mi><mi>vi</mi><mn>2</mn></msubsup><mn>2</mn></mfrac><mrow><mo>(</mo><msub><mi>a</mi><mi>ci</mi></msub><mo>+</mo><msub><mi>g</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>+</mo><msub><mi>K</mi><mi>io</mi></msub><mfrac><mrow><msub><mi>a</mi><mi>vi</mi></msub><msub><mi>a</mi><mi>vo</mi></msub></mrow><mn>2</mn></mfrac><mo>+</mo><msub><mi>K</mi><mi>ip</mi></msub><mfrac><mrow><msub><mi>a</mi><mi>vi</mi></msub><msub><mi>a</mi><mi>vp</mi></msub></mrow><mn>2</mn></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>8</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000663842400000028.GIF" wi="1652" he="140" /></maths>公式(8)即线加速度计的整流误差模型;步骤三、确定线加速度计的整流误差模型中的参数;在步骤二操作的基础上,确定线加速度计的整流误差模型中的4个参数K<sub>ii</sub>、K<sub>iii</sub>、K<sub>ip</sub>和K<sub>io</sub>;步骤3.1:设计试验方案,采用M种不同的形式安装被测加速度计进行试验,得到M组实验数据;其中,M是大于3的整数;步骤3.2:将M组数据分别带入到公式(8),得到M个方程组成的方程组,通过对方程组求解,得到整流误差模型中的参数K<sub>ii</sub>、K<sub>iii</sub>、K<sub>ip</sub>和K<sub>io</sub>,完成校准。
地址 100191 北京市海淀区学院路37号