Title: Autonomous Marine Vehicles Planning and Control