#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);
}