Modeling of Underwater Terrain Aided Navigation and Terrain Matching Algorithm Simulation

In order to make an improved algorithm of good environmental adaptability and practicability, the simulation of three terrain matching algorithms were done on the condition of typical underwater navigation. Firstly, the differences of terrain aided navigation between on land and underwater were researched. Secondly, the underwater terrain aided navigation models were established as well as the underwater terrain aided navigation simulation of TERCOM, SITAN and ICCP. Finally, the influence of INS errors, measurement accuracy, and digital map resolution to algorithms performance were studied.