implemented PVector setMag
implemented PVector heading
rotate2d
implemented lerp
lerp