Intentando optimizar

Retocado el PID de la y en el simulink para aumentar la deribativa.
Preparamos el frenado antes del codigo de enrique.