重力扰动对高精度激光陀螺惯导系统ZUPT的影响分析与补偿

doi:10.3969/j.issn.1001-506X.2020.01.24

摘要/Abstract

摘要：

高精度激光陀螺惯导系统广泛应用于车载自主定位定向当中。当不存在外部测速设备的条件下，一般采用零速修正（zero velocity update，ZUPT）对导航误差的发散过程进行约束。常规ZUPT导航算法中重力矢量采用正常重力模型计算获得，忽略了重力扰动对导航精度的影响。考虑到车载自主导航系统对定位精度的要求，本文从重力扰动对惯性导航误差的影响机理分析入手，指出重力扰动是影响高精度ZUPT导航精度的最主要误差源之一。设计提出了两种适用于车载应用的重力扰动实时补偿方案，并在重力扰动变化剧烈的山区地带进行了长距离车载试验。试验结果表明，对于同一组跑车数据，导航时间2 h ZUPT间隔10 min，激光陀螺惯导系统的水平定位精度由补偿前的8.93 m提高到了补偿后的3.75 m，高程定位精度由补偿前的1.63 m提高到了补偿后的0.80 m。重力扰动补偿方法具有重要的工程应用价值。

关键词: 高精度惯导系统, 零速修正, 重力扰动, 球谐模型

Abstract:

High precision ring laser gyroscope (RLG) inertial navigation system has been widely used in direction and position determination of the land vehicle. On the condition of no external velocity measurement device, zero velocity update (ZUPT) has always been used to restrain the navigation error. In normal way, the ZUPT navigation algorithm calculates the gravity vector by using the standard gravity model, which neglects the effect on navigation precision of the gravity anomaly. Considering the high demand of positioning accuracy of the vehicular autonomous navigation system, the influence mechanism of the inertial navigation error caused by gravity anomaly is analyzed, and it is point out that gravity anomaly is one of the most significant error source of the high precision ZUPT navigation accuracy. Two real-time gravity anomaly compensation methods suitable for vehicular use are proposed here, and a long distance vehicle test is conducted in a mountain region with drastic changing of the gravity anomaly. The test result shows that in one vehicle test data, 2 hours navigation task with 10 min ZUPT interval, the horizontal positioning accuracy is improved from 8.93 m to 3.75 m, the height positioning accuracy is improved from 1.63 m to 0.80 m. The gravity anomaly compensation algorithm shows important engineering application value.

Key words: high precision inertial navigation system, zero velocity update (ZUPT), gravity disturbance, spherical harmonics model

中图分类号:

V249.3

翁浚, 卞肖云. 重力扰动对高精度激光陀螺惯导系统ZUPT的影响分析与补偿[J]. 系统工程与电子技术, 2020, 42(1): 179-183.

Jun WENG, Xiaoyun BIAN. Effect analysis and compensation of the high precision ring laser gyroscope inertial navigation system ZUPT caused by gravity disturbance[J]. Systems Engineering and Electronics, 2020, 42(1): 179-183.

图/表 7

图1

表1

图2

图3

图4

图5

图6

参考文献 30

1	ZENG Q H , ZENG S J , LIU J Y , et al. Smartphone heading correction based on gravity assisted and middle time simulated-zero velocity update method[J]. Sensors, 2018, 18 (10): 3349. doi: 10.3390/s18103349
2	SKOG I , HANDEL P , NILSSON J O , et al. Zero-velocity detection-an algorithm evaluation[J]. IEEE Trans.on Biomedical Engineering, 2010, 57 (11): 2657- 2666. doi: 10.1109/TBME.2010.2060723
3	LI X F, MAO Y L, XIE L, et al. Applications of zero-velocity detector and Kalman filter in zero velocity update for inertial navigation system[C]//Proc.of the IEEE Chinese Guidance, Navigation and Control Conference, 2014: 1760-1763.
4	赵小明, 邓东黎, 蒋志炜, 等. 车载单轴旋转激光捷联惯导抗晃动初始对准和零速修正方法[J]. 中国惯性技术学报, 2013, 21 (3): 302- 307. doi: 10.3969/j.issn.1005-6734.2013.03.006
	ZHAO X M , DENG D L , JIANG Z W , et al. Anti-disturbing alignment and ZUPT methods for land single-axis rotation laser SINS[J]. Journal of Chinese Inertial Technology, 2013, 21 (3): 302- 307. doi: 10.3969/j.issn.1005-6734.2013.03.006
5	PARK S K , SUH Y S . A zero velocity detection algorithm using inertial sensors for pedestrian navigation systems[J]. Sensors, 2010, 10 (10): 9163- 9178. doi: 10.3390/s101009163
6	ZHU Z S , ZHAO B , GUO Y Y , et al. Research on gravity vertical deflection on attitude of position and orientation system and compensation method[J]. Aerospace Science and Technology, 2019, 85, 495- 504. doi: 10.1016/j.ast.2018.12.029
7	HAO X , ZHAO Y W , WANG X S , et al. An analysis of the effect of gravity anomaly to height estimation in high-precision INS/GNSS integrated navigation systems[J]. IEEE Sensors Journal, 2018, 19 (7): 2713- 2721.
8	CHANG L B , QIN F J , WU M P . Gravity disturbance compensation for inertial navigation system[J]. IEEE Trans.on Instrumentation and Measurement, 2018, 99, 1- 15.
9	WANG Q Y , CHENG M , NOURELDIN A , et al. Research on the improved method for dual foot-mounted inertial/magnetometer pedestrian positioning based on adaptive inequality constraints Kalman filter algorithm[J]. Measurement, 2019, 135, 189- 198. doi: 10.1016/j.measurement.2018.11.052
10	XIONG L , MA J , ZHANG L , et al. Submarine navigation based on gravity gradient-terrain matching[J]. Proceedings of SPIE-the International Society for Optical Engineering, 2007, 67904S.1- 67904S.6.
11	WANG H B , WANG Y , FANG J , et al. Simulation research on a minimum root-mean-square error rotation-fitting algorithm for gravity matching navigation[J]. Science China Earth Sciences, 2012, 55 (1): 90- 97.
12	蒋东方, 边少锋, 童余德, 等. 利用高精度地球重力场模型计算扰动重力垂直梯度[J]. 海洋测绘, 2013, 33 (2): 9- 12. doi: 10.3969/j.issn.1671-3044.2013.02.003
	JIANG D F , BIAN S F , TONG Y D , et al. Computing vertical gadient of gravity disturbance using earth gravity field model with high precision[J]. Hydrographic Surveying & Charting, 2013, 33 (2): 9- 12. doi: 10.3969/j.issn.1671-3044.2013.02.003
13	WANG H, XIAO X, DENG Z H, et al.The influence of gravity disturbance on high-precision long-time ins and its compensation method[C]//Proc.of the 4th International Conference on Instrumentation and Measurement, Computer, Communication and Control, 2014: 104-108.
14	HUDDLE J R. Trends in inertial systems technology for high accuracy AUV navigation[C]//Proc.of the Workshop on Autonomous Underwater Vehicles, 1998: 63-73.
15	WONG R V C, SCHWARZ K. Development and field testing of a RLG strapdown inertial survey system[C]//Proc.of IEEE PLANS'88, Position Location and Navigation Symposium, 1998: 480-487.
16	NIU X J, CHEN Q J, KUANG J, et al. Return of inertial surveying-trend or illusion[C]//Proc.of the IEEE/ION Position, Location and Navigation Symposium, 2016: 165-169.
17	NORRDINE A , KASMI Z , BLANKENBACH J . Step detection for ZUPT-aided inertial pedestrian navigation system using foot-mounted permanent magnet[J]. IEEE Sensors Journal, 2016, 16 (17): 6766- 6773. doi: 10.1109/JSEN.2016.2585599
18	BEN Y Y, YIN G S, GAO W, et al. Improved filter estimation method applied in zero velocity update for SINS[C]//Proc.of the International Conference on Mechatronics and Automation, 2009: 3375-3380.
19	FRASER C T. Adaptive extended Kalman filtering strategies for autonomous relative navigation of formation flying spacecraft[D]. Ottawa: Carleton University, 2019.
20	TITTERTON D H, WESTON J L. Strapdown inertial navigation technology[M].2nd ed. The American Institude of Aeronautics and Astronautics (USA) and Institution of Electrical Engineers (UK), 2014.
21	TUCKER T, LEVISON E. The AN/WSN-7B marine gyrocompass/navigator[C]//Proc.of the National Technical Meeting of the Institute of Navigation, 2000: 348-357.
22	ISHIBASHI S, TSUKIOKA S, SAWA T, et al. The rotation control system to improve the accuracy of an inertial navigation system installed in an autonomous underwater vehicle[C]//Proc.of the Symposium on Underwater Technology and Workshop on Scientific Use of Submarine Cables and Related Technologies, 2007: 495-498.
23	严恭敏, 秦永元, 杨波. 车载航位推算系统误差补偿技术研究[J]. 西北工业大学学报, 2006, 24 (1): 26- 30. doi: 10.3969/j.issn.1000-2758.2006.01.007
	YAN G M , QIN Y Y , YANG B . On error compensation technology for vehicular dead reckoning (DR) system[J]. Journal of Northwestern Polytechnical University, 2006, 24 (1): 26- 30. doi: 10.3969/j.issn.1000-2758.2006.01.007
24	PAVLIS N K , HOLMES S A , KENYON S C , et al. The development and evaluation of the earth gravitational model 2008(EGM2008)[J]. Journal of Geophysical Research:Solid Earth, 2012, 117 (4): 1- 38.
25	FORSTE C H, BRUINSMA S L, ABRIKOSOV O, et al. EIGEN-6C4-The latest combined global gravity field model including GOCE data up to degree and order 1949 of GFZ potsdam and GRGS toulouse[C]//Proc.of the Geophysical Research Abstracts, 2014.
26	LIN C A , CHINANG K W , KUO C Y . Integration of INS and GNSS for gravimetric application with USA[J]. International Archives of the Photogrammetry, Remote Sensing & Spatial Information Sciences, 2018, 42 (1): 263- 268.
27	LI S Q , OUYANG Y Z , CHANG G B , et al. Compensation technology of gravity disturbance vector in inertial navigation system[J]. Journal of Chinese Inertial Technology, 2012, 20 (4): 410- 413.
28	LIMPANUPARB T, MILTHORPE J. Associated legendre polynominals and spherical harmonics computation for chemistry applications[C]//Proc.of the 40th Congress on Science and Technology of Thailand, 2014: 233-241.
29	VANDERWERF K D, HENNEPIN M. Inertial navigation with gravity deflection compensation[P]. United States: 5774832, 1998.
30	HSU D Y, HILLS A, BROCKSTEIN A J. Gravity vector compensation system[P]. United States: US6249745B1, 2011.

数据类型	模型阶/次
LAGEOS-1/2 SLR	2~30
GRACE GPS-SST and K-band range-rate data	2~130
GOCE SGG data	2~235
Terrestrial data (DTU+EGM2008)	150~370
DTU+EGM2008	371~2 190

[1]	郝诗文, 张志利, 周召发, 常振军, 刘先一. 重力扰动对惯性导航系统初始对准的影响[J]. 系统工程与电子技术, 2020, 42(7): 1575-1581.
[2]	周广涛, 王晴晴, 高远. 基于ZIHR航向角修正方法的行人导航算法[J]. 系统工程与电子技术, 2019, 41(1): 170-177.
[3]	王志伟, 狄长春, 杨功流, 石志勇, 杨玉良, 王风杰. 炮载惯导高精度准动态零速修正方法[J]. 系统工程与电子技术, 2017, 39(12): 2782-2789.