急求51单片机大神解决问题

想设计一个仿电梯点阵显示层数的51程序，却卡在判断顺序楼梯的问题一直不能想不出来。所以求51大神来给我解解惑
下面举几个明显的例子
1，电梯在1层，一人在3层，1人在2层，目的是5层。3层先按下电梯，2层随后按下，实际情况应该是电梯先到2层，2层停止后，电梯再上到3层。
2，电梯在3层，一人在4层，1人在2层，目的是1层。电梯应先上到4层，再到2层，再到1层。
  到底这些情况的程序怎么写呢?

这个虽然2591100空包网不知道答案，占个沙发吧。

电梯先看自己上还是下，上的过程只检测电梯所在层以上是不是要停。下的过程检测电梯所在楼层以下是不是需要停。如果电梯停着是哪边先有信号先去哪边。如果电梯在3楼 正往1楼下去，4楼有人按也不会返回4楼再下1楼的吧。

说的有点道理，但程序中运用到键盘，键盘中有又了判断上下，可是按键是需要按2次的，但现在程序只能检测一次，第二次根本检测不到。怎么办呢?

保存一下按键不就行了。还有一个忘记了 每层应该有三种指令：上下和未按键。上的过程不检测下的指令。

我感觉没有必要加未按键吧，毕竟先按了上升键，就会先走上升楼梯了，等到到达目的楼层，才会检测到下降按键吧