A Combinational Underwater Aided Navigation Algorithm Based on TERCOM/ICCP and Kalman Filter

• Published in: 2011 Fourth International Joint Conference on Computational Sciences and Optimization pp. 952 - 955
• Main Authors: Gannan Yuan, Hongwei Zhang, Kefei Yuan, Chunyan Tao
• Format: Conference Proceeding
• Language: English
• Published: IEEE 01.04.2011
• Subjects: Accuracy; Algorithm design and analysis; Indexes; IP networks; iterated closest contour point; kalman filter; Kalman filters; Navigation; terrain aided navigation; terrain contour matching; Underwater vehicles; vehicle
• DOI: 10.1109/CSO.2011.23
• ISBN: 9781424497126; 1424497124

In order to solve the problem that the iterated closest contour point(ICCP) algorithm diverges easily when the initial INS error is large, the terrain contour matching (TERCOM) algorithm is firstly used to reduce the initial INS error, then ICCP algorithm is used to obtain the best matching position. Two matching difference is used as the measurement of Kalman filter, INS error is corrected and the optimal estimate is obtained. The correlative analysis MSD is only introduced in the coarse matching stage, and the sliding window is used in the precise matching stage to improve the algorithm efficiency. Simulations are performed and the results show that the proposed combinational algorithm matching process is more stable and the precision is higher than traditional algorithm.