Gravity Aided Navigation Precise Algorithm with Gauss Spline Interpolation

doi:10.11947/j.AGCS.2015.20130741

Abstract

Abstract: The gravity compensation of error equation thoroughly should be solved before the study on gravity aided navigation with high precision. A gravity aided navigation model construction algorithm based on research the algorithm to approximate local grid gravity anomaly filed with the 2D Gauss spline interpolation is proposed. Gravity disturbance vector, standard gravity value error and Eotvos effect are all compensated in this precision model. The experiment result shows that positioning accuracy is raised by 1 times, the attitude and velocity accuracy is raised by 1～2 times and the positional error is maintained from 100~200 m.

Key words: gravity aided navigation, Gauss spline interpolation, gravity error compensation, navigation model

CLC Number:

P229

WEN Chaobin, WANG Yuegang, GUO Zhibin, TIAN Qi, ZUO Zhaoyang, JIANG Xinlei. Gravity Aided Navigation Precise Algorithm with Gauss Spline Interpolation[J]. Acta Geodaetica et Cartographica Sinica, 2015, 44(1): 13-18.

References

[1] LOWREY J A, SHELLENBARGER J C. Passive Navigation Using Inertial Navigation Sensors and Maps[J]. Naval Engineers Journal, 1997, 109(3): 245-249.
[2] BISHOP G C. Gravitational Field Maps and Navigational Errors [J]. IEEE Journal of Oceanic Engineering, 2002, 27(3): 726-737.
[3] RICE H, KELMENSON S, MENDELSOHN L. Geophysical Navigation Technologies and Applications[C]//Proceedings of Position Location and Navigation Symposium.[S.l.]:IEEE, 2004: 618-624.
[4] KIM A, GOLNARAGHI M F. Initial Calibration of an Inertial Measurement Unit Using an Optical Position Tracking System[C]//Proceedings of Position Location and Navigation Symposium.[S.l.]:IEEE, 2004: 96-101.
[5] WANG Hubiao, WANG Yong, FANG Jian. Simulation Research on a Minimum Root-mean-square Error Rotation-fitting Algorithm for Gravity Matching Navigation[J]. Science China: Earth Sciences. 2012,42(7):1055-1062.(王虎彪, 王勇, 方剑. "最小均方误差旋转拟合法"重力辅助导航仿真研究[J]. 中国科学:地球科学,2012,42(7):1055-1062.)
[6] YAN Li, CUI Chenfeng, WU Hualing. A Gravity Matching Algorithm Based on TERCOM[J]. Geomatics and Information Science of Wuhan University,2009,34(3):261-264.(闫利,崔晨风,吴华玲. 基于TERCOM算法的重力匹配[J].武汉大学学报:信息科学版,2009,34(3):261-264.)
[7] LI Shanshan, WU Xiaoping, MA Biao. Correlative Extremum Matching Algorithm Using Underwater Gravity Anomalies[J]. Acta Geodaetica et Cartographica Sinica,2011,40(4):464- 470.(李姗姗,吴晓平,马彪. 水下重力异常相关极值匹配算法[J]. 测绘学报,2011,40(4):464-470.)
[8] CHEN Yi, XIU Chunbuo, LUO Jing. The Simulation of ICCP Algorithm in the Gravity Aided Navigation[C]//Proceedings of Second International Conference on Intelligent Networks and Intelligent Systems.Tianjin:IEEE,2009,25,62-65.
[9] WANG Zhigang, BIAN Shaofeng. ICCP Algorithm for Gravity Aided Inertial Navigation [J]. Acta Geodaetica et Cartographica Sinica, 2008,37(2):147-151.(王志刚, 边少锋. 基于ICCP算法的重力辅助惯性导航. [J].测绘学报, 2008,37(2):147-151.)
[10] YUAN G, ZHANG H W, YUAN K F. A Combinational Underwater Aided Navigation Algorithm Based on TERCOM/ICCP and Kalman Filter[J].IEEE Journal of Sciences and Optimization,2011,23(1),952-955.
[11] SUN Feng, WANG Wenjing, GAO Wei. Contour Matching Algorithm for Passive Gravity Navigation[J]. Chinese Journal of Scientific Instrument, 2009,30(4):817-823.(孙枫, 王文晶, 高伟. 用于无源重力导航的等值线匹配算法[J]. 仪器仪表学报,2009,30(4):817-823.)
[12] WANG Zhigang, BIAN Shaofeng, XIAO Shenghong. Underwater Gravity Aided Inertial Navigation Based on Local Gravity Field Model [J]. Acta Geodaetica et Cartographica Sinica, 2009,38(5):408-414.(王志刚,边少锋,肖胜红. 基于局部地球重力场模型的水下重力辅助惯性导航. [J].测绘学报, 2009,38(5):408-414.)
[13] TONG Yude, BIAN Shaofeng, JIANG Dongfang. The Reconstruction of Local Gravity Anomaly Field Based on Spline Function[J]. Acta Geodaetica et Cartographica Sinica, 2012,41(5):756-760.(童余德,边少锋,蒋东方.基于高斯样条函数的局部重力异常场解析重构. [J].测绘学报, 2012,41(5):756-760.)
[14] LIU Qiang, XU Xiaosu. Study on Sea-bottom Topographic Data Griding Methods [J]. Ship Electronic Engineering, 2013,33(5):59-64.(刘强,徐晓苏. 海底地形数据网格化方法研究[J]. 舰船电子工程,2013,33(5):59-64.)
[15] LIU Fanming, ZHANG Yingfa, JING Xin, et al. Gravity Gradient Parker's Forward Method and Application Using Cosine Transform [J]. Acta Geodaetica et Cartographica Sinica, 2013,42(2):177-190.(刘繁明,张迎发,荆心,等. 利用余弦变换的重力梯度Parker正演方法及其应用. [J].测绘学报, 2013,42(2):177-190.)
[16] GUO Qiuying, XU Zunyi.Study on Error Correction of Gravity Surveying in Underwater Gravity Aided Navigation System[J].Progress in Geophysica 2012, 27(3):1274-1279.(郭秋英,徐遵义. 水下重力辅助导航中重力测量误差改正研究[J].地球物理学进展, 2012,27(3):1274-1279.)
[17] LI Shengquan, OUYANG Yongzhong, CHANG Guobin. Compensation Technology of Gravity Disturbance Vector in Inertial Navigation System[J]. Journal of Chinese Inertial Technology, 2012, 20(4),410-414.(李胜全,欧阳永忠,常国宾. 惯性导航系统重力扰动矢量补偿技术[J]. 中国惯性技术学报,2012, 20(4),410-414.)
[18] SUN Zhongmiao, ZHAI Zhenhe, XIAO Yun, et al. Systematic Error Compensation for Airborne Gravimetry[J], 2013, 56(1), 47-54. (孙中苗,翟振和,肖云,等. 航空重力测量的系统误差补偿 [J]. 地球物理学报, 2013, 56(1), 47-54.)
[19] LUO Di, LIU Zhan, ZHANG Wang, et al. Several Issues in Gravity Correction[J]. Chinese Journal of Scientific Instrument, 2013,28(1):111-121.(骆迪,刘展,张旺,等. 重力校正中存在的若干问题[J].地球物理学进展, 2013,28(1):111-121.)
[20] WANG Yandong, HU Huafeng,YANG Shaoshuai, et al. Application of Gravity Gradient Data in Navigation System. [J]. Electronics Optics and Control,2013,20(11):11-16.(王艳东,胡华峰,杨少帅,等. 重力梯度数据在导航系统中的应用[J]. 电光与控制,2013,20(11):11-16.)
[21] LUO Qing, GAO Xiaoying,WANG Lina. On The INS /GIS Integrated Navigation Algorithm. [J]. Aerospace Control and Application,2013,39(1):40-44.(罗婷,高晓颖,王丽娜. INS/GIS组合导航方法研究[J]. 空间控制技术与应用,2013,39(1):40-44.)
[22] WANG Fenglin, WEN Xiulan, LIN Jian, et al. Federated Kaman Filter for Rate Azimuth Inertial Platform/Log/Gravity Matching Integrated Navigation System. [J]. Aerospace Control and Application,2009,39(2):49-55.(汪凤林,温秀兰,林健, 等. 联邦滤波在RAPINS /计程仪/重力匹配组合导航系统中的应用[J]. 东南大学学报:自然科学版,2009,39(2):49-55.)
[23] YAN Gongmin. The Study of Vehicle Position and Azimuth Determining System [D].XI'an:Northwestern Polytechnical University,2006.(严恭敏.车载自主定位定向系统研究[D].西安:西北工业大学,2006.)