前面我們發布了一系列PID控制器相關的文章,包括經典PID控制器以及參數自適應的PID控制器。這一系列PID控制器雖說實現了主要功能,也在實際使用中取得了良好效果,但還有很多的細節部分可以改進以提高性能和靈活性。所以在這篇中我們來討論改進PID控制器以實現手自動的方便切換。
1、提出問題
PID控制器的效果是眾所周知的,但有些時候我們希望強制輸出某個值以查看執行機構的響應,或者有些時候我們希望直接指定執行機構的行為而不需要它隨時調整,在這些情況下我們該怎么做呢?
這個時候我們需要說明兩個定義。當使用PID控制器自動調節時,我們稱之為自動操作;而如上述情況下我們直接指定控制器的輸出時,或者說直接指定執行機構的行為時,我們稱之為手動。很顯然為了實現前述的相應操作,我們需要為PID控制器添加上手自動轉換功能。在這一篇中我們就來討論這個問題。
2、分析設計
現在我們需要考慮怎么來實現手自動轉換功能。首先我們需要在PID對象中添加一個屬性,這個屬性用於標識PID控制器究竟是處於手動模式還是自動模式。為了方便在外部修改PID對象的手自動模式,我們設計一個指向uint16_t的指針類型。所以我們設計PID對象如下:
1 /*定義PID對象類型*/ 2 typedef struct CLASSIC 3 { 4 float *pPV; //測量值指針 5 float *pSV; //設定值指針 6 float *pMV; //輸出值指針 7 float *pKp; //比例系數指針 8 float *pKi; //積分系數指針 9 float *pKd; //微分系數指針 10 uint16_t *pMA; //手自動操作指針 11 12 float setpoint; //設定值 13 float lasterror; //前一拍偏差 14 float preerror; //前兩拍偏差 15 float deadband; //死區 16 float result; //PID控制器計算結果 17 float output; //輸出值0-100% 18 float maximum; //輸出值上限 19 float minimum; //輸出值下限 20 float errorabsmax; //偏差絕對值最大值 21 float errorabsmin; //偏差絕對值最小值 22 float alpha; //不完全微分系數 23 float deltadiff; //微分增量 24 float integralValue; //積分累計量 25 float gama; //微分先行濾波系數 26 float lastPv; //上一拍的過程測量值 27 float lastDeltaPv; //上一拍的過程測量值增量 28 }CLASSICPID;
對於手自動操作,我們需要通過外部變量來賦值外,在初始化時我們將其默認初始化為自動模式,畢竟我們使用PID控制器的目的不是為了手動操作它。
3、軟件實現
我們為PID對象添加了手自動操作屬性,那么根據這個屬性我們需要對PID控制器進行哪些修改呢?我們考慮一下在自動狀態下和手動狀態下都需要做什么工作。
在自動狀態下沒有什么需要做的,就是讓PID控制器正常輸出就可以了。而在手動狀態下,我們要讓PID控制器的輸出為我們人為給定的輸出。僅僅如此,自然是不行的。我們考慮一下,PID控制器由自動轉為手動時,可能會給系統有什么影響。事實上,我們由自動轉為手動時,只要不修改輸出,整個系統的狀態不會發生變化。但由手動切換到自動時,由於我們修改了輸出值,測量值也會跟着發生變化,在原有設定值的情況下,由手動轉為自動時必然會出現階躍干擾,為了避免這種情況我們在手動狀態下讓設定值跟隨到測量值以達到無擾動切換。據此,我們修改PID控制器代碼為:
1 /* 通用PID控制器,采用增量型算法,具有變積分,梯形積分和抗積分飽和功能,微分項采用不完全微分,一階濾波,alpha值越大濾波作用越強 */ 2 void PIDRegulator(CLASSICPID *vPID) 3 { 4 float thisError; 5 float result; 6 float factor; 7 float increment; 8 float pError,dError,iError; 9 10 if(*vPID->pMA<1) //手動模式 11 { 12 vPID->output=*vPID->pMV; 13 //設置無擾動切換 14 vPID->result=(vPID->maximum-vPID->minimum)*vPID->output/100.0+-vPID->minimum; 15 *vPID->pSV=*vPID->pPV; 16 vPID->setpoint=*vPID->pSV; 17 } 18 else //自動模式 19 { 20 vPID->setpoint=*vPID->pSV; 21 thisError=vPID->setpoint-(*vPID->pPV); //得到偏差值 22 result=vPID->result; 23 if (fabs(thisError)>vPID->deadband) 24 { 25 pError=thisError-vPID->lasterror; 26 iError=(thisError+vPID->lasterror)/2.0; 27 dError=thisError-2*(vPID->lasterror)+vPID->preerror; 28 29 //變積分系數獲取 30 factor=VariableIntegralCoefficient(thisError,vPID->errorabsmax,vPID->errorabsmin); 31 32 //計算微分項增量帶不完全微分 33 vPID->deltadiff=(*vPID->pKd)*(1-vPID->alpha)*dError+vPID->alpha*vPID->deltadiff; 34 35 increment=(*vPID->pKp)*pError+(*vPID->pKi)*factor*iError+vPID->deltadiff; //增量計算 36 } 37 else 38 { 39 if((fabs(vPID->setpoint-vPID->minimum)<vPID->deadband)&&(fabs((*vPID->pPV)-vPID->minimum)<vPID->deadband)) 40 { 41 result=vPID->minimum; 42 } 43 increment=0.0; 44 } 45 46 result=result+increment; 47 48 /*對輸出限值,避免超調和積分飽和問題*/ 49 if(result>=vPID->maximum) 50 { 51 result=vPID->maximum; 52 } 53 if(result<=vPID->minimum) 54 { 55 result=vPID->minimum; 56 } 57 58 vPID->preerror=vPID->lasterror; //存放偏差用於下次運算 59 vPID->lasterror=thisError; 60 vPID->result=result; 61 62 vPID->output=(vPID->result-vPID->minimum)/(vPID->maximum-vPID->minimum)*100.0; 63 *vPID->pMV=vPID->output; 64 } 65 }
4、總結
我們添加了手自動轉換功能,並在手動轉為自動時,做了無擾動切換的預置。經測試效果與我們的預期一致。當我們將PID控制器置為自動狀態時,我們通過修改設定值(SV)來實現對系統的影響。而當我們將PID控制器置為手動狀態時,我們通過修改輸出值(MV)來實現對系統的影響。
歡迎關注: