留言板

尊敬的读者、作者、审稿人, 关于本刊的投稿、审稿、编辑和出版的任何问题, 您可以本页添加留言。我们将尽快给您答复。谢谢您的支持!

姓名
邮箱
手机号码
标题
留言内容
验证码

冗余旋转惯导系统两位置初始对准方法

邹涛 王丽芬 任元 朱挺

邹涛, 王丽芬, 任元, 朱挺. 冗余旋转惯导系统两位置初始对准方法[J]. 红外与激光工程, 2023, 52(1): 20220414. doi: 10.3788/IRLA20220414
引用本文: 邹涛, 王丽芬, 任元, 朱挺. 冗余旋转惯导系统两位置初始对准方法[J]. 红外与激光工程, 2023, 52(1): 20220414. doi: 10.3788/IRLA20220414
Zou Tao, Wang Lifen, Ren Yuan, Zhu Ting. Two-position initial alignment method for redundant rotating inertial navigation system[J]. Infrared and Laser Engineering, 2023, 52(1): 20220414. doi: 10.3788/IRLA20220414
Citation: Zou Tao, Wang Lifen, Ren Yuan, Zhu Ting. Two-position initial alignment method for redundant rotating inertial navigation system[J]. Infrared and Laser Engineering, 2023, 52(1): 20220414. doi: 10.3788/IRLA20220414

冗余旋转惯导系统两位置初始对准方法

doi: 10.3788/IRLA20220414
详细信息
    作者简介:

    邹涛,男,硕士生,主要从事惯性导航系统初始对准方面的研究

  • 中图分类号: TH39

Two-position initial alignment method for redundant rotating inertial navigation system

  • 摘要: 冗余旋转惯导系统(Redundant Rotating Inertial Navigation System, RRINS)可以在传统旋转惯导系统的基础上,进一步提高系统的可靠性。针对该类系统高精度初始对准需求,以正四面体冗余旋转惯导系统为例,研究了两位置初始对准方法。首先以每3个陀螺仪和3个加速度计构成一种组合方式,建立每种组合下惯性器件的零偏与冗余配置相关的解析表达式,并设计RRINS两位置转停方案以估计对应惯性器件的零偏,但是在某些特殊的情况下需要增加观测位置;然后将每个惯性器件在不同组合下得到的结果取均值,并利用该均值对相应惯性器件的测量信息做补偿;最后基于补偿后的惯性器件输出进行RRINS的初始对准。数学仿真和实验验证结果表明,该方法在不同两位置方案下均可有效估计出惯性器件的零偏。仿真中陀螺仪的零偏估计误差在4%以内,加速度计的零偏估计误差基本在2%以内,且相比无零偏补偿的情况,初始对准精度提高10倍以上。实验中水平和方位向的初始对准精度都有提高,航向角对准误差最大减小100倍左右。同时,该方法还可以推广到其他配置方案的冗余旋转惯导系统中,对该类惯导系统初始对准精度的提高具有一定借鉴意义。
  • 图  1  IMU的冗余配置图

    Figure  1.  Redundant configuration of IMU

    图  2  (a) 横滚角粗对准仿真误差; (b) 俯仰角粗对准仿真误差; (c) 航向角粗对准仿真误差

    Figure  2.  (a) Coarse alignment simulation error of roll; (b) Coarse alignment simulation error of pitch; (c) Coarse alignment simulation error of heading

    图  3  实验设备及环境

    Figure  3.  Experimental equipment and environment

    图  4  (a) 横滚角粗对准实验误差; (b) 俯仰角粗对准实验误差; (c) 航向角粗对准实验误差

    Figure  4.  (a) Coarse alignment experimental error of roll; (b) Coarse alignment experimental error of pitch; (c) Coarse alignment experimental error of heading

    图  5  (a) 导航解算姿态误差;(b) 导航解算速度误差; (c) 导航解算位置误差

    Figure  5.  (a) Attitude error of navigation solution; (b) Velocity error of navigation solution ;(c) Position error of navigation solution

    表  1  惯性器件组合方式

    Table  1.   Inertial device combination

    IDG1IDG2IDG3IDG4
    C1
    C2
    C3
    C4
    Remark√ Refers to select this Inertial Device Group (IDG)
    下载: 导出CSV

    表  2  三组位置组合

    Table  2.   Three position combinations

    Position1Position2
    $ \left[ {\begin{array}{*{20}{c}} {{\gamma _1}}&{{\theta _1}}&{{\psi _1}} \end{array}} \right] $$ \left[ {\begin{array}{*{20}{c}} {{\gamma _2}}&{{\theta _2}}&{{\psi _2}} \end{array}} \right] $
    Group1$ \left[ {30^\circ {\text{ }}75^\circ {\text{ }}90^\circ } \right] $$ \left[ {20^\circ {\text{ 29}}5^\circ {\text{ }}90^\circ } \right] $
    Group2$ \left[ {0^\circ {\text{ 0}}^\circ {\text{ }}0^\circ } \right] $$ \left[ {0^\circ {\text{ }}5^\circ {\text{ }}90^\circ } \right] $
    Group3$ \left[ {0^\circ {\text{ 0}}^\circ {\text{ }}0^\circ } \right] $$ \left[ {90^\circ {\text{ 0}}^\circ {\text{ }}90^\circ } \right] $
    下载: 导出CSV

    表  3  RRINS惯性器件的零偏仿真估计结果

    Table  3.   Zero bias simulation results of inertial devices of RRINS

    Zero bias of gyro/(°)·h−1Zero bias of accelerometer/$ {10^{ - 4}}g $
    Theoretical value Value of calculation Theoretical value Value of calculation
    Group1 Group2 Group3 Group1 Group2 Group3
    Gyro1 0.01 0.0100 0.0100 0.0099 Accelerometer1 1 1.0196 1.0010 1.0005
    Gyro2 0.02 0.0202 0.0202 0.0201 Accelerometer2 2 2.0019 2.0061 2.0029
    Gyro3 0.03 0.0299 0.0297 0.0296 Accelerometer3 3 2.9995 3.0023 2.8358
    Gyro4 0.04 0.0399 0.0401 0.0404 Accelerometer4 4 3.9970 3.9937 4.1755
    下载: 导出CSV

    表  4  初始对准仿真位置

    Table  4.   Simulation position of initial alignment

    PositionRoll/(°)Pitch/(°)Heading/(°)
    Position1307590
    Position220−6580
    Position3000
    Position41602080
    Position50590
    Position690090
    Position7208080
    Position80090
    下载: 导出CSV

    表  5  实验RIMU的参数

    Table  5.   Parameters of the experimental RIMU

    ParameterGyro/(o)·h−1Accelerometer
    Bias−10 - +10$ \leqslant $3 mg
    Bias stability$ \leqslant $0.1 50 $ \text{μ} {\rm{g}} $
    下载: 导出CSV
  • [1] Zhang Q, Hu Y, Li S, et al. Mounting parameter estimation from velocity vector observations for land vehicle navigation [J]. IEEE Transactions on Industrial Electronics, 2021, 29(6): 4234-4244.
    [2] Zhai X R, Ren Y, Wang L F, et al. A review of redundant inertial navigation technology [C]//2021 International Conference on Computer, Control and Robotics (ICCCR), 2021: 272-278.
    [3] Li B, Wang H, Mu L, et al. A configuration design method for a redundant inertial navigation system based on diagnosability analysis [J]. Measurement Science and Technology, 2020, 32(2): 025111.
    [4] Zhu Ting, Wang Lifen, Wang Yongrang, et al. Carrier angular motion isolation and modulation method of dual-axis rotation inertial navigation system [J]. Chinese Journal of Scientific Instrument, 2020, 41(12): 66-75. (in Chinese) doi:  10.19650/j.cnki.cjsi.J2006910
    [5] Frutuoso A, Silva F O, de Barros E A. Influence of integration schemes and maneuvers on the initial alignment and calibration of AUVs: Observability and degree of observability analyses [J]. Sensors, 2022, 22(9): 3287. doi:  10.3390/s22093287
    [6] Goshen-Meskin D, Bar-It zhack I Y. Observability analysis of piece-wise constant systems – part I: Theory [J]. IEEE Trans of Aerospace and Electronic Systems, 1992, 28(4): 1056-1067. doi:  10.1109/7.165367
    [7] Lee J G, Park C, Park H. Multiposition alignment of strapdown inertial navigation system [J]. IEEE Transactions on Aerospace and Electronic Systems, 1993, 29(4): 1323-1328. doi:  10.1109/7.259535
    [8] Tan Caiming, Wang Yu, Su Yan, et al. The simplest multi-position analytic alignment for SINS [J]. Journal of Beijing University of Aeronautics and Astronautics, 2015, 41(9): 1645-1650. (in Chinese) doi:  10.13700/j.bh.1001-5965.2015.0033
    [9] Ding Leixiang, Xu Houze, Wang Yong, et al. Improved algorithm of the simplest multi-position analytic aligenment for SINS [J]. Journal of Chinese Inertial Technology, 2016, 24(3): 296-298. (in Chinese)
  • [1] 李鼎, 于旭东, 魏国, 罗晖.  双轴旋转激光惯导非正交误差优化标定方法 . 红外与激光工程, 2023, 52(6): 20230148-1-20230148-9. doi: 10.3788/IRLA20230148
    [2] 王子超, 范会迎, 谢元平, 罗晖, 于旭东.  捷联惯导系统复杂误差参数系统级标定方法 . 红外与激光工程, 2022, 51(7): 20210499-1-20210499-11. doi: 10.3788/IRLA20210499
    [3] 赵洪楠, 江文松, 杨力, 罗哉, 李泓洋.  线激光传感器的边缘偏差修正方法 . 红外与激光工程, 2022, 51(4): 20210317-1-20210317-7. doi: 10.3788/IRLA20210317
    [4] 刘智颖, 姜馨, 李明宇, 贾文波.  芯片式光谱仪光束耦合与对准监测系统设计 . 红外与激光工程, 2020, 49(8): 20190532-1-20190532-6. doi: 10.3788/IRLA20190532
    [5] 董浩, 孙拓, 吴丽娜, 唐帅, 刘晓波.  一种机载红外光谱相机的角位置误差补偿技术 . 红外与激光工程, 2019, 48(10): 1013007-1013007(6). doi: 10.3788/IRLA201948.1013007
    [6] 陈怀宇, 尹达一.  精细导星仪星点定位系统误差的高精度补偿方法 . 红外与激光工程, 2019, 48(11): 1113005-1113005(8). doi: 10.3788/IRLA201948.1113005
    [7] 孙兴伟, 于欣玉, 董祉序, 杨赫然.  激光三角法高精度测量模型 . 红外与激光工程, 2018, 47(9): 906008-0906008(6). doi: 10.3788/IRLA201847.0906008
    [8] 黄民双, 刘晓晨, 马鹏.  脉冲飞行时间激光测距系统中周期误差补偿 . 红外与激光工程, 2018, 47(3): 317004-0317004(5). doi: 10.3788/IRLA201847.0317004
    [9] 胡雄超, 毛晓楠, 吴永康, 闫晓军, 余路伟, 王兆龙.  基于亚像元坐标的像素频率误差补偿方法 . 红外与激光工程, 2017, 46(7): 717006-0717006(6). doi: 10.3788/IRLA201746.0717006
    [10] 石文峰, 王省书, 郑佳兴, 战德军, 王以忠.  激光陀螺捷联惯导系统多位置系统级标定方法 . 红外与激光工程, 2016, 45(11): 1106004-1106004(8). doi: 10.3788/IRLA201645.1106004
    [11] 洪天琦, 黄喆, 杨凌辉, 郭思阳, 邹剑, 叶声华.  外部测量装置的捷联惯导对准方法 . 红外与激光工程, 2016, 45(5): 531002-0531002(5). doi: 10.3788/IRLA201645.0531002
    [12] 闫俊岑, 车英, 耿树彬.  基于新数学模型的自动对准式色散系数测量系统 . 红外与激光工程, 2015, 44(9): 2858-2862,2866.
    [13] 劳达宝, 周维虎, 李万红, 石冬, 林心龙.  基于遗传算法的柱面光栅测角技术研究 . 红外与激光工程, 2015, 44(7): 2182-2188.
    [14] 刘丙才, 李兵, 田爱玲, 高芬.  横向剪切干涉中非共光路误差的识别与补偿 . 红外与激光工程, 2015, 44(8): 2406-2410.
    [15] 杜亮, 张铁, 戴孝亮.  激光跟踪仪测量距离误差的机器人运动学参数补偿 . 红外与激光工程, 2015, 44(8): 2351-2357.
    [16] 江奇渊, 汤建勋, 袁保伦, 韩松来.  激光陀螺捷联惯导尺寸效应误差分析与补偿 . 红外与激光工程, 2015, 44(4): 1110-1114.
    [17] 邓万涛, 汪凯巍, 白剑, 张金春.  高精度子孔径拼接中参考面误差的去除方法 . 红外与激光工程, 2014, 43(4): 1194-1199.
    [18] 于海, 梁立辉, 王树洁, 卢新然, 万秋华.  基于径向基函数神经网络的高精度基准编码器误差补偿 . 红外与激光工程, 2014, 43(12): 4123-4127.
    [19] 于海龙, 吕信明, 汤建勋, 魏国, 王宇, 饶谷音.  激光捷联惯导系统高阶误差模型的建立与分析 . 红外与激光工程, 2013, 42(9): 2375-2379.
    [20] 何小飞, 王巍, 黄继勋.  联邦滤波在光纤陀螺捷联惯导系统传递对准中的应用 . 红外与激光工程, 2013, 42(4): 993-997.
  • 加载中
图(5) / 表(5)
计量
  • 文章访问数:  144
  • HTML全文浏览量:  29
  • PDF下载量:  63
  • 被引次数: 0
出版历程
  • 收稿日期:  2022-03-25
  • 修回日期:  2022-04-27
  • 刊出日期:  2023-01-18

冗余旋转惯导系统两位置初始对准方法

doi: 10.3788/IRLA20220414
    作者简介:

    邹涛,男,硕士生,主要从事惯性导航系统初始对准方面的研究

  • 中图分类号: TH39

摘要: 冗余旋转惯导系统(Redundant Rotating Inertial Navigation System, RRINS)可以在传统旋转惯导系统的基础上,进一步提高系统的可靠性。针对该类系统高精度初始对准需求,以正四面体冗余旋转惯导系统为例,研究了两位置初始对准方法。首先以每3个陀螺仪和3个加速度计构成一种组合方式,建立每种组合下惯性器件的零偏与冗余配置相关的解析表达式,并设计RRINS两位置转停方案以估计对应惯性器件的零偏,但是在某些特殊的情况下需要增加观测位置;然后将每个惯性器件在不同组合下得到的结果取均值,并利用该均值对相应惯性器件的测量信息做补偿;最后基于补偿后的惯性器件输出进行RRINS的初始对准。数学仿真和实验验证结果表明,该方法在不同两位置方案下均可有效估计出惯性器件的零偏。仿真中陀螺仪的零偏估计误差在4%以内,加速度计的零偏估计误差基本在2%以内,且相比无零偏补偿的情况,初始对准精度提高10倍以上。实验中水平和方位向的初始对准精度都有提高,航向角对准误差最大减小100倍左右。同时,该方法还可以推广到其他配置方案的冗余旋转惯导系统中,对该类惯导系统初始对准精度的提高具有一定借鉴意义。

English Abstract

    • 惯导系统因其自主性高、抗干扰能力强并且可以提供丰富的导航参数而被广泛应用于航空、航天、航海和陆用车辆等领域[1]。而其作为保障武器精确打击的核心导航系统的必要前提是可以保证高可靠性和高精度。提高惯导系统的可靠性可以通过冗余配置惯性器件来实现,这种由惯性器件冗余配置而组成的器件级冗余惯导系统已经成为了研究热点[2]。器件级的冗余惯导系统相对于传统的三轴正交配置的惯导系统可以大幅提高系统的可靠性,而其相比于系统级的冗余惯导系统又能在保证可靠性相当的情况下降低成本、减小体积和质量[3]。为了在实现系统高可靠性的同时实现高精度,旋转调制技术可以在惯性器件精度不变的情况下,通过将IMU绕单轴或多轴有规律的旋转将惯性器件的误差调制成周期性地变化信号使其相消,从而达到降低系统导航误差累积的目的[4]

      初始对准是惯导系统开始导航的必要前提,其作用是确定载体在初始时刻的姿态和航向,从而建立载体坐标系到导航坐标系(地理坐标系)之间的方向余弦阵,初始对准的精度直接影响导航精度。目前,传统的捷联惯导系统初始对准技术已经较为成熟,但是其在静基座下初始对准的可观测性较差,这直接影响了初始对准的快速性和精度[5]。1992年,Meskin[6]等提出可在一定条件下通过基座的有目的机动提高系统的可观测性。1993年,Lee[7]等在此基础上首次提出了多位置初始对准方法,并实现了提高捷联惯导系统对准精度的最优二位置对准,获得了较好的效果,随后引发了多位置初始对准的研究热潮。多位置对准技术也可以应用于解析对准,但其只能使用转停状态下的惯性器件输出的数据。谭彩铭[8]等提出了最简多位置解析对准方法,通过几何方法得到IMU偏置的几何解,但是计算方法比较复杂,计算结果受先验信息的影响也比较大。丁磊香[9]等在最简多位置解析对准方法基础上进行了改进,推导了IMU偏置的解析表达式,得到了任意多位置IMU偏置的解析解,解析方法计算简单,解决了先前解析式对准方法存在的受先验信息影响较大的问题。

      上述关于捷联惯导系统的初始对准方面的研究已经较为成熟,而目前并未查阅到有关冗余旋转惯导系统(Redundant Rotating Inertial Navigation System, RRINS)初始对准方面的研究。文中以正四面体冗余旋转惯导系统为例,首先推导了在惯性器件(3个陀螺仪和3个加速度计)组合方式下惯性器件的零偏与冗余配置相关的解析表达式,然后利用两位置的测量信息可以求得每个惯性器件的零偏,最后将求得的零偏对惯性器件的测量信息进行补偿后做对准和导航。在理论分析的基础上做了数学仿真和实验,验证了该方法可有效提高RRINS的初始对准精度。

    • 以正四面体冗余旋转惯导系统为例进行研究,图1所示为正四面体RRINS的IMU的三维模型图和冗余配置三维示意图。

      图  1  IMU的冗余配置图

      Figure 1.  Redundant configuration of IMU

      图1中,正四面体配置的冗余IMU安装框架是正四面体结构,底面是正三角形,3个侧面安装面均是等腰三角形,侧面和底面的夹角均为$ \alpha {\text{ = }}70.53^\circ $s1代表陀螺仪1和加速度计1,s2、s3、s4分别代表陀螺仪2和加速度计2、陀螺仪3和加速度计3、陀螺仪4和加速度计4。s1的测量轴与$ o{z_s} $轴重合,装配于四面体底面,s2、s3、s4测量轴与$ o{z_s} $轴的夹角为$ \alpha $,分别垂直于3个侧面装配,其中s2的测量轴位于$ {x_s}o{z_s} $平面,s3和s4的测量轴在$ {x_s}o{y_s} $平面的投影与$ o{x_s} $轴的夹角分别为$\; {\beta _3} = 120^\circ $$\; {\beta _4} = 240^\circ $。其相应的系统冗余配置矩阵为:

      $$ {\boldsymbol{H}}_s^r = \left[ {\begin{array}{*{20}{c}} 0&0&{ - 1} \\ {\sin \alpha }&0&{\cos \alpha } \\ {\sin \alpha \cos {\beta _3}}&{\sin \alpha \sin {\beta _3}}&{\cos \alpha } \\ {\sin \alpha \cos {\beta _4}}&{\sin \alpha \sin {\beta _4}}&{\cos \alpha } \end{array}} \right] $$ (1)

      惯导系统一般利用IMU坐标系(s系)下的3个正交轴向的惯性器件测量信息实现导航解算,而冗余IMU中惯性器件敏感轴有可能不全在IMU坐标系正交轴向上,或者同个轴向上有多个冗余的惯性器件测量信息,因此需要将惯性器件测量信息转换成IMU坐标系下3个正交轴的等效测量信息。

      具体转换方法以陀螺仪敏感角速率信息为例,由IMU三轴等效测量信息可计算各个惯性器件的敏感信息,可表示为:

      $$ {{\boldsymbol{\hat \omega }}^r} = {\boldsymbol{H}}_s^r{{\boldsymbol{\hat \omega }}^s} $$ (2)

      式中:$ {{\boldsymbol{\hat \omega }}^r} $为RRINS各个陀螺仪的输出;$ {{\boldsymbol{\hat \omega }}^s} $为冗余配置下等效三轴的陀螺仪输出;$ {\boldsymbol{H}}_s^r $为冗余IMU配置矩阵,表示各个惯性器件在IMU中的空间结构。

      $ {{\boldsymbol{\hat \omega }}^r} $具体表示如下:

      $$ {{\boldsymbol{\hat \omega }}^r} = {\left[ {\begin{array}{*{20}{c}} {\hat \omega _1^r}&{\hat \omega _2^r}&{\hat \omega _3^r}&{\hat \omega _4^r} \end{array}} \right]^{\rm{T} }}$$ (3)

      $ {{\boldsymbol{\hat \omega }}^s} $具体表示如下:

      $$ {{\boldsymbol{\hat \omega }}^s} = {\left[ {\begin{array}{*{20}{c}} {\hat \omega _x^s}&{\hat \omega _y^s}&{\hat \omega _z^s} \end{array}} \right]^{\rm{T} }}$$ (4)

      实际使用中为了实现导航解算,可采用最小二乘法将陀螺仪敏感到的角速率$ {{\boldsymbol{\hat \omega }}^r} $转换为IMU等效三轴的角速率$ {{\boldsymbol{\hat \omega }}^s} $,由公式(5)进行计算:

      $$ {{\boldsymbol{\hat \omega }}^s} = {\left( {{\boldsymbol{H}}{{_s^r}^{\rm{T}}}{\boldsymbol{H}}_s^r} \right)^{ - 1}}{\boldsymbol{H}}{_s^{r{\rm{T}}}}{{\boldsymbol{\hat \omega }}^r} $$ (5)

      同理可得:

      $$ {{\boldsymbol{\hat f}}^s} = {\left( {{\boldsymbol{H}}{{_s^r}^{\rm{T}}}{\boldsymbol{H}}_s^r} \right)^{ - 1}}{\boldsymbol{H}}{_s^{{r{\rm{T}}}}}{{\boldsymbol{\hat f}}^r} $$ (6)
      $$ {{\boldsymbol{a}}^s} = {\left( {{\boldsymbol{H}}{{_s^r}^{\rm{T}}}{\boldsymbol{H}}_s^r} \right)^{ - 1}}{\boldsymbol{H}}{_s^{{r{\rm{T}}}}}{{\boldsymbol{a}}^r} $$ (7)
      $$ {{\boldsymbol{\varepsilon }}^s} = {\left( {{\boldsymbol{H}}{{_s^r}^{\rm{T}}}{\boldsymbol{H}}_s^r} \right)^{ - 1}}{\boldsymbol{H}}{_s^{{r{\rm{T}}}}}{{\boldsymbol{\varepsilon }}^r} $$ (8)

      式中:${{\boldsymbol{\hat f}}^r} = {\left[ {\begin{array}{*{20}{c}} {\hat f_1^r}\;\;{\hat f_2^r}\;\;{\hat f_3^r}\;\;{\hat f_4^r} \end{array}} \right]^{\rm{T}}}$为RRINS各个加速度计的输出;${{\boldsymbol{\hat f}}^s} = {\left[ {\begin{array}{*{20}{c}} {\hat f_x^s}\;\;{\hat f_y^s}\;\;{\hat f_z^s} \end{array}} \right]^{\rm{T}}}$为冗余配置下等效三轴的加速度计输出;${{\boldsymbol{a}}^r} = {\left[ {\begin{array}{*{20}{c}} {a_1^r}\;\;{a_2^r}\;\;{a_3^r}\;\;{a_4^r} \end{array}} \right]^{\rm{T}}}$为RRINS各个加速度计的零偏;${{\boldsymbol{a}}^s} = {\left[ {\begin{array}{*{20}{c}} {a_x^s}\;\;{a_y^s}\;\;{a_z^s} \end{array}} \right]^{\rm{T}}}$为冗余配置下等效三轴的加速度计零偏;${{\boldsymbol{\varepsilon }}^r} = {\left[ {\begin{array}{*{20}{c}} {\varepsilon _1^r}\;\;{\varepsilon _2^r}\;\;{\varepsilon _3^r}\;\;{\varepsilon _4^r} \end{array}} \right]^{\rm{T}}}$为RRINS各个陀螺仪的零偏;${{\boldsymbol{\varepsilon }}^s} = {\left[ {\begin{array}{*{20}{c}} {\varepsilon _x^s}\;\;{\varepsilon _y^s}\;\;{\varepsilon _z^s} \end{array}} \right]^{\rm{T}}}$为冗余配置下等效三轴的陀螺仪零偏。

    • 将当地的东北天坐标系作为导航系(记为n系),初始时刻IMU坐标系和载体坐标系固连记为s系,n~s系的转换矩阵记为$ {\boldsymbol{C}}_n^s $。地球自转角速度记为$ {\omega _{ie}} $,载体所在位置的纬度记为$ L $,载体所在位置的重力加速度记为$ g $。若载体处于静止状态,则公式(9)成立:

      $$ {{\boldsymbol{f}}^s} = {\boldsymbol{C}}_n^s{{\boldsymbol{g}}^n} \text{,} {{\boldsymbol{\omega }}^s} = {\boldsymbol{C}}_n^s{\boldsymbol{\omega }}_{ie}^n $$ (9)

      式中:${{\boldsymbol{f}}^s} = {\left[ {\begin{array}{*{20}{c}} {f_x^s}\;\;\;\;{f_y^s}\;\;\;\;{f_z^s} \end{array}} \right]^{\rm{T}}}$$ {{\boldsymbol{\hat f}}^s} $的理论值;${{\boldsymbol{\omega }}^s} = {\left[ {\begin{array}{*{20}{c}} {\omega _x^s}\;\;\;{\omega _y^s}\;\;\;{\omega _z^s} \end{array}} \right]^{\rm{T}}}$$ {{\boldsymbol{\hat \omega }}^s} $的理论值;${{\boldsymbol{g}}^n} = {\left[ {\begin{array}{*{20}{c}} 0\;\;\;0\;\;\;{ - g} \end{array}} \right]^{\rm{T}}}$${\boldsymbol{\omega }}_{ie}^n = {\left[ {\begin{array}{*{20}{c}} 0\;\;\;{{\omega _{ie}}\cos L}\;\;\;{{\omega _{ie}}\sin L} \end{array}} \right]^{\rm{T}}}$

      由公式(9)可得:

      $$ \left| {{{\boldsymbol{f}}^s}} \right| = g \text{,} \left| {{{\boldsymbol{\omega }}^s}} \right| = {\omega _{ie}} \text{,} \left\langle {{{\boldsymbol{f}}^s},{{\boldsymbol{\omega }}^s}} \right\rangle = g{\omega _{ie}}\sin L $$ (10)

      式中:$ \left| {} \right| $为取模运算符;$ \left\langle {} \right\rangle $为内积运算符。

      多位置对准过程中时间比较短,RRINS的惯性器件的零偏可认为保持不变,并且RRINS的误差主要来自于惯性器件的零偏误差,因此在这个过程中只考虑RRINS的惯性器件的零偏误差。

      则可以得到:

      $$ {{\boldsymbol{f}}^s} = {{\boldsymbol{\hat f}}^s} - {{\boldsymbol{a}}^s} \text{,} {{\boldsymbol{\omega }}^s} = {{\boldsymbol{\hat \omega }}^s} - {{\boldsymbol{\varepsilon }}^s} $$ (11)

      将公式(11)代入公式(10)中可以得到:

      $$ \begin{array}{*{20}{c}} {\left| {{{{\boldsymbol{\hat f}}}^s} - {{\boldsymbol{a}}^s}} \right| = g{\text{ }},{\text{ }}\left| {{{{\boldsymbol{\hat \omega }}}^s} - {{\boldsymbol{\varepsilon }}^s}} \right| = {\omega _{ie}}} \\ {\left\langle {{{{\boldsymbol{\hat f}}}^s} - {{\boldsymbol{a}}^s},{{{\boldsymbol{\hat \omega }}}^s} - {{\boldsymbol{\varepsilon }}^s}} \right\rangle = g{\omega _{ie}}\sin L} \end{array} $$ (12)

      将同一轴向安装的惯性器件(1个陀螺仪和1个加速度计)作为一个惯性器件组,选取3个惯性器件组作为一种组合方式。将该组合方式下所选取的惯性器件的测量信息转换至RRINS等效三轴正交坐标系上,得到惯性器件的零偏与冗余配置相关的解析表达式。每一种组合都可以估计出选取的惯性器件的零偏,将每种组合下得到的每个惯性器件对应的零偏取平均作为该惯性器件的零偏。对于正四面体冗余旋转惯导系统有4个惯性器件组,将其记为:惯性器件组1(IDG1)、惯性器件组2(IDG2)、惯性器件组3(IDG3)和惯性器件组4(IDG4),通过惯性器件组的选择组合产生4种组合方式,记为组合方式1(C1)、组合方式2(C2)、组合方式3(C3)、组合方式4(C4),具体组合方式如表1所示。

      表 1  惯性器件组合方式

      Table 1.  Inertial device combination

      IDG1IDG2IDG3IDG4
      C1
      C2
      C3
      C4
      Remark√ Refers to select this Inertial Device Group (IDG)

      下面以组合1为例进行推导RRINS的惯性器件的零偏与冗余配置相关的解析表达式。组合1的冗余配置矩阵$ {{\boldsymbol{H}}_1} $可表示为:

      $$ {{\boldsymbol{H}}_1} = \left[ {\begin{array}{*{20}{c}} 0&0&{ - 1} \\ {\sin \alpha }&0&{\cos \alpha } \\ {\sin \alpha \cos {\beta _3}}&{\sin \alpha \sin {\beta _3}}&{\cos \alpha } \end{array}} \right] $$ (13)

      组合1下RRINS的各个加速度计的零偏表示为${{\boldsymbol{a}}^{r1}} = {\left[ {\begin{array}{*{20}{c}} {a_1^{r1}}&{a_2^{r1}}&{a_3^{r1}} \end{array}} \right]^{\rm{T}}}$,等效三轴的加速度计零偏表示为${{\boldsymbol{a}}^{s1}} = {\left[ {\begin{array}{*{20}{c}} {a_x^{s1}}&{a_y^{s1}}&{a_z^{s1}} \end{array}} \right]^{\rm{T}}}$;RRINS的各个陀螺仪的零偏表示为${{\boldsymbol{\varepsilon }}^{r1}} = {\left[ {\begin{array}{*{20}{c}} {\varepsilon _1^{r1}}&{\varepsilon _2^{r1}}&{\varepsilon _3^{r1}} \end{array}} \right]^{\rm{T}}}$,等效三轴的陀螺仪零偏表示为${{\boldsymbol{\varepsilon }}^{s1}} = {\left[ {\begin{array}{*{20}{c}} {\varepsilon _x^{s1}}&{\varepsilon _y^{s1}}&{\varepsilon _z^{s1}} \end{array}} \right]^{\rm{T}}}$;RRINS的各个加速度的输出表示为${{\boldsymbol{\hat f}}^{r1}} = {\left[ {\begin{array}{*{20}{c}} {\hat f_1^{r1}}&{\hat f_2^{r1}}&{\hat f_3^{r1}} \end{array}} \right]^{\rm{T}}}$,等效三轴的加速度计输出表示为${{\boldsymbol{\hat f}}^{s1}} = {\left[ {\begin{array}{*{20}{c}} {\hat f_x^{s1}}&{\hat f_y^{s1}}&{\hat f_z^{s1}} \end{array}} \right]^{\rm{T}}}$;RRINS的各个陀螺仪的输出表示为${\hat{\boldsymbol{ \omega }}^{r1}} = {\left[ {\begin{array}{*{20}{c}} {\hat \omega _1^{r1}}&{\hat \omega _2^{r1}}&{\hat \omega _3^{r1}} \end{array}} \right]^{\rm{T}}}$,等效三轴的陀螺仪输出表示为${{\boldsymbol{\hat \omega }}^{s1}} = {\left[ {\begin{array}{*{20}{c}} {\hat \omega _x^{s1}}&{\hat \omega _y^{s1}}&{\hat \omega _z^{s1}} \end{array}} \right]^{\rm{T}}}$$ {{\boldsymbol{f}}^{s1}} $$ {{\boldsymbol{\hat f}}^{s1}} $的真实值,$ {{\boldsymbol{\omega }}^{s1}} $$ {{\boldsymbol{\hat \omega }}^{r1}} $的真实值。

      则由公式(11)可得:

      $$ \begin{gathered} {{\boldsymbol{f}}^{s1}} = {{{\boldsymbol{\hat f}}}^{s1}} - {{\boldsymbol{a}}^{s1}} = {\left( {{{\boldsymbol{H}}_1}} \right)^{ - 1}}\left( {{{{\boldsymbol{\hat f}}}^{r1}} - {{\boldsymbol{a}}^{r1}}} \right) \\ {{\boldsymbol{\omega }}^{s1}} = {{{\boldsymbol{\hat \omega }}}^{s1}} - {{\boldsymbol{\varepsilon }}^{s1}} = {\left( {{{\boldsymbol{H}}_1}} \right)^{ - 1}}\left( {{{{\boldsymbol{\hat \omega }}}^{r1}} - {{\boldsymbol{\varepsilon }}^{r1}}} \right) \\ \end{gathered} $$ (14)

      再由公式(12)可得:

      $$ {\left[ {{{\left( {{{\boldsymbol{H}}_1}} \right)}^{ - 1}}\left( {{{{\boldsymbol{\hat f}}}^{r1}} - {{\boldsymbol{a}}^{r1}}} \right)} \right]^{\rm{T}}}\left[ {{{\left( {{{\boldsymbol{H}}_1}} \right)}^{ - 1}}\left( {{{{\boldsymbol{\hat f}}}^{r1}} - {{\boldsymbol{a}}^{r1}}} \right)} \right] = {g^2} $$ (15)
      $$ {\left[ {{{\left( {{{\boldsymbol{H}}_1}} \right)}^{ - 1}}\left( {{{{\boldsymbol{\hat \omega }}}^{r1}} - {{\boldsymbol{\varepsilon }}^{r1}}} \right)} \right]^{\rm{T}}}\left[ {{{\left( {{{\boldsymbol{H}}_1}} \right)}^{ - 1}}\left( {{{{\boldsymbol{\hat \omega }}}^{r1}} - {{\boldsymbol{\varepsilon }}^{r1}}} \right)} \right] = \omega _{ie}^2 $$ (16)
      $$ {\left[ {{{\left( {{{\boldsymbol{H}}_1}} \right)}^{ - 1}}\left( {{{{\boldsymbol{\hat f}}}^{r1}} - {{\boldsymbol{a}}^{r1}}} \right)} \right]^{\rm{T}}}\left[ {{{\left( {{{\boldsymbol{H}}_1}} \right)}^{ - 1}}\left( {{{{\boldsymbol{\hat \omega }}}^{r1}} - {{\boldsymbol{\varepsilon }}^{r1}}} \right)} \right] = g{\omega _{ie}}\sin L $$ (17)

      将公式(15)展开可得:

      $$ {\left( {{{{\boldsymbol{\hat f}}}^{r1}} - {{\boldsymbol{a}}^{r1}}} \right)^{\rm{T}}}{\left( {{{\left( {{{\boldsymbol{H}}_1}} \right)}^{ - 1}}} \right)^{\rm{T}}}{\left( {{{\boldsymbol{H}}_1}} \right)^{ - 1}}\left( {{{{\boldsymbol{\hat f}}}^{r1}} - {{\boldsymbol{a}}^{r1}}} \right) = {g^2} $$ (18)

      $ {\left( {{{\left( {{{\boldsymbol{H}}_1}} \right)}^{ - 1}}} \right)^{\rm{T}}}{\left( {{{\boldsymbol{H}}_1}} \right)^{ - 1}} = {\boldsymbol{K}} $,化简并且忽略二阶小项可得:

      $$ \left[ {{{\left( {{{{\boldsymbol{\hat f}}}^{r1}}} \right)}^{\rm{T}}}({{\boldsymbol{K}}^{\rm{T}}} + {\boldsymbol{K}})} \right]{{\boldsymbol{a}}^{r1}} = {\left( {{{{\boldsymbol{\hat f}}}^{r1}}} \right)^{\rm{T}}}{\boldsymbol{K}}{{\boldsymbol{\hat f}}^{r1}} - {g^2} $$ (19)

      同理,公式(16)展开化简并忽略二阶小项可得:

      $$ \left[ {{{\left( {{{{\boldsymbol{\hat \omega }}}^{r1}}} \right)}^{\rm{T}}}({{\boldsymbol{K}}^{\rm{T}}} + {\boldsymbol{K}})} \right]{{\boldsymbol{\varepsilon }}^{r1}} = {\left( {{{{\boldsymbol{\hat \omega }}}^{r1}}} \right)^{\rm{T}}}{\boldsymbol{K}}{{\boldsymbol{\hat \omega }}^{r1}} - \omega _{ie}^2 $$ (20)

      将公式(17)展开化简并忽略二阶小项可得:

      $$ \left[ {{{\left( {{{{\boldsymbol{\hat \omega }}}^{r1}}} \right)}^{\rm{T}}}{\boldsymbol{K}}} \right]{{\boldsymbol{a}}^{r1}} + \left[ {{{\left( {{{{\boldsymbol{\hat f}}}^{r1}}} \right)}^{\rm{T}}}{{\boldsymbol{K}}^{\rm{T}}}} \right]{{\boldsymbol{\varepsilon }}^{r1}} = {\left( {{{{\boldsymbol{\hat \omega }}}^{r1}}} \right)^{\rm{T}}}{\boldsymbol{K}}{{\boldsymbol{\hat f}}^{r1}} - g{\omega _{ie}}\sin L $$ (21)

      把公式(19)~(21)写成矩阵的形式,可得:

      $$ {\boldsymbol{A}}{\left[ {\begin{array}{*{20}{c}} {{{\boldsymbol{a}}^{r1}}}&{{{\boldsymbol{\varepsilon }}^{r1}}} \end{array}} \right]^{\rm{T}}} = {\boldsymbol{B}} $$ (22)

      其中AB分别表示为:

      $$ {\boldsymbol{A}} = \left[ {\begin{array}{*{20}{c}} {{{\left( {{{{\boldsymbol{\hat f}}}^{r1}}} \right)}^{\rm{T}}}({{\boldsymbol{K}}^{\rm{T}}} + {\boldsymbol{K}})}&0 \\ 0&{{{\left( {{{{\boldsymbol{\hat \omega }}}^{r1}}} \right)}^{\rm{T}}}({{\boldsymbol{K}}^{\rm{T}}} + {\boldsymbol{K}})} \\ {{{\left( {{{{\boldsymbol{\hat \omega }}}^{r1}}} \right)}^{\rm{T}}}{\boldsymbol{K}}}&{{{\left( {{{{\boldsymbol{\hat f}}}^{r1}}} \right)}^{\rm{T}}}{{\boldsymbol{K}}^{\rm{T}}}} \end{array}} \right] $$ (23)
      $$ {\boldsymbol{B}} = \left[ {\begin{array}{*{20}{c}} {{{\left( {{{{\boldsymbol{\hat f}}}^{r1}}} \right)}^{\rm{T}}}{\boldsymbol{K}}{{{\boldsymbol{\hat f}}}^{r1}} - {g^2}} \\ {{{\left( {{{{\boldsymbol{\hat \omega }}}^{r1}}} \right)}^{\rm{T}}}{\boldsymbol{K}}{{{\boldsymbol{\hat \omega }}}^{r1}} - \omega _{ie}^2} \\ {{{\left( {{{{\boldsymbol{\hat \omega }}}^{r1}}} \right)}^{\rm{T}}}{\boldsymbol{K}}{{{\boldsymbol{\hat f}}}^{r1}} - g{\omega _{ie}}\sin L} \end{array}} \right] $$ (24)

      公式(22)就是组合1的RRINS的惯性器件的零偏与冗余配置相关的解析表达式,其他组合也可以得到类似的解析表达式。可以看出表达式是3个方程但是有6个未知量,所以需要两个位置来构造出6个方程。$ {\boldsymbol{A}} $$ {\boldsymbol{B}} $中的参数都是可以测量得到或者是已知的,所以通过解方程就可以得到RRINS的惯性器件的零偏。

      需要特别注意的是在两位置下构造出的6个六元一次方程组的系数矩阵必须满足满秩,否则无法利用该方法求出惯性器件的零偏。系数矩阵不满秩的其中一种情况有两个位置的横滚角和俯仰角都为零,这种情况下只需要增加一个观测位置就可以解决,即可求出惯性器件的零偏。

    • 首先将求取到的RRINS的惯性器件的零偏对惯性器件的测量信息进行补偿;然后利用补偿后的测量信息进行RRINS的粗对准。静基座下粗对准可由公式(25)求出姿态转移矩阵$ {\boldsymbol{C}}_s^n $

      $$ {\boldsymbol{C}}_s^n = {\left[ {\begin{array}{*{20}{c}} {{{\left( {{{\boldsymbol{g}}^n}} \right)}^{\rm{T}}}} \\ {{{\left( {{\boldsymbol{\omega }}_{ie}^n} \right)}^{\rm{T}}}} \\ {{{\left( {{{\boldsymbol{g}}^n} \times {\boldsymbol{\omega }}_{ie}^n} \right)}^{\rm{T}}}} \end{array}} \right]^{ - 1}}\left[ {\begin{array}{*{20}{c}} {{{\left( {{{\boldsymbol{g}}^s}} \right)}^{\rm{T}}}} \\ {{{\left( {{\boldsymbol{\omega }}_{ie}^s} \right)}^{\rm{T}}}} \\ {{{\left( {{{\boldsymbol{g}}^s} \times {\boldsymbol{\omega }}_{ie}^s} \right)}^{\rm{T}}}} \end{array}} \right] = \left[ {\begin{array}{*{20}{c}} {\dfrac{{\sec L}}{{g{\omega _{ie}}}}\left( {\omega _{iez}^sg_y^s - \omega _{iey}^sg_z^s} \right)}&{\dfrac{{\sec L}}{{g{\omega _{ie}}}}\left( {\omega _{iex}^sg_z^s - \omega _{iez}^sg_x^s} \right)}&{\dfrac{{\sec L}}{{g{\omega _{ie}}}}\left( {\omega _{iey}^sg_x^s - \omega _{iex}^sg_y^s} \right)} \\ {\dfrac{{g_x^s}}{g}\tan L + \dfrac{{\omega _{iex}^s}}{{{\omega _{ie}}}}\sec L}&{\dfrac{{g_y^s}}{g}\tan L + \dfrac{{\omega _{iey}^s}}{{{\omega _{ie}}}}\sec L}&{\dfrac{{g_z^s}}{g}\tan L + \dfrac{{\omega _{iez}^s}}{{{\omega _{ie}}}}\sec L} \\ { - \dfrac{{g_x^s}}{g}}&{ - \dfrac{{g_y^s}}{g}}&{ - \dfrac{{g_z^s}}{g}} \end{array}} \right] $$ (25)

      $ {{\boldsymbol{g}}^n} $$ {\boldsymbol{\omega }}_{ie}^n $是当地的重力加速度$ {\boldsymbol{g}} $和地球自转角速度$ {{\boldsymbol{\omega }}_{ie}} $在导航系的分量(这里取地理坐标系为导航坐标系)。

      $$ {{\boldsymbol{g}}^s} = {\boldsymbol{C}}_n^s{{\boldsymbol{g}}^n} \text{,} {\boldsymbol{\omega }}_{ie}^s = {\boldsymbol{C}}_n^s{\boldsymbol{\omega }}_{ie}^n $$ (26)
      $$ {{\boldsymbol{g}}^n} = \left[ {\begin{array}{*{20}{c}} {{g_x}} \\ {{g_y}} \\ {{g_z}} \end{array}} \right] = \left[ {\begin{array}{*{20}{c}} 0 \\ 0 \\ { - g} \end{array}} \right] \text{,} {\boldsymbol{\omega }}_{ie}^n = \left[ {\begin{array}{*{20}{c}} {\omega _{iex}^n} \\ {\omega _{iey}^n} \\ {\omega _{iez}^n} \end{array}} \right] = \left[ {\begin{array}{*{20}{c}} 0 \\ {{\omega _{ie}}\cos L} \\ {{\omega _{ie}}\sin L} \end{array}} \right] $$ (27)

      公式(25)中,载体系下的地球重力加速度矢量$ {{\boldsymbol{g}}^s} = \left[ {\begin{array}{*{20}{c}} {g_x^s}&{g_y^s}&{g_z^s} \end{array}} \right] $和地球自转角速度矢量${\boldsymbol{\omega }}_{ie}^s = \left[ {\begin{array}{*{20}{c}} {\omega _{iex}^s}&{\omega _{iey}^s}&{\omega _{iez}^s} \end{array}} \right]$可以由RRINS的惯性器件的输出等效到三轴后取平均由${{\boldsymbol{\hat f}}^s} = {\left[ {\begin{array}{*{20}{c}} {\hat f_x^s}&{\hat f_y^s}&{\hat f_z^s} \end{array}} \right]^{\rm{T}}}$${{\boldsymbol{\hat \omega }}^s} = {\left[ {\begin{array}{*{20}{c}} {\hat \omega _x^s}&{\hat \omega _y^s}&{\hat \omega _z^s} \end{array}} \right]^{\rm{T}}}$来近似代替。另外通过当地的地理位置可以精确地求出在导航坐标系下的当地重力加速度$ {{\boldsymbol{g}}^n} $及地球自转角速度$ {\boldsymbol{\omega }}_{ie}^n $

    • 仿真选取三组位置来验证算法的有效性,三组位置的设置基于三点考虑并对应于三组位置。一是位置比较随机对应于如表2中的Group1,这个随机的位置需要精密的三轴转台来实现;二是选取的位置可以在双轴转位机构上实现,位置选取如表2中的Group2;三是转动的角度选择常规的90°,选取的位置如表2中的Group3。表2中,$ {\gamma _k} $$ {\theta _k} $$ {\psi _k} $分别表示第$ k\left( {k = 1,2} \right) $个位置处的横滚角、俯仰角和航向角。

      表 2  三组位置组合

      Table 2.  Three position combinations

      Position1Position2
      $ \left[ {\begin{array}{*{20}{c}} {{\gamma _1}}&{{\theta _1}}&{{\psi _1}} \end{array}} \right] $$ \left[ {\begin{array}{*{20}{c}} {{\gamma _2}}&{{\theta _2}}&{{\psi _2}} \end{array}} \right] $
      Group1$ \left[ {30^\circ {\text{ }}75^\circ {\text{ }}90^\circ } \right] $$ \left[ {20^\circ {\text{ 29}}5^\circ {\text{ }}90^\circ } \right] $
      Group2$ \left[ {0^\circ {\text{ 0}}^\circ {\text{ }}0^\circ } \right] $$ \left[ {0^\circ {\text{ }}5^\circ {\text{ }}90^\circ } \right] $
      Group3$ \left[ {0^\circ {\text{ 0}}^\circ {\text{ }}0^\circ } \right] $$ \left[ {90^\circ {\text{ 0}}^\circ {\text{ }}90^\circ } \right] $

      仿真的相关参数如下:

      $$\begin{split} \\ g = 9.8\;{\text{m/}}{{\text{s}}^2} \text{,} {\omega _{ie}} = 15.041\;{(^\circ)} {\text{/h}} \text{,} L = 40^\circ \end{split} $$
      $$ {\left[ {\begin{array}{*{20}{c}} {{a_1}}&{{a_2}}&{{a_3}}&{{a_4}} \end{array}} \right]^{\rm{T}}} = {\left[ {\begin{array}{*{20}{c}} 1&2&3&4 \end{array}} \right]^{\rm{T}}} \times {10^{ - 4}}g $$
      $$ \begin{split} &{\left[ {\begin{array}{*{20}{c}} {{\varepsilon _1}}&{{\varepsilon _2}}&{{\varepsilon _3}}&{{\varepsilon _4}} \end{array}} \right]^{\rm{T}}} = {\left[ {\begin{array}{*{20}{c}} {0.01}& {0.02}& {0.03}& {0.04} \end{array}} \right]^{\rm{T}}}\left( ^\circ \right)/{\text{h}}\\ & {\left[ {\begin{array}{*{20}{c}} {{\sigma _{{a_1}}}}&{{\sigma _{{a_2}}}}&{{\sigma _{{a_3}}}}&{{\sigma _{{a_4}}}} \end{array}} \right]^{\rm{T}}} ={\left[ {\begin{array}{*{20}{c}} 5&5&5&5 \end{array}} \right]^{\rm{T}}}\; \times\\ & {10^{ - 5}}g {\left[ {\begin{array}{*{20}{c}} {{\sigma _{{\varepsilon _1}}}}&{{\sigma _{{\varepsilon _2}}}}&{{\sigma _{{\varepsilon _3}}}}&{{\sigma _{{\varepsilon _4}}}} \end{array}} \right]^{\rm{T}}} ={\left[ {\begin{array}{*{20}{c}} 5&5&5&5 \end{array}} \right]^{\rm{T}}} \; \times\\ & {10^{ - 3}}\left( ^\circ \right)/{\text{h}} \end{split} $$

      仿真参数中,$ g $表示重力加速度,$ {\omega _{ie}} $表示地球自转角速度,$ L $表示纬度,$ {{\boldsymbol{a}}_t} $$ {{\boldsymbol{\varepsilon }}_t}(t = 1,2,3,4) $分别表示加速度计和陀螺仪的零偏,$ {{\boldsymbol{\sigma }}_a} $$ {{\boldsymbol{\sigma }}_\varepsilon } $分别表示加速度计和陀螺仪的测量白噪声。

      三组位置组合中每组组合的两个位置都仿真1 min的数据然后取平均,仿真计算得到的RRINS的惯性器件的零偏如表3所示。

      通过选取的三组位置计算得到的结果可以看出,RRINS的惯性器件的零偏可以被较好的估计出来,整个过程在2 min之内就可以完成。但是也存在由于测量噪声和忽略二阶小项时产生的计算误差,陀螺仪的零偏估计误差在4%以内,加速度计的零偏估计误差基本在2%以内。

      表 3  RRINS惯性器件的零偏仿真估计结果

      Table 3.  Zero bias simulation results of inertial devices of RRINS

      Zero bias of gyro/(°)·h−1Zero bias of accelerometer/$ {10^{ - 4}}g $
      Theoretical value Value of calculation Theoretical value Value of calculation
      Group1 Group2 Group3 Group1 Group2 Group3
      Gyro1 0.01 0.0100 0.0100 0.0099 Accelerometer1 1 1.0196 1.0010 1.0005
      Gyro2 0.02 0.0202 0.0202 0.0201 Accelerometer2 2 2.0019 2.0061 2.0029
      Gyro3 0.03 0.0299 0.0297 0.0296 Accelerometer3 3 2.9995 3.0023 2.8358
      Gyro4 0.04 0.0399 0.0401 0.0404 Accelerometer4 4 3.9970 3.9937 4.1755
    • 在RRINS零偏估计仿真的基础上进行初始对准的仿真,仿真的相关参数和冗余旋转惯导系统零偏估计仿真参数一致。为了验证方法的正确性,初始对准仿真选取8个随机位置来进行验证,每个位置仿真3 min,8个位置具体如表4所示。

      表 4  初始对准仿真位置

      Table 4.  Simulation position of initial alignment

      PositionRoll/(°)Pitch/(°)Heading/(°)
      Position1307590
      Position220−6580
      Position3000
      Position41602080
      Position50590
      Position690090
      Position7208080
      Position80090

      首先,将仿真出的每个位置的原始数据进行粗对准,然后分别用RRINS零偏估计仿真估计出的三组零偏对原始数据进行补偿,数据补偿后再进行粗对准。分别将8个位置原始数据粗对准的值及三组数据补偿后粗对准的值和表4中的真实值做差作为粗对准的误差。将原始数据粗对准的误差和三组数据补偿后粗对准的误差作比较,如图2所示。

      图2(a)~(c)分别为横滚角、俯仰角和航向角的粗对准误差比较,其中original data 曲线代表原始数据粗对准的误差;After calibration 1, After calibration 2, After calibration 3分别代表用RRINS零偏估计仿真中Group1, Group2, Group3、估计出的RRINS的惯性器件的零偏补偿后的粗对准误差。

      图2(a)可以看出,原始数据横滚角的粗对准误差在0.016°以内,数据补偿后横滚角的粗对准误差在0.0002°以内,数据补偿后横滚角粗对准误差减小100倍左右。由图2(b)可以看出,原始数据俯仰角的粗对准误差在0.012°以内,数据补偿后俯仰角的粗对准误差在0.0012°以内,数据补偿后俯仰角对准误差减小10倍。图2(b)中看出Group3估计出的零偏补偿后俯仰角的对准误差相对Group1和Group2估计出的零偏补偿后的对准误差稍大,最大误差在0.0012°,但是也在仿真中所给的器件噪声所导致的对准误差允许的波动范围内。由图2(c)可以看出,原始数据航向角的粗对准误差在0.11°以内,数据补偿后航向角的粗对准误差在0.0012°以内,数据补偿后航向角对准误差减小100倍左右。初始对准的仿真结果表明文中基于两位置对准的冗余旋转惯导系统零偏估计的方法是有效的。

      图  2  (a) 横滚角粗对准仿真误差; (b) 俯仰角粗对准仿真误差; (c) 航向角粗对准仿真误差

      Figure 2.  (a) Coarse alignment simulation error of roll; (b) Coarse alignment simulation error of pitch; (c) Coarse alignment simulation error of heading

    • 在仿真的基础上,将正四面体冗余惯性测量单元(Redundant Inertial Measurement Unit, RIMU)放置于三轴转台上进行实验,实验设备及环境如图3所示。

      图  3  实验设备及环境

      Figure 3.  Experimental equipment and environment

      正四面体RIMU装配的是型号为ZKDK70 MA的光纤陀螺仪和型号为JSD-I/B的石英挠性加速度计,具体技术参数如表5所示。实验中选取的三组位置和RRINS零偏估计仿真中选取的三组位置相同(表2)。每一组的两个位置分别采集1 min的数据。这样就可以计算得到三组不同位置下估计出的RRINS的惯性器件的零偏。

      表 5  实验RIMU的参数

      Table 5.  Parameters of the experimental RIMU

      ParameterGyro/(o)·h−1Accelerometer
      Bias−10 - +10$ \leqslant $3 mg
      Bias stability$ \leqslant $0.1 50 $ \text{μ} {\rm{g}} $
    • 初始对准实验选取的位置和初始对准仿真选取的8个位置相同(表4),每个位置采集静态3 min的数据。首先将采集到的每个位置的原始数据进行粗对准,然后用RRINS零偏估计实验中估计出的三组零偏分别对8个位置的原始数据进行补偿做粗对准。将8个位置的原始数据进行粗对准的值和真实值的差值作为原始数据粗对准的误差,将8个位置的数据分别用三组零偏补偿后进行粗对准的值和真实值的差值作为三组数据补偿后粗对准的误差。

      图4(a)、(b)、(c)所示分别是横滚角、俯仰角和航向角的粗对准误差比较。其中Original data, After calibration 1, After calibration 2和After calibration 3与初始对准仿真中所指代含义的不同点只在于其数据补偿的零偏是RRINS零偏估计实验中得到的三组零偏,而非仿真计算出的零偏。

      图  4  (a) 横滚角粗对准实验误差; (b) 俯仰角粗对准实验误差; (c) 航向角粗对准实验误差

      Figure 4.  (a) Coarse alignment experimental error of roll; (b) Coarse alignment experimental error of pitch; (c) Coarse alignment experimental error of heading

      图4(a)和图4(b)可以看出,数据补偿后横滚角和俯仰角的粗对准误差相比于未补偿数据的粗对准误差基本都有减小。未补偿数据粗对准误差和数据补偿后粗对准误差进行比较,其中横滚角误差减小幅度最大的从0.1673°减小到0.1082°,减小了0.0591°;俯仰角误差减小幅度最大的从0.0981°减小到0.0328°,减小了0.0708°。从图4(c)可以看出,未补偿数据航向角对准误差和数据补偿后航向角对准误差进行比较,减小幅度最大的从3.5482°减小到0.041°,减小了3.5072°,对准误差减小100倍左右。由于实验存在器件的随机噪声比较大;图4(b)中,三组位置估计出的零偏补偿后的对准误差出现一定的偏差波动也都是在噪声引起的对准偏差范围内的。综上,初始对准实验结果验证了基于两位置对准的冗余旋转惯导系统零偏估计方法的有效性。

    • 初始对准后将冗余惯导系统放置于转台上连续采集1 h的静态数据,对采集的1 h的原始数据进行导航解算,另外用RRINS零偏估计实验中三组位置估计出的零偏分别对1 h原始数据补偿后的姿态、速度和位置变化进行解算。将三组位置估计出的零偏中的一组零偏对原始数据补偿后导航解算的姿态、速度和位置误差与原始数据的导航误差进行比较,结果如图5(a)~(c)所示。

      图5(a)可以看出,补偿后的RRINS的导航解算姿态的精度和稳定性都有提高。从图5(b)可以看出,原始数据解算出的东向速度和北向速度出现了很大的偏移,而数据补偿后解算出的结果的稳定性更好,并且精度有很大的提升。如图5(c)所示,进行1 h的导航,数据补偿后解算的纬度误差从0.1127°降低至0.0041°,经度误差从0.9374°降低至0.0633°。实验结果表明,数据补偿后,导航的精度和稳定性得到了有效的提升。

      图  5  (a) 导航解算姿态误差;(b) 导航解算速度误差; (c) 导航解算位置误差

      Figure 5.  (a) Attitude error of navigation solution; (b) Velocity error of navigation solution ;(c) Position error of navigation solution

    • 文中对冗余旋转惯导系统的两位置初始对准方法进行研究。首先通过惯性器件组合的方式构造不同组合下RRINS的零偏估计解析表达式,然后设计不同的RRINS两位置方式估计惯性器件的零偏,并基于每个惯性器件在不同组合下估计的零偏的均值补偿惯性器件输出,进行RRINS的初始对准。文中的两位置方案不要求转位机构必须严格旋转90°或180°,因此转位设计具有一定的普适性,并且整个零偏估计可以在2 min之内完成。仿真结果表明,该方法对陀螺仪的零偏估计误差在4%以内,加速度计的零偏估计误差基本在2%以内;横滚角的对准误差由0.016°减小到0.0002°,俯仰角的对准误差由0.012°减小到0.0012°,航向角的对准误差由0.11°减小到0.0012°。初始对准和静基座导航的实验结果表明该方法可有效提高初始对准的精度和导航精度,其中航向角的对准精度提高近100倍,纬度误差从0.1127°降低至0.0041°,经度误差从0.9374°降低至0.0633°。初始对准实验中少数位置零偏补偿后横滚角和俯仰角对准效果略不佳的原因有待进一步研究。该方法以正四面体冗余旋转惯导系统为例进行分析验证,同样也适用于其他冗余配置的旋转惯导系统,为冗余旋转惯导系统的高精度初始对准方法的研究提供了一定的参考。

参考文献 (9)

目录

    /

    返回文章
    返回