Sei sulla pagina 1di 3

int const trigPin =11;

int const echoPin = 12;

int const ledRojoPin = 2;

int const ledNaranjaPin = 3;

int duracion, distanciaCm;

void setup()

Serial.begin(9600);

//Definir entradas y salidas

pinMode(trigPin, OUTPUT);

pinMode(echoPin, INPUT);

pinMode(ledRojoPin, OUTPUT);

pinMode(ledNaranjaPin, OUTPUT);

void loop()

digitalWrite(trigPin, LOW);
delayMicroseconds(5);

digitalWrite(trigPin, HIGH);

delayMicroseconds(10);

digitalWrite(trigPin, LOW);

pinMode(echoPin, INPUT);

duracion = pulseIn(echoPin, HIGH);

//Convertir centimetros

distanciaCm = (duracion/2)/29.1;

Serial.print("Distancia en Centimetros: ");

Serial.print(distanciaCm);

Serial.println();

if(distanciaCm <= 30)

digitalWrite(ledRojoPin, HIGH);

digitalWrite(ledNaranjaPin, LOW);

else

digitalWrite(ledNaranjaPin, HIGH);

digitalWrite(ledRojoPin, LOW);

}
}

Potrebbero piacerti anche