超声波测距-ESPDuino

ycf

rt

1. #define echopin 5
   
2. #define trigpin 4
   
3. #define led 0
   
4. 
   
5. void setup()
   
6. {
   
7.   Serial.begin(115200);
   
8.   pinMode(echopin, INPUT);
   
9.   pinMode(trigpin, OUTPUT);
   
10.   pinMode(led, OUTPUT);
    
11. }
    
12. 
    
13. void loop()
    
14. {
    
15.   digitalWrite(trigpin, LOW);
    
16.   delayMicroseconds(2);
    
17.   digitalWrite(trigpin, HIGH);
    
18.   delayMicroseconds(10);
    
19.   digitalWrite(trigpin, LOW);//发一个10ms的高脉冲去触发TrigPin
    
20.   float distance = pulseIn(echopin, HIGH);//接收高电平时间
    
21.   distance = distance/58.0;//计算距离
    
22.   if(1<distance && distance<450)
    
23.   {
    
24.     Serial.print("distance：");
    
25.     Serial.print(distance);//输出距离
    
26.     Serial.println("cm");//输出单位
    
27.     if(distance<10)// 距离小于10cm时灯亮---》报警
    
28.     {
    
29.       digitalWrite(led, LOW);
    
30.     }
    
31.     else
    
32.     {
    
33.       digitalWrite(led, HIGH);
    
34.     }
    
35.   }
    
36.   delay(60);//循环间隔60us
    
37. }

复制代码