3-х ступенчатый регулятор мощности

[NikVlaD]

Всем доброго времени суток. Помогите разработать алгоритм работы 3-х ступенчатого регулятора оборотов коллекторного двигателя в зависимости от температуры. Скажу сразу проект этот чисто демонстрационный, делаю для учебного стенда. В качестве контроллера ПР200, сам двигатель будет управляться через симисторный регулятор аналоговым выходом.
Задание примерно такое:
До 20 градусов ничего происходить не должно - двигатель не работает.
При достижении 22 градусов двигатель включается примерно на 30% от номинала и работает так до 24 градусов. При этом загорается индикатор 1 ступени
Если температура превысила отметку 24 включается 2 ступень - загорается индикатор 2 ступени, двигатель работает на 60 %
Если температура больше 26, включается 3 ступень, двигатель на 100%.
Ну и в обратном порядке тоже должно работать.
Начал я с простого, с индикации ступеней.
Безымянный.png
Вроде бы и работает как надо. Но меня напрягает наличие "мёртвой зоны" в 20 градусов. Т.е, на кокой бы ступени не находилась программа при 20 градусах ничего не отключается а выключится только при 19. Проблема бы решилась если бы был блок проверки на равенство дробных чисел, но такого нет... Подскажите пожалуйста способы решения данной проблемы...
И ещё просьба к специалистам, посмотреть проект. Насколько он правильный, может как-то по другому этот алгоритм можно реализовать. В симуляторе оно вроде работает, но вот на практике... это уже вопрос. Пока контроллера у меня нет, ещё только едет)) Так, что проверить не на чем((