Используйте либо простой регулятор Pid_Function либо ПИД регулятор из Util.lib