二零一二年二月二十日

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

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

模擬PID控制系統組成如圖1所示：

1.003.jpg (10.01 KB, 下載次數: 135)

下載附件

2017-6-5 17:21 上傳

             圖1 模擬PID控制系統原理框圖

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

      式中  

u(t)——控制器(也稱調節器)的輸出；

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

Kp——控制器的比例放大系數；

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

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

1.1 PID調節器各校正環節的作用

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

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

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

模擬形式	離散化形式
1.006.jpg (1.98 KB, 下載次數: 138) 下載附件 2017-6-5 17:21 上傳	1.007.jpg (2.11 KB, 下載次數: 144) 下載附件 2017-6-5 17:21 上傳
1.008.jpg (1.48 KB, 下載次數: 134) 下載附件 2017-6-5 17:21 上傳	1.009.jpg (2.05 KB, 下載次數: 142) 下載附件 2017-6-5 17:21 上傳
1.010.jpg (1.5 KB, 下載次數: 147) 下載附件 2017-6-5 17:21 上傳	1.011.jpg (2.86 KB, 下載次數: 135) 下載附件 2017-6-5 17:21 上傳

1.012.jpg (7.84 KB, 下載次數: 131)

下載附件

2017-6-5 17:21 上傳

式中  

1.013.jpg (1.92 KB, 下載次數: 121)

下載附件

2017-6-5 17:21 上傳

               稱為比例項

      

1.014.jpg (2.96 KB, 下載次數: 137)

下載附件

2017-6-5 17:21 上傳

          稱為積分項

      

1.015.jpg (3.14 KB, 下載次數: 137)

下載附件

2017-6-5 17:21 上傳

  稱為微分項

    P控制         

1.016.jpg (1.98 KB, 下載次數: 129)

下載附件

2017-6-5 17:21 上傳

PI控制         

1.017.jpg (2.57 KB, 下載次數: 146)

下載附件

2017-6-5 17:21 上傳

PD控制         

1.018.jpg (2.61 KB, 下載次數: 120)

下載附件

2017-6-5 17:21 上傳

PID控制        

1.019.jpg (3.18 KB, 下載次數: 131)

下載附件

2017-6-5 17:21 上傳

                 

1.020.jpg (5.56 KB, 下載次數: 144)

下載附件

2017-6-5 17:21 上傳

1.021.jpg (4.76 KB, 下載次數: 118)

下載附件

2017-6-5 17:21 上傳

              

式中

1.022.jpg (2.05 KB, 下載次數: 144)

下載附件

2017-6-5 17:21 上傳

u(t)——控制器(也稱調節器)的輸出；

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

Kp——控制器的比例放大系數；

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

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

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

式中

，              

1.025.jpg (3.12 KB, 下載次數: 121)

下載附件

2017-6-5 17:21 上傳

。

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

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

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

1.027.jpg (8.98 KB, 下載次數: 122)

下載附件

2017-6-5 17:21 上傳

           

1.028.jpg (4.25 KB, 下載次數: 136)

下載附件

2017-6-5 17:21 上傳

        式中

1.029.jpg (2.75 KB, 下載次數: 139)

下載附件

2017-6-5 17:21 上傳

，

1.030.jpg (2.3 KB, 下載次數: 106)

下載附件

2017-6-5 17:21 上傳

，

1.031.jpg (1.82 KB, 下載次數: 122)

下載附件

2017-6-5 17:21 上傳

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

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

式中

進一步可以改寫成

式中

、

1.037.jpg (2.25 KB, 下載次數: 147)

下載附件

2017-6-5 17:21 上傳

、

1.038.jpg (1.71 KB, 下載次數: 145)

下載附件

2017-6-5 17:21 上傳

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

根據上述分析，其程序流程圖如下：

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

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

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

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

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

1.040.jpg (33.36 KB, 下載次數: 123)

下載附件

2017-6-5 17:21 上傳

圖4  DSP實現數字PID控制器的電路原理圖

3.2 軟件設計

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

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

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

圖5 代碼調試與編譯

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

1.042.jpg (6.44 KB, 下載次數: 142)

下載附件

2017-6-5 17:21 上傳

1.043.jpg (15.98 KB, 下載次數: 118)

下載附件

2017-6-5 17:21 上傳

1.044.jpg (11.92 KB, 下載次數: 120)

下載附件

2017-6-5 17:21 上傳

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;                      // 比例常數Proportional Const
    
17. double Integral;                        // 積分常數Integral Const
    
18. double Derivative;                      // 微分常數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. //級聯模式，SEQ1 和 SEQ2 作為一個 16 狀態排序器工作。
    
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;           //設置轉換通道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 狀態
    
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 的觸發信號不啟動 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 產生的中斷請求
    
88. AdcRegs.ADCTRL2.bit.INT_MOD_SEQ2=0;
    
89. //每個 SEQ2 結束時，INT_SEQ2 置位
    
90. AdcRegs.ADCTRL2.bit.EVB_SOC_SEQ2=0;   
    
91. //EVB 的觸發信號不啟動 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 通道的數據     
     
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控制算法的實現.doc (477 KB, 下載次數: 375)

2017-6-5 15:10 上傳

點擊文件名下載附件
PID算法的DSP實現資料
下載積分: 黑幣 -5