Guidance of 3D Underwater non Holonomic Vehicle Via Projection on Holonomic Solutions