#include <Wire.h>
#include "Adafruit_TCS34725.h"

/* Initialise with default values (int time = 2.4ms, gain = 1x) */
// Adafruit_TCS34725 tcs = Adafruit_TCS34725();
/* Initialise with specific int time and gain values */
Adafruit_TCS34725 tcs = Adafruit_TCS34725(TCS34725_INTEGRATIONTIME_614MS, TCS34725_GAIN_1X);
int led_far = 13;
#define LEDR 15
#define LEDB 2
#define LEDG 0
#define buton 14
uint16_t r, g, b, c, colorTemp, lux,r_ll, g_ll, b_ll;
uint8_t b_press,b_nr;
uint8_t r_detec, g_detec, b_detec;


void setup(void) {
  Serial.begin(9600);
  pinMode(led_far, OUTPUT);
  pinMode(LEDG,OUTPUT);
  pinMode(LEDB,OUTPUT);
  pinMode(LEDR,OUTPUT);
  pinMode(buton,INPUT);

}

void loop(void) {

  r_ll = r;
  g_ll = g;
  b_ll = b;
  tcs.getRawData(&r, &g, &b, &c);
  // colorTemp = tcs.calculateColorTemperature(r, g, b);
  colorTemp = tcs.calculateColorTemperature_dn40(r, g, b, c);
  lux = tcs.calculateLux(r, g, b);
  if((digitalRead(buton) == HIGH) && (b_press == 0))
  {
    b_nr +=1;
    b_press = 1;
  }
  if((digitalRead(buton) == LOW) )
  {
    b_press = 0;
  }
  if(b_nr > 2)
  {
    b_nr = 0;
  }
  if(b_nr == 0)
  {
    analogWrite(LEDR,255);
    analogWrite(LEDB,0);
    analogWrite(LEDG,0);
  }
    if(b_nr == 1)
  {
    analogWrite(LEDR,0);
    analogWrite(LEDB,0);
    analogWrite(LEDG,255);
  }
     if(b_nr == 2)
  {
    analogWrite(LEDR,255);
    analogWrite(LEDB,0);
    analogWrite(LEDG,255);
  }
  if (lux < 100)
  {
    digitalWrite(led_far, HIGH);
  }
  else
  {
    digitalWrite(led_far, LOW);
  }
  if(r > 500)
  {
    r_detec = 1;
  }
  else
  {
    r_detec = 0;
  }
    if(g > 500)
  {
    g_detec = 1;
  }
  else
  {
    g_detec = 0;
  }
    if(b > 500)
  {
    b_detec = 1;
  }
  else
  {
     b_detec = 0;
  }
    if ((r_detec == 1) && (g_detec == 1) && (b_detec == 0))
  {
    Serial.print("Yellow detected");
    Serial.println(" ");
  }
    if ((r_detec == 1) && (g_detec == 0) && (b_detec == 0))
  {
    Serial.print("Red detected");
    Serial.println(" ");
  }
  if ((r_detec == 0) && (g_detec == 1) && (b_detec == 0))
  {
    Serial.print("Green detected");
    Serial.println(" ");
  }
 /* Serial.print("Color Temp: "); Serial.print(colorTemp, DEC); Serial.print(" K - ");
  Serial.print("Lux: "); Serial.print(lux, DEC); Serial.print(" - ");
  Serial.print("R: "); Serial.print(r, DEC); Serial.print(" ");
  Serial.print("G: "); Serial.print(g, DEC); Serial.print(" ");
  Serial.print("B: "); Serial.print(b, DEC); Serial.print(" ");
  Serial.print("C: "); Serial.print(c, DEC); Serial.print(" ");
  Serial.println(" ");*/

}