arduino循迹小车

最新推荐文章于 2024-09-20 13:07:08 发布

GYF_

最新推荐文章于 2024-09-20 13:07:08 发布

阅读量1.3w

点赞数 11

分类专栏： arduino小车

本文链接：https://blog.csdn.net/G1342522389/article/details/46385583

版权

int MotorRight1=14;
int MotorRight2=15;
int MotorLeft1=16;
int MotorLeft2=17;
int MotorRPWM=3;
int MotorLPWM=5;
const int SensorLeft = 2;      //左感測器輸入腳
//const int SensorMiddle= 4 ;    //中感測器輸入腳
const int SensorRight = 6;     //右感測器輸入腳
int SL;    //左感測器狀態
//int SM;    //中感測器狀態
int SR;    //右感測器狀態

void setup()
{  
  Serial.begin(9600);
  pinMode(MotorRight1, OUTPUT);  // 腳位 14 (PWM)
  pinMode(MotorRight2, OUTPUT);  // 腳位 15 (PWM)
  pinMode(MotorLeft1,  OUTPUT);  // 腳位 16 (PWM) 
  pinMode(MotorLeft2,  OUTPUT);  // 腳位 17 (PWM)
  
  pinMode(MotorLPWM,  OUTPUT);  // 腳位 3 (PWM) 
  pinMode(MotorRPWM,  OUTPUT);  // 腳位 5 (PWM)
  
  pinMode(SensorLeft, INPUT); //定義左感測器
 //   pinMode(SensorMiddle, INPUT);//定義中感測器
  pinMode(SensorRight, INPUT); //定義右感測器
}

void loop() 
 {
 SL = digitalRead(SensorLeft);
 // SM = digitalRead(SensorMiddle);
 SR = digitalRead(SensorRight);
       if (SL == LOW&&SR&