Advertisement
Guest User

Untitled

a guest
Jun 24th, 2019
232
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.86 KB | None | 0 0
  1. void loop() {
  2. digitalWrite(2,HIGH);
  3. digitalWrite(3,HIGH);
  4. digitalWrite(4,HIGH);
  5. if(digitalRead(button1Pin)==0&&!b1b){
  6. b1b=true;
  7. }
  8. hasObstacle = digitalRead(obstaclePin);
  9. if(b1b){
  10. Serial.println("Motor 1");
  11. myStepper.step(1);
  12. digitalWrite(6,HIGH);
  13. if(digitalRead(obstaclePin)==0){
  14. digitalWrite(6,LOW);
  15. b1b=false;
  16. }
  17. }
  18. hasObstacle2 = digitalRead(obstaclePin2);
  19. if(digitalRead(button2Pin)==0&&!b2b)
  20. b2b=true;
  21. if(b2b){
  22. Serial.println("Motor 2");
  23. myStepper2.step(1);
  24. digitalWrite(5,HIGH);
  25. if(digitalRead(obstaclePin2)==0){
  26. digitalWrite(5,LOW);
  27. b2b=false;
  28. }
  29. }
  30. hasObstacle3 = digitalRead(obstaclePin3);
  31. if(digitalRead(button3Pin)==0&&!b3b)
  32. b3b=true;
  33. if(b3b){
  34. Serial.println("Motor 3");
  35. myStepper3.step(1);
  36. digitalWrite(5,HIGH);
  37. if(digitalRead(obstaclePin3)==0){
  38. b3b=false;
  39. digitalWrite(5,LOW);
  40. }
  41. }
  42. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement