Рад, что все получилось.
P.S просто соображение насчет ПИДа: он выдает -100 ...+100, возможно, правильнее будет прибавить 100, получив 0..200, а потом поделить /2->0..100