Para poder realizar esta tarea nos ayudamos de un sensor de luz apuntando hacia el suelo, que toma unos valores de cual es la posición correcta para que se pueda sostener con nuestra ayuda los primeros segundos, una vez que le soltamos, el robot empieza a inclinarse de un lado a otro, pero con el sensor comentado anteriormente, nos va dando la posición exacta y eso nos ayuda para que el robot tome la decisión de si se esta cayendo hacia adelante, las ruedas se muevan hacia adelante, volviéndose a quedar en equilibrio y viceversa. Todo esto basándose en un controlador PID.
Según su comportamiento, realizamos muchisimas pruebas para ajustar cada constante proporcional. A raíz de estas pruebas llegamos a la conclusión de que la constante proporcional debería tener una valor suficiente mente relevante como para recoger el error actual, la integral debía tener valores muy pequeños ya que al ser el sumatorio de los errores aumentaba mucho la velocidad del motor, también decidimos ponerle un tope, para que no llegase a un numero muy alto nunca,y con la constante proporcional derivativa decidimos ajustarla a valores muy altos, ya que al ser la diferencia entre el error actual y el error anterior si esta diferencia es mucha quiere decir que el robot estará muy desequilibrado por lo que necesitará una mayor velocidad y al contrario si la diferencia es pequeña significará que el robot esta relativa mente equilibrado con lo que la velocidad no deberá aumentar en exceso.La que mejor resultados nos dio es la siguiente: Kp=19, Ki=1,Kd=30.
Dos videos que muestran en funcionamiento final de robot.