[Arduino] 초음파센서로 삼색 LED 출력하기

[초음파센서로 삼색 LED 출력하기]

 

* 초음파 회로도

 

 

* 초음파센서 소스

 

#define TRIG 2
#define ECHO 3
#define RED 11
#define GREEN 10
#define BLUE 9

void setup() {
  pinMode(TRIG, OUTPUT);
  pinMode(ECHO, INPUT);
}

void loop() {
  digitalWrite(TRIG, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG, LOW);

  long distance = pulseIn(ECHO, HIGH)/58.2;

  analogWrite(RED, 0);
  analogWrite(GREEN, 0);
  analogWrite(BLUE, 0);

  if(distance < 10)
    analogWrite(RED, 255);
  else if(distance < 20)
    analogWrite(GREEN, 255);
  else
    analogWrite(BLUE, 255);

  delay(100);
}