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

 找回密碼
 立即注冊

QQ登錄

只需一步,快速開始

帖子
查看: 5744|回復: 1
收起左側

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

[復制鏈接]
ID:257459 發表于 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)     //左轉
{
  motor(4,5,1,m);
  motor(7,6,0,m);
}
void turnR(int 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);     //檢測到左邊傳感器遇到黑線,說明小車右偏了,立即往左轉一點
    delay(2);
    while(1){
    num2=digitalRead(12);       //循環判斷中間傳感器度數,
    if(num2==1)
    {  turnL(180);        //如果num2==1說明還沒有轉到中間位置,繼續左轉
     delay(2);}
     else
     break;   //檢測到num2==0說明轉過頭了,跳出循環,檢測三個傳感器的狀態再做出相應動作
   }      //后面道理相同
   }   
      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);
  }
}

評分

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

查看全部評分

回復

使用道具 舉報

ID:257714 發表于 2017-12-5 15:03 | 顯示全部樓層
很有幫助
回復

使用道具 舉報

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

本版積分規則

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

Powered by 單片機教程網

快速回復 返回頂部 返回列表
主站蜘蛛池模板: 一级特黄毛片 | 国产一区二区三区在线看 | 精品一区二区三区在线观看 | 美日韩在线| 国产91丝袜在线播放 | 欧美精品亚洲 | 国产理论在线 | 一级片观看 | 可以免费看黄的网站 | 久草青青草 | 韩国理论在线 | 久久久久精 | 91精品国产乱码久久久 | 91日韩在线 | 国产一区二区在线观看视频 | 色婷婷导航 | 日韩综合久久 | 黄色精品视频 | 国产成人精品av在线观 | 五月婷婷深深爱 | 日韩成人高清 | 日本久久精品视频 | 中文字幕在线观看免费视频 | 91在线视频播放 | 日韩一级大片 | 精品国产一区二 | 国产一区在线看 | 免费看大片a | 国产精自产拍久久久久久蜜 | 黄色激情视频在线观看 | 欧美色综合天天久久综合精品 | 欧美在线网址 | 999久久久国产精品 亚洲黄色三级 | 色站综合| 福利视频二区 | 中文字幕激情 | 欧美国产日韩一区二区 | 亚洲精品字幕 | 国产精品伦理一区 | 久久久久国产精品夜夜夜夜夜 | 伊人av网 |