Major refactor around Point3D and Matrix class.