Advertisement
Kanamex

S04-Evidencia-Sensor Ultrasónico

Jun 23rd, 2021
665
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 1.05 KB | None | 0 0
  1. //Se definen los pines
  2. #define trigPin 13
  3. #define echoPin 12
  4. #define rojo 7
  5. #define verde 6
  6. void setup() {
  7. Serial.begin (9600);
  8. //Se configuran los pines
  9. pinMode(trigPin, OUTPUT);
  10. pinMode(echoPin, INPUT);
  11. pinMode(rojo, OUTPUT);
  12. pinMode(verde, OUTPUT);
  13. }
  14. void loop() {
  15. long duracion, distancia;
  16. //Se deshabilita el sensor
  17. digitalWrite(trigPin, LOW);
  18. delayMicroseconds(2);
  19. //Se habilita el sensor
  20. digitalWrite(trigPin, HIGH);
  21. delayMicroseconds(10);
  22. //Se deshabilita el sensor
  23. digitalWrite(trigPin, LOW);
  24. //Se lee la duracin del pulso en microsegundos
  25. duracion = pulseIn(echoPin, HIGH); //Esta instruccion lee el tiempo que un pin estรก en
  26. estado determinado
  27. Serial.print("Duracion: ");
  28. Serial.println(duracion);
  29. distancia = (duracion/29.2) / 2;
  30. if (distancia < 15)
  31. {
  32. digitalWrite(rojo,HIGH);
  33. digitalWrite(verde,LOW);
  34. }
  35. else
  36. {
  37. digitalWrite(rojo,LOW);
  38. digitalWrite(verde,HIGH);
  39. }
  40. if (distancia >= 330 || distancia <= 3)
  41. {
  42. Serial.println("Fuera de Rango");
  43. }
  44. else
  45. {
  46. Serial.print(distancia);
  47. Serial.println("cm");
  48. }
  49. delay(500);
  50. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement