Renamed Vector3d to Vec3, added math unit test