Add check for whether elevator is at height

Add check for whether elevator is at height #288