Sensor ultrasónico de Arduino (3 / 4 paso)

Paso 3: Escribir el código

#define trigPin 13

#define echoPin 12

#define greenLED 11

#define rojo 10

void setup() {}

Serial.Begin (9600);

pinMode (trigPin, salida);

pinMode (echoPin, entrada);

pinMode (greenLED, salida);

pinMode (rojo, salida);

}

void loop() {}

larga duración, distancia;

digitalWrite (trigPin, LOW);

delayMicroseconds(2);

digitalWrite (trigPin, HIGH);

delayMicroseconds(10);

digitalWrite (trigPin, LOW);

duración = pulseIn (echoPin, HIGH);

distancia = (duración/2) / 29,1;

Si (distancia < 4) {/ / esto es donde pasa el LED de encendido/apagado

digitalWrite(greenLED,HIGH); Cuando se cumple la condición de Red, el LED verde debe apagar digitalWrite(redLED,LOW);

} else {}

digitalWrite(greenLED,LOW); digitalWrite(redLED,HIGH);

}

Si (distancia > = 200 || distancia < = 0) {}

Serial.println ("fuera de rango");

} else {}

Serial.Print(Distance); Serial.println ("cm");

} delay(500);

}