Toward Autonomous Exploration in Confined Underwater Environments