naivxnaivet

Riki

Apr 13th, 2020
83
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.12 KB | None | 0 0
  1. int setDistance = 0;
  2.  
  3. int distance;
  4.  
  5. #include <NewPing.h>
  6. #include <MedianFilter.h>
  7. #include <Wire.h>
  8. #include <MedianFilter.h>
  9.  
  10. #define TRIGGER_PIN 12 // Arduino pin tied to trigger pin on the ultrasonic sensor.
  11. #define ECHO_PIN 11 // Arduino pin tied to echo pin on the ultrasonic sensor.
  12. #define MAX_DISTANCE 450 // Maximum distance we want to ping for (in centimeters). Maximum sensor distance is rated at 400-500cm.
  13.  
  14.  
  15. const int relayPin = 4;
  16. NewPing sonar(TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE); // NewPing setup of pins and maximum distance.
  17.  
  18. MedianFilter filter(31, 0);
  19.  
  20. void setup()
  21. {
  22. Serial.begin(115200); // Open serial monitor at 115200 baud to see ping results.
  23. pinMode(relayPin, OUTPUT);
  24. digitalWrite(relayPin, LOW);
  25. }
  26.  
  27. void loop() {
  28.  
  29.  
  30. unsigned int o, uS = sonar.ping(); // Send ping, get ping time in microseconds (uS).
  31.  
  32. filter.in(uS);
  33. o = filter.out();
  34. Serial.println("Ping: ");
  35.  
  36. distance = o / US_ROUNDTRIP_CM;
  37.  
  38. Serial.println(distance);
  39.  
  40. if(distance <= 105)
  41. {
  42. digitalWrite(relayPin, HIGH);
  43. }
  44. else
  45. {
  46. digitalWrite(relayPin, LOW);
  47. }
  48. }
Advertisement
Add Comment
Please, Sign In to add comment