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

標題: 用arduino nano做的蜘蛛機器人 手機APP藍牙遙控+超聲波避障 [打印本頁]
作者: tanghuiwen    時間: 2020-2-14 17:34
標題: 用arduino nano做的蜘蛛機器人 手機APP藍牙遙控+超聲波避障
（新手）用arduino nano做的簡易蜘蛛機器人，可通過手機APP藍牙串口控制，也可用超聲波避障行走。實物圖看起來有點粗糙，畢竟是寒門子弟在家操手做的，但效果還是可以的。
1、藍牙使用的是HC-05，串口軟件用的是SPP（附件里有）

2、電機是常見的130小電機，帶減速箱。驅動也是常見的L298N.
3、電池用的是兩節串聯的18650鋰電池（電壓7.4v）
4、結構部分是從某寶上20塊買來的益智拼裝玩具蜘蛛機器人，由于單個電機驅動不能實現拐彎，
  自己改成了兩個電機驅動
5、超聲波使用的是常見的4引腳SR04，舵機用的是9g小舵機。


為方便小伙伴們的交流，源代碼已貼出，新手水平有限，望笑納。
  1. #include <Servo.h>
  2. int ENA=3,ENB=9;
  3. int IN1=4;
  4. int IN2=5;
  5. int IN3=7;
  6. int IN4=8;

  8. int trig=A0,echo=A1;//發射、接收
  9. unsigned int juli;//距離
  10. Servo dj;//舵機
  11. void setup()
  12. {
  13.   pinMode(ENA,OUTPUT);
  14.   pinMode(ENB,OUTPUT);
  15.   pinMode(IN1,OUTPUT);
  16.   pinMode(IN2,OUTPUT);
  17.   pinMode(IN3,OUTPUT);
  18.   pinMode(IN4,OUTPUT);
  19.   Serial.begin(9600);
  20.   

  22.   pinMode(trig,OUTPUT);
  23.   pinMode(echo,INPUT);
  24.   dj.attach(11);//舵機引腳
  25.   dj.write(90);//角度
  26. }
  27. void ceju()
  28. {
  29.   digitalWrite(trig,LOW); //測距
  30. delayMicroseconds(2); //延時2微秒
  31. digitalWrite(trig,1);
  32. delayMicroseconds(20);
  33. digitalWrite(trig,0);
  34. int distance = pulseIn(echo,1); //讀取高電平時間.pulseIn函數用于讀取引腳脈沖的時間長度，脈沖可以是HIGH或LOW。如果是HIGH，函數將先等引腳變為高電平，然后開始計時，一直到變為低電平為止。返回脈沖持續的時間長短, 單位為ms。如果超時還沒有讀到的話, 將返回0。
  35. distance = distance/58; //按照公式計算
  36. juli = distance; //把值賦給S
  37. Serial.println(juli); //向串口發送S的值，可以在顯示器上顯示距離
  38. if (juli<30)
  39. {
  40. delay(50); //延時
  41. }
  42.   }
  43.   void chaoshengbo()
  44.   {
  45.     dj.write(90);
  46.     ceju();
  47.     if(juli<10)
  48.     {
  49.       houtui();
  50.       delay(300);
  51.       }
  52.       if(juli>10&&juli<=40)
  53.      { turn();
  54.     }
  55.     if(juli>40)
  56.     {
  57.       qianjin();
  58.       }
  59.   }
  60.   
  61.   void turn()
  62.   { //判斷轉向函數
  63. ting(); //停止所用電機
  64. dj.write(170); //舵機轉到170度既左邊（角度與安裝方式有關）
  65. delay(500); //留時間給舵機轉向
  66. ceju(); //運行測距函數
  67. dj.write(90); //測距完成，舵機回到中位
  68. delay(600); //留時間給舵機轉向
  69. if (juli>30) {qianzuo();} //判斷左邊障礙物距離，如果距離充足,運行左轉
  70. else {
  71. dj.write(10); //否則，舵機轉動到10度，測右邊距離
  72. delay(600);
  73. ceju(); //測距
  74. dj.write(90); //中位
  75. delay(600);
  76. if(juli>30){qianyou();
  77. } //右轉
  78. else{ houtui(); //判斷右邊距離，距離充足右轉否則后退
  79. int x=random(1); //產生一個0到1的隨機數
  80. if (x=0){qianyou();}
  81. else{qianzuo();} //判斷隨機數
  82. } //否則后退，并隨機轉向
  83. }
  84. }
  85. void qianjin()
  86. {
  87.   analogWrite(ENA,250);
  88.   analogWrite(ENB,250);
  89.    digitalWrite(IN1,1);
  90.     digitalWrite(IN2,0);
  91.      digitalWrite(IN3,1);
  92.       digitalWrite(IN4,0);
  93.   }
  94.   void houtui()
  95. {
  96.   analogWrite(ENA,250);
  97.   analogWrite(ENB,250);
  98.    digitalWrite(IN1,0);
  99.     digitalWrite(IN2,1);
  100.      digitalWrite(IN3,0);
  101.       digitalWrite(IN4,1);
  102.   }
  103.   void qianzuo()
  104. {
  105.   analogWrite(ENA,0);
  106.   analogWrite(ENB,200);
  107.    digitalWrite(IN1,0);
  108.     digitalWrite(IN2,0);
  109.      digitalWrite(IN3,1);
  110.       digitalWrite(IN4,0);
  111.   }
  112.   void qianyou()
  113. {
  114.   analogWrite(ENA,200);
  115.   analogWrite(ENB,0);
  116.    digitalWrite(IN1,1);
  117.     digitalWrite(IN2,0);
  118.      digitalWrite(IN3,0);
  119.       digitalWrite(IN4,0);
  120.   }
  121.   void houzuo()
  122. {
  123.   analogWrite(ENA,0);
  124.   analogWrite(ENB,200);
  125.    digitalWrite(IN1,0);
  126.     digitalWrite(IN2,0);
  127.      digitalWrite(IN3,0);
  128.       digitalWrite(IN4,1);
  129.   }
  130.   void houyou()
  131. {
  132.   analogWrite(ENA,200);
  133.   analogWrite(ENB,0);
  134.    digitalWrite(IN1,0);
  135.     digitalWrite(IN2,1);
  136.      digitalWrite(IN3,0);
  137.       digitalWrite(IN4,0);
  138.   }
  139.   void shunshi()
  140. {
  141.   analogWrite(ENA,250);
  142.   analogWrite(ENB,250);
  143.    digitalWrite(IN1,1);
  144.     digitalWrite(IN2,0);
  145.      digitalWrite(IN3,0);
  146.       digitalWrite(IN4,1);
  147.   }
  148.   void nishi()
  149. {
  150.   analogWrite(ENA,250);
  151.   analogWrite(ENB,250);
  152.    digitalWrite(IN1,0);
  153.     digitalWrite(IN2,1);
  154.      digitalWrite(IN3,1);
  155.       digitalWrite(IN4,0);
  156.   }
  157.   void ting()
  158. {
  159.    digitalWrite(IN1,0);
  160.     digitalWrite(IN2,0);
  161.      digitalWrite(IN3,0);
  162.       digitalWrite(IN4,0);
  163.   }
  164.   
  165. void loop() {
  166.   
  167.   if(Serial.available())
  168.   {
  169.     char i=Serial.read();
  170.     switch(i)
  171.     {
  172.       case'b':qianzuo();break;
  173.       case'c':qianjin();break;
  174.       case'd':qianyou();break;
  175.       case'e':nishi();break;
  176.       case'f':ting();break;
  177.       case'g':shunshi();break;
  178.       case'h':houzuo();break;
  179.       case'i':houtui();break;
  180.       case'j':houyou();break;
  181.       case'a':chaoshengbo();break;
  182.       //case'k':gunf();break;
  183.       //case'l':gunt();break;
  184.       }
  185.     }
  186. }
復制代碼
全部資料51hei下載地址：
自制蜘蛛機器人.zip (6.87 MB, 下載次數: 61)

作者: stdperiph    時間: 2021-1-6 23:43
請問需要降壓模塊嗎，電壓7.4有點大是不是



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