Arduino + HC-SR04 超音波測距控制 LED 燈閃爍

hcsr04.ino

#define TRIGPIN 10
#define ECHOPIN 13
#define LED1 8
#define LED2 9

long ping() {
  digitalWrite(TRIGPIN, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIGPIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIGPIN, LOW);
  return pulseIn(ECHOPIN, HIGH)/58;
}

void setup() {
  pinMode(TRIGPIN, OUTPUT);
  pinMode(ECHOPIN, INPUT);
  pinMode(LED1, OUTPUT);
  pinMode(LED2, OUTPUT);
}

void loop() {
  long cm = ping();
  
  if (cm <= 100) {
    digitalWrite(LED1, HIGH);
    delay(cm*1.5 + 10);
    digitalWrite(LED1, LOW);
    digitalWrite(LED2, HIGH);
    delay(cm*1.5 + 10);
    digitalWrite(LED2, LOW);
  }
  
  delay(100);
}