Terrain navigation for underwater vehicles

In this thesis a terrain positioning method for underwater vehicles called the correlation method is presented. Using the method the vehicle can determine its absolute position with the help of a sonar and a map of the bottom topography. The thesis is focused towards underwater positioning but most of the material is directly applicable to flying vehicles as well. The positioning of surface vehicles has been revolutionized by the global positioning system (GPS). However, since the GPS signal does not penetrate into the sea water volume, underwater vehicles still have to use the inertial navigation system (INS) for navigation. Terrain positioning is therefore a serious alternative to GPS for underwater vehicles for zeroing out the INS error in military applications. The thesis begins with a review of different estimation methods as Bayesian and extended Kalman filter methods that have been used for terrain navigation. Some other methods that may be used as the unscented Kalman filter or solving the Fokker-Planck equation using finite element methods are also discussed. The correlation method is then described and the well known problem with multiple terrain positions is discussed. It is shown that the risk of false positions decreases exponentially with the number of measurement beams. A simple hypothesis test of false peaks is presented. It is also shown that the likelihood function for the position under weak assumptions converges to a Gaussian probability density function when the number of measuring beams tends to infinity. The Cramer-Rao lower bound on the position error covariance is determined and it is shown that the proposed method achieves this bound asymptotically. The problem with measurement bias causing position bias is discussed and a simple method for removing the measurement bias is presented. By adjusting the footprint of the measuring sonar beams to the bottom topography a large increase in accuracy and robustness can be achieved in many bottom areas. This matter is discussed and a systematic theory about how to choose way-points is developed. Three sea-trials have been conducted to verify the characteristics of the method and some results from the last one in October 2002 are presented. The sea-trials verify to a very high degree the theory presented. Finally the method is briefly discussed under the assumption that the bottom topography can be described by an autoregressive stochastic process.

[1]  Richard A. Davis,et al.  Time Series: Theory and Methods (2nd ed.). , 1992 .

[2]  Jeffrey K. Uhlmann,et al.  Unscented filtering and nonlinear estimation , 2004, Proceedings of the IEEE.

[3]  Niclas Bergman,et al.  Recursive Bayesian Estimation : Navigation and Tracking Applications , 1999 .

[4]  R. Bucy,et al.  Digital synthesis of non-linear filters , 1971 .

[5]  Ronald N. Bracewell,et al.  The Fourier Transform and Its Applications , 1966 .

[6]  Daniel J. Biezad,et al.  Integrated navigation and guidance systems , 1999 .

[7]  Harry Nyquist.  Certain Topics in Telegraph Transmission Theory , 1928 .

[8]  Y. Pawitan.  In all likelihood : statistical modelling and inference using likelihood , 2002 .

[9]  L. Teng.  Theory and application of Kalman filtering , 1970 .

[10]  James Llinas,et al.  Multisensor Data Fusion , 1990 .

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

[12]  D. Newland.  An introduction to random vibrations and spectral analysis , 1975 .

[13]  S. Haykin.  Kalman Filtering and Neural Networks , 2001 .

[14]  V. Statulevičius,et al.  Limit Theorems of Probability Theory , 2000 .

[15]  F. Daum.  Nonlinear filters: beyond the Kalman filter , 2005, IEEE Aerospace and Electronic Systems Magazine.

[16]  Nasser E. Nahi,et al.  Estimation Theory and Applications , 1969 .

[17]  Torsten Söderström,et al.  Discrete-time Stochastic Systems , 2002 .

[18]  J. C. Hung,et al.  Performance evaluation of six terrain stochastic linearization techniques for TAN , 1991, Proceedings of the IEEE 1991 National Aerospace and Electronics Conference NAECON 1991.

[19]  H. Sorenson,et al.  Nonlinear Bayesian estimation using Gaussian sum approximations , 1972 .

[20]  I. Nygren,et al.  A method for terrain navigation of an AUV , 2001, MTS/IEEE Oceans 2001. An Ocean Odyssey. Conference Proceedings (IEEE Cat. No.01CH37295).

[21]  H. Kushner.  Nonlinear filtering: The exact dynamical equations satisfied by the conditional mode , 1967, IEEE Transactions on Automatic Control.

[22]  J. Bendat,et al.  Random Data: Analysis and Measurement Procedures , 1987 .

[23]  C. R. Rao,et al.  Information and the Accuracy Attainable in the Estimation of Statistical Parameters , 1992 .

[24]  James Llinas,et al.  Handbook of Multisensor Data Fusion , 2001 .

[25]  G. Howell,et al.  Terrain aided navigation using maximum a posteriori estimation , 1990, IEEE Symposium on Position Location and Navigation. A Decade of Excellence in the Navigation Sciences.

[26]  Nando de Freitas,et al.  The Unscented Particle Filter , 2000, NIPS.

[27]  Robert J. Urick,et al.  Principles of underwater sound , 1975 .

[28]  Åke Björck,et al.  Numerical Methods , 2021, Markov Renewal and Piecewise Deterministic Processes.

[29]  A. Khinchin.  Mathematical foundations of statistical mechanics , 1949 .

[30]  J. Douglas Faires,et al.  Numerical Analysis , 1981 .

[31]  F. Klebaner.  Introduction To Stochastic Calculus With Applications , 1999 .

[32]  Lennart Lindh,et al.  Successful prototyping of a real-time hardware based terrain navigation correlator algorithm , 2003, Euromicro Symposium on Digital System Design, 2003. Proceedings..

[33]  N. L. Johnson,et al.  Continuous Univariate Distributions. , 1995 .

[34]  J. Hollowell,et al.  Heli/SITAN: a terrain referenced navigation algorithm for helicopters , 1990, IEEE Symposium on Position Location and Navigation. A Decade of Excellence in the Navigation Sciences.

[35]  W. K. Stewart,et al.  Terrain-relative navigation for autonomous underwater vehicles , 1997 .

[36]  Babak Azimi-Sadjadi,et al.  Approximate Nonlinear Filtering with Applications to Navigation , 2001 .

[37]  Pranab Kumar Sen,et al.  Large Sample Methods in Statistics: An Introduction with Applications , 1993 .

[38]  H. Risken.  Fokker-Planck Equation , 1984 .

[39]  Valery Stohny,et al.  Symmetry Properties and Exact Solutions of the Fokker-Planck Equation , 1997 .

[40]  I. Nygren,et al.  Terrain navigation using the correlator method , 2004, PLANS 2004. Position Location and Navigation Symposium (IEEE Cat. No.04CH37556).

[41]  Charles W. Therrien,et al.  Discrete Random Signals and Statistical Signal Processing , 1992 .

[42]  Wang Tang,et al.  Application of multiple model estimation to a recursive terrain height correlation system , 1983 .

[43]  A. Doucet,et al.  Maximum a Posteriori Sequence Estimation Using Monte Carlo Particle Filters , 2001, Annals of the Institute of Statistical Mathematics.

[44]  Stephen C. Arnold,et al.  Kendall's advanced theory of statistics. Vol.2A: Classical inference and the linear model , 1999 .

[45]  N. Bergman,et al.  Deterministic and stochastic Bayesian methods in terrain navigation , 1998, Proceedings of the 37th IEEE Conference on Decision and Control (Cat. No.98CH36171).

[46]  Y. Bar-Shalom.  Tracking and data association , 1988 .

[47]  Alan J. Robins,et al.  Recent Developments in the "TERPROM" Integrated Navigation System , 1988 .

[48]  Yaakov Bar-Shalom,et al.  Automated Tracking with Target Amplitude Information , 1990, 1990 American Control Conference.

[49]  Fredrik Gustafsson,et al.  Adaptive filtering and change detection , 2000 .

[50]  H. Luetkepohl.  The Handbook of Matrices , 1996 .

[51]  Claes Johnson.  Numerical solution of partial differential equations by the finite element method , 1988 .