int EN1 = 13;
int EN2 = 12;
int EN3 = 11;
int EN4 = 10;

int Fcix = 9;
int Fcdx = 8;
int Fcay = 7;
int Fcdy = 6;

bool FCIX = LOW;
bool FCDX = LOW;
bool FCAY = LOW;
bool FCDY = LOW;

void setup(){
    Serial.begin(9600);
    
    pinMode(EN1, OUTPUT);
    pinMode(EN2, OUTPUT);
    pinMode(EN3, OUTPUT);
    pinMode(EN4, OUTPUT);

    pinMode(Fcix, INPUT);
    pinMode(Fcdx, INPUT);
    pinMode(Fcay, INPUT);
    pinMode(Fcdy, INPUT);

    Serial.println("Ingrese una opcion");
    Serial.println("1 = MotorX Izq. , 2 = MotorX Der. , 3 = MotorY Arr. , 4 = MotorY Aba.");

}

void loop(){

    if (Serial.available() > 0) {
        char valor = Serial.read();
        
        switch(valor){
            case '1':
            do {
                digitalWrite(EN1, HIGH);
                digitalWrite(EN2, LOW);
                FCIX = digitalRead(Fcix);
                Serial.print("El valor del final C. Izq. X es: ");
                Serial.println(FCIX);
            } while (FCIX == LOW);

            digitalWrite(EN1, LOW);
            digitalWrite(EN2, LOW);
            break;
            
            case '2':
            do {
                digitalWrite(EN1, LOW);
                digitalWrite(EN2, HIGH);
                FCDX = digitalRead(Fcdx);
                Serial.print("El valor del final C. Der. X es: ");
                Serial.println(FCDX);
            } while (FCDX == LOW);

            digitalWrite(EN1, LOW);
            digitalWrite(EN2, LOW);
            break;

            case '3':
            do {
                digitalWrite(EN3, LOW);
                digitalWrite(EN4, HIGH);
                FCAY = digitalRead(Fcay);
                Serial.print("El valor del final C. Izq. Y es: ");
                Serial.println(FCAY);
            } while (FCAY == LOW);

            digitalWrite(EN3, LOW);
            digitalWrite(EN4, LOW);
            break;

            case '4':
            do {
                digitalWrite(EN3, HIGH);
                digitalWrite(EN4, LOW);
                FCDY = digitalRead(Fcdy);
                Serial.print("El valor del final C. Der. Y es: ");
                Serial.println(FCDY);
            } while (FCDY == LOW);

            digitalWrite(EN3, LOW);
            digitalWrite(EN4, LOW);
            break;
        }
    }
}