😭😭😭
#include <Servo.h>
#define leftA_track_PIN 30
#define leftB_track_PIN 31
#define middle_track_PIN 32
#define righA_track_PIN 33
#define righB_track_PIN 34
Servo myservo;
void setup() {
Serial.begin(9600); //串口波特率9600(PC端使用)
myservo.attach(11);
pinMode (leftA_track_PIN, INPUT); //设置引脚为输入引脚
pinMode (leftB_track_PIN, INPUT); //设置引脚为输入引脚
pinMode (middle_track_PIN, INPUT);//设置引脚为输入引脚
pinMode (righA_track_PIN, INPUT); //设置引脚为输入引脚
pinMode (righB_track_PIN, INPUT); //设置引脚为输入引脚
}
void turnright (){
myservo.write(120);
}
void loop() {
int sensorA = digitalRead(leftA_track_PIN);
int sensorB = digitalRead(leftB_track_PIN);
int sensorC = digitalRead(middle_track_PIN);
int sensorD = digitalRead(righA_track_PIN);
int sensorE = digitalRead(righB_track_PIN);
if ((sensorB == 0) && (sensorC == 0) && (sensorD == 0)&&(sensorE == 0) && (sensorA == 0))
{
myservo.write(90);
Serial.println(1);
} else if ((sensorB == 1) && (sensorC == 1) && (sensorD == 1)&&(sensorE == 1)&&(sensorA == 1)) {
myservo.write(90);
Serial.println(1);
} else if ((sensorB == 1) && (sensorC == 0) && (sensorD == 0)&&(sensorE == 0)&&(sensorA == 1)) {
turnright();
Serial.println(8);
} else if ((sensorB == 1) && (sensorC == 1) && (sensorD == 0)&&(sensorE == 0)&&(sensorA == 1)) {
myservo.write(135);
Serial.println(6) ;
} else if ((sensorB == 1) && (sensorC == 1) && (sensorD == 1)&&(sensorE == 0)&&(sensorA == 1)) {
myservo.write(150);
Serial.println(4);
} else if ((sensorB == 1) && (sensorC == 0) && (sensorD == 1)&&(sensorE == 1)&&(sensorA == 1)) {
myservo.write(90);
Serial.println(2);
} else if ((sensorB == 0) && (sensorC == 0) && (sensorD == 0)&&(sensorE == 1)&&(sensorA == 1)) {
myservo.write(90);
Serial.println(2); ;
} else if ((sensorB == 0) && (sensorC == 0) && (sensorD == 1)&&(sensorE == 1)&&(sensorA == 0)) {
myservo.write(70);
Serial.println(7) ;
} else if ((sensorB == 0) && (sensorC == 1) && (sensorD == 1)&&(sensorE == 1)&&(sensorA == 0)) {
myservo.write(55);
Serial.println(5);
} else if ((sensorB == 1) && (sensorC == 1) && (sensorD == 1)&&(sensorE == 1)&&(sensorA == 0)) {
myservo.write(30);
Serial.println(3);
}
}
#include <Servo.h>
#define leftA_track_PIN 30
#define leftB_track_PIN 31
#define middle_track_PIN 32
#define righA_track_PIN 33
#define righB_track_PIN 34
Servo myservo;
void setup() {
Serial.begin(9600); //串口波特率9600(PC端使用)
myservo.attach(11);
pinMode (leftA_track_PIN, INPUT); //设置引脚为输入引脚
pinMode (leftB_track_PIN, INPUT); //设置引脚为输入引脚
pinMode (middle_track_PIN, INPUT);//设置引脚为输入引脚
pinMode (righA_track_PIN, INPUT); //设置引脚为输入引脚
pinMode (righB_track_PIN, INPUT); //设置引脚为输入引脚
}
void turnright (){
myservo.write(120);
}
void loop() {
int sensorA = digitalRead(leftA_track_PIN);
int sensorB = digitalRead(leftB_track_PIN);
int sensorC = digitalRead(middle_track_PIN);
int sensorD = digitalRead(righA_track_PIN);
int sensorE = digitalRead(righB_track_PIN);
if ((sensorB == 0) && (sensorC == 0) && (sensorD == 0)&&(sensorE == 0) && (sensorA == 0))
{
myservo.write(90);
Serial.println(1);
} else if ((sensorB == 1) && (sensorC == 1) && (sensorD == 1)&&(sensorE == 1)&&(sensorA == 1)) {
myservo.write(90);
Serial.println(1);
} else if ((sensorB == 1) && (sensorC == 0) && (sensorD == 0)&&(sensorE == 0)&&(sensorA == 1)) {
turnright();
Serial.println(8);
} else if ((sensorB == 1) && (sensorC == 1) && (sensorD == 0)&&(sensorE == 0)&&(sensorA == 1)) {
myservo.write(135);
Serial.println(6) ;
} else if ((sensorB == 1) && (sensorC == 1) && (sensorD == 1)&&(sensorE == 0)&&(sensorA == 1)) {
myservo.write(150);
Serial.println(4);
} else if ((sensorB == 1) && (sensorC == 0) && (sensorD == 1)&&(sensorE == 1)&&(sensorA == 1)) {
myservo.write(90);
Serial.println(2);
} else if ((sensorB == 0) && (sensorC == 0) && (sensorD == 0)&&(sensorE == 1)&&(sensorA == 1)) {
myservo.write(90);
Serial.println(2); ;
} else if ((sensorB == 0) && (sensorC == 0) && (sensorD == 1)&&(sensorE == 1)&&(sensorA == 0)) {
myservo.write(70);
Serial.println(7) ;
} else if ((sensorB == 0) && (sensorC == 1) && (sensorD == 1)&&(sensorE == 1)&&(sensorA == 0)) {
myservo.write(55);
Serial.println(5);
} else if ((sensorB == 1) && (sensorC == 1) && (sensorD == 1)&&(sensorE == 1)&&(sensorA == 0)) {
myservo.write(30);
Serial.println(3);
}
}

