Только пробовать не на макетке, как там нарисовано. стабильность есп в таком виде, похоже, нулевая. У меня не удается в принципе отладить алгоритм, случайные сбросы, мертвые висы в непредсказуемый момент.
p.s. да, все свободные пины подтянуты, источник питания по току не проседает, конденсатор...