Реализация алгоритма наполнения емкости с тремя стадиями

[Сергей0308]

Всем добрый день. Недавно подкинули интересную задачку, но которую не могу нормально реализовать.
Дано:
Аналоговый датчик уровня воды (0-6м, но я делал динамическую подгонку).
Необходимо реализовать три стадии:
1) Если опустилось ниже определенного порога 1 высоты, включается Насос 1. Если поднялось до порога 1.1 Выключить насос 1(полное заполнение)
2) Если опустилось ниже порога 2, отключить насос 1 и перейти на насос 2. Если поднялось до порога 2.1 выключить насос 2 и перейти на насос 1
3) Если опустилось ниже порога 3, работают насосы 1 и 2. Если поднялось до порога 3.1 выключить насос 1, насос 2 оставить в работе
(То есть каждая стадия имеет пороги включения и выключения)

Сам реализовывал в ФБ STшном на IFах с >= и <=, выходила полная шляпа(Стадии накладывались друг на друга)
Прикладываю проект со своими пробами, но там все уже перемешано и напеределывано 100 раз.

Это же очень простой алгоритм, думаю любой школьник за 5 минут сделает, типа так: формируете эти ваши стадии, например с помощью макроса двухпозиционного регулятора с гистерезисом из менеджера компонентов, я в одной из тем выкладывал подобный макрос, но с явным назначением уровней срабатывания, мне кажется это намного удобней! Каждой стадии соответствует её порядковый номер, в смысле, 1, 2 и 3 и из этого значения извлекаем нулевой бит(с весовым коэффициентом "1") и используем для работы первого насоса и первый бит(с весовым коэффициентом "2") и используем для работы второго насоса, всё!

Примерно как-то так, в смысле, мой вариант:

Вариант простого алгоритма.PNG

Вариант простого алгоритма_5.PNG

Простой алгоритм.owle

Или так:

Вариант простого алгоритма_2.PNG

Вариант простого алгоритма_3.PNG

Вариант простого алгоритма_4.PNG

Простой алгоритм_2.owle