Avoidance Bot Code

Here is a sample of code that tells a bot to follow a predesigned path, without using the sensor to avoid objects:


int fwdright= 5;
int revright = 4;
int revleft= 6;
int fwdleft = 7;

void setup() {
pinMode(revright, OUTPUT);
pinMode(fwdright, OUTPUT);
pinMode(revleft, OUTPUT);
pinMode(fwdleft, OUTPUT);
}

void loop() {
goForward();
delay(1000); //go forward one second
turnLeft();
delay(500); //turn left
goForward();
delay(1000);//go forward one second
turnRight();
delay(500);//turn Right
goBackward();
delay(2000);//go backward two seconds
}

void goForward(){
digitalWrite(fwdright,HIGH);
digitalWrite(revright,LOW);
digitalWrite(revleft,LOW);
digitalWrite(fwdleft,HIGH);
}

void turnLeft(){
digitalWrite(fwdright,HIGH);
digitalWrite(revright,LOW);
digitalWrite(revleft,HIGH);
digitalWrite(fwdleft,LOW);
}

void turnRight(){
digitalWrite(fwdright,LOW);
digitalWrite(revright,HIGH);
digitalWrite(revleft,LOW);
digitalWrite(fwdleft,HIGH);
}

void goBackward(){
digitalWrite(fwdright,LOW);
digitalWrite(revright,HIGH);
digitalWrite(revleft,HIGH);
digitalWrite(fwdleft,LOW);
}

You can change the amount of time it goes forward or backwards by changing the number next to the word “delay.” You can add as many turns as you like.