A Triangle Matching Algorithm for Gravity-aided Navigation for Underwater Vehicles

In this paper, a triangle matching algorithm using local gravity field maps is proposed to bound the drift errors inherent in Strapdown Inertial Navigation Systems (SINS) in gravity-aided navigation. This triangle matching algorithm has two main stages, the first is the initial matching stage, which has a coarse phase and a fine phase to address the large unknown initial errors made by INS, and the other is the tracking matching stage, which mainly aims at tracking the matching solution with the vehicle running in real time. Simulations were carried out using data for the Bohai Sea and South China Sea areas, to assess the effects of different initial errors on the matching solutions. Finally some experiments were carried out to evaluate the proposed algorithm. The results show that the triangle matching algorithm has some compelling advantages, such as a capability to address the large unknown initial errors made by INS, and good real-time quality of matching the gravity measurements with the local gravity maps.

[1]  L. Mendelsohn,et al.  Next generation marine precision navigation system , 2000, IEEE 2000. Position Location and Navigation Symposium (Cat. No.00CH37062).

[2]  Annika Kangas,et al.  Comparison of k-MSN and kriging in local prediction , 2012 .

[3]  Wang Peng.  Time Series Marching Algorithm with Confidence and Error Bounds in WSNs , 2008 .

[4]  Hongjian Wang,et al.  Simultaneous localization and mapping based on multilevel-EKF , 2011, 2011 IEEE International Conference on Mechatronics and Automation.

[5]  Yan Li,et al.  Application of Kalman Filter algorithm in gravity-aided navigation system , 2011, 2011 IEEE International Conference on Mechatronics and Automation.

[6]  V. Anastassopoulos,et al.  Super-resolution image reconstruction employing Kriging interpolation technique , 2007, 2007 14th International Workshop on Systems, Signals and Image Processing and 6th EURASIP Conference focused on Speech and Image Processing, Multimedia Communications and Services.

[7]  G. Yuan,et al.  A Combinational Underwater Aided Navigation Algorithm Based on TERCOM/ICCP and Kalman Filter , 2011, 2011 Fourth International Joint Conference on Computational Sciences and Optimization.

[8]  Yuan Gao,et al.  Fingerprint Matching Algorithm Based on Similar Vector Triangle , 2009, 2009 2nd International Congress on Image and Signal Processing.

[9]  Chan Gook Park,et al.  Covariance analysis of strapdown INS considering gyrocompass characteristics , 1995 .

[10]  Behrooz Kamgar-Parsi,et al.  Vehicle localization on gravity maps , 1999, Defense, Security, and Sensing.

[11]  Cheng Jian-hua,et al.  The research of INS's error analysis for underwater vehicle in complex sea conditions , 2010, 2010 8th World Congress on Intelligent Control and Automation.

[12]  Jianhu Zhao,et al.  Study on underwater navigation system based on geomagnetic match technique , 2009, 2009 9th International Conference on Electronic Measurement & Instruments.

[13]  I. Nygren,et al.  Terrain navigation for underwater vehicles using the correlator method , 2004, IEEE Journal of Oceanic Engineering.

[14]  Yu Liu,et al.  Research and Design of Terrain Aided Navigation System , 2011, 2011 7th International Conference on Wireless Communications, Networking and Mobile Computing.

[15]  Zhaoxia Liu,et al.  A new algorithm of global feature matching based on triangle regions for image registration , 2010, IEEE 10th INTERNATIONAL CONFERENCE ON SIGNAL PROCESSING PROCEEDINGS.

[16]  G. C. Bishop.  Gravitational field maps and navigational errors [unmanned underwater vehicles] , 2002 .

[17]  Cheng Yi,et al.  The Simulation of ICCP Algorithm in the Gravity Aided Navigation , 2009, 2009 Second International Conference on Intelligent Networks and Intelligent Systems.

[18]  Lei Yan,et al.  Underwater geomagnetic navigation based on ICP algorithm , 2007, 2007 IEEE International Conference on Robotics and Biomimetics (ROBIO).

[19]  A. J. Healey,et al.  Multivariable sliding mode control for autonomous diving and steering of unmanned underwater vehicles , 1993 .

[20]  H.S. Choi,et al.  Velocity-Aided Underwater Navigation System Using Receding Horizon Kalman Filter , 2006, IEEE Journal of Oceanic Engineering.

[21]  Juan Li,et al.  Simulation system of Gravity Aided Navigation For Autonomous Underwater Vehicle , 2007, 2007 International Conference on Mechatronics and Automation.

[22]  L. B. Hostetler,et al.  Nonlinear Kalman filtering techniques for terrain-aided navigation , 1983 .

[23]  Chen Feng,et al.  Geometry-based mapping of vector data and DEM based on hierarchical Longitude/Latitude Grids , 2010, 2010 Second IITA International Conference on Geoscience and Remote Sensing.

[24]  Zhigang Wang,et al.  A local geopotential model for implementation of underwater passive navigation , 2008 .

[25]  Xiaochun Cao,et al.  Good match exploration using triangle constraint , 2012, Pattern Recognit. Lett..