implemented PVector dist, normalize, limit, setMag, heading, rotate2D and lerp