Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- void loop() {
- digitalWrite(2,HIGH);
- digitalWrite(3,HIGH);
- digitalWrite(4,HIGH);
- if(digitalRead(button1Pin)==0&&!b1b){
- b1b=true;
- }
- hasObstacle = digitalRead(obstaclePin);
- if(b1b){
- Serial.println("Motor 1");
- myStepper.step(1);
- digitalWrite(6,HIGH);
- if(digitalRead(obstaclePin)==0){
- digitalWrite(6,LOW);
- b1b=false;
- }
- }
- hasObstacle2 = digitalRead(obstaclePin2);
- if(digitalRead(button2Pin)==0&&!b2b)
- b2b=true;
- if(b2b){
- Serial.println("Motor 2");
- myStepper2.step(1);
- digitalWrite(5,HIGH);
- if(digitalRead(obstaclePin2)==0){
- digitalWrite(5,LOW);
- b2b=false;
- }
- }
- hasObstacle3 = digitalRead(obstaclePin3);
- if(digitalRead(button3Pin)==0&&!b3b)
- b3b=true;
- if(b3b){
- Serial.println("Motor 3");
- myStepper3.step(1);
- digitalWrite(5,HIGH);
- if(digitalRead(obstaclePin3)==0){
- b3b=false;
- digitalWrite(5,LOW);
- }
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement