programar un ascensor en miniatura

Hola a todos.
Estoy en un proyecto que no es muy facl, por lo menos para mi. Estoy haciendo una replica de un ascensor para 5 pisos controlado desde una pc. Toda la parte electronica ya lo hice (Controladora del motor paso a paso, interfaz al puerto paralelo). Lo unico que me esta faltando es hacer un programita para hacerlo funcionar. La idea es por ej, si me llaman del piso 2 que vaya a el, y despues al 5 y q vaya al mismo y asi sucesivamente.
Espero que me puedan ayudar.
Desde ya muchas gracias.