Fix formatting.
Add matrix print method and separate the tests.