Tren automático cruzar usando Arduino (4 / 5 paso)

Paso 4: #program y código

sensor1 int = 0;
sensor2 int = 1;
int motor1 = 3;
int motor2 = 4;

void setup() {}
pinMode(sensor1,INPUT);
pinMode(sensor2,INPUT);
pinMode(motor1,OUTPUT);
pinMode(motor2,OUTPUT);
}

void loop() {}
C:
{if(sensor1==Low)}
digitalWrite(motor1,HIGH);
digitalWrite(motor2,LOW);
Delay(500);
digitalWrite(motor1,HIGH);
digitalWrite(motor2,HIGH);
A:
{if(sensor2==Low)}
digitalWrite(motor1,LOW);
digitalWrite(motor2,HIGH);
Delay(500);
digitalWrite(motor1,HIGH);
digitalWrite(motor2,HIGH);
Delay(1000);
Goto C;
} Ir A;
{if(sensor2==Low)}
digitalWrite(motor1,HIGH);
digitalWrite(motor2,LOW);
Delay(500);
digitalWrite(motor1,HIGH);
digitalWrite(motor2,HIGH);
B:
{if(sensor1==Low)}
digitalWrite(motor1,LOW);
digitalWrite(motor2,HIGH);
Delay(500);
digitalWrite(motor1,HIGH);
digitalWrite(motor2,HIGH);
Delay(1000);
Goto C;
}
Goto B;
}
}
}

Aquí el retardo de 500ms se utiliza porque la puerta está cerrada en este tiempo. Esto puede cambiar según la respuesta práctica