Preparing the elevator function
Première version de l'algo simple