Basic matrix class + ortho matrix (untested)