捷联惯性导航系统(strapdown inertial navigation system,SINS)中的微机电系统(micro electro mechanical system,MEMS)以其体积小、成本低等特点逐渐成为惯性器件的重要产品。但微机械惯性测量单元(microinertial measurement unit,MIMU)因制作工艺等限制,依然摆脱不了精度低、稳定性差、可靠性不高的命运。为增加导航控制系统的可靠性和精度,硬件冗余技术得到大力发展[1, 2]。一个普通惯性测量单元(inertial measurement unit,IMU)通常包含3个正交的单轴陀螺仪和3个正交的单轴加表。而冗余惯性测量单元(redundant inertialmeasurement unit,RIMU)将更多的惯性器件组合到IMU中,构成正交方案、斜交方案等[3]。本文以普通MIMU作为RIMU的基本单元构建一种新型RIMU。并针对该新型RIMU进行了误差分析,建立了精确的误差补偿数学模型,在此基础上提出了一种标定方法,给出了计算误差模型参数的详细推导过程,最后做出了试验验证。
1 新型冗余配置方案设计
本设计选用美国ADI公司的ADIS16405作为基本单元构成RIMU,ADIS16405是一款完整的三轴陀螺仪、磁力计与加速度计惯性检测系统,可提供校准的数字惯性检测,其传感器轴向示意图如图 1所示。惯性传感器在各个轴上执行精密对准,并对失调和灵敏度进行校准。嵌入式控制器可以动态补偿对MEMS传感器的所有主要影响,因此能够在无需测试、电路或用户干预的情况下保证高度精确的传感器输出。
![]() |
图 1 ADIS16405轴向示意 |
取用3个IMU分别安装在正四面体2个侧面及底面上,构成RIMU的整体设计。底面中心处安放IMU_1,2个侧面中心处分别安放IMU_2、IMU_3,为方便安装,IMU模块均固定在子电路板上。3个IMU通过排线方式与主电路板相连接,根据系统的使用需求,选用Altera公司的CycloneⅢ系列EP3C10E144A7芯片。RIMU整体设计图如图 2。
![]() |
图 2 RIMU的整体设计 |
经过计算,此种冗余配置方式的角速率测量精度比传统的正交配置的测量精度提高了近2倍[4]。在保证角速率测量功能的前提下,该冗余配置方式共有455种测量工作模式来保证其故障容错性能,而且在惯性器件(陀螺或加表)发生故障后系统有足够多故障重构方案[4]。
假设沿参考正交坐标系的测量向量为ω=[ωxωyωz]T,则n个惯性器件的测量输出为m=Hω,式中,m=[m1m2…mn]T,H为测量矩阵。单个惯性器件的安装位置如图 3所示,Eli0和Az0i为第i个惯性器件的理论安装角,Si为沿第i个惯性器件安装方向的单位向量,则Si在载体坐标系OXbYbZb中可表示为
![]() |
图 3 陀螺的安装位置 |
为了提高RIMU的性能,需要对器件的误差进行标定。
2 多余度IMU误差模型 2.1 常值误差
由n个惯性器件组成的RIMU,其常值误差引起的测量误差为Δmb=B=[b1b2…bn]T。
2.2 标度因数误差
标度因数误差引起的测量误差是由于惯性器件的真实标度因数与测试得到的标度因数不一致而造成的[5, 6],表示为Δmk=Ksm。式中:Ks=diag[ks1ks2…ksn],ksi为第i个惯性器件的标度因数误差。
2.3 安装误差
安装误差引起的测量误差是由于各惯性器件在装配时与器件设计位置之间存在着安装误差引起的[7]。 当存在安装误差时,测量矩阵H会存在摄动,即H′=H+ΔH。这里用俯仰角误差δEli和方位角误差δAzi来表示第i个惯性器件的安装误差,如图 4所示,那么实际安装角为Eli=Eli0+δEli、Azi=Az0i-δAzi,经计算,相应的安装误差矩阵为
则由安装误差引起的测量误差为Δmc=ΔH(HTH)-1HTm。
![]() |
图 4 安装误差角示意图 |
2.4 惯性器件误差模型
通过上述分析得知,测量误差由常值误差、标度因数误差与安装误差组成[8],表示为
Δm=Δmb+Δmk+Δmc=B+Ksm+ΔHHTH-1HTm
则第i个惯性器件的测量误差为Δmi=bi+ksimi+piδEli+qiδAzi
式中:pi、qi为相应的安装误差系数。3 冗余标定算法研究
针对MEMS陀螺精度低敏感不到地球自转角速度的情况,利用实验室转台通过设定相应命令为其提供一定的角速率,采集系统输出数据,进行标定[9]。而加表则可通过敏感重力加速度G进行标定[10]。具体标定方法如表 1所示。
输入量 | 位置1 | 位置2 | 位置3 | 位置4 | 位置5 | 位置6 |
加表输出 | G 0 0 | 0 G 0 | 0 0 G | -G 0 0 | 0 -G 0 | 0 0 -G |
陀螺输出 | ω0 0 0 | 0 ω0 0 | 0 0 ω0 | -ω0 0 0 | 0 -ω0 0 | 0 0 -ω0 |
经计算得,惯性器件的常值误差,Δmji表示第i个惯性器件在第j个位置的测量误差值。第i个惯性器件的标度因数误差为

根据IMU安装的空间结构和相互间的机械关系可以计算各惯性器件的理论安装角,详见表 2。
(°) | |||||||||
1 | 2 | 3 | 4 | 5 | 6 | 7 | 8 | 9 | |
Eli0 | 0 | 0 | 90 | 0 | 289.469 2 | 340.527 2 | 0 | 289.472 8 | 340.530 8 |
Az0i | 0 | 90 | 0 | 90 | 0 | 180 | 329.997 1 | 240 | 60 |
由于Eli0=0(i=1,2,4,7),公式无法求解,应针对六位置分别列写方程式,根据具体情况求解,经计算得到:
下面进行试验验证,针对该MEMS-IMU冗余惯性系统,标定试验具体步骤为:将该系统安装在转台上,以该系统底面安装的IMU的x、y、z轴所在方向为参考正交坐标轴,通过位置命令分别使x、y、z轴指天、指地,以一定的角速率ω0=10°/s转动转台外框,分别采集并保存1 s的陀螺和加表数据,经过仿真分析,表 3给出了陀螺误差标定结果。试验表明,加表标定精度能达到2 mG,而陀螺的标定精度为0.05°/s,可有效进行误差补偿。
(°) | ||||||||||
误差类别 | 标定结果 | 误差类别 | 标定结果 | 误差类别 | 标定结果 | 误差类别 | 标定结果 | |||
ks1 | 0.005 1 | δEl1 | -0.578 9 | δAz1 | 0.182 6 | b1 | 0.091 2 | |||
ks2 | 0.006 6 | δEl2 | -0.917 9 | δAz2 | -0.346 2 | b2 | 0.367 1 | |||
ks3 | 0.007 5 | δEl3 | -0.526 4 | δAz3 | -0.483 4 | b3 | 0.032 2 | |||
ks4 | 0.005 1 | δEl4 | 0.915 5 | δAz4 | 0.839 1 | b4 | 0.494 6 | |||
ks5 | 0.001 4 | δEl5 | 0.219 9 | δAz5 | -2.002 0 | b5 | 0.570 3 | |||
ks6 | -0.010 9 | δEl6 | -0.450 1 | δAz6 | 0.915 4 | b6 | 0.402 6 | |||
ks7 | 0.005 6 | δEl7 | 0.520 4 | δAz7 | 1.524 0 | b7 | 1.023 1 | |||
ks8 | -0.000 1 | δEl8 | 0.046 2 | δAz8 | -2.915 9 | b8 | -0.070 5 | |||
ks9 | -0.008 2 | δEl9 | 0.286 8 | δAz9 | 1.096 7 | b9 | -0.106 2 |
4 结束语
提出了一种新型冗余惯性测量单元,以子IMU作为基本组成单元,不同于以往以单个惯性器件为基本组成单元。该RIMU便于构造,易于维修,且成本较低,精度和可靠性较高。同时分析了该系统的误差模型,提出了一种冗余标定方法,并通过试验验证该标定方法简单可靠,并能有效进行误差补偿,标定精度较高,对实际的捷联惯性导航工程系统也有很好的参考价值。
[1] | 李雪莲,孙尧,莫宏伟,等. 一种基于MIMU的九陀螺冗余配置[J]. 哈尔滨工业大学学报,2009(5):90-94. |
[2] | 夏克寒,许化龙. 冗余惯性测量组合的优化配置研究[J]. 飞航导弹,2004(7):53-56. |
[3] | 王京献,张明辉. 一种高可靠捷联惯性测量单元布局[J]. 中国惯性技术学报,2012(3):363-367. |
[4] | 梁海波. 基于陀螺冗余的微惯性系统关键技术研究[D].哈尔滨:哈尔滨工程大学,2011,4-5. |
[5] | 杨华波,张士峰,蔡洪. 空间冗余陀螺仪在轨标定方法[J]. 宇航学报,2010(1):104-110. |
[6] | 黄徽,刘建业,李荣冰. 六余度配置MEMS-IMU误差标定[J]. 应用科学学报,2009(1):106-110. |
[7] | 程骏超,房建成,吴伟仁,等. 一种激光陀螺惯性测量单元混合标定方法[J]. 中国惯性技术学报,2014(4):445-452. |
[8] | 张金亮,秦永元,吴枫. 多惯组冗余系统安装误差的空中标定技术[J]. 传感技术学报,2013(3):367-371. |
[9] | 林玉荣,邓正隆. 激光陀螺捷联惯导系统中惯性器件误差的系统级标定[J]. 哈尔滨工业大学学报,2001(1):112-115. |
[10] | 华冰,刘建业,熊智,等. 捷联惯性传感器多余度配置的误差标定技术研究[J]. 传感器技术,2005(5):31-33. |