const int LB = 2;
const int RB = 15;
const int t1 = 33;
const int t2 = 32;
const int b1 = 21;
const int b2 = 19;
int LBut = 0 ;
int RBut = 0;
int count=0;
int newcount;
void setup() {
Serial.begin(9600);
pinMode(t1, OUTPUT);
pinMode(t2, OUTPUT);
pinMode(b1, OUTPUT);
pinMode(b2, OUTPUT);
pinMode(LB, INPUT);
pinMode(RB, INPUT);
digitalWrite(t1, LOW);
digitalWrite(t2, LOW);
digitalWrite(b1, LOW);
digitalWrite(b2, LOW);
Serial.println("stop");
}
void loop() {
RBut = digitalRead(RB);
LBut = digitalRead(LB);
if (RBut == LOW && LBut == LOW) {
digitalWrite(t1, HIGH);
digitalWrite(t2, HIGH);
digitalWrite(b1, LOW);
digitalWrite(b2, LOW);
Serial.println("forward");
delay(500);
}
else if (RBut == HIGH && LBut == LOW){
digitalWrite(t1, LOW);
digitalWrite(t2, HIGH);
digitalWrite(b1, LOW);
digitalWrite(b2, HIGH);
Serial.println("right");
delay(500);
}
else if (RBut == LOW && LBut == HIGH){
digitalWrite(t1, HIGH);
digitalWrite(t2, LOW);
digitalWrite(b1, HIGH);
digitalWrite(b2, LOW);
Serial.println("left");
delay(500);
}
if (RBut == HIGH && LBut == HIGH){
digitalWrite(t1, LOW);
digitalWrite(t2, LOW);
digitalWrite(b1, HIGH);
digitalWrite(b2, HIGH);
Serial.println("backward");
delay(500);
}
}