Advertisement
Guest User

djjyhhilgljhgutd

a guest
Oct 24th, 2014
121
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.82 KB | None | 0 0
  1. #include <Servo.h>
  2.  
  3. int l=9;
  4. int lc;
  5. int r=11;
  6. int rc;
  7. //servos
  8. Servo left;
  9. int lpos=0;
  10. Servo right;
  11. int rpos=0;
  12.  
  13.  
  14. void setup(){
  15. left.attach(6);
  16. right.attach(5);
  17. Serial.begin(9600);
  18. }
  19. void loop(){
  20.  
  21. //left sensor
  22. lc=0;
  23. pinMode(l,OUTPUT);
  24. digitalWrite(l,HIGH);
  25. delay(1);
  26. pinMode(l,INPUT);
  27. digitalWrite(l,LOW);
  28. while(digitalRead(l)==HIGH){
  29. lc++;
  30. }
  31. Serial.print(lc );
  32.  
  33.  
  34. //rightsensor
  35. rc=0;
  36. pinMode(r,OUTPUT);
  37. digitalWrite(r,HIGH);
  38. delay(1);
  39. pinMode(r,INPUT);
  40. digitalWrite(r,LOW);
  41. while(digitalRead(r)==HIGH){
  42. rc++;
  43.  
  44. }
  45. Serial.println(rc);
  46. //servo
  47. //left
  48. left.write(lpos);
  49. right.write(rpos);
  50. if(lc<150){
  51. lpos=0;
  52. }
  53. else{
  54. lpos=45;
  55. }
  56. // //right
  57. if(rc<150){
  58. rpos=180;
  59. }
  60. else{
  61. rpos=135;
  62. }
  63. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement