Este es el coche con el que vamos a trabajar, podemos observar varios componentes:
Pilas
Cables
Placa Arduino
Controlador de motores
ruedas
2 motores
Sensores infrarrojos
Estos son los componentes que utizaremos en Arduino. Como no tenemos motores utilizaremos 6 bombillas ya que podemos realizar el código con ellas, hay 4 de ellas llamadas IN1-4 que controlarán el giro de las ruedas y 2 llamados ENA y ENB que controlan el encendido y apagado de los
motores; por otra parte tenemos 2 sensores infrarrojos y estos detectará o no la linea roja y harán que se mueva o no.
Estos son los bloques.
Lo primero que hacemos es declarar 3 variables: VEOCIDAD, SENSOR_IZQUIERDA y SENSOR_DERECHA. La velocidad es 180 (si es menos no nos funcionaba porque no había suficiente potencia para que se movieran los motores), y los sensores son 0.
Posteriormente vamos con las funciones, estas se basan en 2 cosas: encender o apagar cada IN y escribir en el pin digital 5 y 6 el valor analógico de la variable VELOCIDAD.
en cada una de las 4 funciones (retroceder no hace falta) vamos a encender y apagar los IN en un orden diferente.
Cabe remarcar que 1 significa encendido y 0 apagado.
En el loop lo primero que hacemos es que la variable SENSER_IZQUIERDA y SENSOR_DERECHO lean el INF_IZQUIERDO y el INF_DERECHO. por ultimo programamos lo que tiene que hacer el cochecito:
- Si el S.D y el S.I leen 0, se detiene
- En cambio( no se puede poner siempre el Si...)si el S.D lee 1 y el S.D lee 1, avanza
- En cambio si el S.D lee 0 y el S.I lee 1, gira a la izquierda
- En cambio si el S.D lee 1 y el SI lee 0, gira a la derecha
Este es el código del proyecto
No hay comentarios:
Publicar un comentario