Предлагаю испытать ШИМ регулятор, собранный из ФБ библиотеки OSCAT. Можно задавать гистерезис, начальное значение скважности импульсов, частоту несущей. Есть возможность обнулить значение интегральной составляющей ПИД регулятора. Скважность импульсов вычисляется по ПИД закону и меняется от 0 до 1. Можно перевести регулятор в ручной режим и задать фиксированную скважность.