Underwater SLAM in a marina environment