I'm sorry here is a copy of my code
#define Motor_SpeedA 6
#define M_A1 7 // Renamed MTR_A1 to M_A1
#define M_A2 8 // Renamed MTR_A2 to M_A2
#define Motor_SpeedB 11
#define M_B1 9 // Renamed MTR_B1 to M_B12q
#define M_B2 10 // Renamed MTR_B2 to M_B2
#define OLS A0
#define ILS A1
#define MS A2
#define IRS A3
#define ORS A4
void setup() {
pinMode(Motor_SpeedA, OUTPUT);
pinMode(M_A1, OUTPUT); // Updated MTR_A1 to M_A1
pinMode(M_A2, OUTPUT); // Updated MTR_A2 to M_A2
pinMode(Motor_SpeedB, OUTPUT);
pinMode(M_B1, OUTPUT); // Updated MTR_B1 to M_B1
pinMode(M_B2, OUTPUT); // Updated MTR_B2 to M_B2
pinMode(OLS, INPUT);
pinMode(ILS, INPUT);
pinMode(MS, INPUT);
pinMode(IRS, INPUT);
pinMode(ORS, INPUT);
Serial.begin(9600);
}
void loop() {
if (digitalRead(OLS) == 0 && digitalRead(ILS) == 0 && digitalRead(MS) == 0 && digitalRead(IRS) == 0 && digitalRead(ORS) == 0){
Forward();
}
else if (digitalRead(OLS) == 1 && digitalRead(ILS) == 1 && digitalRead(MS) == 1 && digitalRead(IRS) == 1 && digitalRead(ORS) == 1){
Backward();
}
else if (digitalRead(OLS) == 1 && digitalRead(ILS) == 1 && digitalRead(MS) == 0 && digitalRead(IRS) == 1 && digitalRead(ORS) == 1){
Forward();
}
else if (digitalRead(OLS) == 0 && digitalRead(ILS) == 1 && digitalRead(MS) == 1 && digitalRead(IRS) == 1 && digitalRead(ORS) == 1){
hardLeft();
}
else if (digitalRead(OLS) == 1 && digitalRead(ILS) == 0 && digitalRead(MS) == 1 && digitalRead(IRS) == 1 && digitalRead(ORS) == 1){
softLeft();
}
else if (digitalRead(OLS) == 1 && digitalRead(ILS) == 0 && digitalRead(MS) == 0 && digitalRead(IRS) == 1 && digitalRead(ORS) == 1){
turnLeft();
}
else if (digitalRead(OLS) == 0 && digitalRead(ILS) == 0 && digitalRead(MS) == 1 && digitalRead(IRS) == 1 && digitalRead(ORS) == 1){
turnLeft();
}
else if (digitalRead(OLS) == 0 && digitalRead(ILS) == 0 && digitalRead(MS) == 0 && digitalRead(IRS) == 1 && digitalRead(ORS) == 1){
hardLeft();
}
else if (digitalRead(OLS) == 1 && digitalRead(ILS) == 1 && digitalRead(MS) == 0 && digitalRead(IRS) == 0 && digitalRead(ORS) == 0){
hardRight();
}
else if (digitalRead(OLS) == 1 && digitalRead(ILS) == 0 && digitalRead(MS) == 0 && digitalRead(IRS) == 1 && digitalRead(ORS) == 1){
turnLeft();
}
else if (digitalRead(OLS) == 0 && digitalRead(ILS) == 0 && digitalRead(MS) == 0 && digitalRead(IRS) == 0 && digitalRead(ORS) == 1){
hardLeft();
}
else if (digitalRead(OLS) == 0 && digitalRead(ILS) == 1 && digitalRead(MS) == 1 && digitalRead(IRS) == 1 && digitalRead(ORS) == 1){
hardLeft();
}
else if (digitalRead(OLS) == 1 && digitalRead(ILS) == 0 && digitalRead(MS) == 0 && digitalRead(IRS) == 0 && digitalRead(ORS) == 0){
hardRight();
}
else if (digitalRead(OLS) == 1 && digitalRead(ILS) == 1 && digitalRead(MS) == 1 && digitalRead(IRS) == 1 && digitalRead(ORS) == 0){
hardRight();
}
else if (digitalRead(OLS) == 1 && digitalRead(ILS) == 1 && digitalRead(MS) == 1 && digitalRead(IRS) == 0 && digitalRead(ORS) == 1){
softRight();
}
else if (digitalRead(OLS) == 1 && digitalRead(ILS) == 1 && digitalRead(MS) == 0 && digitalRead(IRS) == 0 && digitalRead(ORS) == 1){
turnRight();
}
else if (digitalRead(OLS) == 1 && digitalRead(ILS) == 1 && digitalRead(MS) == 0 && digitalRead(IRS) == 0 && digitalRead(ORS) == 0){
hardRight();
}
else if (digitalRead(OLS) == 1 && digitalRead(ILS) == 1 && digitalRead(MS) == 1 && digitalRead(IRS) == 0 && digitalRead(ORS) == 0){
turnRight();
}
else if (digitalRead(OLS) == 1 && digitalRead(ILS) == 1 && digitalRead(MS) == 1 && digitalRead(IRS) == 1 && digitalRead(ORS) == 1){
Backward();
}
else {
Stop();
}
}
//motor b left motor a right
void Forward() {
analogWrite(Motor_SpeedA, 255);
analogWrite(Motor_SpeedB, 255);
digitalWrite(M_A1, LOW);//
digitalWrite(M_A2, HIGH);
digitalWrite(M_B1, HIGH);
digitalWrite(M_B2, LOW);
}
void turnLeft() {
analogWrite(Motor_SpeedA, 255);
analogWrite(Motor_SpeedB, 0);
digitalWrite(M_A1, HIGH);
digitalWrite(M_A2, LOW);
digitalWrite(M_B1, LOW);
digitalWrite(M_B2, LOW);
}
void turnRight() {
analogWrite(Motor_SpeedA, 200);
analogWrite(Motor_SpeedB, 255);
digitalWrite(M_A1, LOW);
digitalWrite(M_A2, LOW);
digitalWrite(M_B1, HIGH);
digitalWrite(M_B2, LOW);
}
void Backward() {
analogWrite(Motor_SpeedA, 50);
analogWrite(Motor_SpeedB, 0);
digitalWrite(M_A1, LOW);
digitalWrite(M_A2, HIGH);
digitalWrite(M_B1, LOW);
digitalWrite(M_B2, HIGH);
}
void hardLeft() {
analogWrite(Motor_SpeedA, 255);
analogWrite(Motor_SpeedB, 255);
digitalWrite(M_A1, LOW);
digitalWrite(M_A2, HIGH);
digitalWrite(M_B1, LOW);
digitalWrite(M_B2, HIGH);
}
void hardRight() {
analogWrite(Motor_SpeedA, 255);
analogWrite(Motor_SpeedB, 255);
digitalWrite(M_A1, HIGH);
digitalWrite(M_A2, LOW);
digitalWrite(M_B1, HIGH);
digitalWrite(M_B2, LOW);
}
void softLeft() {
analogWrite(Motor_SpeedA, 255);
analogWrite(Motor_SpeedB, 0);
digitalWrite(M_A1, LOW);//
digitalWrite(M_A2, HIGH);
digitalWrite(M_B1, LOW);
digitalWrite(M_B2, LOW);
}
void softRight() {
analogWrite(Motor_SpeedA, 0);
analogWrite(Motor_SpeedB, 250);
digitalWrite(M_A1, LOW);//
digitalWrite(M_A2, LOW);
digitalWrite(M_B1, HIGH);
digitalWrite(M_B2, LOW);
}
void Stop() {
digitalWrite(M_A1, LOW);
digitalWrite(M_A2, LOW);
digitalWrite(M_B1, LOW);
digitalWrite(M_B2, LOW);
}