Ler Cor

#include <AFMotor.h>
#define ft 1
#define ts 2

int ult = 0;

int s0_1 = 22;
int s1_1 = 24;
int s2_1 = 26;
int s3_1 = 28;
int out_1 = 30;

int red_1 = 0;
int green_1 = 0;
int blue_1 = 0;

int s0_2 = 31;
int s1_2 = 33;
int s2_2 = 35;
int s3_2 = 37;
int out_2 = 39;

int red_2 = 0;
int green_2 = 0;
int blue_2 = 0;

float blueM1=0, blueM2=0, redM1=0, redM2=0, greenM1=0, greenM2=0;

void setup() {
pinMode(s0_1, OUTPUT);
pinMode(s1_1, OUTPUT);
pinMode(s2_1, OUTPUT);
pinMode(s3_1, OUTPUT);
pinMode(out_1, INPUT);
pinMode(s0_2, OUTPUT);
pinMode(s1_2, OUTPUT);
pinMode(s2_2, OUTPUT);
pinMode(s3_2, OUTPUT);
pinMode(out_2, INPUT);
digitalWrite(s0_1, HIGH);
digitalWrite(s1_1, LOW);
digitalWrite(s0_2, HIGH);
digitalWrite(s1_2, LOW);
Serial.begin(9600);
}

void loop() {

    for(int i = 0; i<10; i++){
    cor1();
    blueM1 += blue_1;
    redM1 += red_1;
    greenM1 += green_1;
      delay(500);
    }
    blueM1 /= 10;
    redM1 /= 10;
    greenM1 /= 10;


     for(int i = 0; i<10; i++){
    cor2();
    blueM2 += blue_2;
    redM2 += red_2;
    greenM2 += green_2;
      delay(500);
    }

    blueM2 /= 10;
    redM2 /= 10;
    greenM2 /= 10;

    Serial.println();
      Serial.println();
     Serial.print("Green1: ");
     Serial.println(greenM1);
      Serial.print("red1: ");
      Serial.println(redM1);
     Serial.print("blue1: ");
     Serial.println(blueM1);
      delay(500);
      Serial.println();
      Serial.println();
      Serial.print("Green2: ");
     Serial.println(greenM2);
      Serial.print("red2: ");
      Serial.println(redM2);
     Serial.print("blue2: ");
     Serial.println(blueM2);
      delay(500);


}


 void cor1() {
    digitalWrite(s2_1, LOW);
    digitalWrite(s3_1, LOW);
    red_1 = pulseIn(out_1, digitalRead(out_1) == HIGH ? LOW : HIGH);


    digitalWrite(s3_1, HIGH);
    blue_1 = pulseIn(out_1, digitalRead(out_1) == HIGH ? LOW : HIGH);

    digitalWrite(s2_1, HIGH);
    green_1 = pulseIn(out_1, digitalRead(out_1) == HIGH ? LOW : HIGH);
}

void cor2() {
    digitalWrite(s2_2, LOW);
    digitalWrite(s3_2, LOW);
    red_2 = pulseIn(out_2, digitalRead(out_2) == HIGH ? LOW : HIGH);

    digitalWrite(s3_2, HIGH);
    blue_2 = pulseIn(out_2, digitalRead(out_2) == HIGH ? LOW : HIGH);

    digitalWrite(s2_2, HIGH);
    green_2 = pulseIn(out_1, digitalRead(out_2) == HIGH ? LOW : HIGH);
}