发明名称 捷联式惯导测量组合中加速度计装配误差标量修正方法
摘要 本发明涉及一种测量误差修正方法,具体是一种捷联式惯导测量组合中加速度计装配误差标量修正方法。解决了现有微惯性测量组合误差补偿方案未考虑安装位置误差、且不适用所有类型加速度计的问题,该方法同时考虑安装方位误差与安装位置误差,既适合3陀螺3加速度计又适合全加速度计阵列;并能对微惯性测量组合MIMU中任何一只加速度计进行单独补偿,计算量小,补偿精度高。
申请公布号 CN101105503A 申请公布日期 2008.01.16
申请号 CN200710062037.7 申请日期 2007.06.02
申请人 中北大学 发明人 秦丽;余靖娜;张文栋;熊继军;刘俊;李杰;孟令军;张会新
分类号 G01P21/00(2006.01);G01P15/02(2006.01) 主分类号 G01P21/00(2006.01)
代理机构 山西太原科卫专利事务所 代理人 朱源
主权项 1.一种捷联式惯导测量组合中加速度计装配误差标量修正方法,根据在载体系中,加速度计j的实际输出值Arj减去理论输出值Aj等于误差值Aej,即Aej=Arj-Aj,则Aj=Arj-Aej;其特征在于:设加速度计j的理论安装位置和方位为uj和θj,实际位置和方位为urj和θrj,则加速度计实际输出和理论输出分别为:<mrow><msub><mi>A</mi><mi>rj</mi></msub><mrow><mo>(</mo><msub><mi>u</mi><mi>rj</mi></msub><mo>,</mo><msub><mi>&theta;</mi><mi>rj</mi></msub><mo>)</mo></mrow><mo>=</mo><mo>&lang;</mo><msubsup><mi>C</mi><mi>n</mi><mi>b</mi></msubsup><mrow><mo>(</mo><mover><mi>R</mi><mrow><mo>.</mo><mo>.</mo></mrow></mover><mo>-</mo><msub><mi>g</mi><mi>n</mi></msub><mo>)</mo></mrow><mo>+</mo><mrow><mo>(</mo><mover><mi>&Omega;</mi><mo>&CenterDot;</mo></mover><mo>+</mo><msup><mi>&Omega;</mi><mn>2</mn></msup><mo>)</mo></mrow><msub><mi>u</mi><mi>rj</mi></msub><mo>,</mo><msub><mi>&theta;</mi><mi>rj</mi></msub><mo>&rang;</mo><mo>=</mo><mo>&lang;</mo><msup><mi>f</mi><mi>b</mi></msup><mo>,</mo><msub><mi>&theta;</mi><mi>rj</mi></msub><mo>&rang;</mo><mo>+</mo><mo>&lang;</mo><msub><mi>Gu</mi><mi>rj</mi></msub><mo>,</mo><msub><mi>&theta;</mi><mi>rj</mi></msub><mo>&rang;</mo></mrow> <mrow><msub><mi>A</mi><mi>j</mi></msub><mrow><mo>(</mo><msub><mi>u</mi><mi>j</mi></msub><mo>,</mo><msub><mi>&theta;</mi><mi>j</mi></msub><mo>)</mo></mrow><mo>=</mo><mo>&lang;</mo><msubsup><mi>C</mi><mi>n</mi><mi>b</mi></msubsup><mrow><mo>(</mo><mover><mi>R</mi><mrow><mo>.</mo><mo>.</mo></mrow></mover><mo>-</mo><msub><mi>g</mi><mi>n</mi></msub><mo>)</mo></mrow><mo>+</mo><mrow><mo>(</mo><mover><mi>&Omega;</mi><mo>&CenterDot;</mo></mover><mo>+</mo><msup><mi>&Omega;</mi><mn>2</mn></msup><mo>)</mo></mrow><msub><mi>u</mi><mi>j</mi></msub><mo>,</mo><msub><mi>&theta;</mi><mi>j</mi></msub><mo>&rang;</mo><mo>=</mo><mo>&lang;</mo><msup><mi>f</mi><mi>b</mi></msup><mo>,</mo><msub><mi>&theta;</mi><mi>j</mi></msub><mo>&rang;</mo><mo>+</mo><mo>&lang;</mo><msub><mi>Gu</mi><mi>j</mi></msub><mo>,</mo><msub><mi>&theta;</mi><mi>j</mi></msub><mo>&rang;</mo></mrow> 其中: <mrow><msup><mi>f</mi><mi>b</mi></msup><mo>=</mo><msubsup><mi>C</mi><mi>n</mi><mi>b</mi></msubsup><mrow><mo>(</mo><mover><mi>R</mi><mrow><mo>.</mo><mo>.</mo></mrow></mover><mo>-</mo><msub><mi>g</mi><mi>n</mi></msub><mo>)</mo></mrow><mo>,</mo></mrow> <mrow><mi>G</mi><mo>=</mo><mover><mi>&Omega;</mi><mo>.</mo></mover><mo>+</mo><msup><mi>&Omega;</mi><mn>2</mn></msup><mo>,</mo></mrow> gn=[0;-9.8;0];根据Aej=Arj-Aj,得:<mrow><msub><mi>A</mi><mi>ej</mi></msub><mo>=</mo><msup><mrow><mo>(</mo><msup><mi>f</mi><mi>b</mi></msup><mo>)</mo></mrow><mi>T</mi></msup><msub><mi>&theta;</mi><mi>ej</mi></msub><mo>+</mo><msup><mrow><mo>(</mo><msubsup><mover><mi>&omega;</mi><mo>.</mo></mover><mi>ib</mi><mi>b</mi></msubsup><mo>)</mo></mrow><mi>T</mi></msup><mrow><mo>(</mo><msub><mi>u</mi><mi>rj</mi></msub><mo>&times;</mo><msub><mi>&theta;</mi><mi>ej</mi></msub><mo>+</mo><msub><mi>u</mi><mi>ej</mi></msub><mo>&times;</mo><msub><mi>&theta;</mi><mi>j</mi></msub><mo>)</mo></mrow><mo>+</mo><msubsup><mi>&theta;</mi><mi>ej</mi><mi>T</mi></msubsup><msup><mi>&Omega;</mi><mn>2</mn></msup><msub><mi>u</mi><mi>rj</mi></msub><mo>+</mo><msubsup><mi>&theta;</mi><mi>j</mi><mi>T</mi></msubsup><msup><mi>&Omega;</mi><mn>2</mn></msup><msub><mi>u</mi><mi>ej</mi></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow> 其中:fb:加速度计阵列质心视加速度uej:安装位置误差,uej=urj-uj urj:实际安装位置θej:方位误差,θej=θrj-θj θj:理论方位<mrow><msubsup><mover><mi>&omega;</mi><mo>.</mo></mover><mi>ib</mi><mi>b</mi></msubsup><mo>=</mo><mo>[</mo><msubsup><mover><mi>&omega;</mi><mo>.</mo></mover><mi>ibx</mi><mi>b</mi></msubsup><mo>,</mo><msubsup><mover><mi>&omega;</mi><mo>.</mo></mover><mi>iby</mi><mi>b</mi></msubsup><mo>,</mo><msubsup><mover><mi>&omega;</mi><mo>.</mo></mover><mi>ibz</mi><mi>b</mi></msubsup><mo>]</mo></mrow> 由式(1)知,装配误差Aej取决于载体的线运动和角运动,在载体只有线运动而没有角运动时,则装配误差只与加速度计安装方位误差有关,与安装位置误差无关;所述测加速度计实际安装位置urj的方法:将微惯性测量组合MIMU安装于三轴转台内框上,1)、归零,使载体坐标系的Xb,Yb,Zb分别与导航系的Xn,Yn,Zn 一致,R为微惯性测量组合MIMU质心距导航系原点的距离;2)、中框以位置方式转动α角;3)、内框以位置方式转动β角,R1为微惯性测量组合MIMU按照步骤3转动后其质心距Yn轴的距离;4)、外框以角速度ω匀速转动(如图4)。以使载体受重力和向心力的双重影响;在重力和向心力的作用下,可得:<mrow><msub><mi>R</mi><mi>n</mi></msub><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>R</mi><mo>&CenterDot;</mo><mi>sin</mi><mi></mi><mi>&alpha;</mi><mi>sin</mi><mi>&beta;</mi></mtd></mtr><mtr><mtd><mo>-</mo><mi>R</mi><mo>&CenterDot;</mo><mi>cos</mi><mi></mi><mi>&alpha;</mi><mi>sin</mi><mi>&beta;</mi></mtd></mtr><mtr><mtd><mi>R</mi><mo>&CenterDot;</mo><mi>cos</mi><mi>&beta;</mi></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow> <mrow><msub><mi>R</mi><mn>1</mn></msub><mo>=</mo><msqrt><msup><msub><mi>R</mi><mi>nx</mi></msub><mn>2</mn></msup><mo>+</mo><msup><msub><mi>R</mi><mi>nz</mi></msub><mn>2</mn></msup></msqrt></mrow> <mrow><msup><mi>f</mi><mi>b</mi></msup><mo>=</mo><msubsup><mi>C</mi><mi>n</mi><mi>b</mi></msubsup><mrow><mo>(</mo><mover><mi>R</mi><mrow><mo>.</mo><mo>.</mo></mrow></mover><mo>-</mo><msub><mi>g</mi><mi>n</mi></msub><mo>)</mo></mrow></mrow> <mrow><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mi>cos</mi><mi>&beta;</mi></mtd><mtd><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><mfenced open='[' close=']'><mtable><mtr><mtd><mi>cos</mi><mi>&alpha;</mi></mtd><mtd><mi>sin</mi><mi>&alpha;</mi></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mo>-</mo><mi>sin</mi><mi>&alpha;</mi></mtd><mtd><mi>cos</mi><mi>&alpha;</mi></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mfenced open='[' close=']'><mtable><mtr><mtd><mi>cos</mi><mrow><mo>(</mo><mi>&omega;t</mi><mo>)</mo></mrow></mtd><mtd><mn>0</mn></mtd><mtd><mo>-</mo><mi>sin</mi><mrow><mo>(</mo><mi>&omega;t</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mi>sin</mi><mrow><mo>(</mo><mi>&omega;t</mi><mo>)</mo></mrow></mtd><mtd><mn>0</mn></mtd><mtd><mi>cos</mi><mrow><mo>(</mo><mi>&omega;t</mi><mo>)</mo></mrow></mtd></mtr></mtable></mfenced><mfenced open='[' close=']'><mtable><mtr><mtd><mo>-</mo><msub><mi>R</mi><mn>1</mn></msub><msup><mi>&omega;</mi><mn>2</mn></msup><mi>sin</mi><mrow><mo>(</mo><mi>&omega;t</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msub><mi>g</mi><mi>n</mi></msub></mtd></mtr><mtr><mtd><mo>-</mo><msub><mi>R</mi><mn>1</mn></msub><msup><mi>&omega;</mi><mn>2</mn></msup><mi>cos</mi><mrow><mo>(</mo><mi>&omega;t</mi><mo>)</mo></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow> <mrow><mo>=</mo><msup><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>g</mi><mi>n</mi></msub><mi>sin</mi><mi>&alpha;</mi></mtd><mtd><msub><mi>g</mi><mi>n</mi></msub><mi>cos</mi><mi></mi><mi>&alpha;</mi><mi>cos</mi><mi>&beta;</mi><mo>-</mo><msub><mi>R</mi><mn>1</mn></msub><msup><mi>&omega;</mi><mn>2</mn></msup><mi>sin</mi><mi>&beta;</mi></mtd><mtd><mo>-</mo><msub><mi>g</mi><mi>n</mi></msub><mi>cos</mi><mi></mi><mi>&alpha;</mi><mi>sin</mi><mi>&beta;</mi><mo>-</mo><msub><mi>R</mi><mn>1</mn></msub><msup><mi>&omega;</mi><mn>2</mn></msup><mi>cos</mi><mi>&beta;</mi></mtd></mtr></mtable></mfenced><mi>T</mi></msup></mrow> <mrow><msub><mi>&omega;</mi><mi>ib</mi></msub><mo>=</mo><msubsup><mi>C</mi><mi>n</mi><mi>b</mi></msubsup><mfenced open='[' close=']'><mtable><mtr><mtd><mn>0</mn></mtd><mtd><mi>&omega;</mi></mtd><mtd><mn>0</mn></mtd></mtr></mtable></mfenced></mrow> <mrow><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mi>cos</mi><mi>&beta;</mi></mtd><mtd><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><mfenced open='[' close=']'><mtable><mtr><mtd><mi>cos</mi><mi>&alpha;</mi></mtd><mtd><mi>sin</mi><mi>&alpha;</mi></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mo>-</mo><mi>sin</mi><mi>&alpha;</mi></mtd><mtd><mi>cos</mi><mi>&alpha;</mi></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mfenced open='[' close=']'><mtable><mtr><mtd><mi>cos</mi><mrow><mo>(</mo><mi>&omega;t</mi><mo>)</mo></mrow></mtd><mtd><mn>0</mn></mtd><mtd><mo>-</mo><mi>sin</mi><mrow><mo>(</mo><mi>&omega;t</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mi>sin</mi><mrow><mo>(</mo><mi>&omega;t</mi><mo>)</mo></mrow></mtd><mtd><mn>0</mn></mtd><mtd><mi>cos</mi><mrow><mo>(</mo><mi>&omega;t</mi><mo>)</mo></mrow></mtd></mtr></mtable></mfenced><mfenced open='[' close=']'><mtable><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mi>&omega;</mi></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow> <mrow><mo>=</mo><msup><mfenced open='[' close=']'><mtable><mtr><mtd><mi>&omega;</mi><mi>sin</mi><mi>&alpha;</mi></mtd><mtd><mi>&omega;</mi><mi>cos</mi><mi></mi><mi>&alpha;</mi><mi>cos</mi><mi>&beta;</mi></mtd><mtd><mo>-</mo><mi>&omega;</mi><mi>cos</mi><mi></mi><mi>&alpha;</mi><mi>sin</mi><mi>&beta;</mi></mtd></mtr></mtable></mfenced><mi>T</mi></msup></mrow> 式(2)、(3)、(4)中,R,α,β均为已知条件,改变不同的α,β和ω,采集多组数据,得加速度计实际安装位置值:<mrow><msub><mi>u</mi><mi>rj</mi></msub><mo>=</mo><msup><mfenced open='[' close=']'><mtable><mtr><mtd><msubsup><mi>&theta;</mi><mi>rj</mi><mi>T</mi></msubsup><mo>[</mo><msubsup><mi>&omega;</mi><mi>ib</mi><mrow><mi>b</mi><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow></msubsup><mo>&times;</mo><mo>]</mo><mo>[</mo><msubsup><mi>&omega;</mi><mi>ib</mi><mrow><mi>b</mi><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow></msubsup><mo>&times;</mo><mo>]</mo></mtd></mtr><mtr><mtd><msubsup><mi>&theta;</mi><mi>ri</mi><mi>T</mi></msubsup><mo>[</mo><msubsup><mi>&omega;</mi><mi>ib</mi><mrow><mi>b</mi><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow></msubsup><mo>&times;</mo><mo>]</mo><mo>[</mo><msubsup><mi>&omega;</mi><mi>ib</mi><mrow><mi>b</mi><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow></msubsup><mo>&times;</mo><mo>]</mo></mtd></mtr><mtr><mtd><msubsup><mi>&theta;</mi><mi>rj</mi><mi>T</mi></msubsup><mo>[</mo><msubsup><mi>&omega;</mi><mi>ib</mi><mrow><mi>b</mi><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow></msubsup><mo>&times;</mo><mo>]</mo><mo>[</mo><msubsup><mi>&omega;</mi><mi>ib</mi><mrow><mi>b</mi><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow></msubsup><mo>&times;</mo><mo>]</mo></mtd></mtr></mtable></mfenced><mrow><mo>-</mo><mn>1</mn></mrow></msup><mfenced open='[' close=']'><mtable><mtr><mtd><msubsup><mi>A</mi><mi>j</mi><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></msubsup><mo>-</mo><msubsup><mi>&theta;</mi><mi>rj</mi><mi>T</mi></msubsup><msup><mi>f</mi><mrow><mi>b</mi><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow></msup></mtd></mtr><mtr><mtd><msubsup><mi>A</mi><mi>j</mi><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></msubsup><mo>-</mo><msubsup><mi>&theta;</mi><mi>rj</mi><mi>T</mi></msubsup><msup><mi>f</mi><mrow><mi>b</mi><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow></msup></mtd></mtr><mtr><mtd><msubsup><mi>A</mi><mi>j</mi><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></msubsup><mo>-</mo><msubsup><mi>&theta;</mi><mi>rj</mi><mi>T</mi></msubsup><msup><mi>f</mi><mrow><mi>b</mi><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow></msup></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow><mo>,</mo></mrow> 由于理论位置uj已知,根据uej=urj-uj,可得式(1)中安装位置误差uej,并将相关数据带入式(1)中,即可得到装配误差Aej;根据 <mrow><msub><mi>A</mi><mi>j</mi></msub><mo>=</mo><msub><mover><mi>A</mi><mo>.</mo></mover><mi>rj</mi></msub><mo>-</mo><msub><mi>A</mi><mi>ej</mi></msub><mo>,</mo></mrow> 得该加速度计的理论输出值Aj。
地址 030051山西省太原市尖草坪区学院路3号