Кто мешает сигнал о положении подать на вход ПИД-а "Текущее значение", а задание на вход "Уставка"?
Зачем городить что-то новое, когда можно реализоваться на уже сделанных блоках?