標(biāo)題: 用三個(gè)巡線模塊做的巡線小車電機(jī)驅(qū)動(dòng)的ARDUINO程序 [打印本頁]
作者: 風(fēng)雨無阻666 時(shí)間: 2017-12-5 14:44
標(biāo)題: 用三個(gè)巡線模塊做的巡線小車電機(jī)驅(qū)動(dòng)的ARDUINO程序
void motor(char pin,char pwmpin,char state,int val)
{
pinMode(pin, OUTPUT);
if(state==1)
{
analogWrite(pwmpin,val);
digitalWrite(pin,1);
}
else if(state==2)
{
analogWrite(pwmpin,val);
digitalWrite(pin,0);
}
else if(state==0)
{
analogWrite(pwmpin,0);
digitalWrite(pin,0);
}
}
void runfoward(int i) //前進(jìn)
{
motor(4,5,1,i);
motor(7,6,1,i);
}
void runback(int j) //后退
{
motor(4,5,2,j);
motor(7,6,2,j);
}
void turnL(int m) //左轉(zhuǎn)
{
motor(4,5,1,m);
motor(7,6,0,m);
}
void turnR(int n) //右轉(zhuǎn)
{
motor(4,5,0,n);
motor(7,6,1,n);
}
void stop() //停止
{
motor(4,5,0,0);
motor(7,6,1,0);
}
void setup()
{
Serial.begin(9600);
}
void loop()
{
char num1,num2,num3;
num1=digitalRead(11);
num2=digitalRead(12);
num3=digitalRead(2);
if((num1==0)&&num2&&num3)
{
turnL(180); //檢測(cè)到左邊傳感器遇到黑線，說明小車右偏了，立即往左轉(zhuǎn)一點(diǎn)
delay(2);
while(1){
num2=digitalRead(12); //循環(huán)判斷中間傳感器度數(shù)，
if(num2==1)
{ turnL(180); //如果num2==1說明還沒有轉(zhuǎn)到中間位置，繼續(xù)左轉(zhuǎn)
delay(2);}
else
break; //檢測(cè)到num2==0說明轉(zhuǎn)過頭了，跳出循環(huán)，檢測(cè)三個(gè)傳感器的狀態(tài)再做出相應(yīng)動(dòng)作
} //后面道理相同
}
else if(num2&&num1&&(num3==0))
{
turnR(180);
delay(2);
while(1)
{
num2=digitalRead(12);
if(num2==1){
turnR(180);
delay(2);}
else
break;
}
}
else
{
runfoward(250);
delay(2);
}
}
作者: 1335542 時(shí)間: 2017-12-5 15:03
很有幫助
| 歡迎光臨 (http://www.zg4o1577.cn/bbs/) |
Powered by Discuz! X3.1 |
主站蜘蛛池模板：
亚洲视频二|
亚洲免费大片
|
亚洲电影第三页
|
毛片一区二区三区
|
手机看片在线播放
|
爱草视频
|
日韩视频a|
精品一区二区在线观看
|
91社区在线观看播放
|
免费人成在线观看网站
|
337p日韩
|
久久久久久亚洲精品
|
一区二区三区四区免费在线观看
|
国产精品久久久久久久久
|
亚洲成人网在线观看
|
福利视频网址
|
亚洲欧美国产精品久久
|
男女国产网站
|
亚洲欧美一区二区三区视频
|
日韩在线第一
|
三极网站|
国外成人在线视频
|
精品国产一区二区三区性色av
|
国产精品高潮呻吟久久
|
免费视频中文字幕
|
欧美激情视频一区二区三区在线播放
|
国产精品免费一区二区三区
|
亚洲一区二区三区在线视频
|
午夜免费av
|
综合自拍
|
久久一区|
日日操视频
|
99精品免费视频
|
欧美一区二区三区在线观看
|
久久久久九九九九
|
中文在线一区二区
|
精品一区二区在线观看
|
日韩欧美成人一区二区三区
|
亚洲一区二区三区视频在线
|
久久久久久免费毛片精品
|
国产欧美一区二区三区在线看
|