Ciao, a me non sembra affatto il modo migliore di implementare un ascensore e neanche di organizzare il codice 
Ti dovresti creare una variabile piano "il piano prenotato", e una variabile posizione "la posizione effettiva
dell'ascensore"
Ti dovresti creare una funzione per muovere l'ascensore che riceve come parametro il piano
Nella funzione fai un confronto if() se piano maggiore di posizione sali, else if se piano minore di posizione
scendi fino al sensore.
Ovviamente nella funzione avrai una variabile sensore che modificherai a secondo del piano
if(piano==1)
sensore=sensore1;
else if(piano==2)
sensore=sensore2
digitalRead(sensore);