Предлагаю рассмотреть возможность реализации ф/блока "Шаговая программа".
Уверен, данный ф/б позволит упростить решение многих задач логико - программного управления. В качестве примера прикладываю кусок тех. описания с реализацией такого ф/б в контроллере "Ремиконт-130". Алгоритм работы продублирован на приложенной картинке.