Эх, у AI! хороший макрос есть для ПР200, а вот на CodeSys его перенести у меня не вышло.... там и наработка выравнивается для моторесурса и управление легко реализовать по температуре или давлению.....
Собственно вы алгоритм уже и расписали...