[发明专利]捷联式惯导测量组合中加速度计装配误差标量修正方法有效
| 申请号: | 200710062037.7 | 申请日: | 2007-06-02 |
| 公开(公告)号: | CN101105503A | 公开(公告)日: | 2008-01-16 |
| 发明(设计)人: | 秦丽;余靖娜;张文栋;熊继军;刘俊;李杰;孟令军;张会新 | 申请(专利权)人: | 中北大学 |
| 主分类号: | G01P21/00 | 分类号: | G01P21/00;G01P15/02 |
| 代理公司: | 山西太原科卫专利事务所 | 代理人: | 朱源 |
| 地址: | 030051山*** | 国省代码: | 山西;14 |
| 权利要求书: | 查看更多 | 说明书: | 查看更多 |
| 摘要: | 本发明涉及一种测量误差修正方法,具体是一种捷联式惯导测量组合中加速度计装配误差标量修正方法。解决了现有微惯性测量组合误差补偿方案未考虑安装位置误差、且不适用所有类型加速度计的问题,该方法同时考虑安装方位误差与安装位置误差,既适合3陀螺3加速度计又适合全加速度计阵列;并能对微惯性测量组合MIMU中任何一只加速度计进行单独补偿,计算量小,补偿精度高。 | ||
| 搜索关键词: | 捷联式惯导 测量 组合 加速度计 装配 误差 标量 修正 方法 | ||
【主权项】:
1.一种捷联式惯导测量组合中加速度计装配误差标量修正方法,根据在载体系中,加速度计j的实际输出值Arj减去理论输出值Aj等于误差值Aej,即Aej=Arj-Aj,则Aj=Arj-Aej;其特征在于:设加速度计j的理论安装位置和方位为uj和θj,实际位置和方位为urj和θrj,则加速度计实际输出和理论输出分别为:A rj ( u rj , θ rj ) = 〈 C n b ( R . . - g n ) + ( Ω · + Ω 2 ) u rj , θ rj 〉 = 〈 f b , θ rj 〉 + 〈 Gu rj , θ rj 〉 A j ( u j , θ j ) = 〈 C n b ( R . . - g n ) + ( Ω · + Ω 2 ) u j , θ j 〉 = 〈 f b , θ j 〉 + 〈 Gu j , θ j 〉 其中: f b = C n b ( R . . - g n ) , G = Ω . + Ω 2 , gn=[0;-9.8;0];根据Aej=Arj-Aj,得: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 ) 其中:fb:加速度计阵列质心视加速度uej:安装位置误差,uej=urj-uj urj:实际安装位置θej:方位误差,θej=θrj-θj θj:理论方位ω . ib b = [ ω . ibx b , ω . iby b , ω . ibz b ] 由式(1)知,装配误差Aej取决于载体的线运动和角运动,在载体只有线运动而没有角运动时,则装配误差只与加速度计安装方位误差有关,与安装位置误差无关;所述测加速度计实际安装位置urj的方法:将微惯性测量组合MIMU安装于三轴转台内框上,1)、归零,使载体坐标系的Xb,Yb,Zb分别与导航系的Xn,Yn,Zn 一致,R为微惯性测量组合MIMU质心距导航系原点的距离;2)、中框以位置方式转动α角;3)、内框以位置方式转动β角,R1为微惯性测量组合MIMU按照步骤3转动后其质心距Yn轴的距离;4)、外框以角速度ω匀速转动(如图4)。以使载体受重力和向心力的双重影响;在重力和向心力的作用下,可得:R n = R · sin α sin β - R · cos α sin β R · cos β - - - ( 2 ) R 1 = R nx 2 + R nz 2 f b = C n b ( R . . - g n ) = 1 0 0 0 cos β sin β 0 - sin β cos β cos α sin α 0 - sin α cos α 0 0 0 1 cos ( ωt ) 0 - sin ( ωt ) 0 1 0 sin ( ωt ) 0 cos ( ωt ) - R 1 ω 2 sin ( ωt ) g n - R 1 ω 2 cos ( ωt ) - - - ( 3 ) = g n sin α g n cos α cos β - R 1 ω 2 sin β - g n cos α sin β - R 1 ω 2 cos β T ω ib = C n b 0 ω 0 = 1 0 0 0 cos β sin β 0 - sin β cos β cos α sin α 0 - sin α cos α 0 0 0 1 cos ( ωt ) 0 - sin ( ωt ) 0 1 0 sin ( ωt ) 0 cos ( ωt ) 0 ω 0 - - - ( 4 ) = ω sin α ω cos α cos β - ω cos α sin β T 式(2)、(3)、(4)中,R,α,β均为已知条件,改变不同的α,β和ω,采集多组数据,得加速度计实际安装位置值:u rj = θ rj T [ ω ib b ( 1 ) × ] [ ω ib b ( 1 ) × ] θ ri T [ ω ib b ( 2 ) × ] [ ω ib b ( 2 ) × ] θ rj T [ ω ib b ( 3 ) × ] [ ω ib b ( 3 ) × ] - 1 A j ( 1 ) - θ rj T f b ( 1 ) A j ( 2 ) - θ rj T f b ( 2 ) A j ( 3 ) - θ rj T f b ( 3 ) - - - ( 5 ) , 由于理论位置uj已知,根据uej=urj-uj,可得式(1)中安装位置误差uej,并将相关数据带入式(1)中,即可得到装配误差Aej;根据 A j = A . rj - A ej , 得该加速度计的理论输出值Aj。
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中北大学,未经中北大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/200710062037.7/,转载请声明来源钻瓜专利网。





