Advertisement
Ceiifadore

Garra e Ultrassonico 1

Nov 21st, 2015
41
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.60 KB | None | 0 0
  1. #define trigPin 8
  2. #define echoPin 9
  3. #include <Servo.h>
  4.  
  5. Servo myservo;
  6.  
  7. void setup() {
  8. Serial.begin (9600);
  9. pinMode(trigPin, OUTPUT);
  10. pinMode(echoPin, INPUT);
  11. myservo.attach(5);
  12.  
  13. }
  14.  
  15. void loop() {
  16.  
  17. int duration, distance,pos=0,i;
  18. digitalWrite(trigPin, LOW);
  19. delayMicroseconds(2);
  20. digitalWrite(trigPin, HIGH);
  21. delayMicroseconds(10);
  22. digitalWrite(trigPin, LOW);
  23. duration = pulseIn(echoPin, HIGH);
  24. distance = (duration/2) / 29.1;
  25. Serial.print(distance);
  26. Serial.println("cm");
  27. if(distance <= 3)
  28. {
  29. myservo.write(0);
  30. }
  31.  
  32. delay(300);
  33. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement