Vector2D code has been completed with smoothing + speed