#define in1 2//Motor1 ON
#define in2 15//Motor1 OFF
#define in3 13//Motor2 OFF
#define in4 12//Motor2 ON
void setup(){
pinMode(in1, OUTPUT);
pinMode(in2, OUTPUT);
pinMode(in3, OUTPUT);
pinMode(in4, OUTPUT);
}
void loop() {
forward();
delay(1000);
turnRight();
delay(1000);
turnLeft();
delay(1000);
Stop();
delay(5000);
}
void forward() {//Maju
digitalWrite(in1, HIGH);//Motor kanan pin maju
digitalWrite(in2, LOW);//Right Motor backword Pin
digitalWrite(in3, LOW);//Left Motor backword Pin
digitalWrite(in4, HIGH);//Left Motor forword Pin
}
void turnRight() {//Kanan
digitalWrite(in1, LOW);//Right Motor forword pin
digitalWrite(in2, HIGH);//Right Motor backword pin
digitalWrite(in3, LOW);//Left Motor backword pin
digitalWrite(in4, HIGH);//Left Motor forword pin
}
void turnLeft(){//Kiri
digitalWrite(in1, HIGH);//Right Motor forword pin
digitalWrite(in2, LOW);//Right Motor backword pin
digitalWrite(in3, HIGH);//Left Motor backword pin
digitalWrite(in4, LOW);//Left Motor forword pin
}
void Stop(){ //Stop
digitalWrite(in1, LOW);//Right Motor forword pin
digitalWrite(in2, LOW);//Right Motor backword pin
digitalWrite(in3, LOW);//Left Motor backword pin
digitalWrite(in4, LOW);//Left Motor forword pin
}