Advertisement
safwan092

Untitled

Dec 2nd, 2021
65
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.24 KB | None | 0 0
  1. int LimitSwitchUpPin = 11;
  2. int LimitSwitchDownPin = 10;
  3.  
  4. // Motor A
  5. int in1 = 9;
  6. int in2 = 8;
  7.  
  8. // Motor B
  9. int in3 = 7;
  10. int in4 = 6;
  11.  
  12. // Motion Sensor Setup
  13. const int led = 13;
  14. const int mspin = A0;
  15.  
  16.  
  17. void setup() {
  18. Serial.begin(9600);
  19. pinMode(led, OUTPUT);
  20. pinMode(mspin, INPUT);
  21. pinMode(in1, OUTPUT);
  22. pinMode(in2, OUTPUT);
  23. pinMode(in3, OUTPUT);
  24. pinMode(in4, OUTPUT);
  25. }
  26.  
  27. void loop() {
  28. int msStatus = analogRead(mspin);
  29. Serial.println(msStatus);
  30. if (msStatus < 500) {
  31. digitalWrite(led, HIGH);
  32. Serial.println("Motion appeard, Led is ON");
  33. moveMotors();
  34. }
  35. if (digitalRead(LimitSwitchDownPin)) {
  36. turnOFF();
  37. delay(5000);
  38. reverse();
  39. }
  40. if (digitalRead(LimitSwitchUpPin)) {
  41. turnOFF();
  42. Serial.println("STOP");
  43. }
  44.  
  45. }//end of loop
  46.  
  47.  
  48. void turnOFF() {
  49. digitalWrite(in1, LOW);
  50. digitalWrite(in2, LOW);
  51. digitalWrite(in3, LOW);
  52. digitalWrite(in4, LOW);
  53. }
  54.  
  55. void reverse() {
  56. digitalWrite(in1, LOW);
  57. digitalWrite(in2, HIGH);
  58. digitalWrite(in3, LOW);
  59. digitalWrite(in4, HIGH);
  60. }
  61.  
  62. void moveMotors() {
  63. //Turn on motor A
  64. digitalWrite(in1, HIGH);
  65. digitalWrite(in2, LOW);
  66. //Turn on motor B
  67. digitalWrite(in3, HIGH);
  68. digitalWrite(in4, LOW);
  69. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement