Advertisement
Guest User

Untitled

a guest
Feb 20th, 2017
72
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.18 KB | None | 0 0
  1. #define trigPin 11
  2. #define echoPin 10
  3. int i1 = 3;
  4. int i2 = 5;
  5. int i3 = 6;
  6. int i4 = 9;
  7. long duration, distance;
  8. void setup() {
  9.  
  10. pinMode(trigPin, OUTPUT);
  11. pinMode(echoPin, INPUT);
  12. pinMode(i2,OUTPUT);
  13. pinMode(i3,OUTPUT);
  14. pinMode(i4,OUTPUT);
  15. pinMode(i1,OUTPUT);
  16.  
  17. //Serial.begin(9600);
  18. }
  19. void loop() {
  20.  
  21. digitalWrite(trigPin, LOW);
  22. delayMicroseconds(2);
  23. digitalWrite(trigPin, HIGH);
  24. delayMicroseconds(10);
  25. digitalWrite(trigPin, LOW);
  26.  
  27. duration = pulseIn(echoPin, HIGH);
  28. distance = (duration/2) * 0.034029;
  29.  
  30. delay(10);
  31.  
  32. //Serial.println(distance);
  33.  
  34. if(distance > 10 && distance <40) {
  35.  
  36. analogWrite(i1,150);
  37. analogWrite(i2,0);
  38. analogWrite(i3,0);
  39. analogWrite(i4,0);
  40. delay(250);
  41. }
  42.  
  43. else if (distance > 0 && distance < 10){
  44.  
  45. analogWrite(i1,0);
  46. analogWrite(i2,100);
  47. analogWrite(i3,0);
  48. analogWrite(i4,100);
  49. delay(500);
  50. analogWrite(i1,150);
  51. analogWrite(i2,0);
  52. analogWrite(i3,0);
  53. analogWrite(i4,0);
  54. delay(250);
  55. }
  56.  
  57.  
  58. else if( distance>40){
  59.  
  60. analogWrite( i1 ,150);
  61. analogWrite(i2 ,0);
  62. analogWrite(i3,150);
  63. analogWrite(i4,0);
  64. }
  65. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement