#include <NewPing.h>
/*Aqui se configuran los pines donde debemos conectar el sensor*/
#define TRIGGER_PIN  12
#define ECHO_PIN     11
#define MAX_DISTANCE 200
/*Crear el objeto de la clase NewPing*/
NewPing sonar(TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE);
float distancia1;
float distancia2;
float velInst;
int T_entreMedidaDist = 250; // en ms
int T_entreMedidaVel  = 1000; / en ms

float medirdistancia(){
  // Obtener medicion de tiempo de viaje del sonido y guardar en variable uS
  int uS = sonar.ping_median();
  // Calcular la distancia con base en una constante
  float d = uS / US_ROUNDTRIP_CM;
  return (d);
}

void setup() {
  Serial.begin(115200);
}

void loop() {
 for(int i=0; i<50; i++){
    distancia1 = medirdistancia();
    delay(T_entreMedidaDist);
    distancia2 = medirdistancia();
    velInst = (distancia1 - distancia2)/T_entreMedidaDist;
    Serial.println("t		d1		d2	T	Velocidad");
    Serial.print(i);
    Serial.print("\t");
    Serial.print(distancia1);
    Serial.print("\t");
    Serial.print(distancia2);
    Serial.print("\t");
    Serial.print(T_entreMedida);
    Serial.print("\t");
    Serial.println(velInst);
    delay(T_entreMedidaVel);
  }
}