Поставьте датчик Т на вход пид регулятора ПЧ.
В ПЧ уже все есть.