#define trigPin 13
#define echoPin 14
#define MAX_DISTANCE 700
float timeOut = MAX_DISTANCE * 58.8;
int soundVelocity = 340;
void setup() {
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
Serial.begin(115200);
}
void loop() {
delay(100);
Serial.printf("Distancia: ");
Serial.print(getSonar() * 10);
Serial.print("mm");
Serial.print(" | ");
Serial.print(getSonar());
Serial.print("cm");
Serial.print(" | ");
Serial.print(getSonar() / 2.54);
Serial.print("in");
Serial.print(" | ");
Serial.print(getSonar() * 100);
Serial.println("m");
}
float getSonar() {
unsigned long pingTime;
float distance;
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
pingTime = pulseIn(echoPin, HIGH, timeOut);
distance = (float)pingTime * soundVelocity / 2 / 10000;
return distance;
}