Formation Control For Autonomous Marine Vehicles