Finished test in rspec for normal matrix. Not test for sparse matrix yet