Не советую. Просто дал идею. Детально Ваш алгоритм не знаю. У меня так работает на Arduino вствоенного в синтезатора. Без задержки в работе, а режимах задается в меню.... если Вы это мне советует ... Мысленно?
Мне как вариант електронное переключение с логикой в MCU проще, чем аппаратное (тумблер) - можете смешивать сигналы пинов к состояние переменными в каждой конфигурации. (+ г. трайслейт)