Matrix class compiling, not yet debugged