Underwater SLAM for Structured Environments Using an