HC-SR04 超音波測距模組

tonyh

1. int trigPin = 12;                  //Trig Pin
   
2. int echoPin = 13;                  //Echo Pin
   
3. float duration, cm, inches;
   
4. 
   
5. void setup() {
   
6.   Serial.begin (9600);              // Serial Port begin
   
7.   pinMode(trigPin, OUTPUT);        // 定義輸入及輸出
   
8.   pinMode(echoPin, INPUT);
   
9. }
   
10. 
    
11. void loop()
    
12. {
    
13.   digitalWrite(trigPin, HIGH);     // 給 Trig 高電位，持續 10 微秒
    
14.   delayMicroseconds(10);
    
15.   digitalWrite(trigPin, LOW);
    
16. 
    
17.   pinMode(echoPin, INPUT);             // 讀取 Echo 的電位
    
18.   duration = pulseIn(echoPin, HIGH);   // 收到高電位時的時間
    
19. 
    
20.   cm = (duration/2) / 29.1;
    
21.   inches = (duration/2) / 74;          // 29.1 * 2.54 = 74
    
22. 
    
23.   Serial.print("Distance : ");  
    
24.   Serial.print(inches);
    
25.   Serial.print("in,   ");
    
26.   Serial.print(cm);
    
27.   Serial.print("cm");
    
28.   Serial.println();
    
29.   
    
30.   delay(250);
    
31. }
    
32. /*
    
33. •  音速 c = 331.5 + 0.607 * t  (其中 t 為攝氏溫度)。
    
34. 
    
35.     例： 攝氏20度時的音速約為： 331.5 + 0.607*20 = 343.64 公尺/秒
    
36. 
    
37. •  音速公尺/秒 換算成 公分/微秒：343.64 * 100 / 1000000 = 0.034364 公分/微秒，亦即
    
38. 
    
39.     音速每公分需要29.1 微秒：  1 / 0.034364 = 29.1 微秒/公分
    
40. 
    
41.     超音波發射的距離為來回，因此單程距離 = 時間差 / 2  再除以  29.1 微秒 / 公分，同樣的如果要換算成英吋，只要將 29.1 再乘以 2.54 即可。
    
42. */

複製代碼

1. #include <Ultrasonic.h>
   
2. 
   
3. Ultrasonic ultrasonic(12,13);   //Trig Pin, Echo Pin
   
4. int distance;
   
5. 
   
6. void setup() {
   
7.   Serial.begin (9600);
   
8. }
   
9. 
   
10. void loop()
    
11. {
    
12.   distance=ultrasonic.read();   //read(INC) 為輸出英吋
    
13.   
    
14.   Serial.print("Distance in CM: ");
    
15.   Serial.println(distance);
    
16.   
    
17.   delay(250);
    
18. }

複製代碼