四博智联产品售后

标题: 超声波测距-ESPDuino [打印本页]

作者: ycf    时间: 2016-7-1 18:05
标题: 超声波测距-ESPDuino
rt
  1. #define echopin 5
  2. #define trigpin 4
  3. #define led 0

  4. void setup()
  5. {
  6.   Serial.begin(115200);
  7.   pinMode(echopin, INPUT);
  8.   pinMode(trigpin, OUTPUT);
  9.   pinMode(led, OUTPUT);
  10. }

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







欢迎光临 四博智联产品售后 (http://bbs.doit.am/) Powered by Discuz! X3.2