Advertisement
Guest User

Untitled

a guest
Oct 13th, 2016
82
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 1.11 KB | None | 0 0
  1.  
  2. #include <Servo.h>.
  3.  
  4. const int trigPin = 10;
  5. const int echoPin = 11;
  6.  
  7. long duration;
  8. int distance;
  9. long filterdistance[4];
  10. Servo myServo;
  11. long filter;
  12. int a=0;
  13.  
  14. void setup() {
  15.   pinMode(trigPin, OUTPUT);
  16.   pinMode(echoPin, INPUT);
  17.   Serial.begin(9600);
  18.   myServo.attach(12);
  19. }
  20. void loop() {
  21.     distance = calculateDistance();
  22.     myServo.write(i);
  23.  
  24.   while(a=0){  
  25.    
  26.     if(distance<100){
  27.   myServo.write(distance);
  28.   delay(30);
  29.   distance = calculateDistance();
  30.     }
  31.    
  32.     else{
  33.         myServo.write(100);
  34.                
  35.                 distance = calculateDistance();
  36.     }
  37.   }
  38.  
  39. }
  40.  
  41. int calculateDistance(){
  42.    
  43.     for(int i=0;i<5;i++){
  44.  
  45.   digitalWrite(trigPin, LOW);
  46.   delayMicroseconds(2);
  47.   // Sets the trigPin on HIGH state for 10 micro seconds
  48.   digitalWrite(trigPin, HIGH);
  49.   delayMicroseconds(10);
  50.   digitalWrite(trigPin, LOW);
  51.   duration = pulseIn(echoPin, HIGH); // Reads the echoPin, returns the sound wave travel time in microseconds
  52.   filterdistance[i]= duration*0.034/2;
  53.   filter=filter+filterdistance[i];
  54.  
  55.   }
  56.   distance=filter/5;
  57.  
  58.   return distance;
  59. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement