const int pin1L = 10;
const int pin2L = 9;
const int speedPinL = 8;
const int pin1R = 12;
const int pin2R = 11;
const int speedPinR = 13;
void mode_pin()
{
pinMode(pin1L, OUTPUT);
pinMode(pin2L, OUTPUT);
pinMode(speedPinL, OUTPUT);
pinMode(pin1R, OUTPUT);
pinMode(pin2R, OUTPUT);
pinMode(speedPinR, OUTPUT);
stop();
}
void set_Motorspeed(int speed_L,int speed_R)
{
analogWrite(speedPinL,speed_L);
analogWrite(speedPinR,speed_R);
}
void go_Forward(void)
{
digitalWrite(pin1L,true);
digitalWrite(pin2L,!true);
digitalWrite(pin1R,true);
digitalWrite(pin2R,!true);
}
void go_Left(void)
{
digitalWrite(pin1L,true);
digitalWrite(pin2L,!true);
digitalWrite(pin1R,!true);
digitalWrite(pin2R,true);
}
void go_Right(void)
{
digitalWrite(pin1L,!true);
digitalWrite(pin2L,true);
digitalWrite(pin1R,true);
digitalWrite(pin2R,!true);
}
void go_Back(void)
{
digitalWrite(pin1L,!true);
digitalWrite(pin2L,true);
digitalWrite(pin1R,!true);
digitalWrite(pin2R,true);
}
void stop()
{
digitalWrite(pin1L,!true);
digitalWrite(pin2L,!true);
digitalWrite(pin1R,!true);
digitalWrite(pin2R,!true);
}
void setup()
{
mode_pin();
go_Forward();
set_Motorspeed(255,255);
delay(2000);
go_Back();
set_Motorspeed(255,255);
delay(2000);
go_Left();
set_Motorspeed(255,255);
delay(5000);
go_Right();
set_Motorspeed(255,255);
delay(1000);
stop();
}