pid-ctrl.c

模糊pID控制的典型程序

void PID_Ctrl(void) //增量式PID，调节ui
{
#define delt_Um 15
//刷新近2次偏差
PID.LastError=PID.ei;
PID.ei=PID.Goal-PID.ADC_data[0];
if(PID.ei<0) PID.abs_ei=-PID.ei;
else PID.abs_ei=PID.ei;
//刷新偏差变化，为零延续上一次的变化趋势
PID.delt_ei=PID.ei-PID.LastError;
if(PID.delt_ei>0) PID.delt_ei_PN=1;
if(PID.delt_ei<0) PID.delt_ei_PN=-1;
//开关控制
if(PID.ei>PID.Limit_PIDorKey)
{PID.ui=3*50;                         //50Hz交流电
return;
}
if(PID.ei<-5)
{PID.ui=0;
return;
}
//增量PID控制
if(((PID.ei>0)&&(PID.delt_ei_PN<0))||((PID.ei<0)&&(PID.delt_ei_PN>0)))
PID.I_sign=0;                 //专家PID测量值正向目标值靠近，取消积分作用
else PID.I_sign=1;
PID.delt_ui=PID.P/17*PID.delt_ei+PID.I_sign*PID.I/100*PID.ei-PID.D/200*(PID.ADC_data[0]-2*PID.ADC_data[1]+PID.ADC_data[2]);
//para_P约等于3.0，para_I约等于0.5，para_D约等于0.25
if(PID.delt_ui>delt_Um) PID.delt_ui=delt_Um;
if(PID.delt_ui<-delt_Um) PID.delt_ui=-delt_Um;
PID.ui+=PID.delt_ui;
if(PID.ui<0)PID.ui=0;
if(PID.ui>3*50)PID.ui=3*50;
}