Refactor. Add matrix errors and counting.
Matrix plus and minus, matrix printing