Competed Vector3D optimalization, and moved some functions to Physics