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

標題: arduino藍牙小車加避障代碼 [打印本頁]
作者: TJCL1451681    時間: 2017-6-6 12:54
標題: arduino藍牙小車加避障代碼
  1. #define IN1 4
  2. #define IN2 5
  3. #define IN3 6
  4. #define IN4 7
  5. void forward();
  6. void back();
  7. void turnLeft();
  8. void turnRight();
  9. void _stop();
  10. int ledpin=13;
  11. int i;
  12. int TrigPin = 8;
  13. int EchoPin = 9;
  14. void setup()
  15. { pinMode(IN1,OUTPUT);
  16. pinMode(IN2,OUTPUT);
  17. pinMode(IN3,OUTPUT);
  18. pinMode(IN4,OUTPUT);
  19. pinMode(TrigPin, OUTPUT);
  20. pinMode(EchoPin, INPUT);
  21. pinMode(ledpin,OUTPUT);
  22. Serial.begin(9600);
  23. }
  24. void loop()
  25. {
  26. i= Serial.read();
  27. digitalWrite(TrigPin, LOW); // 使發出發出超聲波信號接口低電平2μs
  28. delayMicroseconds(2);
  29. digitalWrite(TrigPin, HIGH); // 使發出發出超聲波信號接口高電平10μs，這里是至少10μs
  30. delayMicroseconds(10);
  31. digitalWrite(TrigPin, LOW); // 保持發出超聲波信號接口低電平
  32. int distance = pulseIn(EchoPin, HIGH); // 讀出脈沖時間
  33. distance= distance/58; // 將脈沖時間轉化為距離（單位：厘米）
  34. Serial.println(distance); //輸出距離值
  35. delay(50);
  36. if (distance <=30)
  37. {//如果距離大于50厘米小燈亮起
  38. digitalWrite(ledpin,HIGH);
  39. digitalWrite(IN1,LOW);
  40. digitalWrite(IN2,LOW);
  41. digitalWrite(IN3,LOW);
  42. digitalWrite(IN4,LOW);

  44. }//如果距離小于50厘米小燈熄滅
  45. else
  46. digitalWrite(ledpin,LOW);

  48. //if(Serial.available())
  49. //i= Serial.read();
  50. switch(i)
  51. { case'1':{turnLeft();break;}
  52.   case'2':{forward();break;}
  53.   case'3':{turnRight();break;}
  54.   case'4':{_stop();break;}
  55.   case'5':{back();break;}
  56. }
  57.   
  58. }
  59. void forward()
  60. { digitalWrite(IN1,HIGH);
  61. digitalWrite(IN2,LOW);
  62. digitalWrite(IN3,HIGH);
  63. digitalWrite(IN4,LOW);
  64. }
  65. void back()
  66. { digitalWrite(IN1,LOW);
  67. digitalWrite(IN2,HIGH);
  68. digitalWrite(IN3,LOW);
  69. digitalWrite(IN4,HIGH);
  70. }
  71. void turnLeft()
  72. { digitalWrite(IN1,LOW);
  73. digitalWrite(IN2,LOW);
  74. digitalWrite(IN3,HIGH);
  75. digitalWrite(IN4,LOW);
  76. }

  78. void turnRight()
  79. { digitalWrite(IN1,HIGH);
  80. digitalWrite(IN2,LOW);
  81. digitalWrite(IN3,LOW);
  82. digitalWrite(IN4,LOW);
  83. }

  85. void _stop()
  86. { digitalWrite(IN1,LOW);
  87. digitalWrite(IN2,LOW);
  88. digitalWrite(IN3,LOW);
  89. digitalWrite(IN4,LOW);
  90. }

復制代碼


作者: xqxyk    時間: 2017-6-8 11:24
新手看懂了



歡迎光臨 (http://www.zg4o1577.cn/bbs/) Powered by Discuz! X3.1
主站蜘蛛池模板： 欧美精品久久久久久久久久 | 一区二区三区中文字幕 | 久久人人国产 | 成人一区二区三区在线观看 | 亚洲免费在线 | 久久久久国产精品 | 人人爽人人爽人人片av | 亚洲精品字幕 | av电影一区二区 | 欧美日韩综合视频 | 91精品久久久久 | 91xxx在线观看 | 国产精品国产亚洲精品看不卡15 | 国产999精品久久久 日本视频一区二区三区 | 久久国产精品99久久久大便 | av国产精品毛片一区二区小说 | 欧美 中文字幕 | 国产91精品网站 | 精品网站999| 97视频在线观看免费 | 久久免费观看一级毛片 | www.99热这里只有精品 | 色综合一区二区三区 | 国产欧美在线 | 日韩国产在线观看 | 一级片毛片| 久热久 | 亚洲一级毛片 | 国产乱码精品一区二区三区五月婷 | 日日做夜夜爽毛片麻豆 | 国产精品自拍视频网站 | 国产一区 在线视频 | 久久艹av| 91久久久www播放日本观看 | 国产精品日日夜夜 | 国产成人高清视频 | 国产精品久久久久久婷婷天堂 | av看片| 毛片一级片 | 国产日韩一区二区 | 自拍视频网 |