Ascensor de 3 plantas con finales de carrera

Hantonius:
Buenas, estoy haciendo un proyecto de un ascensor de tres plantas, controlado con un pulsador en cada planta para llamar al ascensor y finales de carrera para detectar en que planta está el ascensor.
Mi problema viene cuando quiero hacer que el ascensor pare en la planta de la que ha sido llamado, no se como hacerlo!
El ascensor se mueve con un servomotor 360º
Alguien que me pueda ayudar??

Hola,
¿Cómo están cableados los pulsadores (al arduino)?. ¿No hay botonera interna (en la cabina)?
Saludos