Title: Development and Testing of Navigation Algorithms for Autonomous Underwater Vehicles