Added the start of the Matrix class. Vector3 is needed