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

 找回密碼
 立即注冊

QQ登錄

只需一步,快速開始

搜索
查看: 5719|回復(fù): 1
打印 上一主題 下一主題
收起左側(cè)

用三個巡線模塊做的巡線小車電機驅(qū)動的ARDUINO程序

[復(fù)制鏈接]
跳轉(zhuǎn)到指定樓層
樓主
ID:257459 發(fā)表于 2017-12-5 14:44 | 只看該作者 回帖獎勵 |倒序瀏覽 |閱讀模式

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)   //前進
{
  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);     //檢測到左邊傳感器遇到黑線,說明小車右偏了,立即往左轉(zhuǎ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;   //檢測到num2==0說明轉(zhuǎn)過頭了,跳出循環(huán),檢測三個傳感器的狀態(tài)再做出相應(yī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);
  }
}

評分

參與人數(shù) 1黑幣 +50 收起 理由
admin + 50 共享資料的黑幣獎勵!

查看全部評分

分享到:  QQ好友和群QQ好友和群 QQ空間QQ空間 騰訊微博騰訊微博 騰訊朋友騰訊朋友
收藏收藏 分享淘帖 頂 踩
回復(fù)

使用道具 舉報

沙發(fā)
ID:257714 發(fā)表于 2017-12-5 15:03 | 只看該作者
很有幫助
回復(fù)

使用道具 舉報

您需要登錄后才可以回帖 登錄 | 立即注冊

本版積分規(guī)則

小黑屋|51黑電子論壇 |51黑電子論壇6群 QQ 管理員QQ:125739409;技術(shù)交流QQ群281945664

Powered by 單片機教程網(wǎng)

快速回復(fù) 返回頂部 返回列表
主站蜘蛛池模板: 亚洲夜夜爽 | 一区二区三区亚洲 | av午夜激情 | 一区二区久久电影 | 久久精品在线免费视频 | 日本亚洲欧美 | 91在线精品秘密一区二区 | 国产亚洲一区二区精品 | 久久精品国产免费高清 | 欧美成人一区二区三区 | 波多野结衣一区二区 | 91视频大全 | 久久久久久久久久久久久久av | 欧美成人精品一区二区男人看 | 欧美精品一区二区三区在线播放 | 亚洲看片网站 | 五月婷婷中文 | 欧美一区二区久久 | 久久久一区二区三区四区 | 97起碰| 欧美福利视频一区 | 日韩欧美在线观看视频网站 | 伊人久久精品一区二区三区 | 黄色三级在线播放 | 欧美性精品 | 日朝毛片 | 99国产精品久久久久久久 | 久久国产精品免费一区二区三区 | 无码国模国产在线观看 | 九色www| 成人欧美一区二区三区1314 | 精品美女视频在线观看免费软件 | 日韩欧美一区二区三区四区 | 久草www| 七七婷婷婷婷精品国产 | 黄色一级免费观看 | 午夜视频免费在线观看 | 黄色在线播放视频 | 亚洲精品久久 | 99国产精品久久久久 | 黄色片在线观看网址 |