Add frame conversion and glFrustum equivalent convenient functions in GlUtil.
Clean up code, move matrix calculations into GlUtil, set correct scale for both frustum and video plane in non-first person view.