Implement Matrix functions

* Submatrix
* Transpose
* Fraction free gaussian elimination
* Diagonal solve