Problema con proyecto de ascensor

Buenas tardes. He estado intentado realizar un circuito que quiero utilizar como maqueta para un ascensor de 3 pisos. He copiado un video de youtube con sus componentes y código, y lo he armado de acuerdo a como estaba, pero no me ha funcionado. A continuación subo el esquema del circuito, el código y paso a enumerar algunas diferencias entre el circuito de ejemplo y el mío, y explicaré mi problema en particular.

y el código es el siguiente:

// ASCENSOR

int Rojo = 13;   // LED ROJO = ASCENSOR OCUPADO
int Verde = 12;  // LED VERDE = ASCENSOR LIBRE

int P1 = 8;   // PULSADOR PRIMER PISO
int P2 = 7;   // PULSADOR SEGUNDO PISO
int P3 = 6;   // PULSADOR TERCER PISO

int S1 = 11;  // SENSOR PRIMER PISO
int S2 = 10;  // SENSOR SEGUNDO PISO
int S3 = 9;   // SENSOR TERCER PISO

int motor = 5;      // ARRANQUE Y PARADA DEL MOTOR
int motorpin2 = 4;
int motorpin7 = 3;

int piso; // VARIABLE QUE IDENTIFICA EL PISO EN EL QUE ESTÁ EL ASCENSOR


void setup() {

  pinMode(Rojo, OUTPUT);
  pinMode(Verde, OUTPUT);

  pinMode(P1, INPUT);
  pinMode(P2, INPUT);
  pinMode(P3, INPUT);

  pinMode(S1, INPUT);
  pinMode(S2, INPUT);
  pinMode(S3, INPUT);

  pinMode(motor, OUTPUT);
  pinMode(motorpin2, OUTPUT);
  pinMode(motorpin7, OUTPUT);

  while (digitalRead(S1) == LOW) {   // INICIALMENTE EL ASCENSOR SE LLEVA AL PISO 1

    digitalWrite(Rojo, HIGH);        // ASCENSOR OCUPADO
    digitalWrite(Verde, LOW);

    digitalWrite(motor, HIGH);       // EL MOTOR ARRANCA
    digitalWrite(motorpin2, LOW);    // EL ASCENSOR BAJA
    digitalWrite(motorpin7, HIGH);   // EL ASCENSOR BAJA
  }

  piso = 1;   // LA VARIABLE PISO SE HACE IGUAL A 1
}


void loop() {

  digitalWrite(motor, LOW);   // EL MOTOR PARA
  digitalWrite(Rojo, LOW);
  digitalWrite(Verde, HIGH);  // ASCENSOR LIBRE

  int pulsador_1 = digitalRead(P1);
  int pulsador_2 = digitalRead(P2);
  int pulsador_3 = digitalRead(P3);


  // IR AL TERCER PISO
  if (pulsador_3 == HIGH) {

    while (digitalRead(S3) == LOW) {   // SUBE MIENTRAS EL ASCENSOR NO HA LLEGADO AL TERCER PISO

      digitalWrite(Rojo, HIGH);        // ASCENSOR OCUPADO
      digitalWrite(Verde, LOW);

      digitalWrite(motor, HIGH);       // EL MOTOR ARRANCA
      digitalWrite(motorpin2, HIGH);   // EL ASCENSOR SUBE
      digitalWrite(motorpin7, LOW);    // EL ASCENSOR SUBE
    }

    piso = 3;
  }


  // IR AL SEGUNDO PISO DESDE ABAJO
  if (pulsador_2 == HIGH && piso < 2) {

    while (digitalRead(S2) == LOW) {   // SUBE MIENTRAS EL ASCENSOR NO HA LLEGADO AL SEGUNDO PISO

      digitalWrite(Rojo, HIGH);        // ASCENSOR OCUPADO
      digitalWrite(Verde, LOW);

      digitalWrite(motor, HIGH);       // EL MOTOR ARRANCA
      digitalWrite(motorpin2, HIGH);   // EL ASCENSOR SUBE
      digitalWrite(motorpin7, LOW);    // EL ASCENSOR SUBE
    }

    piso = 2;
  }


  // IR AL SEGUNDO PISO DESDE ARRIBA
  if (pulsador_2 == HIGH && piso > 2) {

    while (digitalRead(S2) == LOW) {   // BAJA MIENTRAS EL ASCENSOR NO HA LLEGADO AL SEGUNDO PISO

      digitalWrite(Rojo, HIGH);        // ASCENSOR OCUPADO
      digitalWrite(Verde, LOW);

      digitalWrite(motor, HIGH);       // EL MOTOR ARRANCA
      digitalWrite(motorpin2, LOW);    // EL ASCENSOR BAJA
      digitalWrite(motorpin7, HIGH);   // EL ASCENSOR BAJA
    }

    piso = 2;
  }


  // IR AL PRIMER PISO
  if (pulsador_1 == HIGH) {

    while (digitalRead(S1) == LOW) {   // BAJA MIENTRAS EL ASCENSOR NO HA LLEGADO AL PRIMER PISO

      digitalWrite(Rojo, HIGH);        // ASCENSOR OCUPADO
      digitalWrite(Verde, LOW);

      digitalWrite(motor, HIGH);       // EL MOTOR ARRANCA
      digitalWrite(motorpin2, LOW);    // EL ASCENSOR BAJA
      digitalWrite(motorpin7, HIGH);   // EL ASCENSOR BAJA
    }

    piso = 1;
  }
}

Este ascensor debería funcionar de tal manera que:
Si aprieto un pulsador (el cual me designa un piso), y el sensor de carrera correspondiente para el piso está desactivado, el motor debería girar hasta que el sensor de carrera se active.
Mi problema es que, al apretar el pulsador 2 o 3, el circuito cambia de giro, sin importar los finales de carrera. Asi que solo cambia su sentido de giro si los mantengo apretados.

Principales diferencias entre el circuito de la foto y el mío real: Yo no estoy usando leds conectados aún, en lugar de un l293d estoy utilizando un l298n, estoy utilizando 3 finales de carrera como sensores y estoy utilizando una placa arduino nano v3.
He pensado en que un posible error sea la conexión de los finales de carrera, quizas al equivocarme en la conexion entre el NC, Comun o NO, pero ya he probado y aún así no me ha resultado.

Ante todo, muchas gracias!

No se si tendrá algo que ver con el mal funcionamiento, pero si estas usando un L293N tienes que ponerle diodos de alta velocidad externos, creo se les llaman diodos schottky.