RGB LED Based on Distance

1const int redPin = 3;
2const int greenPin = 4;
3const int bluePin  = 5;
4const int echoPin = 9;
5const int trigPin = 8;
6
7int distance;
8
9void  setup(){
10 pinMode(redPin, OUTPUT);
11 pinMode(greenPin, OUTPUT);
12 pinMode(bluePin,  OUTPUT);
13  pinMode(echoPin, INPUT);  
14 pinMode(trigPin, OUTPUT);
15  Serial.begin(9600);  
16}
17
18void loop(){
19 sendPing();
20 int duration = pulseIn(echoPin, HIGH);
21  distance = 0.034 * duration / 2;
22 distance = clamp(distance, 0, 50);
23 printToScreen(distance);  
24 
25 if(distance >= 0 && distance <= 15){           
26    Blue(255);
27    Green(0);
28    Red(0);    
29    }
30else if(distance >= 16 && distance  < 33){       
31    Green(255);
32    Blue(0);
33    Red(0);
34    }
35    else  if (distance >= 33 && distance <= 50){
36      Red(255);
37      Green(0);
38      Blue(0); 
39    }
40}
41
42void Red(int VAL){
43 analogWrite(redPin,  VAL);
44 analogWrite(greenPin, 0);
45 analogWrite(bluePin, 0);
46}
47void Green(int  VAL){
48 analogWrite(redPin, 0);
49 analogWrite(greenPin, VAL);
50 analogWrite(bluePin,  0);
51}
52void Blue(int VAL){
53 analogWrite(redPin, 0);
54 analogWrite(greenPin,  0);
55 analogWrite(bluePin, VAL);
56}
57void sendPing(){
58 digitalWrite(trigPin,  LOW);
59 delayMicroseconds(5);
60 digitalWrite(trigPin, HIGH);
61 delayMicroseconds(10);
62  digitalWrite(trigPin, LOW);
63}
64int clamp(int VAL, int min, int max){
65    if(VAL  <= min){
66    VAL = min;
67    return VAL;
68    }
69    else if(VAL >= max){
70    VAL = max;
71    return VAL;
72    }
73    else{
74    return VAL;
75    }
76}
77void  printToScreen(int TARGET){
78    Serial.print(TARGET);
79    Serial.println("  cm");
80}
81

1const int redPin = 3;
2const int greenPin = 4;
3const int bluePin
4  = 5;
5const int echoPin = 9;
6const int trigPin = 8;
7
8int distance;
9
10void
11  setup(){
12 pinMode(redPin, OUTPUT);
13 pinMode(greenPin, OUTPUT);
14 pinMode(bluePin,
15  OUTPUT);
16  pinMode(echoPin, INPUT);  
17 pinMode(trigPin, OUTPUT);
18  Serial.begin(9600);
19  
20}
21
22void loop(){
23 sendPing();
24 int duration = pulseIn(echoPin, HIGH);
25
26  distance = 0.034 * duration / 2;
27 distance = clamp(distance, 0, 50);
28 printToScreen(distance);
29  
30 
31 if(distance >= 0 && distance <= 15){           
32    Blue(255);
33
34    Green(0);
35    Red(0);    
36    }
37else if(distance >= 16 && distance
38  < 33){       
39    Green(255);
40    Blue(0);
41    Red(0);
42    }
43    else
44  if (distance >= 33 && distance <= 50){
45      Red(255);
46      Green(0);
47
48      Blue(0); 
49    }
50}
51
52void Red(int VAL){
53 analogWrite(redPin,
54  VAL);
55 analogWrite(greenPin, 0);
56 analogWrite(bluePin, 0);
57}
58void Green(int
59  VAL){
60 analogWrite(redPin, 0);
61 analogWrite(greenPin, VAL);
62 analogWrite(bluePin,
63  0);
64}
65void Blue(int VAL){
66 analogWrite(redPin, 0);
67 analogWrite(greenPin,
68  0);
69 analogWrite(bluePin, VAL);
70}
71void sendPing(){
72 digitalWrite(trigPin,
73  LOW);
74 delayMicroseconds(5);
75 digitalWrite(trigPin, HIGH);
76 delayMicroseconds(10);
77
78  digitalWrite(trigPin, LOW);
79}
80int clamp(int VAL, int min, int max){
81    if(VAL
82  <= min){
83    VAL = min;
84    return VAL;
85    }
86    else if(VAL >= max){
87
88    VAL = max;
89    return VAL;
90    }
91    else{
92    return VAL;
93    }
94}
95void
96  printToScreen(int TARGET){
97    Serial.print(TARGET);
98    Serial.println("
99  cm");
100}
101