/* 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;
}
}