Updated MEX interface for CGT OCP solver

- Added support for covariance output (if enabled)
- Added support for algebraic variables.
Merge branch 'master' of github.com:acado/acado