Vector performance fixes

Couple of speedups in the Vector2D class, couldn't resist.