Started cleaning up tests
Added a bunch of tests for matrices and matrix decomp