35 lines
1.2 KiB
C++
35 lines
1.2 KiB
C++
#define ECHOPIN 2// Pin to receive echo pulse
|
|
#define TRIGPIN 3// Pin to send trigger pulse
|
|
void setup(){
|
|
Serial.begin(115200);
|
|
pinMode(ECHOPIN, INPUT);
|
|
pinMode(TRIGPIN, OUTPUT);
|
|
digitalWrite(TRIGPIN, LOW);
|
|
digitalWrite(ECHOPIN, HIGH);
|
|
}
|
|
void loop(){
|
|
digitalWrite(TRIGPIN, LOW); // Set the trigger pin to low for 2uS
|
|
delayMicroseconds(2);
|
|
digitalWrite(TRIGPIN, HIGH); // Send a 10uS high to trigger ranging
|
|
delayMicroseconds(20);
|
|
digitalWrite(TRIGPIN, LOW); // Send pin low again
|
|
int distance = pulseIn(ECHOPIN, HIGH,26000); // Read in times pulse
|
|
distance= distance/58;
|
|
Serial.println(distance);
|
|
delay(50);// Wait 50mS before next ranging
|
|
// int distancia=0;
|
|
// digitalWrite(TRIGPIN, HIGH);
|
|
// delayMicroseconds(10); //Retardo necesario para la inicializacion
|
|
// digitalWrite(TRIGPIN, LOW);
|
|
//
|
|
// while(digitalRead(ECHOPIN)==0);
|
|
// while(digitalRead(ECHOPIN)==1){// && distancia<=500){
|
|
// distancia++;
|
|
// delayMicroseconds(58); // Tiempo que tarda la honda en recorrer 2cm a la velocidad del sonido
|
|
// } // 1cm de ida y 1cm de vuelta
|
|
// delay(50);
|
|
//
|
|
// Serial.println(distancia);
|
|
// //delay(1000);
|
|
}
|