tsc230sensorcolor.ino

const int sR0 = A2; //50;
const int sR1 = A1; //52;
const int sR2 = A4; //46;
const int sR3 = A5; //44;
const int outR = A3; //48;

const int sL0 = A14; //50;
const int sL1 = A15; //52;
const int sL2 = A12; //46;
const int sL3 = A11; //44;
const int outL = A13; //48;

int redRight = 0;
int greenRight = 0;
int blueRight = 0;

int redLeft = 0;
int greenLeft = 0;
int blueLeft = 0;

void setup() {
  Serial.begin(115200);

  pinMode(sR0, OUTPUT);
  pinMode(sR1, OUTPUT);
  pinMode(sR2, OUTPUT);
  pinMode(sR3, OUTPUT);
  pinMode(outR, INPUT);
  digitalWrite(sR0, HIGH);
  digitalWrite(sR1, HIGH);

  pinMode(sL0, OUTPUT);
  pinMode(sL1, OUTPUT);
  pinMode(sL2, OUTPUT);
  pinMode(sL3, OUTPUT);
  pinMode(outL, INPUT);
  digitalWrite(sL0, HIGH);
  digitalWrite(sL1, HIGH);
}


void loop() {
  color();

  Serial.print("Derecha   ");
  Serial.print(redRight, DEC);
  Serial.print("   ");
  Serial.print(greenRight, DEC);
  Serial.print("   ");
  Serial.print(blueRight, DEC);

  if (redRight < greenRight && greenRight < blueRight && blueRight < 35)
  {
    Serial.println("   Amarillo");
  }
  else if (redRight < blueRight && greenRight > blueRight && redRight < 35)
  {
    Serial.println("   Rojo");
  }
  else if (blueRight < redRight && blueRight < greenRight && greenRight < redRight)
  {
    Serial.println("   Azul");
  }

  else if (redRight > greenRight && blueRight > greenRight )
  {
    Serial.println("   Verde");
  }
  else {
    Serial.println("  ");
  }

  Serial.print("Izquierda   ");
  Serial.print(redLeft, DEC);
  Serial.print("   ");
  Serial.print(greenLeft, DEC);
  Serial.print("   ");
  Serial.print(blueLeft, DEC);

  if (redLeft < greenLeft && greenLeft < blueLeft && blueLeft < 35)
  {
    Serial.println("   Amarillo");
  }
  else if (redLeft < blueLeft && greenLeft > blueLeft && redLeft < 35)
  {
    Serial.println("   Rojo");
  }
  else if (blueLeft < redLeft && blueLeft < greenLeft && greenLeft < redLeft)
  {
    Serial.println("   Azul");
  }

  else if (redLeft > greenLeft && blueLeft > greenLeft )
  {
    Serial.println("   Verde");
  }
  else {
    Serial.println("  ");
  }


  delay(900);
}

void color()
{
  digitalWrite(sR2, LOW);
  digitalWrite(sR3, LOW);
  redRight = pulseIn(outR, digitalRead(outR) == HIGH ? LOW : HIGH);
  digitalWrite(sR3, HIGH);
  blueRight = pulseIn(outR, digitalRead(outR) == HIGH ? LOW : HIGH);
  digitalWrite(sR2, HIGH);
  greenRight = pulseIn(outR, digitalRead(outR) == HIGH ? LOW : HIGH);

  digitalWrite(sL2, LOW);
  digitalWrite(sL3, LOW);
  redLeft = pulseIn(outL, digitalRead(outL) == HIGH ? LOW : HIGH);
  digitalWrite(sL3, HIGH);
  blueLeft = pulseIn(outL, digitalRead(outL) == HIGH ? LOW : HIGH);
  digitalWrite(sL2, HIGH);
  greenLeft = pulseIn(outL, digitalRead(outL) == HIGH ? LOW : HIGH);

}