#define LED1 22
#define LED2 2
#define LED3 26
#define LED4 25
int num;
void rightturn();
void leftturn();
void forward();
void backward();
void setup()
{
pinMode(LED1, OUTPUT);
pinMode(LED2, OUTPUT);
pinMode(LED3, OUTPUT);
pinMode(LED4, OUTPUT);
Serial.begin(115200);
}
void loop()
{
if (Serial.available())
{
int num=Serial.read();
Serial.println(num);
if(num=='1')
rightturn();
else if(num=='2')
leftturn();
else if(num=='3')
forward();
else if(num=='4')
backward();
}
}
void rightturn()
{
digitalWrite(LED1, LOW);
digitalWrite(LED2, LOW);
digitalWrite(LED3, HIGH);
digitalWrite(LED4, HIGH);
}
void leftturn()
{
digitalWrite(LED1, HIGH);
digitalWrite(LED2, HIGH);
digitalWrite(LED3, LOW);
digitalWrite(LED4, LOW);
}
void forward()
{
digitalWrite(LED1, HIGH);
digitalWrite(LED2, HIGH);
digitalWrite(LED3, HIGH);
digitalWrite(LED4, HIGH);
}
void backward()
{
digitalWrite(LED1, HIGH);
digitalWrite(LED2, HIGH);
digitalWrite(LED3, HIGH);
digitalWrite(LED4, HIGH);
}