Чесно сказать не так должен выглядеть код
Постараюсь выложить код управления кнопками
2 секунды для ардуины, это вечность(по человеческим меркам)