Matlab and C Controller Update

- C Supervisory changed to free allocated memory at the end of ruta.
- Matlab changed to match C behaviour.
- Matlab testing environment adapted to test new functionality.
- C code cleaned from unused functions
- C header cleaned to match CEA template closer.