초음파 센서로 거리를 인식하여 삼색 LED로 색을 표현하기
10cm 이하 : 빨간색, 20cm 이하 : 초록색, 30cm 이하 : 파란색, 30cm 초과 : 색없음
6_1. 초음파 센서
4_1. 3색 LED
#define ECHO 3
#define TRIG 4
void setup() {
pinMode(ECHO, INPUT);
pinMode(TRIG, OUTPUT);
Serial.begin(9600);
}
void loop() {
digitalWrite(TRIG, LOW); // 4번 끄기
delayMicroseconds(2); // 0.000002초 대기
digitalWrite(TRIG, HIGH); // 4번 켜기
delayMicroseconds(10); // 0.00001초 대기
digitalWrite(TRIG, LOW); // 4번 끄기
long dist = (pulseIn(ECHO, HIGH))/56.2;
Serial.println(dist);
if ( dist<10 ) {
analogWrite(11, 255); // R : 빨간색
analogWrite(10,0); // B : 파란색
analogWrite(9, 0); // G : 초록색
}
else if ( dist<20 ) {
analogWrite(11, 0); // R : 빨간색
analogWrite(10,0); // B : 파란색
analogWrite(9, 255); // G : 초록색
}
else if ( dist<30 ) {
analogWrite(11, 0); // R : 빨간색
analogWrite(10,255); // B : 파란색
analogWrite(9, 0); // G : 초록색
}
else {
analogWrite(11, 0); // R : 빨간색
analogWrite(10,0); // B : 파란색
analogWrite(9, 0); // G : 초록색
}
}
Copyright ⓒ Tech79 All right reserved