Guidance of 3D underwater non-holonomic vehicle via projection on holonomic solutions