ARM, RISC-V контроллеры

Похоже, у Вас сложности в том числе и из-за недостатка памяти. Если поделить весь интерфейс на экраны/состояния автомата и писать "свободно", не экономя память, с повторами, если хочется, то все станет понятно и очевидно. 512Kбайт кода + 16Мбайт на 30-50 экранов/функций вылечат геморрой.