https://www.passeidireto.com/arquivo/20009898/implementacao-de-controladores-de-pid
Recomendo esse arquivo que achei no Passei Direto