Sensor De Color TCS3200

// Prueba del sensor de color TCS3200: mide la luz roja, verde y azul y dice
// qué color predomina. Un número MENOR significa MÁS de ese color.
const int S0 = 4;
const int S1 = 5;
const int S2 = 6;
const int S3 = 7;
const int PIN_OUT = 8;

void setup() {
  pinMode(S0, OUTPUT);
  pinMode(S1, OUTPUT);
  pinMode(S2, OUTPUT);
  pinMode(S3, OUTPUT);
  pinMode(PIN_OUT, INPUT);
  // Escala de salida al 20 % (S0 alto, S1 bajo): adecuada para el Arduino
  digitalWrite(S0, HIGH);
  digitalWrite(S1, LOW);
  Serial.begin(9600);
}

// Elige el filtro con S2 y S3 y mide el ancho del pulso de salida
unsigned long medir(int s2, int s3) {
  digitalWrite(S2, s2);
  digitalWrite(S3, s3);
  delay(50);
  return pulseIn(PIN_OUT, LOW);
}

void loop() {
  unsigned long rojo = medir(LOW, LOW);
  unsigned long verde = medir(HIGH, HIGH);
  unsigned long azul = medir(LOW, HIGH);

  Serial.print("R: "); Serial.print(rojo);
  Serial.print("  V: "); Serial.print(verde);
  Serial.print("  A: "); Serial.print(azul);

  if (rojo < verde && rojo < azul) Serial.println("  -> rojo");
  else if (verde < rojo && verde < azul) Serial.println("  -> verde");
  else Serial.println("  -> azul");
  delay(500);
}