Refactor matrices.py, and improved option parsing
4th order scheme working on the square