/* Project: inversionDeGiro */
  bool E0 = 1;
  bool E0ant = 1;
  bool E1;
  bool E1ant;
  bool E2;
  bool E2ant;
  bool E3;
  bool E3ant;
  
  void setup()
  {
    pinMode(2, INPUT);
    Serial.begin(115200);
    delay(1000);
  Serial.println("E0");
  
    pinMode(14, INPUT);
    pinMode(15, OUTPUT);
    pinMode(12, INPUT);
    pinMode(19, OUTPUT);
    pinMode(4, INPUT);
  }
  
  void loop()
  {
    if(E0){
    }
    if(E0!= E0ant){
    E0ant = E0;
    }if (E0 && digitalRead(2)){
    E0 = false;
    Serial.println("E1");
    E1 = true;
    E1ant = E1;
    }
    if(E1){
    digitalWrite(15,HIGH);
    }
    if(E1!= E1ant){
    E1ant = E1;
    digitalWrite(15,LOW);
    }if (E1 && digitalRead(14)){
    E1 = false;
    Serial.println("E0");
    E0 = true;
    E0ant = E0;
    }
    if(E0){
    }
    if(E0!= E0ant){
    E0ant = E0;
    }if (E0 && digitalRead(12)){
    E0 = false;
    Serial.println("E2");
    E2 = true;
    E2ant = E2;
    }
    if(E2){
    digitalWrite(19,HIGH);
    }
    if(E2!= E2ant){
    E2ant = E2;
    digitalWrite(19,LOW);
    }if (E2 && digitalRead(14)){
    E2 = false;
    Serial.println("E0");
    E0 = true;
    E0ant = E0;
    }
    // 1
    if(digitalRead(4)){
    E0 = 0;
    E1 = 0;
    E2 = 0;
    
    E3 = HIGH;
    }
    else{
    
    
    
    
    
    }
    if(E3){
    digitalWrite(19,HIGH);
    
    digitalWrite(15,HIGH);
    }
    if(E3!= E3ant){
    E3ant = E3;
    digitalWrite(19,LOW);
    
    digitalWrite(15,LOW);
    }if (E3 && !digitalRead(4)){
    E3 = false;
    Serial.println("E0");
    E0 = true;
    E0ant = E0;
    }
  }