arduino循迹小车
2015-06-06 09:43
861 查看
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==LOW)// { digitalWrite(MotorRight1,HIGH); digitalWrite(MotorRight2,LOW); analogWrite(MotorRPWM,150); digitalWrite(MotorLeft1,HIGH); digitalWrite(MotorLeft2,LOW); analogWrite(MotorLPWM,150); } else // { if (SL == HIGH & SR == LOW)// 左黑右白, 快速左轉 { delay(1); digitalWrite(MotorRight1,HIGH); digitalWrite(MotorRight2,LOW); analogWrite(MotorRPWM,130); digitalWrite(MotorLeft1,LOW); digitalWrite(MotorLeft2,LOW); } else if (SR == HIGH & SL == LOW) // 左白右黑, 快速右轉 { delay(1); digitalWrite(MotorRight1,LOW); digitalWrite(MotorRight2,LOW); digitalWrite(MotorLeft1,HIGH); digitalWrite(MotorLeft2,LOW); analogWrite(MotorLPWM,130); } else // 都是白色, 停止 { digitalWrite(MotorRight1,LOW); digitalWrite(MotorRight2,LOW); digitalWrite(MotorLeft1,LOW); digitalWrite(MotorLeft2,LOW);; }}}
相关文章推荐
- 我的arduino小车安装过程
- arduino小车图片
- arduino小车照片!!!!
- arduino小车最新版!!!!!
- Repeated DNA Sequences
- 关于while(std::cin>>value)
- UITextField 光标的位置获取和设置
- Part3 Arduino基本函数
- Android之基本常见知识(持续更新) getwindow() requestWindowFeature()
- 高效位运算 __builtin_系列函数
- Arduino程序设计-C基础
- POJ 1679 THE UNIQUE MST 【次小生成树】
- POJ 2785 4 VALUES WHOSE SUM IS 0 【折半枚举】
- LIGHTOJ 1255-SUBSTRING FREQUENCY 【KMP】
- iOS Programming: The Big Nerd Ranch Guide (4th Edition) 阅读笔记-关于View和View Hierarchy
- OpenCSP开源程序解析之OPENCSP_AuthUI.cpp
- JavaWeb系列之七(response域与request)
- UITableViewCell重用和性能优化
- iOS学习笔记(2)— UIView用户事件响应
- org.json.JSONException: No value for xxx