Paso 3: código
Este es el bosquejo de la misma.
Algo de código y cableado inspirado en http://en.wikiversity.org/wiki/User:Dstaub/robotcar * /
#define trigPin 13 #define echoPin #define 12 led 11 #define led2 10 #define zumbador 9
void setup() {Serial.begin (9600); pinMode (trigPin, salida); pinMode (echoPin, entrada); pinMode (led, salida); pinMode (led2, salida); pinMode (zumbador, salida);}
void loop() {larga duración, distancia, digitalWrite (trigPin, bajo) delayMicroseconds(2); digitalWrite (trigPin, alto); delayMicroseconds(10); digitalWrite (trigPin, baja); duración = pulseIn (echoPin, HIGH); distancia = (duración/2) / 29,1; si (distancia < 50) {digitalWrite(led,HIGH); digitalWrite(buzzer,HIGH); digitalWrite(led2,LOW);
} else {digitalWrite(led,LOW); digitalWrite(buzzer,LOW); digitalWrite(led2,HIGH);} si (distancia > = 200 || distancia < = 0) {Serial.println ("fuera de rango");} else {Serial.print(distance); Serial.println ("cm"); } delay(800);