Updates matrix.h define guard :grin:
Re-arranges the order of matrix functions
Extracts matrix initialization

* Like before, soon we will turn it to a Class!
* First things, first!