remove deprecated code
Massive refactoring to MatrixUtils and TestProblems
added tests/