HC-SR04 초음파 센서 사용법 | 아두이노에 LCD1602와 3색 LED 다이오드 적용

#include <Wire.h>
#include <LiquidCrystal_I2C.h>  // LCE패널 함수 선언

// 초음파센서의 Trig, Echo 핀을 매크로 상수로 선언
#define TRIG 4
#define ECHO 5
// 삼색 LED의 R, G, B에 해당하는 핀들을 매크로 상수로 선언
#define RED 6
#define GREEN 7
#define BLUE 8

LiquidCrystal_I2C lcd (0x27,16,2);   

void setup() {
// 초음파센서의 Trig를 출력모드, Echo를 입력 모드로 설정

  pinMode(TRIG, OUTPUT);
  pinMode(ECHO, INPUT);
  lcd.init();           // LCD 초기화
  lcd.backlight();      // LCD 뒷 전등 켬

}

void loop() {
// 초음파센서의 Trig에서 초음파를 발사하는 코드
  digitalWrite(TRIG, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG, LOW);

// pulseIn 명령어를 통해 Echo핀에 초음파가 들어오는 시간 계산
// 반환된 값에 58.2를 나누어 시간을 cm로 변경
  long distance = pulseIn(ECHO, HIGH)/58.2;

// 3색 LED의 R, G, B를 모두 255로 설정하여 LED를 끔
  analogWrite(RED, 255);
  analogWrite(GREEN, 255);
  analogWrite(BLUE, 255);

    if(distance < 10){
    // 거리가 10cm 이내이면 빨간색으로 표시   
    analogWrite(RED, 0);
  }else if(distance < 20){
    // 거리가 10 ~ 20 이내이면 초록색으로 표시
    analogWrite(GREEN, 0);
  }else if(distance < 30){
    // 거리가 20 ~ 30 이내이면 파란색으로 표시
    analogWrite(BLUE, 0);    
  }

// LCD에서 한번 현시되고 측정된 값이 바뀌면 지우고 다시 현시 
 lcd.clear();
// LCD의 커서를 첫번째 열에 두번째행으로 설정     
  lcd.setCursor(0, 0);
// 측정된 거리값을 LCD에현시
  lcd.print(distance);
  lcd.print("cm");     // 측정 값 뒤에 "cm"글자 표시
  lcd.setCursor(0, 1);
  lcd.print("COLOR : "); 
  if(distance<10){
    lcd.print("RED");
    }else if(distance<20){
    lcd.print("GREEN");
    }else if(distance<30){
    lcd.print("BLUE");  
    }
  
  delay(200);     // 0.2초간 지연

}