A Comparison of Nonlinear Filter Algorithms for Terrain-referenced Underwater Navigation

摘要

Terrain-referenced navigation (TRN) uses topographic data to correct drift errors due to dead-reckoning or inertial navigation. While it has long been applied to aerial vehicle applications, TRN can be more useful for navigation in underwater environments where global positioning system signals are not available. TRN requires a geometric description of undulating terrain surface as a mathematical function or a look-up table, which leads to a nonlinear estimation problem. In this study, three nonlinear filter algorithms for underwater TRN are considered: 1) extended Kalman filter, 2) particle filter, and 3) Rao-Blackwellized particle filter. The performance of these three filters is compared through navigation simulations with actual bathymetry data.