A Combined Matching Algorithm for Underwater Gravity-Aided Navigation

A matching algorithm is a key technique in the gravity-aided inertial navigation system (INS). A matching algorithm combined with an iterated closest contour point (ICCP) algorithm and a point mass filter (PMF) is proposed. The algorithm involves a two-step matching process. First, the PMF based on vehicle position variable can obtain in real-time an instructional position given in a large initial position error. In particular, since the gravity anomaly database is tabulated in the form of a digital model, the parameter in the filter model is estimated by INS short-term displacement. Then, the ICCP algorithm with a sliding window can be employed for further matching. Simulation tests indicate that compared with the conventional ICCP algorithm, the proposed algorithm can achieve better results.

[1]  Changno Lee,et al.  Automated Generation of a Digital Elevation Model Over Steep Terrain in Antarctica From High-Resolution Satellite Imagery , 2015, IEEE Transactions on Geoscience and Remote Sensing.

[2]  Robert B. McGhee,et al.  A Simplified Quaternion-Based Algorithm for Orientation Estimation From Earth Gravity and Magnetic Field Measurements , 2008, IEEE Transactions on Instrumentation and Measurement.

[3]  Xin Zhang,et al.  Adaptive sliding-mode attitude control for autonomous underwater vehicles with input nonlinearities , 2016 .

[4]  F Gustafsson,et al.  Particle filter theory and practice with positioning applications , 2010, IEEE Aerospace and Electronic Systems Magazine.

[5]  Nima Alam,et al.  Cooperative Inertial Navigation for GNSS-Challenged Vehicular Environments , 2013, IEEE Transactions on Intelligent Transportation Systems.

[6]  Nicolas Boizot,et al.  A Real-Time Adaptive High-Gain EKF, Applied to a Quadcopter Inertial Navigation System , 2014, IEEE Transactions on Industrial Electronics.

[7]  O Hegrenaes,et al.  Model-Aided INS With Sea Current Estimation for Robust Underwater Navigation , 2011, IEEE Journal of Oceanic Engineering.

[8]  Bo Wang,et al.  A Self-Calibration Method for Nonorthogonal Angles Between Gimbals of Rotational Inertial Navigation System , 2015, IEEE Transactions on Industrial Electronics.

[9]  Wei Gao,et al.  Improved Artificial Bee Colony Algorithm Based Gravity Matching Navigation Method , 2014, Sensors.

[10]  Yang Li,et al.  Adaptive Neural Network Control of AUVs With Control Input Nonlinearities Using Reinforcement Learning , 2017, IEEE Transactions on Systems, Man, and Cybernetics: Systems.

[11]  Jia Guo,et al.  PMI based nonlinear H∞ estimation of unknown sensor error for INS/GPS integrated system , 2014 .

[12]  Mohamed Benbouzid,et al.  A Flat Design and a Validated Model for an AUV Reconfigurable Magnetic Coupling Thruster , 2016, IEEE/ASME Transactions on Mechatronics.

[13]  Tomas de J Mateo Sanguino,et al.  Toward Simple Strategy for Optimal Tracking and Localization of Robots With Adaptive Particle Filtering , 2016, IEEE/ASME Transactions on Mechatronics.

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

[15]  Zhe Chen.  Local observability and its application to multiple measurement estimation , 1991 .

[16]  Weisheng Yan,et al.  Mutual Information-Based Multi-AUV Path Planning for Scalar Field Sampling Using Multidimensional RRT* , 2016, IEEE Transactions on Systems, Man, and Cybernetics: Systems.

[17]  Benedetto Allotta,et al.  An Attitude Estimation Algorithm for Mobile Robots Under Unknown Magnetic Disturbances , 2016, IEEE/ASME Transactions on Mechatronics.

[18]  Shovan Bhaumik,et al.  Adaptive grid risk-sensitive filter for non-linear problems , 2011 .

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

[20]  Bo Wang,et al.  A Particle Filter-Based Matching Algorithm With Gravity Sample Vector for Underwater Gravity Aided Navigation , 2016, IEEE/ASME Transactions on Mechatronics.

[21]  Bo Wang,et al.  An Improved TERCOM-Based Algorithm for Gravity-Aided Navigation , 2016, IEEE Sensors Journal.

[22]  Fu Mengyin,et al.  Improved ICCP algorithm and its application in gravity matching aided inertial navigation system , 2014, Proceedings of the 33rd Chinese Control Conference.

[23]  Torsten Söderström,et al.  Anticipative grid design in point-mass approach to nonlinear state estimation , 2002, IEEE Trans. Autom. Control..

[24]  Baoqi Huang,et al.  A Novel Terrain-Aided Navigation Algorithm Combined With the TERCOM Algorithm and Particle Filter , 2015, IEEE Sensors Journal.

[25]  Yong Wang,et al.  Simulation research on a minimum root-mean-square error rotation-fitting algorithm for gravity matching navigation , 2011, Science China Earth Sciences.

[26]  Rae-Hong Park,et al.  An Orientation Reliability Matrix for the Iterative Closest Point Algorithm , 2000, IEEE Trans. Pattern Anal. Mach. Intell..

[27]  Hongwei Zhang,et al.  A Combinational Aided Navigation Algorithm Based on Terrain Variance Entropy and ICCP , 2012, 2012 Fifth International Joint Conference on Computational Sciences and Optimization.

[28]  Fredrik Gustafsson,et al.  Terrain navigation using Bayesian statistics , 1999 .

[29]  Kamesh Subbarao,et al.  Nonlinear adaptive filtering in terrain-referenced navigation , 2015, IEEE Transactions on Aerospace and Electronic Systems.