Added ortho matrix and math/matrix.h