Implemented reset in state machine elevators
Only compute next floor when needed