Cleaning up
Adding matrix data structure
Cleaned up output.
Adding example test file
Adding in a unittest
Removed a useless option