А в этом ЧП источником задания для ПИД'а не может быть второй датчик ?
В таком случае 2 датчика и всё.