Underwater simultaneous localization and mapping based on forward-looking sonar

Abstract

A method of underwater simultaneous localization and mapping (SLAM) based on forward-looking sonar was proposed in this paper. Positions of objects were obtained by the forward-looking sonar, and an improved association method based on an ant colony algorithm was introduced to estimate the positions. In order to improve the precision of the positions, the extended Kalman filter (EKF) was adopted. The presented algorithm was tested in a tank, and the maximum estimation error of SLAM gained was 0.25 m. The tests verify that this method can maintain better association efficiency and reduce navigation error.

Keywords

simultaneous localization and mapping (SLAM) / looking forward sonar / extended Kalman filter (EKF)

References

[1] Anderson B, Crowell J (2005). A cost-sensible new autonomous underwater vehicle for surveys/soundings, search & rescue, and research. IEEE/MTS OCEANS Conference and Exhibition, Washington DC, 1228–1233.

[2] Bailey T (2002). Mobile robot localization and mapping in extensive outdoor environments. PhD thesis, University of Sydney, Australian Centre for Field Robotics, 45–60.

[3] Cooper AJ (2005). A comparison of data association techniques for simultaneous localization and mapping. PhD thesis, Aerospace Engineering and Mechanics, University of Minnesota, 116–128.

[4] Eustice RM, Whitcomb LL, Singh H, Grund M (2007). Experimental results in synchronous-clock one-way-travel-time acoustic navigation for autonomous underwater vehicles. IEEE International Conference on Robotics and Automation, Rome, Italy, 4257–4264.

[5] Folkesson J, Leonard J, Leederkerken J, Williams R (2007). Feature tracking for underwater navigation using sonar. Proceedings of the 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems, San Diego, 3678–3684.

[6] Gil A, Stachniss C, Burgard W (2006). Improving data association in vision-based SLAM. Proceedings of the 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems. Beijing, 2076–2081.

[7] Grasmueck M., Eberli G.P., Viggiano D.A. Autonomous underwater vehicle (AUV) mapping reveals coral mound distribution, morphology, and oceanography in deep water of the Straits of Florida. Geophysical Research Letters, 2006, 33(23): 23616-23622

[8] Kinsey JC, Eustice RM, Whitcomb LL (2006). Underwater vehicle navigation: Recent advances and new challenges. IFAC Conference on Maneuvering and Control of Marine Craft, Lisbon, Portugal, 435–445.

[9] Mahon I, Williams S (2004). Slam using natural features in an underwater environment. IEEE Control, Automation, Robotics and Vision Conference, Kunming, China, 2076–2081.

[10] Ribas D (2005). Towards simultaneous localization & mapping for an AUV using an imaging sonar. PhD thesis, University de Girona, 60–72.

[11] Tardos J.D., Newman J., Leonard J. Robust mapping and localization in indoor environments using sonar data. The Int. Journal of Robotics Research, 2002, 21(4): 311-330

[12] Whyte H.D., Bailey T. Simultaneous localization and mapping: Part I. Robotics & Automation Magazine, 2006, 13(2): 99-108

[13] Williams SB, Newman P, Dissanayake G, Whyte HD (2000). Autonomous underwater simultaneous localization and map building. IEEE International Conference on Robotics & Automation, San Francisco, 1793–1798.

[14] Zhang Tiedong (2004). The post-processing of the image for the forward looking sonar. Master thesis, Harbin Engineerng University, 90–103.

[15] Zhang T., Wan L., Xu Y., Ma Y. A preprocess method of the looking forward sonar image. Acoustics and Electronics Engineering, 2008, 91(3): 14-18