当前位置: 首页 > 专利查询>中北大学专利>正文

捷联式惯导测量组合中加速度计装配误差标量修正方法技术

技术编号:2625285 阅读:317 留言:0更新日期:2012-04-11 18:40
本发明专利技术涉及一种测量误差修正方法,具体是一种捷联式惯导测量组合中加速度计装配误差标量修正方法。解决了现有微惯性测量组合误差补偿方案未考虑安装位置误差、且不适用所有类型加速度计的问题,该方法同时考虑安装方位误差与安装位置误差,既适合3陀螺3加速度计又适合全加速度计阵列;并能对微惯性测量组合MIMU中任何一只加速度计进行单独补偿,计算量小,补偿精度高。

【技术实现步骤摘要】

本专利技术涉及一种测量误差修正方法,具体是一种捷联式惯导测量组合中加速度计装配误差标量修正方法
技术介绍
微惯性测量组合由于具有成本低、重量轻、体积小、可靠性高、抗振动冲击力强等一系列独特的优点,其应用前景也越来越广阔,不仅在军事领域,而且在民用领域都具有广阔的应用前景。但是由于装配误差的存在会影响微惯性测量组合中加速度计的输出,进而会影响后续算法解算结果,因而针对由于装配误差建立模型并进行修正是非常必要的。所述装配误差包括安装方位误差和安装位置误差。目前,国内外针对这方面的研究状况如下:美国科罗拉多州大学的Friedrich Roth等人针对由3陀螺3加速度计组成的微惯性测量组合采用了方位偏差的补偿方法,主要考虑到3陀螺3加速度计组成的微惯性测量组合在载体转速较小的时候,其安装位置误差对测量输出值影响不是很大,故其采用的修正(补偿)方案只对安装方位误差进行补偿,并没有考虑安装位置误差;又如西安炮兵工程学院研制的由三个挠性摆式加速度计和两个动力调谐陀螺组成的捷联惯性测量组合,其采用的输出修正模型为:<mrow><msub><mi>u</mi><mi>AI</mi></msub><mo>=</mo><msub><mi>k</mi><mn>0</mn></msub><mo>+</mo><msub><mi>k</mi>&lt;mi>I</mi></msub><msub><mi>g</mi><mi>I</mi></msub><mo>+</mo><msub><mi>k</mi><mi>O</mi></msub><msub><mi>g</mi><mi>O</mi></msub><mo>+</mo><msub><mi>k</mi><mi>P</mi></msub><msub><mi>g</mi><mi>P</mi></msub><mo>+</mo><msub><mi>k</mi><mi>IO</mi></msub><msub><mi>g</mi><mi>I</mi></msub><msub><mi>g</mi><mi>O</mi></msub><mo>+</mo><msub><mi>k</mi><mi>OP</mi></msub><msub><mi>g</mi><mi>O</mi></msub><msub><mi>g</mi><mi>P</mi></msub><mo>+</mo><msub><mi>k</mi><mi>PI</mi></msub><msub><mi>g</mi><mi>P</mi></msub><msub><mi>g</mi><mi>I</mi></msub><mo>+</mo><msub><mi>k</mi><mi>II</mi></msub><msubsup><mi>g</mi><mi>I</mi><mn>2</mn></msubsup><mo>+</mo><msub><mi>k</mi><mi>PP</mi></msub><msubsup><mi>g</mi><mi>P</mi><mn>2</mn></msubsup><mo>+</mo></mrow><mrow><msub><mi>K</mi><mi>I</mi></msub><msub><mover><mi>&omega;</mi><mo>&CenterDot;</mo></mover><mi>I</mi></msub><mo>+</mo><msub><mi>K</mi><mi>O</mi></msub><msub><mover><mi>&omega;</mi><mo>&CenterDot;</mo></mover><mi>O</mi></msub><mo>+</mo><msub><mi>K</mi><mi>P</mi></msub><msub><mover><mi>&omega;</mi><mo>&CenterDot;</mo></mover><mi>P</mi></msu本文档来自技高网...

【技术保护点】
一种捷联式惯导测量组合中加速度计装配误差标量修正方法,根据在载体系中,加速度计j的实际输出值A↓[rj]减去理论输出值A↓[j]等于误差值A↓[ej],即A↓[ej]=A↓[rj]-A↓[j],则A↓[j]=A↓[rj]-A↓[ej];其特征在于:设加速度计j的理论安装位置和方位为u↓[j]和θ↓[j],实际位置和方位为u↓[rj]和θ↓[rj],则加速度计实际输出和理论输出分别为:A↓[rj](u↓[rj],θ↓[rj])=〈C↓[n]↑[b](*-g↓[n])+(*+Ω↑[2])u↓[rj],θ↓[rj]〉=〈f↑[b],θ↓[rj]〉+〈Gu↓[rj],θ↓[rj]〉A↓[j](u↓[j],θ↓[j])=〈C↓[n]↑[b](*-g↓[n])+(*+Ω↑[2])u↓[j],θ↓[j]〉=〈f↑[b],θ↓[j]〉+〈Gu↓[j],θ↓[j]〉其中:f↑[b]=C↓[n]↑[b](*-g↓[n]),G=*+Ω↑[2],g↓[n]=[0;-9.8;0];根据A↓[ej]=A↓[rj]-A↓[j],得:A↓[ej]=(f↑[b])↑[T]θ↓[ej]+(*↓[ib]↑[b])↑[T](u↓[rj]×θ↓[ej]+u↓[ej]×θ↓[j])+θ↓[ej]↑[T]Ω↑[2]u↓[rj]+θ↓[j]↑[T]Ω↑[2]u↓[ej](1)其中:f↑[b]:加速度计阵列质心视加速度u↓[ej]:安装位置误差,u↓[ej]=u↓[rj]-u↓[j]u↓[rj]:实际安装位置θ↓[ej]:方位误差,θ↓[ej]=θ↓[rj]-θ↓[j]θ↓[j]:理论方位*↓[ib]↑[b]=[*↓[ibx]↑[b],*↓[iby]↑[b],*↓[ibz]↑[b]]由式(1)知,装配误差A↓[ej]取决于载体的线运动和角运动,在载体只有线运动而没有角运动时,则装配误差只与加速度计安装方位误差有关,与安装位置误差无关;所述测加速度计实际安装位置u↓[rj]的方法:将微惯性测量组合MIMU安装于三轴转台内框上,1)、归零,使载体坐标系的X↓[b],Y↓[b],Z↓[b]分别与导航系的X↓[n],Y↓[n],Z↓[n]一致,R为微惯性测量组合MIMU质心距导航系原点的距离;2)、中框以位置方式转动α角;3)、内框以位置方式转动β角,R↓[1]为微惯性测量组合MIMU按照步骤3转动后其质心距Yn轴的距离;4)、外框以角速度ω匀速转动(如图4)。以使载...

【技术特征摘要】
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-ujurj:实际安装位置θ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><mfencedopen='['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><mfencedopen='['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><mfencedopen='['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><mfencedopen='['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>)<...

【专利技术属性】
技术研发人员:秦丽余靖娜张文栋熊继军刘俊李杰孟令军张会新
申请(专利权)人:中北大学
类型:发明
国别省市:14[中国|山西]

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1
相关领域技术
  • 暂无相关专利