Reciclado Polo Arduino dispensador (5 / 5 paso)

Paso 5: Arduino cableado + programación

Esencialmente un sensor sonar conectado y un servo con luz LED indicador. Utilice las definiciones en el código para saber donde poner los cables.

El código:

#include < Servo.h >

Servo myservo; crear objeto servo para controlar un servo

int pos = 0;
trigPin int = 4; Trig - puente verde
echoPin int = 2; Puente eco - amarillo
larga duración, cm, pulgadas;

void setup() {}
Comenzar a puerto serial
Serial.Begin (9600);
myservo.Attach(9);
Definir las entradas y salidas
pinMode (trigPin, salida);
pinMode (echoPin, entrada);
pinMode (13, salida);
}

{} void rotate()
va desde 0 grados a 180 grados
en pasos de 1 grado
myservo.Write(100);
Delay(2000);
myservo.Write(0);
Delay(2000);

}

void comprobar (int cm) {}
int temp;
Temp = 0;
Temp = cm;
Si (temp < 5) {}
Delay(1000);
digitalWrite (13, HIGH);
Rotate();
} else {}

digitalWrite (13, bajo);
myservo.Write(95);
}
}

void loop()
{

El sensor se activa mediante un pulso alto de microsegundos 10 o más.
Dar un breve impulso de baja previamente para asegurar un pulso limpio alto:
digitalWrite (trigPin, LOW);
delayMicroseconds(5);
digitalWrite (trigPin, HIGH);
delayMicroseconds(10);
digitalWrite (trigPin, LOW);

Leer la señal del sensor: un alto pulso que
duración es el tiempo (en microsegundos) desde el envío
del ping a la recepción de su eco de un objeto.
pinMode (echoPin, entrada);
duración = pulseIn (echoPin, HIGH);

convertir el tiempo en una distancia
cm = (duración/2) / 29,1;
pulgadas = (duración/2) / 74;

Serial.Print(inches);
Serial.Print ("in");
Serial.Print(cm);
Serial.Print("cm");
Serial.println();
Delay(2000);
myservo.Write(95);
Check(cm);

Delay(100);
}