Underwater SLAM for structured environments using an imaging sonar (Springer tracts in advanced robotics, 2010)