PPLID控制回路及其在FIRA控制中的應用

1、PPLID控制回路及其在FIRA控制中的應用    摘要：吸取PID算法的基本思想，利用PLL的高精度和高靈敏度，從時域調參的角度提出了一種新的前端控制回路PPLID控制回路，并介紹了其在FIRA機器人小車控制系統(tǒng)中的應用。     關鍵詞：鎖相積分環(huán) PID PLL PPLID 全功率提前補償1 對PID的新需求PID算法具結構簡單、物理意義清晰、便于實現(xiàn)的優(yōu)點，因而成為當前工程應用中最普遍和最經典的控制算法。但是參數(shù)整定一直以來都困擾著工程技術人員。一方面，由于PID算法常用于前端控制回路，因而在一個較大的系統(tǒng)中往往有幾

2、十乃至幾百個PID回路，這使得參數(shù)調整十分繁瑣。若各個回路間存在耦合關系，則工作量更是難以預計。    另一方面，PID算法的應用場合十分廣泛，而不同場合的控制參數(shù)卻又不盡相同，因此針對某個被控對象設計的PID電路很難適應另一個被控對象的要求。這使得PID控制系統(tǒng)長期停留在通用算法的層次，難以提升為價格低廉的通用IC。隨著EDA工具的發(fā)展，SOC的市場需求日益增長，算法集成化的趨勢日益明顯，在工業(yè)控制領域的表現(xiàn)之一就是對通用PID集成電路的需求越來越強烈。上述兩方面使得PID的廣泛應用和參數(shù)整定過于繁瑣的矛盾日益突出。要解決這個矛盾，實現(xiàn)PID算法集成化，必須找到

3、一個簡便靈活的參數(shù)整定方法。同時，隨著工業(yè)控制對精度和抗干擾的要求越來越高，高頻微擾的問題日益突出。經曲PID算法采用積分前置的方法來減小高頻微擾的問題。但由于積分效應，必然削弱微分的預測補償能力，從而影響系統(tǒng)的精度和靈敏度。采用新的方法克服高頻微擾，也是一個亟待解決的問題。2 PLL與PID結合對性能的改善PLL在頻率合成、通信以及標準信號發(fā)生器中被廣泛應用，具有整套成熟的理論，是相當經典的電路，其高靈敏度和高精度已被理論和實踐證明。可將PID和PLL有機地結合起來，利用PLL的優(yōu)異性能改進傳統(tǒng)PID電路。2.1 PLL與PID結合構成PPLIDPLL本身可以看成一個鎖相積分環(huán)。其中的鑒相器

4、承擔了差值計算和相位跟蹤的任務（計算標準信號與反饋信號的相位差）；積分器則不僅完成了積分功能，還肩負著保持當前狀態(tài)的任務；而壓控振蕩器（VCO）則負責將被控對象信息反饋回鑒相器2?？梢?，這個環(huán)路已經具備了差值計算和積分的功能，只要再配以比例和微分調節(jié)，就構成一個新疑的控制回路。由于其中含有鎖相積分回路，因此稱其為PPLID（Proportional,PhaseLocked-Integral and Differential Controller,即比例、鎖相積分、微分控制器），其原理如圖1所示。圖2 FIRA小車控制系統(tǒng)的電路圖其中的核心部件是鎖相積分環(huán)，實際上就是一個PLL，代替PID中的積

5、分器和減法器。若差值大于一定域值，則啟動微分和比例調節(jié)；若差值小于域值，則只有鎖相積分器處于工作狀態(tài)，由它完成精細調節(jié)?；鶞市盘柧褪强刂屏?，這里它表現(xiàn)為頻率波形。PPLID吸收了經典PID的基于思想，因此可應用于經典PID回路所能涉及的所有領域，其優(yōu)越性表現(xiàn)在以下四個方面：利用鑒相器作差值運算，大大提高了PPLID的靈敏度和精度。鑒相器可以采取邊沿對齊的方式來實現(xiàn)相位跟蹤，即標準脈沖信號和反饋脈沖信號都輸入鑒相器。只要連沿不對齊，則渙相積分環(huán)就會設法調整被控對象，直到二者的邊沿完全對齊。因此，鎖相環(huán)的靜態(tài)精度和靈敏非常高。PPLID中積分器的平均積分時間很短。鑒相器計算出來的相位差最終是通過積

6、分器轉變?yōu)殡妷褐苯虞敵龅奖豢貙ο笊系?。也就是說，積分器能夠根據(jù)相位差決定在當前累積電壓的基礎上將電壓調高或調低多少。由于鑒相器的高靈敏度使得相位稍有偏離便開始調整，因此積分器每次將電壓調高或調低得很小，從而在很短的時間內就能完成調整工作。即鎖相積分器的平均積分時間是很短的。PPLID利用微分和比例調節(jié)可以實現(xiàn)全功率提前補償?？刂葡到y(tǒng)多處于微擾環(huán)境中，但有時會出現(xiàn)沖擊干擾，差值會瞬間變得很大，僅依靠鎖相積分環(huán)就不能足夠快地收斂到目標值。這時可以啟用微分和比例調節(jié)，對被控對象進行全功率提前補償。這里的全功率指的是采用最高電壓或最大電流對被控對象進行補償，因此這種提前補償?shù)某掷m(xù)時間不會很長，只要偏差

7、小于某個閾值，便立即停止，從而將精細調整的工作交給鎖相積分環(huán)來完成。PPLID可用于高精度控制。由于嵌入了PLL，因此PPLID繼承了PLL回路的高精度特性，完全能夠任要求高精度控制的任務，成本也十分低廉。2.2 PPLID對傳統(tǒng)PID回路性能的改善如前所述，PPLID具有靈敏度高和平均積分時間短的特點，稍有偏差便進行小幅調整，因此對高頻微擾具有天然的自適應能力。同時，由于微分器只在沖擊干擾時才會啟用，在高頻微擾情況下是停止工作的，因此不存在高頻微擾對微分器產生影響的問題。PPLID對PID參數(shù)整定的第一個簡化是免去了微分和比例調節(jié)系數(shù)的調整。在PPLID中，只有當差值大于閾值時才會啟動微分和

8、比例調節(jié)，進行全功率提前補償。當差值小于某相值時，則立即停止微分比例調節(jié)，從而將精細調節(jié)的任務交由PLL承擔?？梢姡琍LLID中的比例和微分調節(jié)并不負責精細調節(jié)，只負責將大幅度的偏差縮小到一定范圍內，因此其系數(shù)對精度是無關緊要的。這樣就免去了微分和比例系數(shù)的調整。參數(shù)整定的第二個簡化是對積分系數(shù)的要求大大寬松了。這種寬松性表現(xiàn)為：只要鎖相積分器的延時小于被控對象的反應延時，環(huán)路就能夠糾偏，而且能夠及時精確地糾偏。說它能夠糾偏是因為采取邊沿對齊方式的PLL，其捕捉范圍并不依賴于積分器的延時常數(shù)3，這意味著在小幅振蕩的情況下，鎖相積分環(huán)的收斂性與積分常數(shù)的關聯(lián)很小，只要保證環(huán)路對輸出控制量（即積分

9、器的輸出）的調整速度快于被控對象的變化，就能夠穩(wěn)定在目標控制器。顯然決定環(huán)路調整快慢的是最長延時單元，也就是積分器，只要其積分延時小于被控對象的反映延時，環(huán)路就能糾偏。說它能及地精確地糾偏是因鑒相器的高精度和高靈敏度使得鎖相積分環(huán)的平均積分時間很短，這意味著偏差很小的情況下，環(huán)路能立即進行調整。在控制系統(tǒng)中，被控對象多為機械運動或溫度、壓力和流量等物理變化。其反應延時一般總大于積分器的延時，因此要調整積分延時使其小于被控對象的反應延時是十分簡便的。由上可見，PLL與PID相結合，參數(shù)整定實際上就歸結為延時參數(shù)的調整。這種調整無需在Z域進行分析，只要在時域直接進行即可（對于積分器，即調整電容和電

10、阻值），這樣就大大簡化了參數(shù)整定。參數(shù)整定的簡化，不僅提高了PID回路的調試效率，而且為設計價格低廉的集成PPLID電路提供了可能。整個電路唯一需要根據(jù)工作環(huán)境進行調整的就是積分器的延時參數(shù)，只要將積分器留給用戶調整，就能使得芯片應用于多種場合。3 PPLID在FIRA中的應用在FIRA足球機器人小車的前端控制器中應用了PPLID回路，取得了較好的效果。其實現(xiàn)如圖2的所示（這里只提供了小車左輪的電路，右輪與此對稱）。由于傳感器返回的信號是頻率信號，可以直接輸入到鑒相器的反饋端，因此無需使用壓控振蕩器。3.1 AVR單片機本系統(tǒng)采用ATMEL公司AVR系列單片機中的AT90S8515作為前端控制

11、器，它除了產生標準信號、管理與上位機的無線通信、實現(xiàn)動態(tài)控制算法外，還擔負PPLID中的閾值比較、啟用和關閉微分調節(jié)等任務。3.2 鎖相積分回路鎖相積分回中就是一個PLL，其鑒相功能直接由CD4046的比較器II實現(xiàn)，最高工作頻率可達1.4MHz。PLL內部集成了兩個位相比較器I和II，這里使用的是相位比較器II。這是一個由信號的上升沿控制的數(shù)字存儲網絡，對輸入信號占空比的要求不高，允許輸入非對稱波形，具有很寬的捕捉頻率范圍，而且不會鎖定在輸入信號的諧波上。當進入鎖定狀態(tài)時，能保證兩個輸入信號之間的相移為0（關于CD4046的詳細介紹見參考文獻3）。積分器電路采用如3所示的超前滯后網絡。其傳遞

12、函數(shù)為：G（s）=(1+2·s)/(1+1·)其中，1=(R1+R2)·C1,2=R2·C1通過選擇合適的R1，R2和C1的值，就可以在一定范圍內設定時間常數(shù)。由于存在電機慣性，因而采用超前滯后濾波器且超前時間常數(shù)大于滯后時間常數(shù)，系統(tǒng)將獲得很好的穩(wěn)定性。3.3 支援驅動器支援驅動器采納了微分調節(jié)的基本思想。微分調節(jié)實際上就是根據(jù)差值的變化來預計被控對象的變化，在本例中就是根據(jù)差值的大小，來預測當前電機轉速的偏離是否能夠局面速收斂。如果單靠鎖相環(huán)不能快速收斂，則支援驅動器啟動，快速提高或降低電機控制電壓，進行全功率提前補償；當差值小于閾值時，便由鎖相積分環(huán)來完成精細調節(jié)。3