Implement Vec3D and Vec3D
Reorganize tests