Самодельный таймер для коптера

Постепенно начинаю подумывать над переходом на кнопки, потому что дребезг пока никак не хочет побеждаться.

Я с этим справляюсь используя в процедуре сканирования кнопки функцию delay(). Может с энкодером тоже проканает?