Added Vector3D and Matrix3D class. All tests green.