semi complete Matrix class

Completed matrix.h need to add "setBlock" function to .cpp