#define LM1 2
#define LM2 3
#define RM1 4
#define RM2 5
int i;
void setup()
{
for (i=2; i<6; i++)
pinMode(i, OUTPUT);
}
void loop()
{
RobotGo();
delay(2000);
Robotleft();
delay(500);
RobotGo() ;
delay(2000);
Robotleft();
delay(500);
RobotGo() ;
delay(2000);
RobotRhigt();
delay(500);
RobotGo() ;
delay(2000);
RobotRhigt();
delay(500);
RobotGo() ;
delay(2000);
}
void RobotGo()
{
digitalWrite(LM1,0);
digitalWrite(LM2,1);
digitalWrite(RM1,0);
digitalWrite(RM2,1);
}
void RobotBack()
{
digitalWrite(LM1,1);
digitalWrite(LM2,0);
digitalWrite(RM1,1);
digitalWrite(RM2,0);
}
void RobotStop()
{
digitalWrite(LM1,0);
digitalWrite(LM2,0);
digitalWrite(RM1,0);
digitalWrite(RM2,0);
}
void RobotRhigt()
{
digitalWrite(LM1,0);
digitalWrite(LM2,1);
digitalWrite(RM1,0);
digitalWrite(RM2,0);
}
void Robotleft()
{
digitalWrite(LM1,0);
digitalWrite(LM2,0);
digitalWrite(RM1,0);
digitalWrite(RM2,1);
}