Optimized model transformation matrices

Added ortho projection math but not used yet