Refactored matrix code, implemented mat2
More skeletons of matrices and updated README