|
| 1 | +#include <odroid_go.h> |
| 2 | +#include "sensors/Adafruit_TCS34725.h" |
| 3 | + |
| 4 | +//- #define CALI_ENABLE |
| 5 | +//- #define PROCESSING_ENABLE |
| 6 | +#define LCD_ENABLE |
| 7 | + |
| 8 | +#if defined(PROCESSING_ENABLE) |
| 9 | +#undef LCD_ENABLE |
| 10 | +#endif |
| 11 | + |
| 12 | +Adafruit_TCS34725 tcs = Adafruit_TCS34725(TCS34725_INTEGRATIONTIME_50MS, TCS34725_GAIN_1X); |
| 13 | + |
| 14 | +unsigned long preMillis = 0; |
| 15 | +unsigned long curMillis = 0; |
| 16 | +int rCal, gCal, bCal; |
| 17 | +uint16_t clear, red, green, blue; |
| 18 | +unsigned char step = 0; |
| 19 | +int cali(void); |
| 20 | + |
| 21 | +int cali(void) { |
| 22 | + |
| 23 | + uint32_t sum; |
| 24 | + float r, g, b; |
| 25 | + |
| 26 | + switch (step) { |
| 27 | + |
| 28 | + case 0: |
| 29 | + |
| 30 | + curMillis = millis(); |
| 31 | + if (curMillis - preMillis >= 5000) { |
| 32 | + |
| 33 | + step = 1; |
| 34 | + |
| 35 | + tcs.setInterrupt(false); // turn on LED |
| 36 | + tcs.getRawData(&red, &green, &blue, &clear); |
| 37 | + tcs.setInterrupt(true); // turn off LED |
| 38 | + |
| 39 | + GO.lcd.clearDisplay(); |
| 40 | + GO.lcd.setCursor(30, 50); |
| 41 | + GO.lcd.println("Put on GREEN"); |
| 42 | + |
| 43 | + sum = clear; |
| 44 | + r = red; r /= sum; |
| 45 | + g = green; g /= sum; |
| 46 | + b = blue; b /= sum; |
| 47 | + r *= 256; g *= 256; b *= 256; |
| 48 | + |
| 49 | + rCal = r; |
| 50 | + |
| 51 | + preMillis = millis(); |
| 52 | + } |
| 53 | + break; |
| 54 | + |
| 55 | + case 1: |
| 56 | + |
| 57 | + curMillis = millis(); |
| 58 | + if (curMillis - preMillis >= 5000) { |
| 59 | + |
| 60 | + step = 2; |
| 61 | + |
| 62 | + tcs.setInterrupt(false); // turn on LED |
| 63 | + //- delay(60); // takes 50ms to read |
| 64 | + tcs.getRawData(&red, &green, &blue, &clear); |
| 65 | + tcs.setInterrupt(true); // turn off LED |
| 66 | + |
| 67 | + GO.lcd.clearDisplay(); |
| 68 | + GO.lcd.setCursor(30, 50); |
| 69 | + GO.lcd.println("Put on BLUE"); |
| 70 | + |
| 71 | + sum = clear; |
| 72 | + r = red; r /= sum; |
| 73 | + g = green; g /= sum; |
| 74 | + b = blue; b /= sum; |
| 75 | + r *= 256; g *= 256; b *= 256; |
| 76 | + |
| 77 | + gCal = g; |
| 78 | + |
| 79 | + preMillis = millis(); |
| 80 | + } |
| 81 | + break; |
| 82 | + |
| 83 | + case 2: |
| 84 | + |
| 85 | + curMillis = millis(); |
| 86 | + if (curMillis - preMillis >= 5000) { |
| 87 | + step = 3; |
| 88 | + |
| 89 | + tcs.setInterrupt(false); // turn on LED |
| 90 | + tcs.getRawData(&red, &green, &blue, &clear); |
| 91 | + tcs.setInterrupt(true); // turn off LED |
| 92 | + |
| 93 | + sum = clear; |
| 94 | + r = red; r /= sum; |
| 95 | + g = green; g /= sum; |
| 96 | + b = blue; b /= sum; |
| 97 | + r *= 256; g *= 256; b *= 256; |
| 98 | + |
| 99 | + GO.lcd.clearDisplay(); |
| 100 | + |
| 101 | + bCal = b; |
| 102 | + } |
| 103 | + break; |
| 104 | + |
| 105 | + case 3: |
| 106 | + |
| 107 | + return 0; |
| 108 | + |
| 109 | + default:; |
| 110 | + } |
| 111 | + |
| 112 | + return 1; |
| 113 | +} |
| 114 | + |
| 115 | +void setup() { |
| 116 | + GO.begin(); |
| 117 | + Serial.println("Color View Test!"); |
| 118 | + |
| 119 | + if (tcs.begin()) { |
| 120 | + Serial.println("Found sensor"); |
| 121 | + } else { |
| 122 | + Serial.println("No TCS34725 found ... check your connections"); |
| 123 | + while (1); // halt! |
| 124 | + } |
| 125 | + |
| 126 | + GO.lcd.setCursor(30, 50); |
| 127 | + GO.lcd.setTextSize(2); |
| 128 | + GO.lcd.println("Hello, ODROID-GO"); |
| 129 | + |
| 130 | +#if defined(CALI_ENABLE) |
| 131 | + delay(1000); |
| 132 | + |
| 133 | + GO.lcd.clearDisplay(); |
| 134 | + GO.lcd.setCursor(30, 50); |
| 135 | + GO.lcd.print("Put on RED"); |
| 136 | + preMillis = millis(); |
| 137 | + |
| 138 | + while (cali()); |
| 139 | + |
| 140 | + GO.lcd.clearDisplay(); |
| 141 | + GO.lcd.setTextColor(WHITE); |
| 142 | + GO.lcd.setCursor(0, 40); |
| 143 | + GO.lcd.setTextSize(2); |
| 144 | + GO.lcd.print("Cali:R("); GO.lcd.print(int(rCal), DEC); |
| 145 | + GO.lcd.print(") G("); GO.lcd.print(gCal, DEC); |
| 146 | + GO.lcd.print(") B("); GO.lcd.print(bCal, DEC); |
| 147 | + GO.lcd.println(")"); |
| 148 | +#endif |
| 149 | + |
| 150 | + delay(2000); |
| 151 | +} |
| 152 | + |
| 153 | +void loop() { |
| 154 | + |
| 155 | + //- uint16_t clear, red, green, blue; |
| 156 | + |
| 157 | + tcs.setInterrupt(false); // turn on LED |
| 158 | + //- delay(60); // takes 50ms to read |
| 159 | + tcs.getRawData(&red, &green, &blue, &clear); |
| 160 | + tcs.setInterrupt(true); // turn off LED |
| 161 | + |
| 162 | +#if !defined(LCD_ENABLE) |
| 163 | + Serial.print("C:\t"); Serial.print(clear); |
| 164 | + Serial.print("\tR:\t"); Serial.print(red); |
| 165 | + Serial.print("\tG:\t"); Serial.print(green); |
| 166 | + Serial.print("\tB:\t"); Serial.print(blue); |
| 167 | +#endif |
| 168 | + |
| 169 | + // Figure out some basic hex code for visualization |
| 170 | + uint32_t sum = clear; |
| 171 | + float r, g, b; |
| 172 | + r = red; r /= sum; |
| 173 | + g = green; g /= sum; |
| 174 | + b = blue; b /= sum; |
| 175 | + r *= 256; g *= 256; b *= 256; |
| 176 | + |
| 177 | +#if defined(CALI_ENABLE) |
| 178 | + r = r - rCal + 256; |
| 179 | + g = g - gCal + 256; |
| 180 | + b = b - bCal + 256; |
| 181 | +#endif |
| 182 | + |
| 183 | +#if !defined(LCD_ENABLE) |
| 184 | + Serial.print("\t"); |
| 185 | + Serial.print((int)r, HEX); Serial.print((int)g, HEX); Serial.print((int)b, HEX); |
| 186 | + Serial.println(); |
| 187 | +#endif |
| 188 | + |
| 189 | + //Serial.print((int)r ); Serial.print(" "); Serial.print((int)g);Serial.print(" "); Serial.println((int)b ); |
| 190 | + |
| 191 | +#if defined(LCD_ENABLE) |
| 192 | + |
| 193 | + uint16_t colorTemp, lux, rgb565; |
| 194 | + |
| 195 | + colorTemp = tcs.calculateColorTemperature(r, g, b); |
| 196 | + lux = tcs.calculateLux(r, g, b); |
| 197 | + rgb565 = (((int)r) & 0xF8) << 8 | (((int)g) & 0xFC) << 3 | ((int)b) >> 3; |
| 198 | + |
| 199 | + //- GO.lcd.clearDisplay(); |
| 200 | + GO.lcd.fillScreen(rgb565); |
| 201 | + GO.lcd.setTextColor(WHITE); |
| 202 | + GO.lcd.setCursor(0, 40); |
| 203 | + GO.lcd.setTextSize(2); |
| 204 | + GO.lcd.print("* RGB565(Hex) : 0x"); |
| 205 | + GO.lcd.println(rgb565, HEX); |
| 206 | + GO.lcd.println(" "); |
| 207 | + |
| 208 | + GO.lcd.print("* Color Temp : "); GO.lcd.println(colorTemp, DEC); |
| 209 | + GO.lcd.print("* Lux : "); GO.lcd.println(lux, DEC); |
| 210 | + GO.lcd.println(" "); |
| 211 | + |
| 212 | + GO.lcd.print("* R - raw : "); GO.lcd.print(int(r), DEC); GO.lcd.print(" - "); GO.lcd.println(red, DEC); |
| 213 | + GO.lcd.print("* G - raw : "); GO.lcd.print(int(g), DEC); GO.lcd.print(" - "); GO.lcd.println(green, DEC); |
| 214 | + GO.lcd.print("* B - raw : "); GO.lcd.print(int(b), DEC); GO.lcd.print(" - "); GO.lcd.println(blue, DEC); |
| 215 | + GO.lcd.print("* Clear : "); GO.lcd.print(int(clear), DEC); |
| 216 | + |
| 217 | + delay(1000); |
| 218 | + |
| 219 | +#endif |
| 220 | +} |
| 221 | + |
0 commit comments