Поменял местами уставку с измереным значением и все работает на пид util, теперь осталось коэффициенты подобрать. VoBa спасибо за совет, очень благодарен.