Custom matrix class to eventually improve performance
Massive performance improvement in Matrix3D for c++