Guidance and Control of Ocean Vehicles door Thor I. Fossen