留言板

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

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

正四面体冗余惯导全参数现场快速标定方法

翟雪瑞 任元 王丽芬 朱挺 王琛

翟雪瑞, 任元, 王丽芬, 朱挺, 王琛. 正四面体冗余惯导全参数现场快速标定方法[J]. 红外与激光工程, 2022, 51(7): 20210784. doi: 10.3788/IRLA20210784
引用本文: 翟雪瑞, 任元, 王丽芬, 朱挺, 王琛. 正四面体冗余惯导全参数现场快速标定方法[J]. 红外与激光工程, 2022, 51(7): 20210784. doi: 10.3788/IRLA20210784
Zhai Xuerui, Ren Yuan, Wang Lifen, Zhu Ting, Wang Chen. Full parameter rapid field calibration method for regular tetrahedral redundant inertial navigation[J]. Infrared and Laser Engineering, 2022, 51(7): 20210784. doi: 10.3788/IRLA20210784
Citation: Zhai Xuerui, Ren Yuan, Wang Lifen, Zhu Ting, Wang Chen. Full parameter rapid field calibration method for regular tetrahedral redundant inertial navigation[J]. Infrared and Laser Engineering, 2022, 51(7): 20210784. doi: 10.3788/IRLA20210784

正四面体冗余惯导全参数现场快速标定方法

doi: 10.3788/IRLA20210784
基金项目: 国家自然科学基金(11772001); 北京市“高创计划”青年拔尖人才(2017000026833 ZK23)
详细信息
    作者简介:

    翟雪瑞,女,硕士生,主要从事冗余惯性导航技术及误差标定技术方面的研究

  • 中图分类号: U666.1;V249.32

Full parameter rapid field calibration method for regular tetrahedral redundant inertial navigation

Funds: National Natural Science Foundation of China (11772001);Youth Top-Notch Talent Support Program of Beijing, China (2017000026833 ZK23)
  • 摘要: 正四面体冗余惯导系统(RINS)具有高可靠性、高精度等特点,而误差标定是实现高精度导航解算的必要手段。当前正四面体RINS的误差标定均需要利用高精度转台实现,不仅标定成本高、标定时间长,而且在外场等硬件条件不足的情况下无法进行全误差参数的标定。针对这一问题,提出了一种无需高精度转台的正四面体RINS全误差参数现场快速标定方法。首先,建立了正四面体RINS的误差模型;然后,根据解析粗对准姿态误差矩阵与正四面体RINS零偏的关系提出了基于六位置的零偏标定方法;之后,设计三位置旋转方案进行陀螺仪的标度因数和安装误差标定;最后,利用零偏标定的六位置方案进行加速度计的标度因数和安装误差标定。仿真及试验结果表明,该方法能有效地标定出所有误差参数,在1 h静基座导航试验中,标定后北向定位精度从61.065 5 km提升至0.476 7 km,东向定位精度从161.202 7 km提升至4.842 2 km。
  • 图  1  正四面体冗余配置方案图

    Figure  1.  Tetrahedron redundant configuration diagram

    图  2  六位置转位示意图

    Figure  2.  Six-position transposition diagram

    图  3  三位置旋转方案示意图

    Figure  3.  Three-position rotation scheme

    图  4  正四面体RINS结构图

    Figure  4.  Structure diagram of tetrahedral redundant inertial navigation system

    图  5  试验设备及环境

    Figure  5.  Experiment equipment and environment

    图  6  导航解算姿态误差

    Figure  6.  Attitude error of navigation solution

    图  8  导航解算位置误差

    Figure  8.  Position error of navigation solution

    图  7  导航解算速度误差

    Figure  7.  Velocity error of navigation solution

    表  1  每个位置估计的IMU轴向零偏

    Table  1.   IMU axial biases for each position estimation

    BiasPos1Pos2Pos3Pos4Pos5Pos6
    $\delta {\hat \omega _U}$$\delta \hat \omega _{x1}^b$$ - \delta \hat \omega _{x2}^b$$\delta \hat \omega _{y1}^b$$ - \delta \hat \omega _{y2}^b$$\delta \hat \omega _{z1}^b$$ - \delta \hat \omega _{z2}^b$
    $\delta {\hat f_U}$$\delta \hat f_{x1}^b$$ - \delta \hat f_{x2}^b$$\delta \hat f_{y1}^b$$ - \delta \hat f_{y2}^b$$\delta \hat f_{z1}^b$$ - \delta \hat f_{z2}^b$
    下载: 导出CSV

    表  2  光纤陀螺误差参数设定

    Table  2.   Setting values of gyroscope error parameters

    ParameterGyro
    scope 1
    Gyro
    scope 2
    Gyro
    scope 3
    Gyro
    scope 4
    Bias/(°)·h−10.60.5−0.30.4
    Scale factor/bits·((°)/s)−1170000170000170000170000
    Installation error $\delta {u_{gi}}$
    /(″)
    40404040
    Installation error $\delta {v_{gi}}$
    /(″)
    40404040
    Noise/(°)·h−1/20.010.010.010.01
    下载: 导出CSV

    表  3  加速度计误差参数设定

    Table  3.   Setting values of accelerometer error parameters

    ParameterAccelerometer 1Accelerometer 2Accelerometer 3Accelerometer 4
    Bias/mg0.30.2−0.40.5
    Scale factor
    /bits·((°)/s)−1
    1111
    Installation error $\delta {u_{fi}}$
    /(″)
    40404040
    Installation error $\delta {v_{fi}}$
    /(″)
    40404040
    Noise/mg·h−1/20.020.020.020.02
    下载: 导出CSV

    表  4  仿真试验结果

    Table  4.   Simulation results

    Fiber optic gyroscope parametersPresetSimulation resultsErrorAccelerometer parametersPresetSimulation resultsError
    ${b_{g1} }/{(^\circ)\cdot {\rm{h} }^{-1} }$ 0.6 0.5874 2.10% ${b_{f1} }/{\rm{mg}}$ 0.3 0.3056 1.87%
    ${b_{g2} }/{(^\circ)\cdot {\rm{h} }^{-1} }$ 0.5 0.5098 1.96% ${b_{f2} }/{\rm{mg}}$ 0.2 0.1991 0.45%
    ${b_{g3} }/{(^\circ)\cdot {\rm{h} }^{-1} }$ −0.3 −0.2877 4.10% ${b_{f3} }/{\rm{mg}}$ −0.4 −0.3926 1.85%
    ${b_{g4} }/{(^\circ)\cdot {\rm{h} }^{-1} }$ 0.4 0.3753 6.18% ${b_{f4} }/{\rm{mg}}$ 0.5 0.4991 0.18%
    ${ {K}_{g1} }/{\rm{bits} }\cdot({(^\circ)/ {\rm{s} })^{-1} }$ 170000 170142.54048690 0.0838% ${ {K}_{f1} }/{\rm{bits} }\cdot{({\rm{m/s^2} }) ^{-1} }$ 1 1.00000447 0.000004%
    ${ {K}_{g2} }/{\rm{bits} }\cdot({(^\circ)/ {\rm{s} })^{-1} }$ 170000 170024.96320257 0.0147% ${ {K}_{f2} }/{\rm{bits} }\cdot{({\rm{m/s^2} }) ^{-1} }$ 1 0.99965628 0.0003%
    ${ {K}_{g3} }/{\rm{bits} }\cdot({(^\circ)/ {\rm{s} })^{-1} }$ 170000 169981.63378409 0.0108% ${ {K}_{f3} }/{\rm{bits} }\cdot{({\rm{m/s^2} }) ^{-1} }$ 1 1.00019696 0.0002%
    ${ {K}_{g4} }/{\rm{bits} }\cdot({(^\circ)/ {\rm{s} })^{-1} }$ 170000 169981.53174746 0.0109% ${ {K}_{f4} }/{\rm{bits} }\cdot{({\rm{m/s^2} }) ^{-1} }$ 1 0.99979333 0.0002%
    $ {H_{g1 x}} $ $1.939\;255 \times {10^{ - 4}}$ ${{1}}{{.939\;254}} \times {10^{ - 4}}$ 0.0001% $ {H_{f1 x}} $ $1.939\;255 \times {10^{ - 4}}$ ${{1}}{{.939\;257}} \times {10^{ - 4}}$ 0.0001%
    $ {H_{g1 y}} $ $1.939\;255 \times {10^{ - 4}}$ $1.939\;254 \times {10^{ - 4}}$ 0.0001% $ {H_{f1 y}} $ $1.939\;255 \times {10^{ - 4}}$ $1.939\;258 \times {10^{ - 4}}$ 0.0002%
    $ {H_{g1 z}} $ −1 −0.999999 0.0001% $ {H_{f1 z}} $ $ - 1$ −0.999999 0.0001%
    $ {H_{g2 x}} $ 0.942633 0.942775 0.0151% $ {H_{f2 x}} $ 0.942633 0.942775 0.0151%
    $ {H_{g2 y}} $ $ {{ - }}2.474\;740 \times {10^{ - 4}} $ ${{ - 2}}{{.472\;355}} \times {10^{ - 4}}$ 0.0964% $ {H_{f2 y}} $ $ - 2.474\;740 \times {10^{ - 4}} $ ${{ - 2}}{{.472\;524}} \times {10^{ - 4}}$ 0.0896%
    $ {H_{g2 z}} $ 0.333378 0.333428 0.0150% $ {H_{f2 z}} $ 0.333378 0.333429 0.0153%
    $ {H_{g3 x}} $ −0.471261 −0.471270 0.0019% $ {H_{f3 x}} $ −0.471261 −0.471236 0.0053%
    $ {H_{g3 y}} $ 0.816626 0.816554 0.0088% $ {H_{f3 y}} $ 0.816626 0.816583 0.0053%
    $ {H_{g3 z}} $ 0.333378 0.333384 0.0018% $ {H_{f3 z}} $ 0.333378 0.333361 0.0051%
    $ {H_{g4 x}} $ −0.471373 −0.471427 0.0115% $ {H_{f4 x}} $ −0.471373 −0.471418 0.0095%
    $ {H_{g4 y}} $ −0.816379 −0.816450 0.0087% $ {H_{f4 y}} $ −0.816379 −0.816458 0.0097%
    $ {H_{g4 z}} $ 0.333378 0.333416 0.0114% $ {H_{f4 z}} $ 0.333378 0.333409 0.0093%
    下载: 导出CSV

    表  5  光纤陀螺、加速度计技术规格

    Table  5.   Technical specification of fiber optic gyroscope and accelerometer

    Parameter nameParameter indicator
    Fiber optic gyroscope bias stability$/{(^\circ)\cdot {\rm{h} }^{-1} }$ $ \leqslant $0.1
    Fiber optic gyroscope scale factor$/{\rm{bits} }\cdot({(^\circ)/ {\rm{s} })^{-1} }$ 176000±5000
    Accelerometer bias stability$/\text{μ} {\rm{g}}$ 50
    Accelerometer scale factor$/{\rm{mA} } \cdot{{ g} }^{-1}$ 1.1-1.5
    下载: 导出CSV

    表  6  光纤陀螺误差标定结果

    Table  6.   Gyroscope error calibration results

    Fiber optic gyroscope parametersCalibration resultsFiber optic gyroscope parametersCalibration results
    ${b_{g1} }/{(^\circ)\cdot {\rm{h} }^{-1} }$ 0.0541 ${ {K}_{g1} }/{\rm{bits} }\cdot({(^\circ)/ {\rm{s} })^{-1} }$ 172207.11
    ${b_{g2} }/{(^\circ)\cdot {\rm{h} }^{-1} }$ 0.0524 ${ {K}_{g2} }/{\rm{bits} }\cdot({(^\circ)/ {\rm{s} })^{-1} }$ 177573.77
    ${b_{g3} }/{(^\circ)\cdot {\rm{h} }^{-1} }$ 0.0780 ${ {K}_{g3} }/{\rm{bits} }\cdot({(^\circ)/ {\rm{s} })^{-1} }$ 179823.99
    ${b_{g4} }/{(^\circ)\cdot {\rm{h} }^{-1} }$ −1.1961 ${ {K}_{g4} }/{\rm{bits} }\cdot({(^\circ)/ {\rm{s} })^{-1} }$ 171997.12
    $ {H_{g1 x}} $ −0.0015 $ {H_{g3 x}} $ −0.4703
    $ {H_{g1 y}} $ −0.0034 $ {H_{g3 y}} $ 0.8168
    $ {H_{g1 z}} $ −1.0000 $ {H_{g3 z}} $ 0.3340
    $ {H_{g2 x}} $ 0.9418 $ {H_{g4 x}} $ −0.4673
    $ {H_{g2 y}} $ 0.0016 $ {H_{g4 y}} $ −0.8186
    $ {H_{g2 z}} $ 0.3362 $ {H_{g4 z}} $ 0.3339
    下载: 导出CSV

    表  7  加速度计误差标定结果

    Table  7.   Accelerometer error calibration results

    Accelerometer parametersCalibration resultsAccelerometer parametersCalibration results
    ${b_{f1} }/{{g} }$−0.0167${ {K}_{f1} }/{\rm{bits} }\cdot{({\rm{m/s^2} }) ^{-1} }$0.9680
    ${b_{f2} }/{{g} }$0.0087${ {K}_{f2} }/{\rm{bits} }\cdot{({\rm{m/s^2} }) ^{-1} }$0.9687
    ${b_{f3} }/{{g} }$0.0109${ {K}_{f3} }/{\rm{bits} }\cdot{({\rm{m/s^2} }) ^{-1} }$0.9907
    ${b_{f4} }/{{g} }$−0.0029${ {K}_{f4} }/{\rm{bits} }\cdot{({\rm{m/s^2} }) ^{-1} }$0.9516
    $ {H_{f1 x}} $${ { - } }3.159\;0 \times {10^{ - 5} }$$ {H_{f3 x}} $−0.4734
    $ {H_{f1 y}} $${ { - } }1.225\;7 \times {10^{ - 4} }$$ {H_{f3 y}} $−0.8152
    $ {H_{f1 z}} $−1.0000$ {H_{f3 z}} $0.3337
    $ {H_{f2 x}} $0.9428$ {H_{f4 x}} $−0.4696
    $ {H_{f2 y}} $−0.0019$ {H_{f4 y}} $−0.8173
    $ {H_{f2 z}} $0.3335$ {H_{f4 z}} $0.3338
    下载: 导出CSV

    表  8  光纤陀螺转台试验结果

    Table  8.   Gyroscope turntable test results

    Rotating wayStandard value/(°)·s−1Factory parameterCalibration parameter
    Compensation result
    /(°)·s−1
    Relative errorCompensation result
    /(°)·s−1
    Relative error
    x(clockwise) 10 10.0126 0.00126 9.9932 −0.00068
    x(counterclockwise) −10 −9.9687 −0.00313 −10.0011 0.00011
    y(clockwise) 10 9.9842 −0.00158 9.9967 −0.00037
    y(counterclockwise) −10 −9.9825 −0.00175 −9.9903 −0.00097
    z(clockwise) 10 9.9709 −0.00291 9.9995 −0.00005
    z(counterclockwise) −10 −9.9599 −0.00401 −10.0046 0.00046
    下载: 导出CSV

    表  9  加速度计转台试验结果

    Table  9.   Accelerometer turntable test results

    PositionStandard value/m·s2 Factory parameterCalibration parameter
    Compensation result/m·s2Relative errorCompensation result Relative error
    x(up) 9.8014 9.8046 3.2648 E-4 9.8022 −8.1621 E-5
    x(down) −9.8014 −9.7952 −6.3256 E-4 −9.8014 0
    y(up) 9.8014 9.8020 6.1216 E-5 9.8011 3.06079 E-5
    y(down) −9.8014 −9.7987 −2.7547 E-4 −9.8017 −3.0608 E-5
    z(up) 9.8014 9.7957 −5.8155 E-4 9.8029 −1.5304 E-4
    z(down) −9.8014 −9.7994 −2.0405 E-4 −9.8029 −1.5304 E-4
    下载: 导出CSV
  • [1] 王巍. 新型惯性技术发展及在宇航领域的应用[J]. 红外与激光工程, 2016, 45(03): 11-16.

    Wang Wei. Development of new inertial technology and its application in aerospace field [J]. Infrared and Laser Engineering, 2016, 45(3): 0301001. (in Chinese)
    [2] 王巍, 邢朝洋, 冯文帅. 自主导航技术发展现状与趋势[J]. 航空学报, 2021, 42(11): 18-36.

    Wang Wei, Xing Chaoyang, Feng Wenshuai. Research of autonomous navigation technology [J]. Acta Aeronautica et Astronautica Sinica, 2021, 42(11): 18-36. (in Chinese)
    [3] 刘颖, 赵小东, 李言, 等. 采用冗余设计的光纤陀螺组合支架的优化及分析[J]. 红外与激光工程, 2012, 41(06): 1556-1560. doi:  10.3969/j.issn.1007-2276.2012.06.029

    Liu Ying, Zhao Xiaodong, Li Yan, et al. Optimize and analysis of fiber optic gyroscope combination bracket based on redundancy design [J]. Infrared and Laser Engineering, 2012, 41(6): 1556-1560. (in Chinese) doi:  10.3969/j.issn.1007-2276.2012.06.029
    [4] 朱挺, 王丽芬, 王永让, 等. 双轴旋转惯导载体角运动隔离调制方法研究[J]. 仪器仪表学报, 2020, 41(12): 66-75.

    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)
    [5] 任元, 王丽芬, 苗继松, 等. 捷联惯导系统偏轴-旋转复合调制技术[M]. 北京: 国防工业出版社, 2020.

    Ren Yuan, Wang Lifen, Miao Jisong, et al. Non-coaxial Rotation Compound Modulation Technology for Strapdown Inertial Navigation System[M]. Beijing: National Defense Industry Press, 2020. (in Chinese)
    [6] Pittelkau M E. Calibration and attitude determination with redundant inertial measurement units [J]. Journal of Guidance Control & Dynamics, 2012, 28(4): 743-752.
    [7] 赵新强, 晁代宏, 宋来亮. 基于单轴转台的斜置RSINS标定方法[J]. 导航与控制, 2014, 13(3): 19-25, 55. doi:  10.3969/j.issn.1674-5558.2014.03.004

    Zhao Xinqiang, Chao Daihong, Song Lailiang. A method to calibrate skewed RSINS by single-axis turntable [J]. Navigation and Control, 2014, 13(3): 19-25, 55. (in Chinese) doi:  10.3969/j.issn.1674-5558.2014.03.004
    [8] 魏莉莉, 黄军, 傅长松, 等. 带斜置元件的光纤陀螺捷联惯组标定方法[J]. 中国惯性技术学报, 2015, 23(01): 14-19.

    Wei Lili, Huang Jun, Fu Changsong, et al. Calibration method of FOG strapdown IMU with asked sensor axis [J]. Journal of Chinese Inertial Technology, 2015, 23(1): 14-19. (in Chinese)
    [9] 梁海波, 梁婕, 孟恭, 等. 冗余陀螺测量单元的实验室标定方法设计[J]. 航天控制, 2016, 34(1): 9-14, 19. doi:  10.3969/j.issn.1006-3242.2016.01.002

    Liang Haibo, Liang Jie, Meng Gong, et al. Method of laboratory calibration for redundant gyroscope unit [J]. Aerospace Control, 2016, 34(1): 9-14, 19. (in Chinese) doi:  10.3969/j.issn.1006-3242.2016.01.002
    [10] 程建华, 刘明, 王振民. 基于陀螺仪输出误差观测的冗余INS标定方法[J]. 中国惯性技术学报, 2019, 27(3): 301-306, 396.

    Cheng Jianhua, Liu Ming, Wang Zhenmin. Calibration method of redundant INS based on output error observation of gyroscope [J]. Journal of Chinese Inertial Technology, 2019, 27(3): 301-306,396. (in Chinese)
    [11] 李杨, 郭磊, 葛靖宇, 等. 一种基于输出误差观测的冗余MEMS-IMU标定技术研究[J]. 导航定位与授时, 2020, 7(01): 133-138.

    Li Yang, Guo Lei, Ge Jingyu, et al. Research on redundant MEMS-IMU calibration technology based on output error observation [J]. Navigation Positioning & Timing, 2020, 7(1): 133-138. (in Chinese)
    [12] Gheorghe M V, Bodea M C, Dobrescu L. Calibration of skew redundant sensor configurations in the presence of field alignment errors [J]. IEEE Transactions on Instrumentation and Measurement, 2019, 69(4): 1794-1804.
    [13] 王坚, 梁建, 韩厚增. 低成本IMU的多位置旋转现场标定方法[J]. 中国惯性技术学报, 2017, 25(03): 294-298.

    Wang Jian, Liang Jian, Han Houzeng. Method for low-cost IMU in-field calibration through multi-position rotation [J]. Journal of Chinese Inertial Technology, 2017, 25(3): 294-298. (in Chinese)
    [14] 王岁儿, 杨功流, 王丽芬, 等. 一种IMU全零偏快速标定方法[J]. 中国惯性技术学报, 2020, 28(3): 316-322.

    Wang Suier, Yang Gongliu, Wang Lifen, et al. A fast calibration method for the all biases of IMU [J]. Journal of Chinese Inertial Technology, 2020, 28(3): 316-322. (in Chinese)
    [15] 杨管金子, 李建辰, 黄海, 等. 基于遗传算法的加速度计免转台标定方法[J]. 中国惯性技术学报, 2017, 25(1): 119-123.

    Yang Guanjingzi, Li Jianchen, Huang Hai, et al. Non-turntable calibration method for three-accelerometer based on genetic algorithm [J]. Journal of Chinese Inertial Technology, 2017, 25(1): 119-123. (in Chinese)
    [16] 高爽, 张若愚. 基于自适应遗传算法的MEMS加速度计快速标定方法[J]. 北京航空航天大学学报, 2019, 45(10): 1982-1989.

    Gao Shuang, Zhang Ruoyu. Rapid calibration method of MEMS accelerometer based on adaptive GA [J]. Journal of Beijing University of Aeronautics and Astronautics, 2019, 45(10): 1982-1989. (in Chinese)
    [17] 戴洪德, 郑伟伟, 郑百东, 等. 基于IFOA的MEMS加速度计无转台标定[J]. 北京航空航天大学学报, 2021, 47(10): 1959-1968.

    Dai Hongde, Zheng Weiwei, Zheng Baidong, et al. Calibration of MEMS accelerometer without turntable based on IFOA [J]. Journal of Beijing University of Aeronautics and Astronautics, 2021, 47(10): 1959-1968. (in Chinese)
    [18] 胡梦纯, 徐挺, 黄云柯, 等. 冗余结构光纤陀螺捷联惯组标定优化方法研究[J]. 上海航天, 2016, 33(S1): 134-139.

    Hu Mengchun, Xu Ting, Huang Yunke, et al. Optimization method for calibration of redundant structure FOG IMU [J]. Aerospace Shanghai, 2016, 33(S1): 134-139. (in Chinese)
    [19] Silva F O, Hemerly E M, Leite-Filho W C. Error analysis of analytical coarse alignment formulation for stationary SINS [J]. IEEE Transactions on Aerospace and Electronic System, 2016, 52(4): 1777-1796. doi:  10.1109/TAES.2016.7738355
    [20] Silva F O, Hemerly E M, Leite-Filho W C, et al. A fast in-field coarse alignment and bias estimation method for stationary intermediate-grade IMUs [J]. IEEE Transactions on Instrumentation and Measurement, 2017, 67(4): 831-838.
  • [1] 赵英伟, 李湘源, 郑佳兴, 谭文锋.  考虑洋流速度的激光惯导/里程仪标定方法 . 红外与激光工程, 2023, 52(6): 20230142-1-20230142-9. doi: 10.3788/IRLA20230142
    [2] 李鼎, 于旭东, 魏国, 罗晖.  双轴旋转激光惯导非正交误差优化标定方法 . 红外与激光工程, 2023, 52(6): 20230148-1-20230148-9. doi: 10.3788/IRLA20230148
    [3] 邹涛, 王丽芬, 任元, 朱挺.  冗余旋转惯导系统两位置初始对准方法 . 红外与激光工程, 2023, 52(1): 20220414-1-20220414-9. doi: 10.3788/IRLA20220414
    [4] 王子超, 范会迎, 谢元平, 罗晖, 于旭东.  捷联惯导系统复杂误差参数系统级标定方法 . 红外与激光工程, 2022, 51(7): 20210499-1-20210499-11. doi: 10.3788/IRLA20210499
    [5] 李锟, 丁红昌, 曹国华, 侯翰.  光学连续闭环光电编码器误差检测系统 . 红外与激光工程, 2022, 51(7): 20210715-1-20210715-8. doi: 10.3788/IRLA20210715
    [6] 陈宇轩, 仇中军, 汤骏杰.  线扫描视觉检测系统机械—成像综合误差建模 . 红外与激光工程, 2022, 51(12): 20220282-1-20220282-10. doi: 10.3788/IRLA20220282
    [7] 邹媛媛, 李鹏飞, 左克铸.  三线结构光视觉传感器现场标定方法 . 红外与激光工程, 2018, 47(6): 617002-0617002(6). doi: 10.3788/IRLA201847.0617002
    [8] 董春梅, 任顺清, 陈希军, 王常虹.  激光陀螺捷联惯导系统的模观测标定方法 . 红外与激光工程, 2018, 47(9): 917007-0917007(9). doi: 10.3788/IRLA201847.0917007
    [9] 王志伟, 石志勇, 秦俊奇, 王风杰.  火箭弹载捷联惯导简易标定路径设计 . 红外与激光工程, 2016, 45(2): 217005-0217005(8). doi: 10.3788/IRLA201645.0217005
    [10] 王文攀, 赵勇志, 曹玉岩, 王志臣, 王富国.  基于多体系统理论的光电望远镜误差建模分析 . 红外与激光工程, 2016, 45(8): 817001-0817001(6). doi: 10.3788/IRLA201645.0817001
    [11] 石文峰, 王省书, 郑佳兴, 战德军, 王以忠.  激光陀螺捷联惯导系统多位置系统级标定方法 . 红外与激光工程, 2016, 45(11): 1106004-1106004(8). doi: 10.3788/IRLA201645.1106004
    [12] 王宏力, 何贻洋, 陆敬辉, 杨阳, 陈俊宇.  星敏感器安装误差的三位置法地面标定方法 . 红外与激光工程, 2016, 45(11): 1113003-1113003(6). doi: 10.3788/IRLA201645.1113003
    [13] 王志伟, 石志勇, 全振中.  某型火箭炮捷联惯导在线标定方案研究 . 红外与激光工程, 2015, 44(1): 266-272.
    [14] 江奇渊, 汤建勋, 袁保伦, 韩松来.  激光陀螺捷联惯导尺寸效应误差分析与补偿 . 红外与激光工程, 2015, 44(4): 1110-1114.
    [15] 江奇渊, 汤建勋, 韩松来, 袁保伦.  36维Kalman滤波的激光陀螺捷联惯导系统级标定方法 . 红外与激光工程, 2015, 44(5): 1579-1586.
    [16] 薛海建, 郭晓松, 周召发, 魏皖宁.  激光陀螺任意二位置寻北仪及误差分析 . 红外与激光工程, 2015, 44(6): 1784-1789.
    [17] 多丽娅, 张丽杰.  北斗卫星导航系统接收机测量误差建模及估计 . 红外与激光工程, 2015, 44(S1): 137-142.
    [18] 高春峰, 魏国, 谢元平, 李耿, 刘灿.  二频机抖激光陀螺捷联惯导系统快速?方法 . 红外与激光工程, 2014, 43(2): 375-381.
    [19] 于海龙, 吕信明, 汤建勋, 魏国, 王宇, 饶谷音.  激光捷联惯导系统高阶误差模型的建立与分析 . 红外与激光工程, 2013, 42(9): 2375-2379.
    [20] 韩潇, 朱嘉琦, 周峰, 陈晓丽.  多层四面体非晶碳膜的热稳定性 . 红外与激光工程, 2012, 41(1): 144-148.
  • 加载中
图(8) / 表(9)
计量
  • 文章访问数:  271
  • HTML全文浏览量:  98
  • PDF下载量:  24
  • 被引次数: 0
出版历程
  • 收稿日期:  2021-10-26
  • 修回日期:  2022-02-21
  • 网络出版日期:  2022-08-13
  • 刊出日期:  2022-08-05

正四面体冗余惯导全参数现场快速标定方法

doi: 10.3788/IRLA20210784
    作者简介:

    翟雪瑞,女,硕士生,主要从事冗余惯性导航技术及误差标定技术方面的研究

基金项目:  国家自然科学基金(11772001); 北京市“高创计划”青年拔尖人才(2017000026833 ZK23)
  • 中图分类号: U666.1;V249.32

摘要: 正四面体冗余惯导系统(RINS)具有高可靠性、高精度等特点,而误差标定是实现高精度导航解算的必要手段。当前正四面体RINS的误差标定均需要利用高精度转台实现,不仅标定成本高、标定时间长,而且在外场等硬件条件不足的情况下无法进行全误差参数的标定。针对这一问题,提出了一种无需高精度转台的正四面体RINS全误差参数现场快速标定方法。首先,建立了正四面体RINS的误差模型;然后,根据解析粗对准姿态误差矩阵与正四面体RINS零偏的关系提出了基于六位置的零偏标定方法;之后,设计三位置旋转方案进行陀螺仪的标度因数和安装误差标定;最后,利用零偏标定的六位置方案进行加速度计的标度因数和安装误差标定。仿真及试验结果表明,该方法能有效地标定出所有误差参数,在1 h静基座导航试验中,标定后北向定位精度从61.065 5 km提升至0.476 7 km,东向定位精度从161.202 7 km提升至4.842 2 km。

English Abstract

    • 惯性导航系统(Inertial Navigation System, INS)是一种利用陀螺仪和加速度计测量载体的角速度和加速度,并实时解算出载体姿态、速度、位置的自主式导航系统[1]。惯性导航系统导航精度的提高可以通过多种途径,其中一种方法是增加惯性器件的数量,构成冗余惯性导航系统(Redundant Inertial Navigation System, RINS)[2-3];也可通过提高惯性器件误差标定精度,将标定结果补偿到惯性器件中,从而有效提高导航精度[4-5]。目前,三轴正交惯导系统的误差标定技术已趋于成熟,针对冗余配置的惯导系统误差标定技术研究相对较少,因此对冗余配置下惯性器件的标定技术进行深入研究十分必要[6]

      目前冗余惯导系统的误差标定主要依托高精度转位机构、转台等测试设备。2014年,赵新强等[7]设计了四位置静态和三位置转动标定方法对斜置冗余捷联惯导系统进行标定,可标定出所有参数。2015年,魏莉莉等[8]针对带斜置冗余元件的光纤陀螺捷联惯导系统进行标定。2016年后,梁海波等[9]、程建华等[10]、李杨等[11]采用Kalman滤波方法实现了冗余惯导系统误差的标定。2020年,Marius V. Gheorghe等[12]提出了一种标定正十二面体冗余传感器配置的新方法。以上研究均需要单轴、双轴或者三轴转台等高精度测试设备辅助实现误差标定,标定效率较低,成本较高,在外场等硬件条件不足的情况下无法进行全误差参数的标定。

      因此,王坚等[13]、王岁儿等[14]针对三轴正交惯导系统提出了现场标定方法。随着计算机的发展,杨管金子等[15]、高爽等[16]、戴洪德等[17]将一些智能优化算法应用到现场快速标定问题的求解中,但只能标定出三轴正交惯导系统中加速度计的误差。由于误差模型的不同,以上现场标定方法均不适用于冗余惯导系统。2016年,胡梦纯等[18]提出了一种针对冗余配置光纤惯组系统的不依赖高精度转台的现场标定方法,该方法仅适用于斜置配置的惯导系统。

      综上所述,目前并无有效的方法解决正四面体冗余惯导系统的现场快速标定问题。针对这一现状,文中在分析正四面体RINS中的光纤陀螺和加速度计误差的基础上,建立了误差模型,根据解析粗对准姿态误差矩阵与正四面体RINS零偏的关系,利用六位置方案标定出光纤陀螺和加速度计的零偏,之后设计了一种三位置旋转方案标定出光纤陀螺的标度因数和安装误差,利用零偏标定的六位置方案标定出加速度计的标度因数和安装误差,最后通过仿真试验及所在实验室研制的正四面体RINS的实物试验验证了方法的正确性及有效性。

    • 冗余惯导系统包括多种冗余配置方案,如正交冗余配置方案、圆锥冗余配置方案、斜置冗余配置方案等。文中采用的是由四个光纤陀螺和四个石英挠性加速度计组成的正四面体冗余配置方案,如图1所示。

      图  1  正四面体冗余配置方案图

      Figure 1.  Tetrahedron redundant configuration diagram

      以光纤陀螺为例进行分析,正四面体RINS输出角速度${{\boldsymbol{\omega}} _{m}}$为:

      $$ {{\boldsymbol{\omega}} _{m}}{ = }{\boldsymbol{H}}{{\boldsymbol{\omega}} _{b}} $$ (1)

      式中:${{\boldsymbol{\omega}} _{b}}$为载体坐标系中三轴等效角速度;${{\boldsymbol{\omega}} _m}$为四个光纤陀螺敏感的角速度;${{\boldsymbol{H}}}$为惯导系统的冗余配置矩阵,如公式(2)所示:

      $$ {\boldsymbol{H}}{\text{ = }}\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] $$ (2)

      式中:$\alpha $为正四面体侧面与底面的设计角度,为70.53°;${\;\beta _3}$${\;\beta _4}$为陀螺仪3和陀螺仪4敏感轴在xoz平面的投影与ox轴的设计角度,分别为120°、240°。

      将配置角度数值代入可得具体的四面体配置矩阵如下:

      $$ {\boldsymbol{H}}{\text{ = }}\left[ {\begin{array}{*{20}{c}} 0&0&{ - 1} \\ {0.942\;8}&0&{0.333\;3} \\ { - 0.471\;4}&{0.816\;5}&{0.333\;3} \\ { - 0.471\;4}&{ - 0.816\;5}&{0.333\;3} \end{array}} \right] $$ (3)

      利用最小二乘法可得到等效三轴角速度$ {\hat{\boldsymbol{ \omega}} _b} $的最优估计:

      $$ {\hat{\boldsymbol{ \omega}} _b} = {\left( {{{\boldsymbol{H}}^{\rm{T}}}{\boldsymbol{H}}} \right)^{ - 1}}{{\boldsymbol{H}}^{\rm{T}}}{{\boldsymbol{\omega}} _m} $$ (4)

      惯性器件的误差主要包括确定性误差和随机误差,其中确定性误差包括零偏、标度因数误差和安装误差。

      当陀螺仪输入的角速度为0时,输出的值即为零偏。正四面体RINS中的光纤陀螺的零偏${{{\boldsymbol{B}}}_{g}}$为:

      $$ {{{\boldsymbol{B}}}_g} = {\left[ {\begin{array}{*{20}{c}} {{b_{g1}}}&{{b_{g2}}}&{{b_{g3}}}&{{b_{g4}}} \end{array}} \right]^{\rm{T}}} $$ (5)

      式中:$ {b_{g1}} $$ {b_{g2}} $$ {b_{g3}} $$ {b_{g4}} $为四个光纤陀螺的零偏。

      由零偏引起的量测误差$ \Delta {{\boldsymbol{m}}_b} $为:

      $$ \Delta {{\boldsymbol{m}}_b} = {{\boldsymbol{B}}_g} $$ (6)

      标度因数是输出数字脉冲与输入角速率之比,标度因数不准确引入的误差是标度因数误差。正四面体RINS中的光纤陀螺的标度因数误差$ \delta {{\boldsymbol{K}}_g} $为:

      $$ \delta {{\boldsymbol{K}}_g} = \left[ {\begin{array}{*{20}{c}} {{\delta }{{K}_{g1}}}&0&0&0 \\ 0&{{\delta }{{K}_{g2}}}&0&0 \\ 0&0&{{\delta }{{K}_{g3}}}&0 \\ 0&0&0&{{\delta }{{K}_{g4}}} \end{array}} \right] $$ (7)

      式中:$ {\delta }{{K}_{g1}} $$ {\delta }{{K}_{g2}} $$ {\delta }{{K}_{g3}} $$ {\delta }{{K}_{g4}} $为四个光纤陀螺的标度因数误差。

      由标度因数误差引起的量测误差$ \Delta {{\boldsymbol{m}}_k} $为:

      $$ \Delta {{\boldsymbol{m}}_k} = \delta {{\boldsymbol{K}}_g}{{\boldsymbol{\omega}} _m} $$ (8)

      由于装配工艺和加工水平有限,光纤陀螺敏感轴的实际指向与设定指向存在偏差,称为安装误差。每个光纤陀螺包含两项安装误差,分别用俯仰角误差$\delta {u_{gi}}$和方位角误差$\delta {v_{gi}}$表示。经计算,光纤陀螺包含安装误差的冗余配置矩阵$ {{\boldsymbol{H}}_g} $为:

      $$ {{\boldsymbol{H}}_g} = \left[ {\begin{array}{*{20}{c}} {{H_{g1x}}}&{{H_{g1y}}}&{{H_{g1z}}} \\ {{H_{g2x}}}&{{H_{g2y}}}&{{H_{g2z}}} \\ {{H_{g3x}}}&{{H_{g3y}}}&{{H_{g3z}}} \\ {{H_{g4x}}}&{{H_{g4y}}}&{{H_{g4z}}} \end{array}} \right] $$ (9)

      式中:$ {H_{gmn}} $(m=1, 2, 3, 4; n=x, y, z)为陀螺仪m敏感轴相对n轴由于安装误差导致的交耦系数。

      $$ \left\{ {\begin{array}{*{20}{l}} {{H_{g1x}} = - \delta {u_{g1}}\sin \beta \cos {\beta _1} + \delta {v_{g1}}\cos \;\beta \sin {\beta _1}} \\ {{H_{g1y}} = - \delta {u_{g1}}\sin \beta \sin {\beta _1} - \delta {v_{g1}}\cos \;\beta \cos {\beta _1}} \\ {{H_{g1z}} = - 1{\text{ + }}\delta {u_{g1}}\cos \;\beta } \\ {{H_{g2x}} = \sin \alpha - \delta {u_{g2}}\sin \alpha \cos {\beta _2} + \delta {v_{g2}}\cos \alpha \sin {\beta _2}} \\ {{H_{g2y}} = - \delta {u_{g2}}\sin \alpha \sin {\beta _2} - \delta {v_{g2}}\cos \alpha \cos {\beta _2}} \\ {{H_{g2z}} = \cos \alpha {\text{ + }}\delta {u_{g2}}\cos \alpha } \\ {{H_{g3x}} = \sin \alpha \cos {\beta _3} - \delta {u_{g3}}\sin \alpha \cos {\beta _3} + \delta {v_{g3}}\cos \alpha \sin {\beta _3}} \\ {{H_{g3y}} = \sin \alpha \sin {\beta _3} - \delta {u_{g3}}\sin \alpha \sin {\beta _3} - \delta {v_{g3}}\cos \alpha \cos {\beta _3}} \\ {{H_{g3z}} = \cos \alpha {\text{ + }}\delta {u_{g3}}\cos \alpha } \\ {{H_{g4x}} = \sin \alpha \cos {\beta _4} - \delta {u_{g4}}\sin \alpha \cos {\beta _4} + \delta {v_{g4}}\cos \alpha \sin {\beta _4}} \\ {{H_{g4y}} = \sin \alpha \sin {\beta _4} - \delta {u_{g4}}\sin \alpha \sin {\beta _4} - \delta {v_{g4}}\cos \alpha \cos {\beta _4}} \\ {{H_{g4z}} = \cos \alpha {\text{ + }}\delta {u_{g4}}\cos \alpha } \end{array}} \right. $$ (10)

      式中:$ \;\beta $为陀螺仪1敏感轴与xoz平面的设计角度;$ {\;\beta _1} $$ {\;\beta _2} $为陀螺仪1和陀螺仪2敏感轴在xoz平面的投影与ox轴的设计角度。

      由安装误差引起的量测误差$ \Delta {{{\boldsymbol{m}}}_h} $为:

      $$ \Delta {{\boldsymbol{m}}_h} = \left( {{{{{\boldsymbol{H}}}}_g} - {\boldsymbol{H}}} \right){\left( {{{\boldsymbol{H}}^{\rm{T}}}{\boldsymbol{H}}} \right)^{ - 1}}{{\boldsymbol{H}}^{\rm{T}}}{{\boldsymbol{\omega}} _m} $$ (11)

      通过上述分析,当考虑光纤陀螺零偏、标定因数误差、安装误差,同时考虑随机误差时,正四面体RINS中光纤陀螺输出角速度${\omega _m}$为:

      $$ {{\boldsymbol{\omega}} _m} = \left( {{\boldsymbol{I}} + \delta {{\boldsymbol{K}}_g}} \right)\left( {{{\boldsymbol{H}}_g}{{\boldsymbol{\omega}} _b} + {{\boldsymbol{B}}_g}} \right) + {{\boldsymbol{\eta}} _g} $$ (12)

      式中:${\boldsymbol{I}}$为单位矩阵;${\boldsymbol\eta _g}$为四个光纤陀螺的随机误差。

      当光纤陀螺输出为数字脉冲时,误差模型表示为:

      $$ {{{{\boldsymbol{N}}}}_{\omega m}} = {{{{\boldsymbol{K}}}}_g}\left( {{{{{\boldsymbol{H}}}}_g}{{\boldsymbol{\omega}} _b} + {{{{\boldsymbol{B}}}}_g}} \right) + {{\boldsymbol{\eta}} _g} $$ (13)

      式中:$ {{\boldsymbol{N}}_{\omega m}} $为光纤陀螺输出数字脉冲;$ {{\boldsymbol{K}}_g} $为光纤陀螺的标度因数。

      同理可得正四面体RINS中加速度计输出加速度$ {{{\boldsymbol{f}}}_m} $为:

      $$ {{{\boldsymbol{f}}}_m} = \left( {{\boldsymbol{I}} + \delta {{\boldsymbol{K}}_f}} \right)\left( {{{\boldsymbol{H}}_f}{{{\boldsymbol{f}}}_b} + {{\boldsymbol{B}}_f}} \right) + {{\boldsymbol{\eta}} _f} $$ (14)

      式中:$\delta {{\boldsymbol{K}}_f}$为加速度计的标度因数误差;$ {{\boldsymbol{H}}_f} $为加速度计包含安装误差的冗余配置矩阵;$ {{{\boldsymbol{f}}}_b} $为载体坐标系等效三轴加速度;$ {{\boldsymbol{B}}_f} $为加速度计的零偏;${{\boldsymbol{\eta}} _f}$为加速度计的随机误差。

      当加速度计输出为数字脉冲时,误差模型表示为:

      $$ {{\boldsymbol{N}}_{fm}} = {{\boldsymbol{K}}_f}\left( {{{\boldsymbol{H}}_f}{{\boldsymbol{f}}_b} + {{\boldsymbol{B}}_f}} \right) + {{\boldsymbol{\eta}} _f} $$ (15)

      式中:$ {{\boldsymbol{N}}_{fm}} $为加速度计输出数字脉冲;$ {{\boldsymbol{K}}_f} $为加速度计的标度因数。

      至此,建立了正四面体RINS中光纤陀螺和加速度计的误差模型。

    • 文中根据解析粗对准姿态误差矩阵中的非正交、非单位化误差与正四面体RINS中光纤陀螺、加速度计的天向零偏合量的关系标定出正四面体RINS中惯性器件的零偏。解析粗对准是指利用地球重力加速度矢量和地球自转角速度矢量实现惯导系统的对准,不需要其他外部信息。通过惯性器件的测量值可以直接计算出初始捷联矩阵:

      $$ {\boldsymbol{C}}_b^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}}}^b}} \right)}^{\rm{T}}}} \\ {{{\left( {{{\boldsymbol{\omega}} }_{ie}^b} \right)}^{\rm{T}}}} \\ {{{\left( {{{{\boldsymbol{g}}}^b} \times {{\boldsymbol{\omega}} }_{ie}^b} \right)}^{\rm{T}}}} \end{array}} \right] $$ (16)

      式中:${{\boldsymbol{g}}^n}$$ {\boldsymbol{\omega}} _{ie}^n $分别为重力加速度和地球自转角速度在导航系中分量;${{\boldsymbol{g}}^b}$${\boldsymbol{ \omega}} _{ie}^b $分别为重力加速度和地球自转角速度在载体系中分量。

      当解析粗对准存在误差时,姿态误差矩阵为:

      $$ {{\boldsymbol{E}}} = {\delta {\boldsymbol{C}}}_b^n{\left( {{{\boldsymbol{C}}}_b^n} \right)^{\rm{T}}} $$ (17)

      式中:${\delta {\boldsymbol{C}}}_b^n$为由陀螺仪和加速度计的零偏等误差引起的姿态误差。

      根据参考文献[19-20]对解析粗对准误差的分析,解析粗对准的误差主要是对准误差${{E}_{ss}}$和非正交、非单位化误差${{E}_s}$,如下所示:

      $$ {{\boldsymbol{E}}} = {{{\boldsymbol{E}}}_{ss}} + {{{\boldsymbol{E}}}_s} $$ (18)
      $$ {{{\boldsymbol{E}}}_{ss}}{\text{ = }}\frac{{{{\boldsymbol{E}}} - {{{\boldsymbol{E}}}^{{\rm{T}}}}}}{2} = \left[ {\begin{array}{*{20}{c}} 0&{{\varphi _U}}&{ - {\varphi _E}} \\ { - {\varphi _U}}&0&{{\varphi _N}} \\ {{\varphi _E}}&{ - {\varphi _N}}&0 \end{array}} \right] $$ (19)
      $$ {{{\boldsymbol{E}}}_{s}}{\text{ = }}\frac{{{{\boldsymbol{E}}} + {{{\boldsymbol{E}}}^{{\rm{T}}}}}}{2} = \left[ {\begin{array}{*{20}{c}} {{\eta _E}}&{{o_U}}&{{o_N}} \\ {{o_U}}&{{\eta _N}}&{{o_E}} \\ {{o_N}}&{{o_E}}&{{\eta _U}} \end{array}} \right] $$ (20)

      式中:$ {\varphi _U} $$ {\varphi _N} $$ {\varphi _E} $分别为天向、北向、东向对准误差;$ {o_U} $$ {o_N} $$ {o_E} $分别为天向、北向、东向非正交误差;$ {\eta _U} $$ {\eta _N} $$ {\eta _E} $分别为天向、北向、东向非单位化误差。

      根据参考文献[14]对非正交、非单位化误差与陀螺仪和加速度计零偏的分析可得,天向加速度误差合量、天向陀螺误差合量及北向陀螺误差合量为:

      $$ \left\{ \begin{gathered} \delta {f_U} = g{\eta _U} \\ \delta {\omega _N} = \varOmega \left[ {{\eta _E} - {\eta _U} + \left( {\delta {f_N}\tan L} \right)/g} \right]\cos L \\ \delta {\omega _U} = \varOmega \left( {2{o_E} - {\eta _U}\tan L + \delta {f_N}/g} \right)\cos L \\ \end{gathered} \right. $$ (21)

      式中:$ g、\varOmega 、L $分别为冗余惯导系统所在位置的重力加速度幅值、地球自转角速度幅值和纬度;$ \delta {f_N} $$ \delta {f_U} $为北向、天向加速度误差合量;$ \delta {\omega _N} $$ \delta {\omega _U} $为天向陀螺误差合量。

      由于在实际外场条件下找北比较困难,因此只利用天向陀螺仪误差合量和天向加速度误差合量进行零偏标定。经分析,加速度计的北向零偏合量对天向陀螺仪的零偏合量影响非常小,因此可忽略$ \delta {f_N}/g $误差项。文中选用一种六位置方案,只需要RINS的三个轴依次指向天和地,如图2所示。每个位置估计的零偏结果如表1所示。

      图  2  六位置转位示意图

      Figure 2.  Six-position transposition diagram

      表 1  每个位置估计的IMU轴向零偏

      Table 1.  IMU axial biases for each position estimation

      BiasPos1Pos2Pos3Pos4Pos5Pos6
      $\delta {\hat \omega _U}$$\delta \hat \omega _{x1}^b$$ - \delta \hat \omega _{x2}^b$$\delta \hat \omega _{y1}^b$$ - \delta \hat \omega _{y2}^b$$\delta \hat \omega _{z1}^b$$ - \delta \hat \omega _{z2}^b$
      $\delta {\hat f_U}$$\delta \hat f_{x1}^b$$ - \delta \hat f_{x2}^b$$\delta \hat f_{y1}^b$$ - \delta \hat f_{y2}^b$$\delta \hat f_{z1}^b$$ - \delta \hat f_{z2}^b$

      经过计算可得陀螺仪和加速度计三轴等效零偏为:

      $$ \left\{ {\begin{array}{*{20}{c}} {\delta \hat \omega _x^b = \left( {\delta \hat \omega _{x1}^b{\text{ + }}\delta \hat \omega _{x2}^b} \right)/2} \\ {\delta \hat \omega _y^b = \left( {\delta \hat \omega _{y1}^b{\text{ + }}\delta \hat \omega _{y2}^b} \right)/2} \\ {\delta \hat \omega _z^b = \left( {\delta \hat \omega _{z1}^b{\text{ + }}\delta \hat \omega _{z2}^b} \right)/2} \end{array}} \right. $$ (22)
      $$ \left\{ {\begin{array}{*{20}{c}} {\delta \hat f_x^b = \left( {\delta \hat f_{x1}^b{\text{ + }}\delta \hat f_{x2}^b} \right)/2} \\ {\delta \hat f_y^b = \left( {\delta \hat f_{y1}^b{\text{ + }}\delta \hat f_{y2}^b} \right)/2} \\ {\delta \hat f_z^b = \left( {\delta \hat f_{z1}^b{\text{ + }}\delta \hat f_{z2}^b} \right)/2} \end{array}} \right. $$ (23)

      参考文献[19-20],根据姿态转换矩阵$ {{\hat {\boldsymbol{C}}}}_b^n $计算出非正交、非单位化误差:

      $$ {{{\hat {\boldsymbol{E}}}}_s} = \frac{1}{2}\left[ {{{\hat {\boldsymbol{C}}}}_b^n{{\left( {{{\hat {\boldsymbol{C}}}}_b^n} \right)}^{\rm{T}}} - {{{\boldsymbol{I}}}}} \right] $$ (24)

      将公式(24)计算得出的$ {\hat o_E} $$ {\hat \eta _U} $代入公式(21)中,将结果代入公式(22)、(23)中,可求得陀螺仪和加速度计的零偏合量为:

      $$ \left\{ {\begin{array}{*{20}{c}} {\delta \hat \omega _x^b = \varOmega \left[ {\left( {{{\hat o}_{E1}} - {{\hat o}_{E2}}} \right) + \dfrac{{\left( {{{\hat \eta }_{U2}} - {{\hat \eta }_{U1}}} \right)\tan L}}{2}} \right]\cos L} \\ {\delta \hat \omega _y^b = \varOmega \left[ {\left( {{{\hat o}_{E3}} - {{\hat o}_{E4}}} \right) + \dfrac{{\left( {{{\hat \eta }_{U4}} - {{\hat \eta }_{U3}}} \right)\tan L}}{2}} \right]\cos L} \\ {\delta \hat \omega _z^b = \varOmega \left[ {\left( {{{\hat o}_{E5}} - {{\hat o}_{E6}}} \right) + \dfrac{{\left( {{{\hat \eta }_{U6}} - {{\hat \eta }_{U5}}} \right)\tan L}}{2}} \right]\cos L} \end{array}} \right. $$ (25)
      $$ \left\{ {\begin{array}{*{20}{c}} {\delta \hat f_x^b{\text{ = }}g\left( {{{\hat \eta }_{U1}} - {{\hat \eta }_{U2}}} \right)/2} \\ {\delta \hat f_y^b{\text{ = }}g\left( {{{\hat \eta }_{U3}} - {{\hat \eta }_{U4}}} \right)/2} \\ {\delta \hat f_z^b{\text{ = }}g\left( {{{\hat \eta }_{U5}} - {{\hat \eta }_{U6}}} \right)/2} \end{array}} \right. $$ (26)

      将公式(25)、(26)代入公式(1)中,即可计算出四个光纤陀螺和四个加速度计的零偏为:

      $$ \left\{ {\begin{array}{*{20}{l}} \begin{gathered} {b_{g1}} = - \delta \hat \omega _z^b \\ {b_{g2}} = \delta \hat \omega _x^b\sin \alpha + \delta \hat \omega _z^b\cos \alpha \\ {b_{g3}} = \delta \hat \omega _x^b\sin \alpha \cos {\beta _3} + \delta \hat \omega _y^b\sin \alpha \sin {\beta _3} + \delta \hat \omega _z^b\cos \alpha \\ {b_{g4}} = \delta \hat \omega _x^b\sin \alpha \cos {\beta _4} + \delta \hat \omega _y^b\sin \alpha \sin {\beta _4} + \delta \hat \omega _z^b\cos \alpha \\ {b_f}_1 = - \delta \hat f_z^b \\ \end{gathered} \\ {{b_f}_2 = \delta \hat f_x^b\sin \alpha + \delta \hat f_z^b\cos \alpha } \\ {{b_f}_3 = \delta \hat f_x^b\sin \alpha \cos {\beta _3} + \delta \hat f_y^b\sin \alpha \sin {\beta _3} + \delta \hat f_z^b\cos \alpha } \\ {{b_f}_4 = \delta \hat f_x^b\sin \alpha \cos {\beta _4} + \delta \hat f_y^b\sin \alpha \sin {\beta _4} + \delta \hat f_z^b\cos \alpha } \end{array}} \right. $$ (27)
    • 针对现场快速标定问题,使用大理石平台和正六面体工装对正四面体RINS中的惯性器件进行标定。利用三位置手动旋转n圈的方法为正四面体RINS提供角速度输入,利用六位置方法为正四面体RINS提供比力输入,比较陀螺仪和加速度计的输出和输入,可估计出陀螺仪和加速度计的标度因数和安装误差。

    • 文中采用三位置手动旋转n圈的方式标定光纤陀螺的标度因数和安装误差,编排方案如图3所示。将正四面体RINS安装于正六面体工装后置于大理石平台上,令x轴朝天,顺时针、逆时针旋转正六面体工装n圈,对yz轴进行同样的操作,要求在规定时间T内相对均匀地转动n圈。

      图  3  三位置旋转方案示意图

      Figure 3.  Three-position rotation scheme

      x轴朝天为例进行分析,当正四面体RINS进行旋转时,光纤陀螺输入的角速度为:

      $$ \begin{split} \left[ {\begin{array}{*{20}{c}} {{\omega _x}} \\ {{\omega _y}} \\ {{\omega _z}} \end{array}} \right] =& \left[ {\begin{array}{*{20}{c}} 1&0&0 \\ 0&{\cos \theta \left( t \right)}&{\sin \theta \left( t \right)} \\ 0&{ - \sin \theta \left( t \right)}&{\cos \theta \left( t \right)} \end{array}} \right] \times\\ &\left[ {\begin{array}{*{20}{c}} {\varOmega \sin L} \\ {\varOmega \cos L} \\ 0 \end{array}} \right] + \left[ {\begin{array}{*{20}{c}} { \pm {\omega _{ix}}\left( t \right)} \\ 0 \\ 0 \end{array}} \right] \end{split} $$ (28)

      式中:$ {\omega _{ix}}\left( t \right) $为手动旋转时瞬时角速度;$ \theta \left( t \right) $为手动旋转累积转动角度。

      将公式(28)代入公式(13),两边求积分再相减可得:

      $$ {K_{g1}}{H_{g1x}} = \frac{{\displaystyle\int_0^T {N_{\omega 1}^{x + }{\rm{d}}t - \displaystyle\int_0^T {N_{\omega 1}^{x - }{\rm{d}}t} } }}{{2\displaystyle\int_0^T {{\omega _{ix}}\left( t \right){\rm{d}}t} }}{\text{ = }}\frac{{\displaystyle\int_0^T {N_{\omega 1}^{x + }{\rm{d}}t - \displaystyle\int_0^T {N_{\omega 1}^{x - }{\rm{d}}t} } }}{{4n\pi }} $$ (29)

      式中:n为旋转圈数;T为规定的时间;$ N_{\omega 1}^{x + } $$ N_{\omega 1}^{x - } $分别为正四面体RINS绕x轴顺时针、逆时针旋转时陀螺仪1的输出。

      $ {K_{gmn}}{\text{ = }}{K_{gm}}{H_{gmn}} $m=1, 2, 3, 4; n=x, y, z),同理可求得$ {K_{g2 x}} $$ {K_{g3 x}} $$ {K_{g4 x}} $,当y轴朝天时可求得$ {K_{g1 y}} $$ {K_{g2 y}} $$ {K_{g3 y}} $$ {K_{g4 y}} $,当z轴朝天时可求得$ {K_{g1 z}} $$ {K_{g2 z}} $$ {K_{g3 z}} $$ {K_{g4 z}} $

      归一化可求得正四面体RINS中的光纤陀螺的标度因数和安装误差导致的交耦系数:

      $$ {{K}_{gm}} = \sqrt {{K^2}_{gmx} + {K^2}_{gmy} + {K^2}_{gmz}} $$ (30)
      $$ {H_{gmn}}{\text{ = }}\frac{{{K_{gmn}}}}{{{K_{gm}}}} $$ (31)
    • 使用零偏标定所设计的六位置编排次序进行标定,如图2所示。将位置1和位置2的加速度计输入代入误差模型公式(15)中,可得:

      $$ \begin{split} N_{fm}^1 = & {{K}_{fm}}\left( {{H_{fmx}}{f_x} + {H_{fmy}}{f_y} + {H_{fmz}}{f_z}} \right) + {{K}_{fm}}{B_{fm}} {\text{ = }}\\ & {{K}_{fm}}{H_{fmx}}g + {{K}_{fm}}{B_{fm}} \end{split} $$ (32)
      $$ \begin{split} N_{fm}^2 = & {{K}_{fm}}\left( {{H_{fmx}}{f_x} + {H_{fmy}}{f_y} + {H_{fmz}}{f_z}} \right) + {{K}_{fm}}{B_{fm}} {\text{ = }} \\ & {{K}_{fm}}{H_{fmx}}\left( { - g} \right) + {{K}_{fm}}{B_{fm}} \end{split} $$ (33)

      将公式(32)与公式(33)相减可得:

      $$ {{K}_{fm}}{H_{fmx}}{\text{ = }}\frac{{N_{fm}^1 - N_{fm}^2}}{{2g}} $$ (34)

      式中:$ {K_{fm}} $m=1, 2, 3, 4)为第m个加速度计的标度因数;$ {H_{fmx}} $为第m个加速度计敏感轴相对x轴由于安装误差导致的交耦系数;$ N_{fm}^1 $$ N_{fm}^2 $分别为位置1和位置2第m个加速度计的输出。

      $ {K_{fmn}}{\text{ = }}{K_{fm}}{H_{fmn}} $(m=1, 2, 3, 4; n=x, y, z),由剩下四个位置可求得$ {K_{fmy}} $$ {K_{fmz}} $。归一化可求得加速度计的标度因数和安装误差导致的交耦系数:

      $$ {K_{fm}} = \sqrt {{K^2}_{fmx} + {K^2}_{fmy} + {K^2}_{fmz}} $$ (35)
      $$ {H_{fmn}}{\text{ = }}\frac{{{K_{fmn}}}}{{{K_{fm}}}} $$ (36)
    • 为验证文中提出的正四面体RINS现场快速标定方法的有效性,进行了仿真试验。设当地地理纬度为40.356°,经度为116.67°,正四面体RINS所在高度为50 m。惯性器件采样周期为200 Hz,光纤陀螺和加速度计的误差参数设定如表2~3所示。

      表 2  光纤陀螺误差参数设定

      Table 2.  Setting values of gyroscope error parameters

      ParameterGyro
      scope 1
      Gyro
      scope 2
      Gyro
      scope 3
      Gyro
      scope 4
      Bias/(°)·h−10.60.5−0.30.4
      Scale factor/bits·((°)/s)−1170000170000170000170000
      Installation error $\delta {u_{gi}}$
      /(″)
      40404040
      Installation error $\delta {v_{gi}}$
      /(″)
      40404040
      Noise/(°)·h−1/20.010.010.010.01

      表 3  加速度计误差参数设定

      Table 3.  Setting values of accelerometer error parameters

      ParameterAccelerometer 1Accelerometer 2Accelerometer 3Accelerometer 4
      Bias/mg0.30.2−0.40.5
      Scale factor
      /bits·((°)/s)−1
      1111
      Installation error $\delta {u_{fi}}$
      /(″)
      40404040
      Installation error $\delta {v_{fi}}$
      /(″)
      40404040
      Noise/mg·h−1/20.020.020.020.02

      按照图2所示的六位置编排方案生成静态冗余惯导系统的仿真数据,每个位置采集2 min数据,计算光纤陀螺的零偏和加速度计的零偏、标度因数及安装误差估计结果。按照图3所示的三位置旋转方案生成冗余惯导系统中光纤陀螺的仿真数据,计算光纤陀螺的标度因数和安装误差。仿真结果如表4所示,可见提出的现场快速标定方法可有效估计得到标定结果,其中惯性器件的零偏标定结果误差在7%以内,标度因数的标定结果误差在0.1%以内,安装误差导致的交耦系数的标定结果误差在0.1%以内,对加速度计的误差标定精度高于光纤陀螺的误差标定精度。

      表 4  仿真试验结果

      Table 4.  Simulation results

      Fiber optic gyroscope parametersPresetSimulation resultsErrorAccelerometer parametersPresetSimulation resultsError
      ${b_{g1} }/{(^\circ)\cdot {\rm{h} }^{-1} }$ 0.6 0.5874 2.10% ${b_{f1} }/{\rm{mg}}$ 0.3 0.3056 1.87%
      ${b_{g2} }/{(^\circ)\cdot {\rm{h} }^{-1} }$ 0.5 0.5098 1.96% ${b_{f2} }/{\rm{mg}}$ 0.2 0.1991 0.45%
      ${b_{g3} }/{(^\circ)\cdot {\rm{h} }^{-1} }$ −0.3 −0.2877 4.10% ${b_{f3} }/{\rm{mg}}$ −0.4 −0.3926 1.85%
      ${b_{g4} }/{(^\circ)\cdot {\rm{h} }^{-1} }$ 0.4 0.3753 6.18% ${b_{f4} }/{\rm{mg}}$ 0.5 0.4991 0.18%
      ${ {K}_{g1} }/{\rm{bits} }\cdot({(^\circ)/ {\rm{s} })^{-1} }$ 170000 170142.54048690 0.0838% ${ {K}_{f1} }/{\rm{bits} }\cdot{({\rm{m/s^2} }) ^{-1} }$ 1 1.00000447 0.000004%
      ${ {K}_{g2} }/{\rm{bits} }\cdot({(^\circ)/ {\rm{s} })^{-1} }$ 170000 170024.96320257 0.0147% ${ {K}_{f2} }/{\rm{bits} }\cdot{({\rm{m/s^2} }) ^{-1} }$ 1 0.99965628 0.0003%
      ${ {K}_{g3} }/{\rm{bits} }\cdot({(^\circ)/ {\rm{s} })^{-1} }$ 170000 169981.63378409 0.0108% ${ {K}_{f3} }/{\rm{bits} }\cdot{({\rm{m/s^2} }) ^{-1} }$ 1 1.00019696 0.0002%
      ${ {K}_{g4} }/{\rm{bits} }\cdot({(^\circ)/ {\rm{s} })^{-1} }$ 170000 169981.53174746 0.0109% ${ {K}_{f4} }/{\rm{bits} }\cdot{({\rm{m/s^2} }) ^{-1} }$ 1 0.99979333 0.0002%
      $ {H_{g1 x}} $ $1.939\;255 \times {10^{ - 4}}$ ${{1}}{{.939\;254}} \times {10^{ - 4}}$ 0.0001% $ {H_{f1 x}} $ $1.939\;255 \times {10^{ - 4}}$ ${{1}}{{.939\;257}} \times {10^{ - 4}}$ 0.0001%
      $ {H_{g1 y}} $ $1.939\;255 \times {10^{ - 4}}$ $1.939\;254 \times {10^{ - 4}}$ 0.0001% $ {H_{f1 y}} $ $1.939\;255 \times {10^{ - 4}}$ $1.939\;258 \times {10^{ - 4}}$ 0.0002%
      $ {H_{g1 z}} $ −1 −0.999999 0.0001% $ {H_{f1 z}} $ $ - 1$ −0.999999 0.0001%
      $ {H_{g2 x}} $ 0.942633 0.942775 0.0151% $ {H_{f2 x}} $ 0.942633 0.942775 0.0151%
      $ {H_{g2 y}} $ $ {{ - }}2.474\;740 \times {10^{ - 4}} $ ${{ - 2}}{{.472\;355}} \times {10^{ - 4}}$ 0.0964% $ {H_{f2 y}} $ $ - 2.474\;740 \times {10^{ - 4}} $ ${{ - 2}}{{.472\;524}} \times {10^{ - 4}}$ 0.0896%
      $ {H_{g2 z}} $ 0.333378 0.333428 0.0150% $ {H_{f2 z}} $ 0.333378 0.333429 0.0153%
      $ {H_{g3 x}} $ −0.471261 −0.471270 0.0019% $ {H_{f3 x}} $ −0.471261 −0.471236 0.0053%
      $ {H_{g3 y}} $ 0.816626 0.816554 0.0088% $ {H_{f3 y}} $ 0.816626 0.816583 0.0053%
      $ {H_{g3 z}} $ 0.333378 0.333384 0.0018% $ {H_{f3 z}} $ 0.333378 0.333361 0.0051%
      $ {H_{g4 x}} $ −0.471373 −0.471427 0.0115% $ {H_{f4 x}} $ −0.471373 −0.471418 0.0095%
      $ {H_{g4 y}} $ −0.816379 −0.816450 0.0087% $ {H_{f4 y}} $ −0.816379 −0.816458 0.0097%
      $ {H_{g4 z}} $ 0.333378 0.333416 0.0114% $ {H_{f4 z}} $ 0.333378 0.333409 0.0093%
    • 为进一步验证正四面体RINS现场快速标定方法,使用所在实验室研制的正四面体RINS进行标定试验。该系统由四个光纤陀螺和四个石英挠性加速度计组成,系统结构如图4所示,器件技术规格如表5所示。将正四面体RINS装入正六面体工装后放置于大理石平台上搭建试验环境,如图5所示。

      图  4  正四面体RINS结构图

      Figure 4.  Structure diagram of tetrahedral redundant inertial navigation system

      表 5  光纤陀螺、加速度计技术规格

      Table 5.  Technical specification of fiber optic gyroscope and accelerometer

      Parameter nameParameter indicator
      Fiber optic gyroscope bias stability$/{(^\circ)\cdot {\rm{h} }^{-1} }$ $ \leqslant $0.1
      Fiber optic gyroscope scale factor$/{\rm{bits} }\cdot({(^\circ)/ {\rm{s} })^{-1} }$ 176000±5000
      Accelerometer bias stability$/\text{μ} {\rm{g}}$ 50
      Accelerometer scale factor$/{\rm{mA} } \cdot{{ g} }^{-1}$ 1.1-1.5

      图  5  试验设备及环境

      Figure 5.  Experiment equipment and environment

    • 在试验开始前对系统预热1 h,进行六位置试验,将系统xyz轴分别朝天和地,每个位置采集2 min静态数据,共12 min;然后进行三位置旋转试验,将系统xyz轴朝天,以大理石平台的侧面作为基准,分别顺时针、逆时针旋转正六面体工装三圈,旋转前后要求同一个面与大理石平台的侧面重合,同时要求1.5 min内完成三圈旋转,共9 min。上述两步标定共需21 min。按照上述原理计算标定结果,光纤陀螺误差标定结果如表6所示,加速度计误差标定结果如表7所示。

      表 6  光纤陀螺误差标定结果

      Table 6.  Gyroscope error calibration results

      Fiber optic gyroscope parametersCalibration resultsFiber optic gyroscope parametersCalibration results
      ${b_{g1} }/{(^\circ)\cdot {\rm{h} }^{-1} }$ 0.0541 ${ {K}_{g1} }/{\rm{bits} }\cdot({(^\circ)/ {\rm{s} })^{-1} }$ 172207.11
      ${b_{g2} }/{(^\circ)\cdot {\rm{h} }^{-1} }$ 0.0524 ${ {K}_{g2} }/{\rm{bits} }\cdot({(^\circ)/ {\rm{s} })^{-1} }$ 177573.77
      ${b_{g3} }/{(^\circ)\cdot {\rm{h} }^{-1} }$ 0.0780 ${ {K}_{g3} }/{\rm{bits} }\cdot({(^\circ)/ {\rm{s} })^{-1} }$ 179823.99
      ${b_{g4} }/{(^\circ)\cdot {\rm{h} }^{-1} }$ −1.1961 ${ {K}_{g4} }/{\rm{bits} }\cdot({(^\circ)/ {\rm{s} })^{-1} }$ 171997.12
      $ {H_{g1 x}} $ −0.0015 $ {H_{g3 x}} $ −0.4703
      $ {H_{g1 y}} $ −0.0034 $ {H_{g3 y}} $ 0.8168
      $ {H_{g1 z}} $ −1.0000 $ {H_{g3 z}} $ 0.3340
      $ {H_{g2 x}} $ 0.9418 $ {H_{g4 x}} $ −0.4673
      $ {H_{g2 y}} $ 0.0016 $ {H_{g4 y}} $ −0.8186
      $ {H_{g2 z}} $ 0.3362 $ {H_{g4 z}} $ 0.3339

      表 7  加速度计误差标定结果

      Table 7.  Accelerometer error calibration results

      Accelerometer parametersCalibration resultsAccelerometer parametersCalibration results
      ${b_{f1} }/{{g} }$−0.0167${ {K}_{f1} }/{\rm{bits} }\cdot{({\rm{m/s^2} }) ^{-1} }$0.9680
      ${b_{f2} }/{{g} }$0.0087${ {K}_{f2} }/{\rm{bits} }\cdot{({\rm{m/s^2} }) ^{-1} }$0.9687
      ${b_{f3} }/{{g} }$0.0109${ {K}_{f3} }/{\rm{bits} }\cdot{({\rm{m/s^2} }) ^{-1} }$0.9907
      ${b_{f4} }/{{g} }$−0.0029${ {K}_{f4} }/{\rm{bits} }\cdot{({\rm{m/s^2} }) ^{-1} }$0.9516
      $ {H_{f1 x}} $${ { - } }3.159\;0 \times {10^{ - 5} }$$ {H_{f3 x}} $−0.4734
      $ {H_{f1 y}} $${ { - } }1.225\;7 \times {10^{ - 4} }$$ {H_{f3 y}} $−0.8152
      $ {H_{f1 z}} $−1.0000$ {H_{f3 z}} $0.3337
      $ {H_{f2 x}} $0.9428$ {H_{f4 x}} $−0.4696
      $ {H_{f2 y}} $−0.0019$ {H_{f4 y}} $−0.8173
      $ {H_{f2 z}} $0.3335$ {H_{f4 z}} $0.3338
    • 为验证标定结果的有效性,将正四面体RINS放置于大理石平台上连续采集约1 h数据进行静基座导航试验,分别解算原始数据和误差补偿后正四面体RINS的姿态、速度和位置变化,结果如图6~8所示。从图6可以看出,标定后的正四面体RINS的横滚角、俯仰角和航向角精度和稳定性更高。从图7可以看出,利用原始数据解算的东向速度和北向速度出现很大偏移,标定后速度稳定性和精度有很大的提升。如图8所示,标定后1 h北向位置误差从61.0655 km降低至0.4767 km,1 h东向位置误差从161.2027 km降低至4.8422 km。试验结果表明,经过现场快速标定方法标定后,有效提升了RINS的导航精度,验证了该方法的有效性。

      图  6  导航解算姿态误差

      Figure 6.  Attitude error of navigation solution

      图  8  导航解算位置误差

      Figure 8.  Position error of navigation solution

      图  7  导航解算速度误差

      Figure 7.  Velocity error of navigation solution

    • 为进一步验证标定结果的有效性,根据三轴转台试验进行结果验证,转台的角分辨率优于1.5"。将xyz轴朝天放置,然后将转台绕外框轴方向以10 (°)/s的速度进行旋转,记录四个光纤陀螺的输出数据。然后分别将xyz轴朝天和朝地放置,记录四个加速度计的输出数据。将现场快速标定方法计算出的误差结果代入到误差模型中,根据输出数据利用最小二乘法得到等效三轴角速度和加速度,以转台设定值作为标准值进行对比,结果如表8表9所示。

      表 8  光纤陀螺转台试验结果

      Table 8.  Gyroscope turntable test results

      Rotating wayStandard value/(°)·s−1Factory parameterCalibration parameter
      Compensation result
      /(°)·s−1
      Relative errorCompensation result
      /(°)·s−1
      Relative error
      x(clockwise) 10 10.0126 0.00126 9.9932 −0.00068
      x(counterclockwise) −10 −9.9687 −0.00313 −10.0011 0.00011
      y(clockwise) 10 9.9842 −0.00158 9.9967 −0.00037
      y(counterclockwise) −10 −9.9825 −0.00175 −9.9903 −0.00097
      z(clockwise) 10 9.9709 −0.00291 9.9995 −0.00005
      z(counterclockwise) −10 −9.9599 −0.00401 −10.0046 0.00046

      表 9  加速度计转台试验结果

      Table 9.  Accelerometer turntable test results

      PositionStandard value/m·s2 Factory parameterCalibration parameter
      Compensation result/m·s2Relative errorCompensation result Relative error
      x(up) 9.8014 9.8046 3.2648 E-4 9.8022 −8.1621 E-5
      x(down) −9.8014 −9.7952 −6.3256 E-4 −9.8014 0
      y(up) 9.8014 9.8020 6.1216 E-5 9.8011 3.06079 E-5
      y(down) −9.8014 −9.7987 −2.7547 E-4 −9.8017 −3.0608 E-5
      z(up) 9.8014 9.7957 −5.8155 E-4 9.8029 −1.5304 E-4
      z(down) −9.8014 −9.7994 −2.0405 E-4 −9.8029 −1.5304 E-4

      表8表9中的结果可看出,该现场快速标定方法标定出的误差参数补偿到惯性器件中,其结果相对误差均小于出厂参数补偿后的结果,再次证明该方法的有效性。

    • (1) 提出一种针对正四面体RINS误差标定方法,可标定出光纤陀螺和加速度计的所有确定性误差参数,包括零偏、标度因数和安装误差,无需使用高精度转位结构、转台等测试设备,简便灵活,实用性强,耗时较短,适用于多种场合。

      (2) 通过仿真试验可以看出,该方法可有效标定出惯性器件的所有误差参数。从静基座导航试验结果可以看出,标定后的导航效果明显优于未进行标定的导航效果,验证了该方法的正确性。转台试验结果再次验证了标定方法的有效性,为其他冗余配置惯导系统的现场快速标定研究提供了重要参考。

参考文献 (20)

目录

    /

    返回文章
    返回