Cleaning of the CGT

- Removed some old files, mainly the OCP solver
- Removed some rarely used classes
- Removed classes which are going to be deprecated
- Patched some classes so that we can compile ACADO
Cleaned the OCP class