二零一二年二月二十日

前言在數(shù)字PID算法是目前一般控制領域中經(jīng)常使用的自動控制算法，它依據(jù)給定的設定值，反饋值，以及比例系數(shù)，積分和微分時間，計算出一定的控制量，使被控對象能保持在設定的工作范圍，并且可以自動的消除外部擾動。由于軟件系統(tǒng)的靈活性，經(jīng)計算出的PID參數(shù)可以在調(diào)試過程中隨時改變。能更精確的控制系統(tǒng)。得到較好的控制效果。PID 控制原理簡單、實現(xiàn)方便,并且適應面廣、魯棒性強,其控制品質(zhì)對被控對象特性的變化不是很敏感。隨著計算機技術的發(fā)展,在 PID 控制的基礎上,出現(xiàn)了很多改進的數(shù)字 PID 控制方法 ,如微分先行 PID 控制、積分分離 PID 控制、帶死區(qū)的PID 控制等。對于數(shù)字PID 控制方法,又分為增量式 PID 控制算式和位置式 PID 控制算式。在絕大多數(shù)工業(yè)控制中,數(shù)字 PID 控制仍然是一種穩(wěn)定的、可靠的、實現(xiàn)簡單的、使用廣泛的控制方法。

本設計以TI公司的TMS320VC5509和外接 D/ A芯片,實現(xiàn)數(shù)字 PID 控制器,采用的 PID 控制算法是增量式 PID 控制算法。TMS320VC5509 具有較高的運行速度和數(shù)據(jù)處理能力,能保證系統(tǒng)對多路模擬信號的實時采集和處理,提高系統(tǒng)的整體性能和集成度。在 DSP 內(nèi)部設置參考輸入量,通過DSP片上 10 位 A/ D 轉(zhuǎn)換器采樣,把控制對象的實際輸出量采集到 DSP 中,經(jīng)過DSP 的數(shù)字運算處理后,通過外部的 D/ A AD7237 進行數(shù)/ 模轉(zhuǎn)換,得到實際的模擬控制量去控制被控對象,使之按照系統(tǒng)的設置運行工作。

模擬PID控制系統(tǒng)組成如圖1所示：

             圖1 模擬PID控制系統(tǒng)原理框圖

PID調(diào)節(jié)器是一種線性調(diào)節(jié)器，它將給定值r(t)與實際輸出值c(t)的偏差的比例(P)、積分(I)、微分(D)通過線性組合構成控制量，對控制對象進行控制。根據(jù)圖1，可以推導出PID調(diào)節(jié)器的微分方程為：

      式中  

u(t)——控制器(也稱調(diào)節(jié)器)的輸出；

e(t)——控制器的輸入（常常是設定值與被控量之差，即e(t)=r(t)-c(t)）；

Kp——控制器的比例放大系數(shù)；

Ti ——控制器的積分時間；

Td —— 控制器的微分時間。

1.1 PID調(diào)節(jié)器各校正環(huán)節(jié)的作用

比例環(huán)節(jié)：即時成比例地反應控制系統(tǒng)的偏差信號e(t)，偏差一旦產(chǎn)生，調(diào)節(jié)器立即產(chǎn)生控制作用以減小偏差。對于大多數(shù)調(diào)節(jié)器而言，都不采用比例增益kc作為刻度，而是用比例度來刻度，即δ=1/kc*100%. 也就是說比例度與調(diào)節(jié)器的放大倍數(shù)的倒數(shù)成比例。調(diào)節(jié)器的比例度越小，它的放大倍數(shù)越大，它把偏差放大的能力越大，反之亦然。

積分環(huán)節(jié)：主要用于消除靜差，提高系統(tǒng)的無差度。積分作用的強弱取決于積分時間常數(shù)TI，TI越大，積分作用越弱，反之則越強。調(diào)節(jié)器的積分作用就是為了消除自控系統(tǒng)的余差而設置的。所謂積分，就是隨時間進行累積的意思，即當有偏差輸入e存在時，積分調(diào)節(jié)器就要將偏差隨時間不斷累積起來，也就是積分累積的快慢與偏差e的大小和積分速度成正比。只要有偏差e存在，積分調(diào)節(jié)器的輸出就要改變，也就是說積分作用總是起作用的，只有偏差不存在時，積分才會停止。

微分環(huán)節(jié)：能反應偏差信號的變化趨勢(變化速率)，并能在偏差信號的值變得太大之前，在系統(tǒng)中引入一個有效的早期修正信號，從而加快系統(tǒng)的動作速度，減小調(diào)節(jié)時間。可見，微分分量對偏差的任何變化都會產(chǎn)生控制作用，以調(diào)整系統(tǒng)輸出，阻止偏差變化,預見隨后。偏差變化越快，則產(chǎn)生的阻止作用越大。對于一個固定不變的偏差e(t)，不論其數(shù)值多大，根本不會有微分作用輸出。

模擬形式	離散化形式

式中                  稱為比例項

                 稱為積分項

         稱為微分項

    P控制         

PI控制         

PD控制         

PID控制        

                 

              

式中

u(t)——控制器(也稱調(diào)節(jié)器)的輸出；

e(t)——控制器的輸入（常常是設定值與被控量之差，即e(t)=r(t)-c(t)）；

Kp——控制器的比例放大系數(shù)；

Ti ——控制器的積分時間；

Td——控制器的微分時間。

設u(k)為第k次采樣時刻控制器的輸出值，可得離散的PID算式

式中 ，               。

由于計算機的輸出u(k)直接控制執(zhí)行機構（如閥門），u(k)的值與執(zhí)行機構的位置（如閥門開度），所以通常稱上式為位置式PID控制算法。

圖2 位置式PID控制器流程圖

位置式PID控制算法的缺點：當前采樣時刻的輸出與過去的各個狀態(tài)有關，計算時要對e(k)進行累加，運算量大；而且控制器的輸出u(k)對應的是執(zhí)行機構的實際位置，如果計算機出現(xiàn)故障，u(k)的大幅度變化會引起執(zhí)行機構位置的大幅度變化。

           

        式中 ， ，

增量式PID是指數(shù)字控制器的輸出只是控制量的增量Δu(k)。采用增量式算法時，計算機輸出的控制量Δu(k)對應的是本次執(zhí)行機構位置的增量，而不是對應執(zhí)行機構的實際位置，因此要求執(zhí)行機構必須具有對控制量增量的累積功能，才能完成對被控對象的控制操作。執(zhí)行機構的累積功能可以采用硬件的方法實現(xiàn)；也可以采用軟件來實現(xiàn)，如利用算式 程序化來完成。

由上式可得增量式PID控制算式

式中

進一步可以改寫成

式中 、 、

一般計算機控制系統(tǒng)的采樣周期T在選定后就不再改變，所以，一旦確定了Kp、Ti、Td，只要使用前后3次測量的偏差值即可求出控制增量。

根據(jù)上述分析，其程序流程圖如下：

圖3 增量型控制算法路程圖

增量式算法優(yōu)點：①算式中不需要累加。控制增量Δu(k)的確定僅與最近3次的采樣值有關，容易通過加權處理獲得比較好的控制效果；②DSP每次只輸出控制增量，即對應執(zhí)行機構位置的變化量，故機器發(fā)生故障時影響范圍小、不會嚴重影響生產(chǎn)過程。

經(jīng)過綜合比較，最終選擇了增量式控制算法。

為了實現(xiàn)上述控制算法，還需要硬件電路才行，設計電路原理圖如圖4所示：

從圖4 中可以看出,模擬量輸入,也即被控電機的實際輸出轉(zhuǎn)速,通過一個限流電阻 R 送到由 AD8041 構成的電壓跟隨器里,經(jīng)過放大后,再經(jīng)二極管D1 和 D2嵌位以及電阻 R 限流,送到TMS320VC5509片上的 A/D 轉(zhuǎn)換其中使得 A/D 的輸入限制在 0～3 300 mV。TMS320VC5509 一共有16 路復用的片上 A/D 轉(zhuǎn)換器,本實例只采用第 0 通道的A/D轉(zhuǎn)換。由DSP計算出控制量,通過外部數(shù)據(jù)總線送給D/ A 轉(zhuǎn)換器,采用 AD 公司的 AD7237 芯片,他是 8 位 D/ A 轉(zhuǎn)換器,由DSP的外部地址總線A2 ,A1 ,A0 構成D/ A轉(zhuǎn)換器的譯碼電路,D/ A轉(zhuǎn)換器的輸出采用AD7237 的A相輸出。TMS320VC5509 由外部提供復位信號,由無源晶振提供6 MHz時鐘。片上 A/D 轉(zhuǎn)換器的參考電壓高電平 V 接DSP電源+3.3 V 。

圖4  DSP實現(xiàn)數(shù)字PID控制器的電路原理圖

3.2 軟件設計

本設計運用了CCSV3.3軟件，它是一個完整的DSP集成開發(fā)環(huán)境，CCS支持軟仿真器、各種型號的硬仿真器、各種DSK和EVM板。

[11]CCS主要特點有：集成可視化代碼編輯界面，可以方便地直接編寫C、匯編、.h文件、.cmd文件等；集成代碼生成工具，包括匯編器、優(yōu)化的C編譯器和連接器等；具有完整的基本調(diào)試工具，可以載入執(zhí)行文件(.out)，查看寄存器窗口、存儲器窗口和變量窗口、反匯編窗口等，支持在C源代碼級進行調(diào)試；支持多片DSP聯(lián)合調(diào)試；

斷點工具，支持硬件斷點、數(shù)據(jù)空間讀/寫斷點、條件斷點等；探針工具（probe points），用于進行算法仿真，數(shù)據(jù)監(jiān)視等；剖析工具（profile pionts），用于評估代碼執(zhí)行的時間；數(shù)據(jù)圖形顯示工具，可繪制時域/頻域波形、眼圖、星座圖等，并可以自動刷新；提供GEI二工具，用戶可以根據(jù)需要編寫自己的控制面板/菜單，從而方便直觀地修改變量，配置參數(shù)。支持RTDX（Real time date exchange）技術，利用該技術可以在不中斷目標系統(tǒng)運行的情況下，實現(xiàn)DSP與其它應用程序（OLE）實現(xiàn)數(shù)據(jù)交換，具有開放式的plug-ins技術，支持其它第三方的ActiveX插件。提供DSP、BIOS工具，利用該工具可增強對代碼的實時分析能力，減少開發(fā)人員對硬件資源熟悉程度的依賴性。

圖5 代碼調(diào)試與編譯

為了驗證算法的可行性，現(xiàn)建立數(shù)字PID直流電機控制模型，然后用Matlab的LTI狀態(tài)分析工具箱進行仿真，并繪制轉(zhuǎn)速及控制電壓變化圖形。

1. /*****************************************************************
   
2. PID Function
   
3. The PID (比例、積分、微分) function is used in mainly
   
4. control applications. PIDCalc performs one iteration of the PID
   
5. algorithm.
   
6. While the PID function works, main is just a dummy program showing
   
7. a typical usage.
   
8. ****************************************************************/
   
9. /****************************頭文件******************************/
   
10. #include "DSP28_Device.h"
    
11. #include "System.h"
    
12. #include "DSP28_Adc.h"
    
13. 
    
14. typedef struct PID {
    
15. double SetPoint;                        // 設定目標Desired value
    
16. double Proportion;                      // 比例常數(shù)Proportional Const
    
17. double Integral;                        // 積分常數(shù)Integral Const
    
18. double Derivative;                      // 微分常數(shù)Derivative Const
    
19. double LastError;                       // Error[-1]
    
20. double PrevError;                       // Error[-2]
    
21. double SumError;                       // Sums of Errors
    
22. } PID;
    
23. /*********************PID計算部分*********************************/
    
24. double PIDCalc( PID *pp, double NextPoint )
    
25. {
    
26. double dError,
    
27. Error;
    
28. Error = pp->SetPoint - NextPoint;                          // 偏差
    
29. pp->SumError += Error;                                  // 積分
    
30. dError = pp->LastError - pp->PrevError;                    // 當前微分
    
31. pp->PrevError = pp->LastError;
    
32. pp->LastError = Error;
    
33. return (pp->Proportion * Error                             // 比例項
    
34. + pp->Integral * pp->SumError                            // 積分項
    
35. + pp->Derivative * dError );                               // 微分項
    
36. }
    
37. 
    
38. /**********************Initialize PID Structure************************/
    
39. void PIDInit (PID *pp)
    
40. {
    
41. memset ( pp,0,sizeof(PID));
    
42. }
    
43. 
    
44. /********************Main Program*********************************/
    
45. double sensor (void)                                     // Dummy Sensor Function
    
46. {
    
47. return 100.0;
    
48. }
    
49. void actuator(double rDelta)                             // Dummy Actuator Function
    
50. {}
    
51. 
    
52. void InitAdc(void)
    
53. {
    
54. unsigned int i;
    
55. AdcRegs.ADCTRL1.bit.RESET=1;
    
56. NOP;
    
57. AdcRegs.ADCTRL1.bit.RESET=0;                      //重新設置
    
58. AdcRegs.ADCTRL1.bit.SUSMOD=3;              //設置仿真掛起模式 3，
    
59. AdcRegs.ADCTRL1.bit.ACQ_PS=0;
    
60. AdcRegs.ADCTRL1.bit.CPS=0;
    
61. //對高速時鐘 HSPCLK 分頻，=0 時，不分頻，=1 時，二分頻
    
62. AdcRegs.ADCTRL1.bit.CONT_RUN=0;             //開始-----停止模式
    
63. AdcRegs.ADCTRL1.bit.SEQ_CASC=1;
    
64. //級聯(lián)模式，SEQ1 和 SEQ2 作為一個 16 狀態(tài)排序器工作。
    
65. AdcRegs.ADCTRL3.bit.ADCBGRFDN=3;           //帶隙和參考電路上電for(i=0;i<10000;i++) NOP;
    
66. AdcRegs.ADCTRL3.bit.ADCPWDN=1;
    
67. //除帶隙和參考電路外的 ADC 其它模擬電路上電
    
68. for(i=0;i<5000;i++)  NOP;
    
69. AdcRegs.ADCTRL3.bit.ADCCLKPS=15;
    
70.                                             //時鐘分頻 ADCCLKPS=HSPCLKPS/[2*15*(ADCTRL1[7]+1)]
    
71. AdcRegs.ADCTRL3.bit.SMODE_SEL=1;           //選擇同步采樣模式
    
72. 
    
73. AdcRegs.MAX_CONV.bit.MAX_CONV=0;           //設置轉(zhuǎn)換通道0
    
74. AdcRegs.CHSELSEQ1.bit.CONV00=0;
    
75. AdcRegs.ADC_ST_FLAG.bit.INT_SEQ1_CLR=1;   //清除 SEQ1 的中斷標志位
    
76. AdcRegs.ADC_ST_FLAG.bit.INT_SEQ2_CLR=1;   //清除 SEQ2 的中斷標志位
    
77. AdcRegs.ADCTRL2.bit.EVB_SOC_SEQ=0;      //無作用
    
78. AdcRegs.ADCTRL2.bit.RST_SEQ1=0;      
    
79. //將排序器立即復位到 CONV00 狀態(tài)
    
80. AdcRegs.ADCTRL2.bit.INT_ENA_SEQ1=1;  //使能 INT_SEQ1 的中斷請求
    
81. AdcRegs.ADCTRL2.bit.INT_MOD_SEQ1=0;
    
82.                                           //每個 SEQ1 序列結束時，INT_SEQ1 置位
    
83. AdcRegs.ADCTRL2.bit.EVA_SOC_SEQ1=0;    //EVA 的觸發(fā)信號不啟動 SEQ1
    
84. AdcRegs.ADCTRL2.bit.EXT_SOC_SEQ1=0;    //無操作
    
85. AdcRegs.ADCTRL2.bit.RST_SEQ2=0;        //無操作
    
86. AdcRegs.ADCTRL2.bit.SOC_SEQ2=0;         //清除一個掛起的 SOC 觸法
    
87. AdcRegs.ADCTRL2.bit.INT_ENA_SEQ2=0;     //禁止 INT_SEQ2 產(chǎn)生的中斷請求
    
88. AdcRegs.ADCTRL2.bit.INT_MOD_SEQ2=0;
    
89. //每個 SEQ2 結束時，INT_SEQ2 置位
    
90. AdcRegs.ADCTRL2.bit.EVB_SOC_SEQ2=0;   
    
91. //EVB 的觸發(fā)信號不啟動 SEQ2
    
92. AdcRegs.ADCTRL2.bit.SOC_SEQ1=1;
    
93. //軟件觸法，從當前停止的位置啟動 SEQ1
    
94. 
    
95. void main(void)
    
96. {
    
97. PID sPID;                                // PID Control Structure
    
98. double rOut;                             // PID Response (Output)
    
99. double rIn;                              // PID Feedback (Input)
    
100. PIDInit ( &sPID );                        // Initialize Structure
     
101. sPID.Proportion = 0.5;                    // Set PID Coefficients
     
102. sPID.Integral = 0.5;
     
103. sPID.Derivative = 0.0;
     
104. sPID.SetPoint = 100.0;                    // Set PID Setpoint
     
105. for (;;) {                                // Mock Up of PID Processing
     
106. rIn = sensor ();                           // Read Input
     
107. rOut = PIDCalc ( &sPID,rIn );               // Perform PID Interation
     
108. actuator ( rOut );                         // Effect Needed Changes
     
109. while(AdcRegs.ADC_ST_FLAG.bit.SEQ1_BSY==0)
     
110. {
     
111. AdcRegs.ADCTRL2.bit.SOC_SEQ1=1;
     
112. }     //只要 SEQ1 不忙，那么就啟動 SOC_SEQ1
     
113. }
     
114. /*********************AD 中斷服*********************************/
     
115. 
     
116. interrupt void ad(void)
     
117. {      
     
118.    PieCtrl.PIEACK.bit.ACK1=1;               //采集 ADC0 通道的數(shù)據(jù)     
     
119. ADtemp[adflag]=(AdcRegs.RESULT0>>4)&0x0fff;
     
120. //右移四位，減小誤差
     
121.                     //RESULT 寄存器的低四位為無效位，故應右移四位
     
122.         adflag++;
     
123.         if(adflag==MAX_DATA)
     
124. {
     
125.           adflag=0;
     
126. }
     
127.      AdcRegs.ADC_ST_FLAG.bit.INT_SEQ1_CLR=1;    //清除中斷標志位
     
128.      AdcRegs.ADCTRL2.bit.SOC_SEQ1=1;      
     
129. 
     
130. …………限于本文篇幅 余下代碼請從51黑下載附件…………

復制代碼

完整論文下載（word格式 可編輯）：
基于DSP的PID控制算法的實現(xiàn).doc (477 KB, 下載次數(shù): 375)

2017-6-5 15:10 上傳

點擊文件名下載附件
PID算法的DSP實現(xiàn)資料