Skip to main content

Using Augmented State Kalman filter to localize multi autonomous underwater vehicles


The present paper describes a system for the construction of visual maps (“mosaics”) and motion estimation for a set of AUVs (Autonomous Underwater Vehicles). Robots are equipped with down-looking camera which is used to estimate their motion with respect to the seafloor and built an online mosaic. As the mosaic increases in size, a systematic bias is introduced in its alignment, resulting in an erroneous output. The theoretical concepts associated with the use of an Augmented State Kalman Filter (ASKF) were applied to optimally estimate both visual map and the fleet position.


  1. R. Alami and S. S. C. Botelho. Plan-based multirobot cooperation. In Michael Beetz, Jachim Hertzberg, Malik Ghallab, and Martha E. Pollack, editors,Advances in Plan-Based Control of Robotic Agents, volume 2466 ofLecture Notes in Computer Science. Springer, 2002.

  2. D Blidberg. The development of autonomous underwater vehicles (auvs); a brief summary. InIEEE Int. Conf. on Robotics and Automation (ICRA’01), 2001.

  3. S. S. C. Botelho, R. Mendes, L. Taddei, and M. Teixeira. Lambdari um robô subaqüático autônomo. InSimpósio Brasileiro De Automação Inteligente — VI SBAI, 2003.

  4. R. Deaves. Covariance bounds for augmented state kalman filter application.IEEE Electronics Letters., 35(23):2062–2063, 1999.

    Article  Google Scholar 

  5. S. Fleischer.Bounded-error vision-based of autonomous underwater vehicles. PhD thesis, Stanford University, 2000.

  6. R Garcia.A Proposal to Estimate the Motion of an Underwater Vehicle Through Visual Mosaicking. PhD thesis, Universitat de Girona, 2001.

  7. R. Garcia, J. Puig, P. Ridao, and X. Cufi. Augmented state kalman filtering for auv navigation. InIEEE Int. Conf. on Robotics and Automation (ICRA’02), 2002.

  8. M.G. González, P. Holifield, and M. Varley. Improved video mosaic construction by accumulated alignment error distribution. InBritish Machine Vision Conference, pages 377–387, 1998.

  9. R. Madhavan, K. Fregene, and L. Parker. Distributed heterogeneous outdoor multi-robot localization. InIEEE Int. Conf. on Robotics and Automation (ICRA’02), 2002.

  10. H. Madjidi and S. Negahdaripour. On robustness and localization accuracy of optical flow computation from color imagery. In2nd International Symposium on 3D Data Processing, Visualization and Transmission, 2004.

  11. A. Matos and N. Cruz. Auv navigation and guidance in a moving acoustic network. InIEEE Oceans 2005, 2005.

  12. S. Roumeliotis and G. Bekey. Distributed multirobot localization.IEEE Trans. on Robotics and Automation, 18(5), 2002.

  13. Y. Rzhanov, L. M. Linnett, and R Forbes. Underwater video mosaicing for seabed mapping. InInternational Conference on Image Processing, 2000.

  14. A. Tavares. Um estudo sobre a modelagem e o controle de veículos subaquáticos não tripulados. Master’s thesis, Engenharia Oceânica, Fundação Universidade Federal do Rio Grande, 2003.

  15. H Thomas. Advanced techniques for underwater vehicles positioning guidance and supervision. InIEEE Oceans 2005, 2005.

  16. A. Vargas, C.A. Madsen, and S. S. C. Botelho. Navision — sistema de visão subaqüático para navegação e montagem de mosaicos em auvs. InSeminário e Workshop em Engenharia Oceânica, 2004.

  17. R. Wernli. Auv’s — a technology whose time has come. InIEEE International Conference in Underwater Tecnologies 2002, 2002.

Download references

Author information



Additional information

This work was sponsored by Conselho Nacional de Pesquisa (CNPq)

Rights and permissions

Open Access This article is distributed under the terms of the Creative Commons Attribution 2.0 International License ( ), which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.

Reprints and Permissions

About this article

Cite this article

Botelho, S., Neves, R., Taddei, L. et al. Using Augmented State Kalman filter to localize multi autonomous underwater vehicles. J Braz Comp Soc 13, 61–70 (2007).

Download citation

  • Issue Date:

  • DOI:


  • Multi-Robots
  • Autonomous Underwater Vehicles
  • Mosaics
  • Robotic Localization