Можно попробовать использовать ПИД из библиотеки, идущей с контроллером