ardunio开发——超声波传感器——根据距离控制灯亮

// ---------------------------------------------------------------------------
// Example NewPing library sketch that does a ping about 20 times per second.
// ---------------------------------------------------------------------------

#include <NewPing.h>

#define TRIGGER_PIN  D6  // Arduino pin tied to trigger pin on the ultrasonic sensor.
#define ECHO_PIN     D7  // Arduino pin tied to echo pin on the ultrasonic sensor.
#define LED D4
#define MAX_DISTANCE 200 // Maximum distance we want to ping for (in centimeters). Maximum sensor distance is rated at 400-500cm.

NewPing sonar(TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE); // NewPing setup of pins and maximum distance.
int zeroNum = 0; 

void setup() {
  Serial.begin(115200); // Open serial monitor at 115200 baud to see ping results.

  //指定接口模型
  pinMode(LED,OUTPUT);
}

void loop() {
  delay(50);                     // Wait 50ms between pings (about 20 pings/sec). 29ms should be the shortest delay between pings.
  Serial.print("Ping: ");
  Serial.print(sonar.ping_cm()); // Send ping, get distance in cm and print result (0 = outside set distance range)
  Serial.println("cm");

  // 防止没有物体时亮灯,减少跳变的情况
  if(sonar.ping_cm() == 0){
    zeroNum ++ ;
  }else{
    zeroNum = 0 ;
  }

  // 判定是否灯亮
  if(sonar.ping_cm()< 20 || zeroNum < 2){
    digitalWrite(LED,HIGH);
  }else{
    digitalWrite(LED,LOW);
  }

}