Vamos a suponer que tenemos un robot con 2 motores y 2 LDR.
Según la iluminación, el robot deberá siempre buscar la luz, así sus motores se moverán para dirigirlo a izquierda o derecha según qué LDR detecte más luz. El algoritmo a seguir será el siguiente:
Por ahora vamos a simular los 2 motores con 2 leds que funcionarán de la siguiente manera:
- Si un motor va hacia delante su led debe parpadear rápidamente
- Si un motor va hacia atrás su led deberá parpadear léntamente.
Para esto deberás definir 2 funciones externas que simularán este comportamiento en los leds (recuerda que se definen fuera de loop):
void adelante(motor,tiempo)
{
...
...
}
void atras(motor,tiempo)
{
...
...
}
Donde la palabra "motor" será "motorIZ"1 ó "motorDE" segùn el motor que queramos mover.
La palabra "tiempo" dice los milisegundos que debe estar moviéndose el motor (en nuestro caso los leds)
La función deberá llamarse desde loop, por ejemplo así:
adelante(motorIZ,300);
