Прикручивание кнопок к 32 битной плате

По некоторым причинам не хочу ставить энкодер (хотя он прекрасно работает) и решил заменить его кнопками, но после нескольких дней опытов и нахождения некоторой информации хабре получилось заставить работать только одну кнопку (нажатие). Может кто-то из спецов по С++ поможет помочь переделать файл ultralcd.cpp 

uint8_t enc = 0;

      if (buttons & EN_A) enc |= B01;

      if (buttons & EN_B) enc |= B10;

      if (enc != lastEncoderBits) {

        switch (enc) {

          case encrot0: ENCODER_SPIN(encrot3, encrot1); break;

          case encrot1: ENCODER_SPIN(encrot0, encrot2); break;

          case encrot2: ENCODER_SPIN(encrot1, encrot3); break;

          case encrot3: ENCODER_SPIN(encrot2, encrot0); break;

        }

        #if BOTH(HAS_LCD_MENU, AUTO_BED_LEVELING_UBL)

          external_encoder();

        #endif

        lastEncoderBits = enc;

      }

    #endif // HAS_ENCODER_WHEEL

  }