// Motor A connections
int enA = 5;
int in1 = 9;
int in2 = 10;
// Motor B connections
int enB = 6;
int in3 = 11;
int in4 = 12;
void setup()
{
Serial.begin(9600);
Serial.println("robot PROJECT-");
// Set all the motor control pins to outputs
pinMode(enA, OUTPUT);
pinMode(enB, OUTPUT);
pinMode(in1, OUTPUT);
pinMode(in2, OUTPUT);
pinMode(in3, OUTPUT);
pinMode(in4, OUTPUT);
// Turn off motors - Initial state
digitalWrite(in1, LOW);
digitalWrite(in2, LOW);
digitalWrite(in3, LOW);
digitalWrite(in4, LOW);
// Turn off motors - Initial state
digitalWrite(in1, HIGH);
digitalWrite(in2, LOW);
digitalWrite(in3, HIGH);
digitalWrite(in4, LOW);
//mot1(0,1,0,1); Serial.println("1"); delay(10000); //robot go forward
//mot1(1,0,1,0); Serial.println("2"); delay(7000); //reverse
//mot1(0,1,1,0); Serial.println("3"); delay(2000); //left
//mot1(1,0,0,1); Serial.println("4"); delay(2000); //right
Serial.println("SETUP DONE");
}
void forward()
{
digitalWrite(in1, HIGH);
digitalWrite(in2, LOW);
digitalWrite(in4, HIGH);
digitalWrite(in3, LOW);
}
void loop()
{
forward();
}