Как раз на блоке PLA из менеджера компонентов, когда-то делал установку для сушки древесины, тоже было несколько шагов, но там было условие выдерживать еще и интенсивность выхода на уставку, плюс еще много заморочек, делался аналого ТРМ251, только для полевых условий, если пропадало питание, после его включения нужно было принимать решение автоматически продолжать шаг, или возвращаться на предыдущий. Так-что этот макрос идеальный вариант именно для построения диаграммы, дальше уже под конкретику добавить логику.