Implemented YPSControlledVector3d