La solicitud de interrupción (4 / 4 paso)

Paso 4: Código (Diviértete)

/*

HC-SR04 Ping distancia sensor VCC 5V de Arduino GND a GND de Arduino Echo a Arduino pin 13 Trig a pin Arduino Motor 12 a Arduino 3 Original codigo mejoras al Ping sketch procedente de Trollmaker.com algo de código y cableado inspirado en http://en.wikiversity.org/wiki/User:Dstaub/robotcar modificado por inviernos Tolson (27 de agosto de 2014) para monitor serie simplificado de lectura. Modificado por Anthony Pease (09 de noviembre de 2015) para la interacción motor * /

#define trigPin 12 #define echoPin 13 #define moterPin 3

const int motorPin = 3;

void setup() {Serial.begin (9600); pinMode (trigPin, salida); pinMode (echoPin, entrada); pinMode (motorPin, 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;

Serial.Print ("en la gama:"); Serial.Print(Distance); Serial.println ("cm");

Si (distancia < = 45 & & distancia > = 2) {Serial.print ("activo"); digitalWrite (motorPin, HIGH); Delay(100); } else {digitalWrite (motorPin, LOW); delay(100);} delay(100); }