Add Vector3D class