欧美极品高清xxxxhd,国产日产欧美最新,无码AV国产东京热AV无码,国产精品人与动性XXX,国产传媒亚洲综合一区二区,四库影院永久国产精品,毛片免费免费高清视频,福利所导航夜趣136

標題: 基于arduino的超聲波避障源碼 [打印本頁]

作者: acolasia    時間: 2018-7-23 11:23
標題: 基于arduino的超聲波避障源碼
定義多個函數,可以自己選擇

arduino源程序如下:
  1. int Echo = A1;  // Echo回聲腳(P2.0)
  2. int Trig =A0;  //  Trig 觸發腳(P2.1)

  3. int Distance = 0;

  4. int Left_motor_go=8;     //左電機前進(IN1)
  5. int Left_motor_back=9;     //左電機后退(IN2)

  6. int Right_motor_go=10;    // 右電機前進(IN3)
  7. int Right_motor_back=11;    // 右電機后退(IN4)

  8. int key=A2;//定義按鍵 A2 接口
  9. int beep=A3;//定義蜂鳴器 A3 接口

  10. void setup()
  11. {
  12.   pinMode(Left_motor_go,OUTPUT); // PIN 8 (PWM)
  13.   pinMode(Left_motor_back,OUTPUT); // PIN 9 (PWM)
  14.   pinMode(Right_motor_go,OUTPUT);// PIN 10 (PWM)
  15.   pinMode(Right_motor_back,OUTPUT);// PIN 11 (PWM)
  16.   pinMode(key,INPUT);//定義按鍵接口為輸入接口
  17.   pinMode(beep,OUTPUT);
  18.   pinMode(Echo, INPUT);    // 定義超聲波輸入腳
  19.   pinMode(Trig, OUTPUT);   // 定義超聲波輸出腳
  20. }
  21. //=======================智能小車的基本動作=========================
  22. //void run(int time)     // 前進
  23. void run()     // 前進
  24. {
  25.   digitalWrite(Right_motor_go,HIGH);  // 右電機前進
  26.   digitalWrite(Right_motor_back,LOW);     
  27.   analogWrite(Right_motor_go,150);//0~255調速,左右輪差異略增減
  28.   analogWrite(Right_motor_back,0);
  29.   digitalWrite(Left_motor_go,LOW);  // 左電機前進
  30.   digitalWrite(Left_motor_back,HIGH);
  31.   analogWrite(Left_motor_go,0);//PWM比例0~255調速,左右輪差異略增減
  32.   analogWrite(Left_motor_back,150);
  33.   //delay(time * 100);   //執行時間,可以調整  
  34. }

  35. void brake(int time)  //剎車,停車
  36. {
  37.   digitalWrite(Right_motor_go,LOW);
  38.   digitalWrite(Right_motor_back,LOW);
  39.   digitalWrite(Left_motor_go,LOW);
  40.   digitalWrite(Left_motor_back,LOW);
  41.   delay(time * 100);//執行時間,可以調整  
  42. }

  43. //void left(int time)         //左轉(左輪不動,右輪前進)
  44. void left()         //左轉(左輪不動,右輪前進)
  45. {
  46.   digitalWrite(Right_motor_go,HIGH);        // 右電機前進
  47.   digitalWrite(Right_motor_back,LOW);
  48.   analogWrite(Right_motor_go,150);
  49.   analogWrite(Right_motor_back,0);//PWM比例0~255調速
  50.   digitalWrite(Left_motor_go,LOW);   //左輪后退
  51.   digitalWrite(Left_motor_back,LOW);
  52.   analogWrite(Left_motor_go,0);
  53.   analogWrite(Left_motor_back,0);//PWM比例0~255調速
  54.   //delay(time * 100);        //執行時間,可以調整  
  55. }

  56. void spin_left(int time)         //左轉(左輪后退,右輪前進)
  57. {
  58.   digitalWrite(Right_motor_go,HIGH);        // 右電機前進
  59.   digitalWrite(Right_motor_back,LOW);
  60.   analogWrite(Right_motor_go,150);
  61.   analogWrite(Right_motor_back,0);//PWM比例0~255調速
  62.   digitalWrite(Left_motor_go,HIGH);   //左輪后退
  63.   digitalWrite(Left_motor_back,LOW);
  64.   analogWrite(Left_motor_go,150);
  65.   analogWrite(Left_motor_back,0);//PWM比例0~255調速
  66.   delay(time * 100);        //執行時間,可以調整  
  67. }

  68. void right(int time)
  69. //void right()        //右轉(右輪不動,左輪前進)
  70. {
  71.   digitalWrite(Right_motor_go,LOW);   //右電機后退
  72.   digitalWrite(Right_motor_back,LOW);
  73.   analogWrite(Right_motor_go,0);
  74.   analogWrite(Right_motor_back,0);//PWM比例0~255調速
  75.   digitalWrite(Left_motor_go,LOW);//左電機前進
  76.   digitalWrite(Left_motor_back,HIGH);
  77.   analogWrite(Left_motor_go,0);
  78.   analogWrite(Left_motor_back,150);//PWM比例0~255調速
  79.   delay(time * 100);        //執行時間,可以調整  
  80. }

  81. void spin_right(int time)        //右轉(右輪后退,左輪前進)
  82. {
  83.   digitalWrite(Right_motor_go,LOW);   //右電機后退
  84.   digitalWrite(Right_motor_back,HIGH);
  85.   analogWrite(Right_motor_go,0);
  86.   analogWrite(Right_motor_back,150);//PWM比例0~255調速
  87.   digitalWrite(Left_motor_go,LOW);//左電機前進
  88.   digitalWrite(Left_motor_back,HIGH);
  89.   analogWrite(Left_motor_go,0);
  90.   analogWrite(Left_motor_back,150);//PWM比例0~255調速
  91.   delay(time * 100);        //執行時間,可以調整        
  92. }

  93. void back(int time)          //后退
  94. {
  95.   digitalWrite(Right_motor_go,LOW);  //右輪后退
  96.   digitalWrite(Right_motor_back,HIGH);
  97.   analogWrite(Right_motor_go,0);
  98.   analogWrite(Right_motor_back,150);//PWM比例0~255調速
  99.   digitalWrite(Left_motor_go,HIGH);  //左輪后退
  100.   digitalWrite(Left_motor_back,LOW);
  101.   analogWrite(Left_motor_go,150);
  102.   analogWrite(Left_motor_back,0);//PWM比例0~255調速
  103.   delay(time * 100);     //執行時間,可以調整   
  104. }
  105. //==========================================================

  106. void keysacn()//按鍵掃描
  107. {
  108.   int val;
  109.   val=digitalRead(key);//讀取數字7 口電平值賦給val
  110.   while(!digitalRead(key))//當按鍵沒被按下時,一直循環
  111.   {
  112.     val=digitalRead(key);//此句可省略,可讓循環跑空
  113.   }
  114.   while(digitalRead(key))//當按鍵被按下時
  115.   {
  116.     delay(10);        //延時10ms
  117.     val=digitalRead(key);//讀取數字7 口電平值賦給val
  118.     if(val==HIGH)  //第二次判斷按鍵是否被按下
  119.     {
  120.       digitalWrite(beep,HIGH);                //蜂鳴器響
  121.       while(!digitalRead(key))        //判斷按鍵是否被松開
  122.         digitalWrite(beep,LOW);                //蜂鳴器停止
  123.     }
  124.     else
  125.       digitalWrite(beep,LOW);          //蜂鳴器停止
  126.   }
  127. }

  128. void Distance_test()   // 量出前方距離
  129. {
  130.   digitalWrite(Trig, LOW);   // 給觸發腳低電平2μs
  131.   delayMicroseconds(2);
  132.   digitalWrite(Trig, HIGH);  // 給觸發腳高電平10μs,這里至少是10μs
  133.   delayMicroseconds(10);
  134.   digitalWrite(Trig, LOW);    // 持續給觸發腳低電
  135.   float Fdistance = pulseIn(Echo, HIGH);  // 讀取高電平時間(單位:微秒)
  136.   Fdistance= Fdistance/58;       //為什么除以58等于厘米,  Y米=(X秒*344)/2
  137.   // X秒=( 2*Y米)/344 ==》X秒=0.0058*Y米 ==》厘米=微秒/58
  138.   Distance = Fdistance;
  139. }  
  140. void loop()
  141. {
  142.   keysacn();           //調用按鍵掃描函數
  143.   while(1)
  144.   {
  145.     Distance_test();//測量前方距離
  146.     if(Distance < 30)//數值為碰到障礙物的距離,可以按實際情況設置
  147.       while(Distance < 30)//再次判斷是否有障礙物,若有則轉動方向后,繼續判斷
  148.       {
  149.         back(2);   
  150.         spin_right(1);//右轉
  151.         digitalWrite(beep,HIGH);          //蜂鳴器響
  152.         Distance_test();//測量前方距離
  153.   
  154.       }
  155.     else
  156.       
  157.       {
  158.         run();//無障礙物,直行
  159.         digitalWrite(beep,LOW);  
  160.       }
  161.   }
  162. }
復制代碼

所有資料51hei提供下載:
avoid_ultrasonic.zip (1.95 KB, 下載次數: 11)







歡迎光臨 (http://m.raoushi.com/bbs/) Powered by Discuz! X3.1