Advertisement
Guest User

Untitled

a guest
Oct 17th, 2018
107
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.09 KB | None | 0 0
  1. #define trigPin1 3
  2. #define echoPin1 2
  3.  
  4. #define trigPin2 4
  5. #define echoPin2 5
  6.  
  7. #define trigPin3 7
  8. #define echoPin3 8
  9.  
  10. long duration, distance, RightSensor,BackSensor,FrontSensor,LeftSensor;
  11.  
  12. void setup()
  13. {
  14. Serial.begin (9600);
  15. pinMode(trigPin1, OUTPUT);
  16. pinMode(echoPin1, INPUT);
  17. pinMode(trigPin2, OUTPUT);
  18. pinMode(echoPin2, INPUT);
  19. pinMode(trigPin3, OUTPUT);
  20. pinMode(echoPin3, INPUT);
  21. }
  22.  
  23. void loop() {
  24. SonarSensor(trigPin1, echoPin1);
  25. RightSensor = distance;
  26. SonarSensor(trigPin2, echoPin2);
  27. LeftSensor = distance;
  28. SonarSensor(trigPin3, echoPin3);
  29. FrontSensor = distance;
  30.  
  31. /*
  32.  
  33. */
  34. if (LeftSensor < 130 || FrontSensor < 130 || RightSensor < 130)
  35. {
  36. Serial.print(LeftSensor);
  37. Serial.print(" - ");
  38. Serial.print(FrontSensor);
  39. Serial.print(" - ");
  40. Serial.println(RightSensor);
  41. Serial.println("hit");
  42. }
  43.  
  44. }
  45.  
  46. void SonarSensor(int trigPin,int echoPin)
  47. {
  48. digitalWrite(trigPin, LOW);
  49. delayMicroseconds(2);
  50. digitalWrite(trigPin, HIGH);
  51. delayMicroseconds(10);
  52. digitalWrite(trigPin, LOW);
  53. duration = pulseIn(echoPin, HIGH);
  54. distance = (duration/2) / 29.1;
  55.  
  56. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement