Dam wall detection and tracking using a Mechanically Scanned Imaging Sonar

In Dam inspection tasks, an underwater robot has to grab images while surveying the wall meanwhile maintaining a certain distance and relative orientation. This paper proposes the use of an MSIS (Mechanically Scanned Imaging Sonar) for relative positioning of a robot with respect to the wall. An imaging sonar gathers polar image scans from which depth images (Range & Bearing) are generated. Depth scans are first processed to extract a line corresponding to the wall (with the Hough Transform), which is then tracked by means of an EKF (Extended Kalman Filter) using a static motion model and an implicit measurement equation associating the sensed points to the candidate line. The line estimate is referenced to the robot fixed frame and represented in polar coordinates (ρ&θ) which directly corresponds to the actual distance and relative orientation of the robot with respect to the wall. The proposed system has been tested in simulation as well as in water tank conditions.