arduino紅外循跡小車代碼

int left1 = 7;
int left2 = 6;
int right1 = 5;
int right2 = 4;
int left = 13;
int mid = 12;
int right = 11;
 
void setup() {
  // put your setup code here, to run once:
  Serial.begin(9600);
pinMode(left1, OUTPUT);
pinMode(left2, OUTPUT);
pinMode(right1, OUTPUT);
pinMode(right2, OUTPUT);
pinMode(left, INPUT);
pinMode(mid, INPUT);
pinMode(right, INPUT);

}

void qian()
{
digitalWrite(left1,HIGH);
digitalWrite(left2,LOW);
digitalWrite(right1,HIGH);
digitalWrite(right2,LOW);
}
void you()
{
digitalWrite(left1,HIGH);
digitalWrite(left2,LOW);
digitalWrite(right1,LOW);
digitalWrite(right2,LOW);
}

void zuo()
{
digitalWrite(left1,LOW);
digitalWrite(left2,LOW);
digitalWrite(right1,HIGH);
digitalWrite(right2,LOW);
}

void loop() {
  // put your main code here, to run repeatedly:
int r,m,l;
r=digitalRead(right);
m=digitalRead(mid);
l=digitalRead(left);
if(l==LOW&&m==LOW&&r==LOW)
{
  qian();
}
if(l==HIGH&&m==LOW&&r==LOW)
{
  you();
}

if(l==LOW&&m==HIGH&&r==LOW)
{
qian();
delay(1000);
zuo();
delay(900);
}
if(l==LOW&&m==LOW&&r==HIGH)
{
  zuo();
}

}