/* 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
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.