PlanoInclinado

#define buzzer 7

#define pinSensorUM  4
#define pinSensorDOIS 3
#define pinSensorTRES  8
#define pinLedVm  6
#define pinLedAz  5

int estadoUM; // variavel que guarda  o estado do sensor
int estadoDOIS;
int estadoTRES;

unsigned long instanteUM = 0;    // tempo total decorrido desde que o programa foi executado
unsigned long instanteDOIS = 0;
unsigned long instanteTRES = 0;

unsigned long elapsedTimeOne;    // tempo decorrido do primeiro intervalo
unsigned long elapsedTimeTwo;    // tempo decorrido do segundo intervalo
unsigned long tempoTotal;
int passou = 0;

void setup() {

      Serial.begin (9600);
      pinMode(pinLedVm,OUTPUT);
      pinMode(pinLedAz,OUTPUT);
      pinMode(buzzer,OUTPUT);
      pinMode(pinSensorUM, INPUT);
      pinMode(pinSensorDOIS, INPUT);
      pinMode(pinSensorTRES, INPUT);

     digitalWrite (pinLedVm,LOW);   // desliga LED vermelho
     digitalWrite (pinLedAz,LOW);      // desliga LED verde
     digitalWrite (buzzer,LOW);
}

void loop()
{
estadoUM = digitalRead(pinSensorUM); // ler o pinSensor1 e armazena em estado
 if (estadoUM == LOW)
    {
        instanteUM = millis();
        digitalWrite (pinLedVm, HIGH);
        digitalWrite (pinLedAz, LOW);
        tone (buzzer, 2500);
        passou = 1;
    }
  if (passou == 1)
  {
   estadoDOIS = digitalRead(pinSensorDOIS); // ler o pinSensor1 e armazena em estado
   if (estadoDOIS == LOW)
   {
        instanteDOIS = millis();
        digitalWrite (pinLedVm, LOW);
        digitalWrite (pinLedAz, HIGH);
        noTone (buzzer);
        elapsedTimeOne = (instanteDOIS - instanteUM);
        passou = 2;
        }
     }

 if (passou == 2)
{
    estadoTRES = digitalRead (pinSensorTRES);
     if (estadoTRES == LOW)
     {
        instanteTRES = millis();
        digitalWrite (pinLedVm, HIGH);
        digitalWrite (pinLedAz, LOW);
        tone (buzzer, 2500);
        passou = 3;
      }
   }
   if (passou == 3)
   {
       elapsedTimeTwo = (instanteTRES - instanteDOIS);
        tempoTotal = (elapsedTimeOne + elapsedTimeTwo);

       Serial.print (" Primeiro intervalo (ms) =   ");
       Serial.println (elapsedTimeOne);   // imprime no monitor serial o 1º interval

       Serial.print("Segundo intervalo (ms) =     ");
       Serial.println(elapsedTimeTwo);

       Serial.print("Tempo Total (ms) =     ");
       Serial.println(tempoTotal);
       digitalWrite (pinLedVm,LOW);   // desliga LED vermelho
       digitalWrite (pinLedAz,LOW);      // desliga LED verde
       digitalWrite (buzzer,LOW);
        if (passou == 0)
     }
}