電機伺服控制和PID算法簡介

1、電機伺服控制和PID算法詳解1電機伺服控制技術(shù)簡介所謂伺服控制，通常也就是指閉壞控制，即通過反饋環(huán)節(jié)，測量被控制對象的變化，用 以修正電機輸出的控制技術(shù)。對于要求不高的應(yīng)用，通常采用簡單的開環(huán)控制。例如，給直流有刷電機的兩根引線通 電，電機就會旋轉(zhuǎn)；施加的電圧越高，電機轉(zhuǎn)速越高，力量越大。但是在很多需要精密控制 的場合，僅僅這種方式還是不夠的，還礙要依靠一定的反饋裝置，將電機的轉(zhuǎn)速或位宣信息 反饋給微控制器或其他的機械裝置，通過 淀的算法變成町以調(diào)節(jié)電機擰制佇勺的輸出，從 而使電機的實際轉(zhuǎn)速、位置等參數(shù)與我們所希望的一致。機器人控制是一個精度要求比較高 的領(lǐng)域，例如.基于以下的一些考慮.機器人

2、平臺需要使用閉環(huán)控制。a）開壞控制情況卜，移動機器人在爬坡時，電機速度會I、降。更糟糕的是，當(dāng)雙軸獨立驅(qū) 動的移動機器人以一定的角度接近斜坡時。每一個車輪轉(zhuǎn)速的下降值將會不同，結(jié)果是 機器人的實際運動軌跡是沿著一條曲線而不是直線行進。b）不平坦的地面會造成移動機器人的兩個車輪轉(zhuǎn)速Z間的差異。如果轉(zhuǎn)速較低的車輪的驅(qū) 動電機沒有得到相應(yīng)的電壓補給，移動機器人將偏移既定的路線。c）由于安裝工藝、負載不完全均衡等原因，即使是完全匹配的兩個電機，并在相同的輸入 電壓條件下，他們的速度有時仍會產(chǎn)生不同，即轉(zhuǎn)速差。d）如果釆用的是PWM控制，即使在PWM信號占空比不變的條件卜，隨著電池電斥的逐 漸下降，電機

3、供給電壓也會隨之降低，從而導(dǎo)致電機的轉(zhuǎn)速與給定值不完全一致。綜介以上的一些考虔，必須選擇閉環(huán)控制的方式，其工作流程如下圖所示：閉環(huán)系統(tǒng)中 加上了反饋環(huán)節(jié)（通常機器人的驅(qū)動電機使用的是增帚:式光學(xué)編碼器）。在閉環(huán)控制系統(tǒng)中， 速度指令值通過微控制器變換到功放驅(qū)動電路，功放驅(qū)動電路再為電機提供能量。光學(xué)編碼 器用丁測量車輪速度的實際值并將其回饋給微控制器?；嶋H轉(zhuǎn)速號給定轉(zhuǎn)速的差值，即 ''偏差"，馳動器按照一定的計算方法（如PID算法）調(diào)整相應(yīng)的電壓供給，如此反復(fù)，H 到達到給定轉(zhuǎn)速。閉環(huán)控制模型示總圖速度閉環(huán)控制示盤圖這里，電機的控制算法起到了十分關(guān)鍵的作用。控制算

4、法的過程是：通過接受指令速度 值，通過運算向電機提供適當(dāng)?shù)鸟Y動電斥，盡快地和盡呈平穩(wěn)的使電機轉(zhuǎn)速達到指令速度值, 并維持這個速度值。換言之，一旦電機速度達到了指令速度值，即使在各種不利的因素(如 斜坡、碰撞之類等市電機轉(zhuǎn)速發(fā)生變化的因素)的干擾下也應(yīng)該保持該速度值不變?，F(xiàn)在己 經(jīng)有形形色色的控制算法被研究出來，實際上，控制理論本身就是一門獨立的學(xué)科。這里僅 介紹經(jīng)典、流行的比例積分微分(PID:Proportional Integral Derivative)控制算法。2 PID調(diào)節(jié)器及其軟件實現(xiàn)PID控制器是控制系統(tǒng)中技術(shù)比較成熟，而且是應(yīng)用最廣泛的一種控制器。它的結(jié)構(gòu)簡 單，參數(shù)容易調(diào)整，

5、不一定需要系統(tǒng)的確切數(shù)學(xué)模型，因此在工業(yè)的0個領(lǐng)域中都有應(yīng)用。PID控制器最先出現(xiàn)在模擬控制系統(tǒng)中，傳統(tǒng)的模擬PID控制器是通過硬件(電子元 件、氣動和液壓元件)來實現(xiàn)它的功能。隨看計算機的出現(xiàn)，把它移植到計算機控制系統(tǒng)中 來，將原來的硬件實現(xiàn)的功能用軟件來代替，因此稱作數(shù)字PID控制器，所形成的-整套 算法則稱為數(shù)字PID算法。數(shù)字PID控制器與模擬PID控制器相比，貝有非常強的靈活性, 可以根據(jù)實驗和經(jīng)驗在線調(diào)試參數(shù)，因此町以得到更好的控制性能。這里將介紹PID控制 的基本原理、數(shù)字PID控制算法及改進以及數(shù)字PID控制器的參數(shù)選擇。3模擬式PID調(diào)節(jié)器在模擬控制系統(tǒng)中，控制器址常用的控制

6、規(guī)律是PID控制。為了說明控制器的工作原 理，我們先看一個例子。上圖是 個小功率直流電機調(diào)速原理圖。給定轉(zhuǎn)速nO(t)與實際轉(zhuǎn) 速n(tz)進行比較，其差值e(t)=nO(t)-n(t)z經(jīng)過PID控制器調(diào)整后輸出電壓控制信號 u(t)ru(t)經(jīng)過功率放大后，驅(qū)動直流電動機改變其轉(zhuǎn)速。常規(guī)的模擬式PID控制系統(tǒng)原理框圖如上圖所示。該系統(tǒng)由模擬PID控制器和被控對 象組成。圖中的r(t)是給定值，y(t)是系統(tǒng)的實際輸出值，給定值和實際輸出值構(gòu)成控制偏 差e(t) =r(t)y(t),其中e(t)作為PID控制器的輸入，u(t)作為PID控制器的輸出和被控 對彖的輸入。因此模擬式PID調(diào)節(jié)器的

7、控制規(guī)律為u (t > Kp e(t) 4- J-Je(t)dt 4-Td+Ti odt式中Kp比例系數(shù);1-積分常數(shù)：%-微分常數(shù)：u0 控制常最：在模擬PID中，比例壞節(jié)的作用是對偏差瞬間作出快速反應(yīng)。偏差一旦產(chǎn)生，控制器 立即產(chǎn)生控制作用，使控制量向減少偏差的方向變化'控制作用的強弱取決于比例系數(shù)Kp , Kp越大，控制越強；但是過大的Kp會導(dǎo)致系統(tǒng)震蕩，破壞系統(tǒng)的穩(wěn)定性。由上式可以看出，只有當(dāng)偏差存在時，第一項才有控制量輸出。所以，對大部分被控制 對彖（如II流電機的調(diào)壓調(diào)速），需要加上適當(dāng)?shù)呐c轉(zhuǎn)速和機械負載有關(guān)的控制常量,否 則，比例環(huán)節(jié)將會產(chǎn)生靜態(tài)誤差。積分環(huán)節(jié)的作用

8、是把偏差的積累作為輸出。在控制過程中，只要有偏差存在，積分環(huán)節(jié) 的輸出就會不斷增大。直到偏差e（t）=O,輸出的u（t）才可能維持在某一常量，使系統(tǒng)在給 定值（t）不變的條件下趙于穩(wěn)態(tài)。因此，即使不加控制常量,也能消除系統(tǒng)輸出的靜態(tài) 誤差。積分環(huán)節(jié)的調(diào)節(jié)作用雖然會消除靜態(tài)誤差，但是也會降低系統(tǒng)的響應(yīng)速度，增加系統(tǒng)的 超調(diào)量。積分常數(shù)E越人，積分的積累作用越弱。堆人積分常數(shù)£會減慢靜態(tài)誤差的消除 過程，但是可以減少超調(diào)量，提高系統(tǒng)的穩(wěn)定性。所以，必須根據(jù)實際控制的具體要求來確 定丁】。實際的控制系統(tǒng)除了希望消除靜態(tài)誤差外，還要求加快調(diào)節(jié)過程。在偏差出現(xiàn)的瞬間， 或在偏差變化的瞬間，不但

9、要對偏差量作出立即響應(yīng)（比例環(huán)節(jié)的作用），而且要根據(jù)偏差 的變化趨勢預(yù)先給出適當(dāng)?shù)募m正。為了實現(xiàn)這T乍用，可在PI控制器的基礎(chǔ)上加入微分環(huán) 節(jié)，形成PID控制器。微分環(huán)節(jié)的作用是阻止偏差的變化。它是根據(jù)偏差的變化趙勢（變化速度）進行控制。 偏差變化的越快，微分控制器的輸出就越人，并能在偏差值變?nèi)酥斑M行修正。微分作用的 引入，將冇助于減少超調(diào)量，克服怠蕩，使系統(tǒng)趨于穩(wěn)定。特別對于高階系統(tǒng)非常有利，它 加快了系統(tǒng)的跟蹤速度。但微分的作用対輸入信兮的噪盧很敬感，対那些噪曲較人的系統(tǒng)一 版不用微分，或在微分起作用之前先對輸入信號進行濾波。適當(dāng)?shù)倪x擇微分常數(shù) ,可以使微分環(huán)節(jié)的作用達到最優(yōu)。4數(shù)字式P

10、ID調(diào)節(jié)器由于計算機的出現(xiàn)，計算機進入了控制領(lǐng)域。人們將模擬PID控制規(guī)律引入到計算機 （或其他微處理器）中來。對上式的PID控制規(guī)律進行適當(dāng)?shù)淖儞Q，就可以用軟件來實現(xiàn) PID控制，即數(shù)字PID控制。數(shù)字PID控制算法町以分為位豐式PID控制算法和增量式PID控制算法。a）位置式PID控制算法由于計算機或單片機控制是一種釆樣控制，它只能根據(jù)采樣時刻的偏差值計算控制杲, 而不能像模擬控制那樣連續(xù)輸出控制最，進行連續(xù)控制。由于這一特點，式3中的積分項 和微分項不能直接使用，必須進行離散化處理。離散化處理的方法為：以T作為采樣周期, k作為采樣序號則離散時間kT對應(yīng)著連續(xù)時間匕用求和的形式代替積分，

11、用增量的形式 代替微分，可作如下近似變換t«kT(k=O,l/乙 )Je(t)dtb£e(jT) =Te(j)0J=0J=0de(t)e(kT)_e(k_l)T _ 魚土dt "TT-上式中，為了表示方便，將e(kT)簡化成e(k)等。將上式代入式中，就可以鬧離做的PID 殍式為：U(k) = Kpek + 舌藝勺 + 卡( ek_x) + u0或£日丁u(k) = Kpek + Ki；勺 + Kd(ek 一 耳“)+ %式中 k-采樣序號? k=0zl,2uk第k次采樣時刻的計算機輸出值；ek第k次采樣時刻輸入的偏差值；e-第k-1次采樣時刻輸入的偏差

12、值；Ki積分常數(shù)，Ki = KpT/g：Kd微分常數(shù)，Kd = Kpl；/T：u0開始進行PID控制時的原始初值：如果采樣周期取得足夠小，則式中的近似計算町獲得足夠精確的結(jié)果，離散控制過程與 連續(xù)控制過程十分接近。它給出了全部控制量的人小，因此被稱為全量式或位置式PID控 制算法。這種算法的缺點是：由于全量輸出，所以每次輸出均與過去狀態(tài)有關(guān)，計算時要進 行累加,工作量大,;并且，因為計算機輸出量對應(yīng)的是執(zhí)行機構(gòu)的實際位置,如果計算機 出現(xiàn)故障，輸出量將會人幅度變化，會引起執(zhí)行機構(gòu)的人幅度變化，何町能造成-定事故, 這在生產(chǎn)實際中是不能允許的。因此采用増量式PID控制算法：PID川:以是損獨H制

13、2：；的的川f 制啟的卯I*、加I加卜: 由式可得p i-itu(kl)= Kp6.x + 亍谷勺 + 爺(勺. 一 勺_2) + *將上式與式相減，整理町得：Au(k)=u(k)-u(k 1)=陌6+ 半( 斗】+ )=!Cp(g +豐 +半&%) = KpA 4-Kiek 4-KdA2式中 Aek =卷ek-u q = q _ 2也+q.2 =_ g-i；Ki = Kp ;Kd = KpE；T由上式可以看出，如果計算機控制系統(tǒng)采用恒定的采樣周期T, 一旦確定了 A,B,C,就 可以利用前后三次測量值的偏差，求出控制增量。實際中位置式增最的PID控制算法可以通過增最式控制算法推出遞推計算公式% =嘰 +在實際的應(yīng)用中，根據(jù)貝體的系統(tǒng)要求，需要采用一定的改進算法。1、死區(qū)設(shè)定：由于系統(tǒng)本身的需要精度或者是固有的機械特性設(shè)定一定的控制死區(qū)，町以認為控制量在此控制區(qū)內(nèi)己經(jīng)達到了穩(wěn)定。為此，設(shè)定死區(qū)deadjinej如下計算： Ujj = Uiz 如果 | e* |v dead _line;Uk = 1&- + Allk z 如果 | * |x dead _