Underwater Slam For Structured Environments Using An Imaging Sonar by David Ribas & Pere Ridao