초음파 거리 알림기

// 초음파 거리 알림기 - ModuKit
// 거리에 따라 LED와 부저로 알림을 줍니다.

const int TRIG = 7;
const int ECHO = 6;
const int BUZZER = 8;
const int LED_GREEN = 11;
const int LED_YELLOW = 10;
const int LED_RED = 9;

long getDistance() {
  digitalWrite(TRIG, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG, LOW);
  
  long duration = pulseIn(ECHO, HIGH);
  return duration * 0.034 / 2;  // cm 변환
}

void setup() {
  pinMode(TRIG, OUTPUT);
  pinMode(ECHO, INPUT);
  pinMode(BUZZER, OUTPUT);
  pinMode(LED_GREEN, OUTPUT);
  pinMode(LED_YELLOW, OUTPUT);
  pinMode(LED_RED, OUTPUT);
  Serial.begin(9600);
  Serial.println("거리 알림기 시작!");
}

void loop() {
  long distance = getDistance();
  Serial.print("거리: ");
  Serial.print(distance);
  Serial.println(" cm");

  // 모든 LED 끄기
  digitalWrite(LED_GREEN, LOW);
  digitalWrite(LED_YELLOW, LOW);
  digitalWrite(LED_RED, LOW);
  noTone(BUZZER);

  if (distance < 10) {
    // 매우 가까움 - 빨간 LED + 빠른 경고음
    digitalWrite(LED_RED, HIGH);
    tone(BUZZER, 1000);
    Serial.println("⚠️ 매우 가까움!");
  } else if (distance < 20) {
    // 가까움 - 노란 LED + 느린 경고음
    digitalWrite(LED_YELLOW, HIGH);
    tone(BUZZER, 500);
    Serial.println("⚡ 가까움");
  } else if (distance < 50) {
    // 보통 - 초록 LED
    digitalWrite(LED_GREEN, HIGH);
    Serial.println("✅ 안전");
  }

  delay(200);
}