#define Fci 2
#define Fcu 3
#define MotAv 0
#define Motind 1
#define T1 (millis()- tini > 2000)
#define T2 (millis()- tini2 > 4000)
unsigned long tini, tini2;
char stato ='A';
int N=0;
void setup() {
pinMode(Motind, OUTPUT);
pinMode(MotAv, OUTPUT);
pinMode(Fci, INPUT);
pinMode(Fcu, INPUT);
}
void loop() {
if (stato == 'A'){
if(digitalRead(Fci)== 0){
stato='B';
tini=millis();
}
} else if (stato =='B'){
if (T1 == true){
stato = 'C';
digitalWrite(MotAv, HIGH);
}
} else if (stato =='C'){
if (digitalRead(Fcu)== 0){
digitalWrite(MotAv, LOW);
stato ='D';
tini2=millis();
}
} else if (stato =='D'){
if(T2 == true){
digitalWrite(Motind, HIGH);
stato='E';
}
} else if (stato == 'E'){
if (digitalRead(Fci)==0){
stato = 'F';
digitalWrite(Motind, LOW);
}
} else if (stato == 'F'){
if (digitalRead(Fci)==1){
stato = 'A';
}
}
}