基于Wemos的智能感应开盖垃圾桶

#include <Servo.h>
#define DuoPIN D5
Servo myDuoJi;
#define Echo D2
#define Trig D8


long getTime()
{
    digitalWrite(Trig,HIGH);
    delayMicroseconds(10);
    digitalWrite(Trig,LOW);
    return pulseIn(Echo,HIGH);
  }

void initChaoShengBo()
{
    pinMode(Echo,INPUT);
    pinMode(Trig,OUTPUT);
  }

void setup() {
  // put your setup code here, to run once:
    initChaoShengBo();
    myDuoJi.attach(DuoPIN);
    Serial.begin(115200);
    
}

void loop() {
  // put your main code here, to run repeatedly:
      long dis;
      dis = getTime()/58;
      Serial.print(dis);
      Serial.println("cm");
      if(dis<10){
          myDuoJi.write(0);
          delay(1000);
        }else{
            myDuoJi.write(90);
          }
     
      delay(1000);
    
   
}