標題: 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); // 使發(fā)出發(fā)出超聲波信號接口低電平2μs
    
28. delayMicroseconds(2);
    
29. digitalWrite(TrigPin, HIGH); // 使發(fā)出發(fā)出超聲波信號接口高電平10μs，這里是至少10μs
    
30. delayMicroseconds(10);
    
31. digitalWrite(TrigPin, LOW); // 保持發(fā)出超聲波信號接口低電平
    
32. int distance = pulseIn(EchoPin, HIGH); // 讀出脈沖時間
    
33. distance= distance/58; // 將脈沖時間轉(zhuǎn)化為距離（單位：厘米）
    
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);
    
43. 
    
44. }//如果距離小于50厘米小燈熄滅
    
45. else
    
46. digitalWrite(ledpin,LOW);
    
47. 
    
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. }
    
77. 
    
78. void turnRight()
    
79. { digitalWrite(IN1,HIGH);
    
80. digitalWrite(IN2,LOW);
    
81. digitalWrite(IN3,LOW);
    
82. digitalWrite(IN4,LOW);
    
83. }
    
84. 
    
85. void _stop()
    
86. { digitalWrite(IN1,LOW);
    
87. digitalWrite(IN2,LOW);
    
88. digitalWrite(IN3,LOW);
    
89. digitalWrite(IN4,LOW);
    
90. }
    
91. 
    

復制代碼

---

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

---

歡迎光臨 (http://www.torrancerestoration.com/bbs/)

Powered by Discuz! X3.1