Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #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);
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement