Sensor Ultrasonico
Materiales:
-Protoboard
-Placa de arduino
-5 leds (un Verde,3 Amarillos y un Rojo)
-5 resistencias de de 220 Ohmios
-1 sensor ultrasonico de 4 entradas
//indicamos las etiquetas
iint rojo = 8;
int amarilloa = 5;
int amarillob = 6;
int amarilloc = 7;
int verde = 4;
int echo = 3;
int trig = 2;
int sensor;
int distancia;
int sonido = 33000;
void setup()
{
Serial.begin(9600); //salidas
pinMode(echo, INPUT);
pinMode(trig, OUTPUT);
pinMode(rojo, OUTPUT);
pinMode(amarilloa, OUTPUT);
pinMode(amarillob, OUTPUT);
pinMode(amarilloc, OUTPUT);
pinMode(verde, OUTPUT);
}
void loop() //proceso
{
digitalWrite(trig,LOW);
delayMicroseconds(2);
digitalWrite(trig,HIGH);
delayMicroseconds(10);
digitalWrite(trig,LOW);
sensor = pulseIn(echo,HIGH);
distancia = sensor * 0.01729;
Serial.println(distancia);
if (distancia <= 50)
{
digitalWrite(rojo, HIGH);
}
else
{
digitalWrite(rojo, LOW);
}
if (distancia <=75)
{
digitalWrite(amarilloc, HIGH);
}
else
{
digitalWrite(amarilloc, LOW);
}
if (distancia <= 100)
{
digitalWrite(amarillob, HIGH);
}
else
{
digitalWrite(amarillob, LOW);
}
if (distancia <= 125)
{
digitalWrite(amarilloa, HIGH);
}
else
{
digitalWrite(amarilloa, LOW);
}
if (distancia <= 200)
{
digitalWrite(verde, HIGH);
}
else
{
digitalWrite(verde, LOW);
}
}
Comments
Post a Comment