The Lone Knight
Ну, логику программы вроде понимаю. Сейчас напишу код, пришлю. Может правильно будет
Смотри что у тебя происходит в loop и что в это же время происходит с устройством. Если понимаешь логику цикла в нем - всего осталось организовать опрос кнопок и действие, что произойдет. (Если у тебя 2 кнопки и я верно с твоего скудного рассказа понял, что тебе нужно)