Боюсь, что так с алгоритмом вам никто не подскажет. То, что вы хотите сделать напоминает тиристорный преобразователь напряжения. Однако, ТПН содержит в себе разные защиты двигателя. Вам придется самому разрабатывать это все, что бы реализовать на уровне БУСТ и ПЛК.