Estructura del controlador
Optimización
Optimizar el controlador de velocidad
Comprobar y optimizar el factor P
Optimizar el controlador de posición