I want to get my elegoo 3.0 robot car to solve a maze using left hand strategy. I have attempted many things, and they all failed because i am new at this.
here is my code:
#define LT_M !digitalRead(4)
#define LT_L !digitalRead(2)
#define LT_R !digitalRead(10)
#define ENA 5
#define ENB 6
#define IN1 7
#define IN2 8
#define IN3 9
#define IN4 11
#define carspeed 125
void forward(){
analogWrite(ENA, carspeed);
analogWrite(ENB, carspeed);
digitalWrite(IN1, LOW);
digitalWrite(IN2, HIGH);
digitalWrite(IN3, HIGH);
digitalWrite(IN4, LOW);
Serial.println("go forward!");
}
void left(){
analogWrite(ENA, carspeed);
analogWrite(ENB, carspeed);
digitalWrite(IN1, LOW);
digitalWrite(IN2, HIGH);
digitalWrite(IN3, LOW);
digitalWrite(IN4, HIGH);
Serial.println("go left!");
}
void right(){
analogWrite(ENA, carspeed);
analogWrite(ENA, carspeed);
digitalWrite(IN1, HIGH);
digitalWrite(IN2, LOW);
digitalWrite(IN3, HIGH);
digitalWrite(IN4, LOW);
Serial.println("go right!");
}
void setup(){
Serial.begin(9600);
pinMode(LT_M,INPUT);
pinMode(LT_L,INPUT);
pinMode(LT_R,INPUT);
}
void loop() {
if(LT_M){
forward();
while(LT_L, false);
}
else if(LT_L){
left();
while(LT_M, false);
}
else if(LT_R){
right();
while(LT_M and LT_L, false);
}
}
any advise?