久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

標題: 求教循跡小車，代碼 [打印本頁]

作者: gugugu123 時間: 2019-4-26 08:52
標題: 求教循跡小車，代碼
int IN1=5;
int IN2=6;//左輪
int IN3=9;
int IN4=10;//右輪
int outputValue = 0;
const int SensorLeft1=A1;//左感測器輸入腳
const int SensorLeft2=A2;
const int SensorRight1=A3;//右感測器輸入腳
const int SensorRight2=A4;
const int ENA=6;
const int ENB=5;
int SL1;
int SL2;//左感測器狀態
int SR1;
int SR2;//右感測器狀態
void setup() {
Serial.begin(9600);
pinMode(IN1,OUTPUT);
pinMode( IN2,OUTPUT);
pinMode( IN3,OUTPUT);
pinMode( IN4,OUTPUT);
pinMode(SensorLeft1,INPUT);
pinMode(SensorLeft2,INPUT);
pinMode(SensorRight1,INPUT);
pinMode(SensorRight2,INPUT);// put your setup code here, to run once:
}

void loop() {
digitalWrite(IN2,LOW);
digitalWrite(IN4,LOW);
SL1=digitalRead(SensorLeft1);
SL2=digitalRead(SensorLeft2);
SR1=digitalRead(SensorRight1);
SR2=digitalRead(SensorRight2);
if (SL1==HIGH &&SL2==HIGH&& SR1==HIGH&& SR2==HIGH)//前進
{delay(1);
analogWrite(ENA,100);
analogWrite(ENB,100);
digitalWrite( IN1,HIGH);
digitalWrite( IN2,LOW);//IN1左電機高電平正轉
digitalWrite( IN3,HIGH);//IN3右電機高電平反轉
digitalWrite( IN4,LOW);
}
else
if(SL1==HIGH&&SL2==HIGH&&SR1==LOW&&SR2==LOW)
{delay(1);
  analogWrite(ENA,50);
  analogWrite(ENB,50);
  digitalWrite(IN1,HIGH);
  digitalWrite(IN2,LOW);
  digitalWrite(IN3,LOW);
  digitalWrite(IN4,HIGH);
}
else
if(SL1==LOW&&SL2==LOW&&SR1==HIGH&&SR2==HIGH)
{delay(1);
  analogWrite(ENA,50);
  analogWrite(ENB,50);
  digitalWrite(IN1,LOW);
  digitalWrite(IN2,HIGH);
  digitalWrite(IN3,HIGH);
  digitalWrite(IN4,LOW);
}
}

歡迎光臨 (http://www.zg4o1577.cn/bbs/)