Для 3-х позиционного управления Вам надо написать свой ПИД, переписав классический в дифференциальной форме. Вот пример.
Правила форума