Topological Navigation for Autonomous Underwater Vehicles in Confined Semi-Structured Environments