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

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 2829|回復(fù): 0
收起左側(cè)

arduino小車控制程序，包含與樹莓派通信程序

[復(fù)制鏈接]
ID:404916 發(fā)表于 2018-10-2 19:31 | 顯示全部樓層 |閱讀模式
小車控制程序，包含與樹莓派通信程序
0.png

單片機(jī)源程序如下:

  2. int PWMA=10;
  3. int IN1 = 10;
  4. int IN2 = 9;
  5. int PWMB = 6;
  6. int IN3 = 6;
  7. int IN4 = 5;
  8. const int TrigPin = 2;
  9. const int EchoPin = 3;
  10. float distance;
  11. #include <Servo.h>    // 聲明調(diào)用Servo.h庫
  12. Servo myservo;        // 創(chuàng)建一個(gè)舵機(jī)對象
  13. int pos = 0;          // 變量pos用來存儲舵機(jī)位置
  14. String comdata = "";
  15. int i;

  17. void setup()
  18. {
  19.   pinMode(PWMA, OUTPUT); //PWM
  20.   pinMode(IN1, OUTPUT);
  21.   pinMode(IN2, OUTPUT);
  22.   pinMode(PWMB, OUTPUT); //PWM
  23.   pinMode(IN3, OUTPUT);
  24.   pinMode(IN4, OUTPUT);
  25.   // 初始化串口通信及連接SR04的引腳
  26.         Serial.begin(9600);
  27.         pinMode(TrigPin, OUTPUT);
  28.     // 要檢測引腳上輸入的脈沖寬度，需要先設(shè)置為輸入狀態(tài)
  29.         pinMode(EchoPin, INPUT);
  30.     Serial.println("Ultrasonic sensor:");
  31.   myservo.attach(5);  // 將引腳9上的舵機(jī)與聲明的舵機(jī)對象連接起來
  32.   Serial.begin(9600);
  33. }

  35. void up()
  36. {
  37.   digitalWrite(IN1, LOW);
  38.   digitalWrite(IN2, HIGH);
  39.   digitalWrite(IN3, LOW);
  40.   digitalWrite(IN4, HIGH);
  41.   analogWrite(PWMA, 10);
  42.   analogWrite(PWMB, 10);
  43.   delay(5000);
  44. }

  46. void down()
  47. {
  48.   digitalWrite(IN1, HIGH);
  49.   digitalWrite(IN2, LOW);
  50.   digitalWrite(IN3, HIGH);
  51.   digitalWrite(IN4, LOW);
  52.   analogWrite(PWMA, 10);
  53.   analogWrite(PWMB, 10);
  54.   delay(5000);
  55. }

  57. void sto()
  58. {
  59.   digitalWrite(IN1, LOW);
  60.   digitalWrite(IN2, LOW);
  61.   digitalWrite(IN3, LOW);
  62.   digitalWrite(IN4, LOW);
  63.   analogWrite(PWMA, 0);
  64.   analogWrite(PWMB, 0);
  65.   delay(5000);
  66. }

  68. void left()
  69. {
  70.   digitalWrite(IN1, LOW);
  71.   digitalWrite(IN2, HIGH);
  72.   digitalWrite(IN3, HIGH);
  73.   digitalWrite(IN4, LOW);
  74.   analogWrite(PWMA, 10);
  75.   analogWrite(PWMB, 10);
  76.   delay(5000);
  77. }

  79. void right()
  80. {
  81.   digitalWrite(IN1, HIGH);
  82.   digitalWrite(IN2, LOW);
  83.   digitalWrite(IN3, LOW);
  84.   digitalWrite(IN4, HIGH);
  85.   analogWrite(PWMA, 10);
  86.   analogWrite(PWMB, 10);
  87.   delay(5000);
  88. }

  90. void d()
  91. {
  92.     // 產(chǎn)生一個(gè)10us的高脈沖去觸發(fā)TrigPin
  93.         digitalWrite(TrigPin, LOW);
  94.         delayMicroseconds(2);
  95.         digitalWrite(TrigPin, HIGH);
  96.         delayMicroseconds(10);
  97.         digitalWrite(TrigPin, LOW);
  98.     // 檢測脈沖寬度，并計(jì)算出距離
  99.         distance = pulseIn(EchoPin, HIGH) / 58.00;
  100.         
  101. }

  103. void roun()
  104. {
  105.    for(pos = 0; pos < 180; pos += 1){    // 舵機(jī)從0°轉(zhuǎn)到180°，每次增加1°         
  106.       myservo.write(pos);           // 給舵機(jī)寫入角度   
  107.       delay(15);                    // 延時(shí)15ms讓舵機(jī)轉(zhuǎn)到指定位置
  108.    }
  109.     for(pos = 180; pos>=1; pos-=1) {    // 舵機(jī)從180°轉(zhuǎn)回到0°，每次減小1°                              
  110.        myservo.write(pos);        // 寫角度到舵機(jī)     
  111.        delay(15);                 // 延時(shí)15ms讓舵機(jī)轉(zhuǎn)到指定位置
  112.     }
  113. }

  115. void loop()
  116. {
  117. d();
  118.   while (Serial.available() > 0){
  119.         comdata += char(Serial.read());
  120.         i=comdata.toInt();//每次讀一個(gè)char字符，并相加
  121.         delay(2);
  122.     }
  123.     if (comdata.length() > 0){
  124.         if (i<140){
  125.           Serial.println("left");
  126.            left();
  127.         }
  128.         if(i>140&i<180){
  129.           Serial.println("up");
  130.           if(distance<30)
  131.           sto();
  132.           else
  133.           up();
  134.          
  135.         }
  136.         if (i>=180){
  137.           Serial.println("right");
  138.            right();
  139.         }
  140.        // Serial.println(i); //打印接收到的字符
  141.         comdata = "";
  142.     }
  143.    
  144. }

復(fù)制代碼

所有資料51hei提供下載:
arduino.rar (13.71 KB, 下載次數(shù): 18)


回復(fù)

使用道具 舉報(bào)

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

本版積分規(guī)則

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

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

快速回復(fù) 返回頂部 返回列表