Так ли нужно ПИД регулирование в конкретно данном случае ? Если нужно, то тут получается всё несколько сложнее, если нет, то сильно проще. Чего конкретно регулируем ?