void pid_Cal(void) { //float index = 0; IncPid * p = NULL; p = &g_PID_Inc; p->SetVal = sys_para.given_temp; p->ActualVal = g_pt100.f_real_value; p->err = p->SetVal - p->ActualVal; if(work_temp_phase == work_phase_43C_level) { if(FAN_Speed_Status == FAN_Speed_LOW) { if(fabs(p->err) >= 6.0f) { p->Kp = 0; //0.45 p->Ki = 0.4; //0.05 p->Kd = 0; } else { p->Kp = 1.8; //0.4 0.475 p->Ki = 0.4; //0.05 0.07 p->Kd = 0; //0.2 } } else if(FAN_Speed_Status == FAN_Speed_HIGH) { if(fabs(p->err) >= 6.0f) { p->Kp = 0; //0.45 p->Ki = 0.4; //0.05 p->Kd = 0; } else { p->Kp = 1.75; //0.4 0.475 p->Ki = 0.38; //0.05 0.07 p->Kd = 0; //0.2 } } } else if(work_temp_phase == work_phase_38C_level) { if(FAN_Speed_Status == FAN_Speed_LOW) { if(fabs(p->err) >= 6.0f) { p->Kp = 0; //0.45 p->Ki = 0.4; //0.05 p->Kd = 0; } else { p->Kp = 1.8; //0.4 0.475 p->Ki = 0.4; //0.05 0.07 p->Kd = 0; //0.2 } } else if(FAN_Speed_Status == FAN_Speed_HIGH) { if(fabs(p->err) >= 6.0f) { p->Kp = 0; //0.45 p->Ki = 0.4; //0.05 p->Kd = 0; } else { p->Kp = 1.75; //0.4 0.475 p->Ki = 0.38; //0.05 0.07 p->Kd = 0; //0.2 } } } else if(work_temp_phase == work_phase_32C_level) { if(FAN_Speed_Status == FAN_Speed_LOW) { if(fabs(p->err) >= 6.0f) { p->Kp = 0; //0.45 p->Ki = 0.4; //0.05 p->Kd = 0; } else { p->Kp = 1.8; //0.4 0.475 p->Ki = 0.4; //0.05 0.07 p->Kd = 0; //0.2 } } else if(FAN_Speed_Status == FAN_Speed_HIGH) { if(fabs(p->err) >= 6.0f) { p->Kp = 0; //0.45 p->Ki = 0.4; //0.05 p->Kd = 0; } else { p->Kp = 1.75; //0.4 0.475 p->Ki = 0.38; //0.05 0.07 p->Kd = 0; //0.2 } } } p->IncrementVal = (p->Kp * (p->err - p->err_next)) + (p->Ki * p->err) + (p->Kd * (p->err - 2 * p->err_next + p->err_last)); p->err_last = p->err_next; p->err_next = p->err; }
可以看出,首先调整的是P控制,代码中为Ki,因为增量式pid的ki参数相当于位置式的p控制,所以首先调整ki,是的温度出现震荡,然后添加kp(位置式的d控制),这样就可以使系统稳定。
同时,也是用了微分分离的思想,就是温差比较大的时候,不要微控制,即kp=0;,到了一定稳定范围了,才使用pd控制。