Combinational Seabed Terrain Matching Algorithm Basing on Probability Data Associate Filtering and Iterative Closest Contour Point

This paper is committed to solve some key technique of seabed terrain matching. After introduced the specificity of seabed terrain matching, we analyzed the advantage and disadvantage of TERCOM, PDAF (Probabilistic Data Association Filtering) and ICCP (Iterative Closest Contour Point), then a combinational seabed terrain matching algorithm was proposed to improve the accuracy and practicability of seabed terrain matching which is based and ICCP. By using this combinational algorithm, underwater vehicle is allowed for mobile navigation in the period of terrain matching. Theoretical analysis and simulation results both show that the performance of this combinational algorithm is satisfactory.