Вариантов реализации ветвления море. Например такой (быстренько набросал)

Снимок.PNG

Слева ваши программы. А биты выбора режима дело схемотехники вашего станка.