Arduino-----超声波测距

1. #define PIN_TRIG 12  
2. #define PIN_ECHO 11  
3.     
4. float cm;  
5. float temp;  
6.     
7. void setup() {    
8.   Serial.begin(9600);    
9.   pinMode(PIN_TRIG, OUTPUT);    
10.   pinMode(PIN_ECHO, INPUT);    
11. }    
12.     
13. void loop() {  
14.   digitalWrite(PIN_TRIG, LOW);  
15.   delayMicroseconds(2);  
16.   digitalWrite(PIN_TRIG, HIGH);  
17.   delayMicroseconds(10);  
18.   digitalWrite(PIN_TRIG, LOW);  
19.       
20.   temp = float(pulseIn(PIN_ECHO, HIGH));  
21.   cm = (temp * 17 )/1000;  
22.     
23.   Serial.print("Echo = ");    
24.   Serial.print(temp);  
25.   Serial.print(",  Distance = ");    
26.   Serial.print(cm);  
27.   Serial.println("cm");    
28.   delay(300);    
29. }   
30.