Advertisement
gabbyshimoni

filterUSsensor

May 28th, 2019
471
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 0.75 KB | None | 0 0
  1. #define trigPin 7
  2. #define echoPin 8
  3.  long duration;
  4.   long distance;
  5. int numberOfSamples = 10, counter=0;
  6. long sum=0;
  7.  
  8. void setup()
  9. {
  10.   pinMode(trigPin, OUTPUT);
  11.    pinMode(echoPin, INPUT);
  12.   Serial.begin(9600);
  13. }
  14.  
  15. void loop()
  16. {
  17.   while(counter <numberOfSamples){
  18.    
  19.   getDistance();
  20.    
  21.     if(distance>3 && distance <300){
  22.     sum+=distance;
  23.       counter++;
  24.     }
  25.   }
  26.    
  27.   Serial.print("average distance[cm] = ");
  28.   Serial.println(sum*1.0/counter);
  29.   delay(10);
  30.   counter = 0;
  31.   sum=0;
  32. }
  33.  
  34. void getDistance(){
  35.   digitalWrite(trigPin, LOW);
  36.   delayMicroseconds(2);
  37.   digitalWrite(trigPin, HIGH);
  38.   delayMicroseconds(10);
  39.   digitalWrite(trigPin, LOW);
  40.  
  41.   duration = pulseIn(echoPin,HIGH);
  42.   distance = duration/58.1;
  43.  
  44. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement