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

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 2104|回復: 0
打印 上一主題 下一主題
收起左側(cè)

Arduino尋跡避障小車程序

[復制鏈接]
跳轉(zhuǎn)到指定樓層
樓主
ID:882006 發(fā)表于 2021-8-25 21:43 | 只看該作者 回帖獎勵 |倒序瀏覽 |閱讀模式
  1. int m1=5;
  2. int m2=6;
  3. int m3=9;
  4. int m4=3;
  5. #define TRIG 7
  6. #define ECHO 11
  7. float cm;
  8. float tmp;
  9. float juli;
  10. int out1=A0;
  11. int out2=A1;
  12. int out3=A2;
  13. int out4=A3;
  14. int out5=A4;
  15. int out[5]={0,0,0,0,0,};
  16. int i;
  17. int hx;
  18. int b=0;
  19. int bx;
  20. void setup()
  21. {
  22.    pinMode(m1,OUTPUT);
  23.    pinMode(m2,OUTPUT);
  24.    pinMode(m3,OUTPUT);
  25.    pinMode(m4,OUTPUT);
  26.    Serial.begin(9600);
  27.    pinMode(TRIG,OUTPUT);
  28.    pinMode(ECHO,INPUT);
  29.    pinMode(out1,INPUT);
  30.    pinMode(out2,INPUT);
  31.    pinMode(out3,INPUT);
  32.    pinMode(out4,INPUT);
  33.    pinMode(out5,INPUT);
  34.    i=0;
  35. }
  36. void distance()//定義距離
  37. {
  38.     digitalWrite(TRIG,LOW);
  39.     delayMicroseconds(2);
  40.     digitalWrite(TRIG,HIGH);
  41.     delayMicroseconds(10);
  42.     digitalWrite(TRIG,LOW);
  43.     tmp=float(pulseIn(ECHO,HIGH));
  44.     cm=(tmp*17)/1000;
  45.     Serial.print("Echo=");
  46.     Serial.print(tmp);
  47.     Serial.print(",距離=");
  48.     Serial.print(cm);
  49.     Serial.println("cm");
  50.     juli=cm;
  51. }
  52. void pao()//前進
  53. {
  54.      analogWrite(m1,140);
  55.      analogWrite(m2,0);
  56.      analogWrite(m3,140 );
  57.      analogWrite(m4,0);
  58. }

  60. void zuozhuan()
  61. {
  62.   analogWrite(m1,140);
  63.   analogWrite(m2,0);         
  64.   analogWrite(m3,30);
  65.   analogWrite(m4,0);        
  66. }

  68. void youzhuan()
  69. {
  70.   analogWrite(m1,30);
  71.   analogWrite(m2,0);         
  72.   analogWrite(m3,160);
  73.   analogWrite(m4,0);      
  74. }


  77. void youzhuanj()
  78. {
  79.      analogWrite(m1,0);
  80.      analogWrite(m2,0);
  81.      analogWrite(m3,180);
  82.      analogWrite(m4,0);
  83. }
  84. void zuozhuanj()
  85. {
  86.      analogWrite(m1,150);
  87.      analogWrite(m2,0);
  88.      analogWrite(m3,0);
  89.      analogWrite(m4,0);
  90. }
  91. void shache()//定義剎車
  92. {
  93.     analogWrite(m1,0);
  94.     analogWrite(m2,0);
  95.     analogWrite(m3,0);
  96.     analogWrite(m4,0);
  97.    
  98. }

  100. void youzhijiaowan()
  101. {
  102.     analogWrite(m1,225);
  103.     analogWrite(m2,0);
  104.     analogWrite(m3,30);
  105.     analogWrite(m4,0);
  106. }
  107. void zuozhijiaowan()
  108. {
  109.    analogWrite(m1,0);
  110.     analogWrite(m2,0);
  111.     analogWrite(m3,250);
  112.     analogWrite(m4,0);
  113. }

  115. void xunji()
  116. {
  117.        out[0] = digitalRead(out1);
  118.        out[1] = digitalRead(out2);
  119.        out[2] = digitalRead(out3);
  120.        out[3] = digitalRead(out4);
  121.        out[4] = digitalRead(out5);
  122.        if ( ((out[0] == 0) && (out[1] == 0)&&(out[2] == 0) && (out[3] == 0) && (out[4] == 0)) )
  123.        {
  124.         i=i++;
  125.         if(i==2)
  126.          {
  127.           shache();
  128.           delay(200);
  129.           zuozhijiaowan();
  130.           delay(200);
  131.          }
  132.          else  if(i>=3)
  133.          {
  134.            pao();
  135.            delay(20);
  136.            shache();
  137.          
  138.          }
  139.          else
  140.          pao();
  141.          
  142.         
  143.        }
  144.       else if ((out[0] == 1) && (out[1] == 1) && (out[2] == 1) && (out[3] == 1) && (out[4] == 1))
  145.       
  146.       {
  147.         
  148.         if(bx==0)
  149.         {
  150.           delay(200);
  151.           pao();
  152.         }
  153.       
  154.       }
  155.      
  156.      else if ((out[0] == 1) && (out[1] == 1) && (out[2] == 0) && (out[3] == 1) && (out[4] == 1))
  157.      {
  158.         pao();
  159.      }
  160.     else if ((out[0] == 1) && (out[1] == 0) && (out[2] == 1) && (out[3] == 1) && (out[4] == 1))
  161.     {
  162.      
  163.        youzhuan();
  164.       
  165.     }
  166.     else if ((out[0] == 0) && (out[1] == 1) && (out[2] == 1) && (out[3] == 1) && (out[4] == 1))
  167.     {
  168.       youzhuan();  
  169.      if ((out[0] == 1) && (out[1] == 1) && (out[2] == 1) && (out[3] == 1) && (out[4] == 1))
  170.     {
  171.      zuozhuan();
  172.    
  173.     }
  174.       }
  175.     else if ((out[0] == 1) && (out[1] == 1) && (out[2] == 1) && (out[3] == 0) && (out[4] == 1))
  176.     {
  177.     zuozhuan();
  178.     }
  179.    else if ((out[0] == 1) && (out[1] == 1) && (out[2] == 1) && (out[3] == 1) && (out[4] == 0))
  180.     {
  181.     zuozhuanj();
  182.       if ((out[0] == 1) && (out[1] == 1) && (out[2] == 1) && (out[3] == 1) && (out[4] == 1))
  183.     {
  184.      zuozhuan();
  185.    
  186.     }
  187.     }
  188.    

  190. }

  192. void duankou()
  193. {
  194.      out[0] = digitalRead(out1);
  195.      out[1] = digitalRead(out2);
  196.      out[2] = digitalRead(out3);
  197.      out[3] = digitalRead(out4);
  198.      out[4] = digitalRead(out5);
  199. }
  200. void bizhang()
  201. {
  202.    while(1)
  203.    {
  204.     distance();
  205.     if(juli<=60&&juli>10)
  206.     {
  207.       if(juli<35&&juli>10)
  208.       {
  209.        shache();
  210.        youzhijiaowan();
  211.        delay(70);
  212.         distance();
  213.         if(juli>60)
  214.       
  215.         {
  216.           while(1)
  217.           {
  218.             pao();
  219.             duankou();
  220.             if ((out[0] == 0) || (out[1] == 0) || (out[2] == 0))  
  221.                  {
  222.                       shache();
  223.                       delay(200);
  224.                       zuozhijiaowan();
  225.                       delay(150);
  226.                       break;
  227.                   }
  228.             
  229.           }
  230.                
  231.         }
  232.         
  233.       }
  234.       else
  235.       xunji();
  236.      }
  237.      else
  238.     xunji();
  239.    }
  240. }
  241. void loop()
  242.   {
  243.    bizhang();
  244.   }
復制代碼


評分

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

查看全部評分

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

使用道具 舉報

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

本版積分規(guī)則

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

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

快速回復 返回頂部 返回列表
主站蜘蛛池模板： 在线观看涩涩视频 | 国产综合久久久久久鬼色 | 精品在线免费看 | 久久久国产一区 | 黄色成人国产 | 国产成人精品综合 | 欧美久久久久久久 | 精品久久久久久久久久久 | 国产激情精品视频 | 亚洲一区二区三区免费观看 | 国产精品18久久久 | 日韩精品一区二区三区中文在线 | 日韩精品一区二区三区 | 国产在线中文字幕 | 综合另类 | 欧美一区精品 | 精品久久久久久亚洲精品 | 中文字幕一区二区三区精彩视频 | 日韩一区二区三区视频 | 天天操综合网 | 日韩av一区二区在线观看 | 亚洲精品久久久久中文字幕二区 | 亚洲国产精选 | 国产成人精品一区二区三区网站观看 | 国产亚洲精品成人av久久ww | 在线观看亚洲一区二区 | 不卡一二三区 | 久久av一区二区三区 | 亚洲社区在线 | 91精品国产一区二区三区香蕉 | 国产亚洲第一页 | 日韩欧美国产精品一区二区三区 | 男人的天堂久久 | 99久久婷婷国产综合精品首页 | 欧美国产日韩精品 | 久久久久国产 | 亚洲国产91 | 欧美乱码精品一区二区三区 | 日韩在线资源 | 中文字幕亚洲欧美日韩在线不卡 | 精品中文字幕在线 |