Research on Iterative Closest Contour Point for Underwater Terrain-Aided Navigation

  • Wang Kedong
  • Yan Lei
  • Deng Wei
  • Zhang Junhong
Part of the Lecture Notes in Computer Science book series (LNCS, volume 4109)


In order to provide underwater vehicle high-precision navigation information for long time, the coordinate properties of underwater terrain can be used to aid inertial navigation system (INS) by matching algorithm. Behzad and Behrooz (1999) introduce iterative closest contour point (ICCP) from image registration to underwater terrain matching and provide its exact form and prove its validity with an example. Bishop (2002) proves its validity systemically. However, their research considers that the matching origin is known exactly while it is seldom satisfied in practice. Simulation results show that ICCP is easy to diverge when the initial INS error is very large (such as 3km). To overcome the drawback, two enhancements are put forward. (1) The matching origin is added into matching process; (2) The whole matching process is divided into two phases: the coarse and the accurate. The coarse matching rules include mean absolute difference (MAD) and mean square difference (MSD) which is usually applied in terrain contour matching (TERCOM). The accurate matching is the ICCP optimization. Simulation results show that the updated ICCP matches application conditions very well and it is convergent with very high precision. Especially, when INS precision is not high, the updated ICCP matching process is more stable and its precision is higher than TERCOM’s.


ICCP TERCOM Pattern Recognition Map Matching Terrain-Aided Navigation 


  1. 1.
    Yan, M.: Terrain Matching Algorithm Design and Simulation for Underwater TAN System. Peking University thesis, Beijing (2004)Google Scholar
  2. 2.
    Sistiaga, M., Opderbecke, J., Aldon, M.J., et al.: Map Based Underwater Navigation Using a Multibeam Echo Sounder. Oceans Conference Record (IEEE) 2, 747–751 (1998)Google Scholar
  3. 3.
    Maurer, C., Aboutanos, G., Dawant, B., et al.: Registration of 3-D Images Using Weighted Geometrical Features. IEEE Transactions on Medical Imaging 6, 836–849 (1996)CrossRefGoogle Scholar
  4. 4.
    Yamany, S.M., Ahmed, M.N., Hemayed, E.E., et al.: Novel Surface Registration Using the Grid Closest Point (GCP) Transform. In: IEEE International Conference on Image Processing, vol. 3, pp. 809–813 (1998)Google Scholar
  5. 5.
    Miga, M.I., Sinha, T.K., Cash, D.M., et al.: Cortical Surface Registration for Image-guided Neurosurgery Using Laser-range Scanning. IEEE Transactions on medical Imaging 8, 973–985 (2003)CrossRefGoogle Scholar
  6. 6.
    Yang, X., Sheng, Y., Guan, W., et al.: Adaptive Hill Climbing and Iterative Closest Point Algorithm for Multisensor Image Registration with Partial Hausdorff Distance. In: Proceedings of SPIE-The International Society for Optical Engineering, vol. 4051, pp. 99–109 (2000)Google Scholar
  7. 7.
    Kaneko, S., Kondo, T., Miyamoto, A.: Robust Matching of 3D Contours Using Iterative Closest Point Algorithm Improved by M-estimation. Pattern Recognition 9, 2041–2047 (2003)CrossRefGoogle Scholar
  8. 8.
    Fountain, J.R.: Digital Terrain System. IEE Colloquium (Digest) 169, 4/1–4/6 (1997)Google Scholar
  9. 9.
    Behzad, K.P., Behrooz, K.P.: Vehicle Localization on Gravity Maps. In: Proceedings of SPIE-The International Society for Optical Engineering, vol. 3693, pp. 182–191 (1999)Google Scholar
  10. 10.
    Bishop, G.C.: Gravitational Field Maps and Navigational Errors. IEEE Journal of Oceanic Engineering 3, 726–737 (2002)CrossRefGoogle Scholar

Copyright information

© Springer-Verlag Berlin Heidelberg 2006

Authors and Affiliations

  • Wang Kedong
    • 1
  • Yan Lei
    • 2
  • Deng Wei
    • 2
  • Zhang Junhong
    • 3
  1. 1.School of AstronauticsBeihang UniversityBeijingChina
  2. 2.Institute of Remote Sensing and GISPeking UniversityBeijingChina
  3. 3.School of Automation Science and Electrical EngineeringBeihang UniversityBeijingChina

Personalised recommendations