3D Path Following and Tracking for an Inspection Class ROV