actually 2 really clever things here:

1. separate down/up queues
2. just move floors one by one. I was trying to define on which floor to go next and it is a bit complicated :)