Я обычно использую ПИД из библиотеки Util.lib, а вызываю регулятор в программе с периодичностью 1 сек. Этот вариант 100% рабочий!!!