# define in1 2 // Motor 1 ON
# define in2 15 // motor 1 OFF
# define in3 13 // Motor 2 ON
# define in4 12 // Motor 2 OFF
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);//Right Motor forword Pin
digitalWrite (in2, LOW);//Right Motor forword Pin
digitalWrite (in3, LOW);//Left Motor forword Pin
digitalWrite (in4, HIGH);//Left Motor forword Pin
}
void turnRight (){ //Kanan
digitalWrite (in1, LOW);//Right Motor foreord 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);//Right 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
}