Хабр Курсы для всех
РЕКЛАМА
Практикум, Хекслет, SkyPro, авторские курсы — собрали всех и попросили скидки. Осталось выбрать!
uint16_t DoFullPID(uint16_t In, uint16_t Ref, uint16_t *Coeff)
{
uint16_t Kp, Ki, Kd, Output, Error;
Error = Ref - In;
Kp = Coeff[0];
Ki = Coeff[1];
Kd = Coeff[2];
IntTerm_C += Ki*Error;
Output = Kp * Error;
Output += IntTerm_C;
Output += Kd * (Error - PrevError_C);
PrevError_C = Error;
return (Output);
}
Корректная реализация разностной схемы ПИД регулятора