#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);//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 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 forword Pin
digitalWrite (in4,LOW );//Left Motor backword Pin
}