Collision Detection + Push Boxes in Space + Vector3D class and usage