Arduino - Controlling 2 HC-SR04 sensors

/* ArPiBot - Fase 1 - URKO PINEDA OLMO Para mas informacion sobre el codigo, mirar la documentacion */ // Definimos los pines que vamos a utilizar. #define echoPin0 13 #define trigPin0 12 #define echoPin1 7 #define trigPin1 8 #define LEDPin 13 // Tambien las variables globales a utilizar. #define dObsMax 5 #define dObsMin 0 void setup() { Serial.begin (9600); pinMode(trigPin0, OUTPUT); pinMode(echoPin0, INPUT); pinMode(trigPin1, OUTPUT); pinMode(echoPin1, INPUT); pinMode(LEDPin, OUTPUT); } void loop() { int tiempo0, tiempo1, distancia0, distancia1; digitalWrite(trigPin0, HIGH); digitalWrite(trigPin1, HIGH); delayMicroseconds(1000); digitalWrite(trigPin0, LOW); digitalWrite(trigPin1, LOW); tiempo0 = pulseIn(echoPin0, HIGH); tiempo1 = pulseIn(echoPin1, HIGH); distancia0 = (tiempo0 / 2) / 29.1; distancia1 = (tiempo1 / 2) / 29.1; if (distancia0 >= dObsMax || distancia0 <= dObsMin){ digitalWrite(LEDPin, LOW); Serial.println("Sensor #0: Fuera del rango"); } else { digitalWrite(LEDPin, HIGH); Serial.print("Sensor #0: Distancia --> "); Serial.print(distancia0); Serial.println(" cm"); } if (distancia1 >= dObsMax || distancia1 <= dObsMin){ digitalWrite(LEDPin, LOW); Serial.println("Sensor #1: Fuera del rango"); } else { digitalWrite(LEDPin, HIGH); Serial.print("Sensor #1: Distancia --> "); Serial.print(distancia1); Serial.println(" cm"); } delay(500); }

1 Response

If someone needs more explanations, I have all my souce code (including datasheets, etc.) on this Mega folder ( https://mega.co.nz/#F!dwRgmKQC!uggy46d5B3rSfMpwSHahuA)
Press "Like" if you like it, of course! ;)

Write a comment

You can use [html][/html], [css][/css], [php][/php] and more to embed the code. Urls are automatically hyperlinked. Line breaks and paragraphs are automatically generated.