You are on page 1of 2

int bumper1= 10;

int valbum1= 0;
int bumper2= 11;
int valbum2= 0;
int ena1= 5;
int ena2= 6;
int M1A= 4;
int M1B= 7;
int M2A= 8;
int M2B= 12;

void setup() {

pinMode(ena1, OUTPUT); //ENABLE1


pinMode(ena2, OUTPUT); //ENABLE2
pinMode(bumper1, INPUT_PULLUP); //BUMPER1
pinMode(bumper2, INPUT_PULLUP); //BUMPER2
pinMode(M1A, OUTPUT);
pinMode(M1B, OUTPUT);
pinMode(M2A, OUTPUT);
pinMode(M2B, OUTPUT);
digitalWrite(ena1, HIGH);
digitalWrite(ena2, HIGH);
}

void loop() {

valbum1= digitalRead(bumper1);
valbum2= digitalRead(bumper2);

if((valbum1==0))
{
digitalWrite(M1A, LOW);
digitalWrite(M1B, HIGH);
digitalWrite(M2A, LOW);
digitalWrite(M2B, HIGH);
delay(1000);
digitalWrite(M1A, HIGH);
digitalWrite(M1B, LOW);
digitalWrite(M2A, LOW);
digitalWrite(M2B, HIGH);
delay(500);
}

if((valbum2==0))

{
digitalWrite(M1A, LOW);
digitalWrite(M1B, HIGH);
digitalWrite(M2A, LOW);
digitalWrite(M2B, HIGH);
delay(1000);
digitalWrite(M1A, HIGH);
digitalWrite(M1B, LOW);
digitalWrite(M2A, LOW);
digitalWrite(M2B, HIGH);
delay(500);
}
else
{
digitalWrite(M1A, HIGH);
digitalWrite(M1B, LOW);
digitalWrite(M2A, HIGH);
digitalWrite(M2B, LOW);
}
}

You might also like