#define TRIGGER 3
#define ECHO 2
uint16_t cm_cal;
uint8_t r_led=13;
uint8_t g_led=12;
uint8_t b_led=11;
void setup() {
Serial.begin(9600);
pinMode(TRIGGER, OUTPUT);
pinMode(ECHO, INPUT);
pinMode(r_led,OUTPUT);
pinMode(g_led,OUTPUT);
pinMode(b_led,OUTPUT);
}
void loop() {
digitalWrite(TRIGGER, HIGH);
delayMicroseconds(10);
digitalWrite(TRIGGER, LOW);
uint16_t duration = pulseIn(ECHO, HIGH);
cm_cal=duration/58;
Serial.println(cm_cal);
analogWrite(r_led,00);
analogWrite(g_led,00);
analogWrite(b_led,00);
delay(1000);
if(cm_cal>100)
{
analogWrite(r_led,255);
delay(100);
analogWrite(r_led,0);
delay(500);
Serial.println("1");
}
if(cm_cal<100 && cm_cal>=50)
{
analogWrite(g_led,255);
delay(100);
analogWrite(g_led,0);
delay(500);
Serial.println("0");
}
if(cm_cal<50)
{
analogWrite(b_led,255);
delay(100);
analogWrite(b_led,0);
delay(500);
Serial.println("3");
}
}