Added camera matrix
Added base code for MatrixStack