資源簡介
PID算法.c
代碼片段和文件信息
/*本代碼開源,如果引用請注明來自STCunio?Studio*/
/*聯系方式QQ:117112538,歡迎交流**************/
#include“pid.h“
int?abcCoefficients[3];
long?controlHistory[3];
long?controlOutput;
void?pidbegin(int?aint?bint?c)
{
// int?abc;
// a=Q15(kp?+?ki?+?kd);
// b=Q15(-1?*(kp?+?2?*?kd));
// c=Q15(kd);
??controlHistory[0]=0;
controlHistory[1]=0;
??controlHistory[2]=0;
controlOutput=0;
abcCoefficients[0]=a;
abcCoefficients[1]=b;
abcCoefficients[2]=c;
}
long?pid(int?refe
評論
共有 條評論