Advertisement
safwan092

Project_11174_Code

Feb 25th, 2023
23
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.95 KB | None | 0 0
  1. #define relay 5
  2. #define irSensor 4
  3. #define trigPin 3
  4. #define echoPin 2
  5.  
  6. long duration;
  7. int Distance;
  8. int sensorState = 0;
  9. int moveFlag = 0;
  10.  
  11. void setup() {
  12. Serial.begin(9600);
  13. pinMode(relay, OUTPUT);
  14. pinMode(trigPin, OUTPUT);
  15. pinMode(echoPin, INPUT);
  16. pinMode(irSensor, INPUT);
  17. digitalWrite(relay, 1);
  18. digitalWrite(trigPin, 0);
  19. moveFlag = 0;
  20.  
  21. }
  22. void loop() {
  23. IR();
  24. US();
  25. if (moveFlag) {
  26. digitalWrite(relay, 0);
  27. if (Distance>20) {
  28. digitalWrite(relay, 1);
  29. }
  30. }
  31.  
  32. }
  33.  
  34. void US() {
  35. digitalWrite(trigPin, LOW);
  36. delayMicroseconds(2);
  37. digitalWrite(trigPin, HIGH);
  38. delayMicroseconds(10);
  39. digitalWrite(trigPin, LOW);
  40. duration = pulseIn(echoPin, HIGH);
  41. Distance = duration * 0.034 / 2;
  42. Serial.print("Distance: ");
  43. Serial.println(Distance);
  44. }
  45.  
  46. void IR() {
  47. sensorState = digitalRead(irSensor);
  48. Serial.println(sensorState);
  49. if (!sensorState) {
  50. moveFlag = 1;
  51. }
  52. }
  53.  
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement