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

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 3013|回復: 0
打印 上一主題 下一主題
收起左側

基于arduino的超聲波，紅外綜合避障源程序

[復制鏈接]
跳轉到指定樓層
樓主
ID:732993 發表于 2020-7-16 18:21 | 只看該作者 回帖獎勵 |倒序瀏覽 |閱讀模式
  1. #define IN1 12//12口電機右正反轉，引腳可調下同
  2. #define IN2 11//11口電機右調速
  3. #define IN3 10//10口電機左正反轉
  4. #define IN4 9//9口電機左調速
  5. #define hN1 4//4口左1紅外
  6. //#define hN2 7//7口左2紅外
  7. #define hN3 8//8口右3紅外

  9. #define Trig 2//超聲波Trig
  10. #define Echo 3//超聲波Echo
  11. #define Trig2 5//超聲波Trig2
  12. #define Echo2 6//超聲波Echo2
  13. int Time=0;//高電平時間
  14. int X=0; //X是距離,單位厘米
  15. int X2=0; //X是距離,單位厘米
  16. long ran;//定義隨機變量（1到4）

  18. int xleft=0;//紅外感應左
  19. //int xzhong=0;//紅外感應中
  20. int xreight=0;//紅外感應右左


  23. void motor(int x,int y)//x=1是后退;x=2是前;x=3是左；x=4是右；y是轉速
  24. {
  25. switch(x){
  26.   case 1:
  27.    digitalWrite(IN1,1);
  28.   analogWrite(IN2,y);
  29.   digitalWrite(IN3,0);
  30.   analogWrite(IN4,y);
  31.   break;
  32.   case 2:
  33.   digitalWrite(IN1,0);
  34.   analogWrite(IN2,y);
  35.   digitalWrite(IN3,1);
  36.   analogWrite(IN4,y);
  37.   break;
  38.   case 3:
  39.   digitalWrite(IN1,0);
  40.   analogWrite(IN2,y);
  41.   digitalWrite(IN3,0);
  42.   analogWrite(IN4,y);
  43.   break;
  44.   case 4:
  45.   digitalWrite(IN1,1);
  46.   analogWrite(IN2,y);
  47.   digitalWrite(IN3,1);
  48.   analogWrite(IN4,y);
  49.   break;
  50.   }
  51.     Serial.println("x=");
  52.   Serial.println(x);
  53. }
  54. void loop() {
  55.        csb();
  56.        ydyd();
  57.    
  58. }


  61. void setup() {
  62.   Serial.begin(9600);
  63. pinMode(IN1,OUTPUT);
  64. pinMode(IN2,OUTPUT);
  65. pinMode(IN3,OUTPUT);
  66. pinMode(IN4,OUTPUT);
  67. pinMode(Trig,OUTPUT);//口是對超聲波輸出波形Trig
  68. pinMode(Echo,INPUT);//口是超聲波反饋Echo
  69. pinMode(hN1,INPUT);//hN1口是1號紅外檢測
  70. //pinMode(hN2,INPUT);//hN2口是2號紅外檢測
  71. pinMode(hN3,INPUT);//hN3口是3號紅外檢測

  73. //randomSeed(analogRead(0));
  74. //attachInterrupt(0,back,RISING);//中斷函數
  75. }





  81. /*void back()
  82. {
  83.   motor(1,120);
  84.   }*/
  85.   
  86.   
  87. void csb(){
  88.    digitalWrite(Trig,LOW);//3口，輸出低電平
  89. delayMicroseconds(2);//等待2微秒
  90. digitalWrite(Trig,HIGH);//3口，輸出高電平
  91. delayMicroseconds(10);//等待10微秒，觸發信號
  92. digitalWrite(Trig,LOW);//拉低電平
  93. Time=pulseIn(Echo,HIGH);//檢測反饋的高電平時間
  94. X=Time/58;//計算距離
  95. digitalWrite(Trig2,LOW);//3口，輸出低電平
  96. delayMicroseconds(2);//等待2微秒
  97. digitalWrite(Trig2,HIGH);//3口，輸出高電平
  98. delayMicroseconds(10);//等待10微秒，觸發信號
  99. digitalWrite(Trig2,LOW);//拉低電平
  100. Time=pulseIn(Echo2,HIGH);//檢測反饋的高電平時間
  101. X2=Time/58;//計算距離
  102. }

  104. void ydyd(){
  105.      xleft=digitalRead(hN1);
  106.     //xzhong=digitalRead(hN2);
  107.    xreight=digitalRead(hN3);
  108. if(X>=5)
  109. {
  110.   motor(1,100);
  111.   delay(1000);
  112.   }
  113.   else
  114.   {     
  115.        if((xleft==1)&&(xreight==1))
  116.         {
  117.          // ran=random (2,5);   
  118.           motor(2,120);
  119.          
  120.            
  121.         }
  122.       if((xleft==0)&&(xreight==1))
  123.         {
  124.           motor(3,100);
  125.         }
  126.        if((xleft==1)&&(xreight==0))
  127.         {
  128.           motor(4,100);
  129.         }

  131.        if((xleft==0)&&(xreight==0))
  132.         {
  133.            digitalWrite(IN1,0);
  134.             analogWrite(IN2,0);
  135.             digitalWrite(IN3,0);
  136.             analogWrite(IN4,0);
  137.         }   
  138.         if(X2>=5)
  139.         {
  140.       motor(2,100);
  141.       delay(1000);
  142.           }                 
  143.     }

  145.     Serial.println("X=");
  146.   Serial.println(X);
  147.       Serial.println("x1=");
  148.   Serial.println(xleft);
  149.         Serial.println("xr=");
  150.   Serial.println(xreight);
  151. }
復制代碼


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

使用道具 舉報

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

本版積分規則

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

Powered by 單片機教程網

快速回復 返回頂部 返回列表
主站蜘蛛池模板： 欧美一区二区三区在线视频 | 精品国产精品国产偷麻豆 | 免费精品久久久久久中文字幕 | 在线看片网站 | 久久久日韩精品一区二区三区 | 久久男人| 欧美日韩国产三级 | 四虎影视一区二区 | 久久国产精品-国产精品 | 97超碰成人 | 很很干很很日 | 丝袜美腿一区二区三区 | 天天插天天舔 | 亚州av| 草比网站| 亚洲欧美日本在线 | 久久久久国产一区二区三区 | 精品一二三区视频 | 久久国产精品-国产精品 | 人人射人人| 99精品国产一区二区三区 | 日韩av成人在线观看 | 国产一区二区在线91 | 精品欧美黑人一区二区三区 | 日韩欧美国产精品一区二区三区 | 狠狠躁躁夜夜躁波多野结依 | 亚洲网站在线播放 | 2022精品国偷自产免费观看 | 国产精品一区二区av | 欧美理论在线观看 | 国产一区二区三区在线 | 国产一区二区三区精品久久久 | 亚洲一二视频 | 日韩欧美国产精品 | 观看毛片 | 亚洲精品一区中文字幕乱码 | 成人精品高清 | 午夜一级大片 | 欧美亚州 | 国产精品无码专区在线观看 | 亚洲一一在线 |