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();
}
}
arduino红外循迹小车代码
最新推荐文章于 2024-07-08 23:19:15 发布