#include <Ultrasonic.h>
#define ECHO_PIN 2
#define TRIG_PIN 3
#define MAX_DISTANCE 100
Ultrasonic ultrader(5,4); //pin trig, pin echo
Ultrasonic ultraiz(3,2); //pin trig, pin echo 3,2
Ultrasonic ultracen(8,7); //pin trig, pin echo 8,7
int distanciaiz; // variable de distancia del ultrasonico izquierdo
int distanciader; // variable de distancia del ultrasonico derecho
int distanciacen; // variable de distancia del ultrasonico central
void setup() {
Serial.begin(115200);
pinMode(LED_BUILTIN, OUTPUT);
pinMode(TRIG_PIN, OUTPUT);
pinMode(ECHO_PIN, INPUT);
}
float readDistanceCM() {
digitalWrite(TRIG_PIN, LOW);
delayMicroseconds(2);
digitalWrite(TRIG_PIN, HIGH);
delayMicroseconds(10);
digitalWrite(TRIG_PIN, LOW);
int duration = pulseIn(ECHO_PIN, HIGH);
return duration * 0.034 / 2;
}
void loop(){
float distanciader = readDistanceCM();
float distanciaiz = readDistanceCM() ;
float distanciacen = readDistanceCM();
bool isNearby = distanciaiz < 100;
digitalWrite(LED_BUILTIN, isNearby);
Serial.print("derecha: ");
Serial.print(readDistanceCM()); // CM or INC
Serial.print(" cm " );
Serial.print("izquierda: ");
Serial.print(readDistanceCM()); // CM or INC
Serial.println(" cm " );
Serial.print("central: ");
Serial.print(readDistanceCM()); // CM or INC
Serial.println(" cm " );
delay(100);
}