AUV Self-localization in Structured Environments Using a Scanning Sonar and an Extended Kalman Filter

Autonomous Underwater Vehicles (AUV) are growing in importance for their many underwater applications, due to their characteristics and functionalities. Making use of a imaging sonar, it is possible to acquire the AUV's distance to existing obstacles. Then, through an implementation of a feature detection algorithm and an estimator, it is possible to interpolate the vehicle's relative position. This paper proposes a localization method for structured environments employing a mechanical scanning sonar feeding an extended Kalman filter. Some tests were then run in two different water tanks in order to verify the effectiveness of the solutions. These tests were performed in two different phases. For the first one, all the readings were taken with the vehicle steady and immobile. The second phase was executed with the vehicle in motion. The results are presented and compared against ground-truth measurements.