Спасибо я понял все и ПИД работает, только я все больше понимаю, что мне не ПИД нужен, а может быть ПИ. ПИД очень быстро и не всегда хорошо реагирует на изменение пораметров объекта. Вообщем у него много лишних движений. Для инерционного объекта лишнии движения не нужны, нужно мало, но по делу.
Подыскиваю все возможные варианты. Если есть опыт в исползовании других видов регуляторов, напишите.