Realtime AUV Terrain Based Navigation with Octomap in a Natural Environment

  • Guillem Vallicrosa
  • Albert Palomer
  • David Ribas
  • Pere Ridao
Part of the Advances in Intelligent Systems and Computing book series (AISC, volume 252)


This paper addresses the problems of Terrain Based Navigation (TBN) and Occupancy Grid Mapping for an Autonomous Underwater Vehicle (AUV). The two problems are solved using the same tools to make feasible in future works to implement a Simultaneous Localization and Mapping (SLAM). Realtime Occupancy Grid Mapping on the real vehicle Girona500 AUV is achieved by means of the Octomap library. The resulting map is later used for TBN with the parallelized execution of a Particle Filter making also use of the Octomap library to compare multibeam sonar ranges against the known map. The Occupancy Grid Mapping and the Particle filter are implemented as individual nodes in the vehicle’s software architecture in ROS. Tests were carried out in a dataset of a natural environment near the coast. Several parameters involving the Particle Filter (number of particles, number of beams, uncertainty of measurements) are studied. Finally, the results are compared with the dead reckoning obtained by the AUV and the USBL positions obtained from a surface boat.


Occupancy Grid Mapping Terrain Based Navigation Octomap AUV Particle Filter Realtime 


Unable to display preview. Download preview PDF.

Unable to display preview. Download preview PDF.


  1. 1.
    Anonsen, K., Hallingstad, O.: Terrain aided underwater navigation using point mass and particle filters. In: Proceedings of the IEEE/ION Position Location and Navigation Symposium (2006)Google Scholar
  2. 2.
    Barkby, S., Williams, S.B., Pizarro, O., Jakuba, M.: A Featureless Approach to Efficient Bathymetric SLAM Using Distributed Particle Mapping. Journal of Field Robotics 28(1), 19–39 (2011)CrossRefMATHGoogle Scholar
  3. 3.
    Bergem, O.: Bathymetric navigation of autonomous underwater vehicles using a multibeam sonar and a Kalman filter with relative measurement covariance matrices. Dr. Scient thesis, University of Trondheim, Norway (1993)Google Scholar
  4. 4.
    Doucet, A., Godsill, S., Andrieu, C.: On sequential Monte Carlo sampling methods for Bayesian filtering. Statistics and Computing 10(3), 197–208 (2000)CrossRefGoogle Scholar
  5. 5.
    Durrant-Whyte, H., Bailey, T.: Simultaneous localization and mapping: part I. IEEE Robotics & Automation Magazine 13(2), 99–110 (2006)CrossRefGoogle Scholar
  6. 6.
    Gordon, N., Salmond, D., Smith, A.: Novel approach to nonlinear/non-Gaussian Bayesian state estimation. IEE Proceedings 140, 107–113 (1993)CrossRefGoogle Scholar
  7. 7.
    Gracias, N.: Mosaic–based Visual Navigation for Autonomous Underwater Vehicles. PhD thesis, Instituto Superior T ecnico, Lisbon, Portugal (June 2003)Google Scholar
  8. 8.
    Haralick, R.: Propagating covariance in computer vision. In: Proc. of the Workshop on Performance Characteristics of Vision Algorithms, Cambridge, UK (April 1996)Google Scholar
  9. 9.
    Hornung, A., Wurm, K.M., Bennewitz, M., Stachniss, C., Burgard, W.: OctoMap: an efficient probabilistic 3D mapping framework based on octrees. Autonomous Robots (February 2013)Google Scholar
  10. 10.
    Karlsson, R., Gustafsson, F., Karlsson, T.: Particle filtering and Cramer-Rao lower bound for underwater navigation. In: 2003 International Conference on Acoustics, Speech, and Signal Processing (ICASSP 2003) (2003)Google Scholar
  11. 11.
    Mallios, A., Ribas, D., Ridao, P.: Localization Advances in the Unstructured Underwater Environment. In: Proceedings of the 9th Hellenic Symposium of Oceanography and Fishery, vol. 1, pp. 111–116 (2009)Google Scholar
  12. 12.
    Maurelli, F., Krupinski, S., Petillot, Y., Salvi, J.: A Particle Filter Approach for AUV Localization. In: OCEANS MTS/IEEE (2008)Google Scholar
  13. 13.
    Fairfield, D.W.N., Kantor, G.: Real-Time SLAM with Octree Evidence Grids for Exploration in Underwater Tunnels. Journal of Field Robotics 24(1-2), 3–21 (2007)CrossRefGoogle Scholar
  14. 14.
    Ribas, D., Ridao, P., Domingo, J.D., Neira, J.: Underwater SLAM in Man-Made Structured Environments. Journal of Field Robotics 25, 898–921 (2008)CrossRefMATHGoogle Scholar
  15. 15.
    Ribas, D., Ridao, P., Magi, L., Palomeras, N., Carreras, M.: The Girona 500, a multipurpose autonomous underwater vehicle. In: OCEANS 2011 IEEE-Spain, pp. 1–5. IEEE (June 2011)Google Scholar
  16. 16.
    Sistiaga, M., Opderbecke, J., Aldon, M., Rigaud, V.: Map based underwater navigation using a multibeam echosounder. In: OCEANS 1998 Conference Proceedings, vol. 2 (1998)Google Scholar
  17. 17.
    Thrun, S.: Probabilistic robotics, vol. 45. ACM (2002)Google Scholar
  18. 18.
    Zandara, S., Ridao, P., Mallios, A., Ribas, D.: MBpIC-SLAM: Probabilistic Surface Matching for Bathymetry Based SLAM. In: IFAC Workshop on Navigation, Guidance and Control of Underwater Vehicles (NGCUV 2012) (2012)Google Scholar

Copyright information

© Springer International Publishing Switzerland 2014

Authors and Affiliations

  • Guillem Vallicrosa
    • 1
  • Albert Palomer
    • 1
  • David Ribas
    • 1
  • Pere Ridao
    • 1
  1. 1.Computer Vision and Robotics Institute (VICOROB)Universitat de GironaGironaSpain

Personalised recommendations