一階倒立擺控制系統(tǒng)設計

倒立擺課程設計報告路甯城，//孝課程設計說明書課程名稱：控制系統(tǒng)課程設計設計題目：二階倒立擺控制器設計院系：信息與電氣工程學院班級： 設計者：學號：指導教師:設計時間:2013年2月25日到2013年3月8號倒立擺課程設計報告課程設計(論文)任務書專業(yè)自動化班 級0902101學生指導教師題目一階倒立擺課程設計子題設計時間2013年2月25日至2013年3月8日共2周設計要求設計(論文)的任務和基本要求，包括設計任務、查閱文獻、方案設計、說明書(計算、圖紙、撰寫內容及規(guī)范等)、工作量等內容。.建立一階倒立擺數(shù)學模型.做模型仿真試驗(1)給出Matlab仿真程序。(2)給出仿真結果和響應曲線。.倒立擺系統(tǒng)的PID控制算法設計設計PID控制器，使得當在小車上施加1N的脈沖信號時，閉環(huán)系統(tǒng)的響應指標為：(1)穩(wěn)定時間小于5秒(2)穩(wěn)態(tài)時擺桿與垂直方向的夾角變化小于0.1弧度并作PID控制算法的MATLAB仿真.倒立擺系統(tǒng)的最優(yōu)控制算法設計用狀態(tài)空間法設計控制器，使得當在小車上施加0.2m的階躍信號時，閉環(huán)系統(tǒng)的響應指標為：(1)擺桿角度9和小車位移工的穩(wěn)定時間小于5秒(2)%的上升時間小于1秒(3)9的超調量小于20度(0.35弧度)(4)穩(wěn)態(tài)誤差小于2%。指導教師簽字： 系(教研室)主任簽字:2013年3月5日倒立擺課程設計報告目錄TOC\o"1-5"\h\z\o"CurrentDocument"一、建立一階倒立擺數(shù)學模型 4一階倒立擺的微分方程模型 4一階倒立擺的傳遞函數(shù)模型 6一階倒立擺的狀態(tài)空間模型 7\o"CurrentDocument"二、一階倒立擺matlab仿真 9\o"CurrentDocument"三、倒立擺系統(tǒng)的PID控制算法設計 13\o"CurrentDocument"四、倒立擺系統(tǒng)的最優(yōu)控制算法設計 23五、總結 錯誤!未定義書簽。\o"CurrentDocument"六、參考文獻 29倒立擺課程設計報告一、建立一階倒立擺數(shù)學模型首先建立一階倒立擺的物理模型。在忽略空氣阻力和各種摩擦之后，可將直線一級倒立擺系統(tǒng)抽象成小車和勻質桿組成的系統(tǒng)，如圖1所示。系統(tǒng)內部各相關參數(shù)定義如下：M 小車質量m擺桿質量b小車摩擦系數(shù)l 擺桿轉動軸心到桿質心的長度I擺桿慣量F 加在小車上的力x小車位置“ 擺桿與垂直向上方向的夾角。 擺桿與垂直向下方向的夾角（考慮到擺桿初始位置為豎直向下）一階倒立擺的微分方程模型對一階倒立擺系統(tǒng)中的小車和擺桿進行受力分析，其中，N和P為小車與擺桿相互作用力的水平和垂直方向的分量。倒立擺課程設計報告圖1-2小車及擺桿受力圖分析小車水平方向所受的合力，可以得到以下方程:Mx^F-bx-N(1-1)倒立擺課程設計報告圖1-2小車及擺桿受力圖分析小車水平方向所受的合力，可以得到以下方程:Mx^F-bx-N(1-1)由擺桿水平方向的受力進行分析可以得到下面等式：（1-2）即:把這個等式代入式（1-1）中，就得到系統(tǒng)的第一個運動方程：一小占一府一小⑺一心門'=（（1-4）為了推出系統(tǒng)的第二個運動方程，我們對擺桿垂直方向上的合力進行分析，可以得到下面方程：P-mg-m（/cos日）（- （1-5）即：1一*二一："35—通力,C'S（1-6）力矩平衡方程如下：（1-7）-Plsin6-Nicos6-10（1-7）由于"二，二一"C0"二一"①、門c二一,所以等式前面有負號。

倒立擺課程設計報告合并這兩個方程，約去P和N,得到第二個運動方程：\一一"葉內一門二 if設“二：一門，（“是擺桿與垂直向上方向之間的夾角），假設“<<1弧度，則可以進行近似處理：cos9=-1,sin9=R,（—）2=0。用u代表被控對dtI十ml20—dtI十ml20—mgl(/)—mix(1-9)mis(mis(2-3)TOC\o"1-5"\h\z\o"CurrentDocument"(M+m)x+bx- =u一階倒立擺的傳遞函數(shù)模型對式（1-9）進行拉普拉斯變換，得：l/ihklJNVig中z二〃四NV （2-1）［（AY+m）X⑸/+bXC-"〃①⑸1 ?⑸注意：推導傳遞函數(shù)時假設初始條件為0。由于輸出為角度中，求解方程組的第一個方程，可得：）仃心! （2-2）a.. --或①⑸X（x）（I+ml~）s~-mgl如果令錯誤!未找到引用源。，則有：「！E：I./- -仃口 （2-4）把上式代入方程組（2-1）的第二個方程，得：（M一例"""'一屋①（￡）『+卜'+ '）+'①w）￡—=U。） （2-5）fillS-

倒立擺課程設計報告整理后得到傳遞函數(shù)：ml2；1'：，_ J (2-6)t/(.v) 4h(Iml~)3(AZ+m)mgl2btngi1 l51 lS*q qq其中片[(初+〃])(！+初h-(初)21一階倒立擺的狀態(tài)空間模型設系統(tǒng)狀態(tài)空間方程為:X=AX+Bu（3-1）方程組（2-9）對x解代數(shù)方程，得到解如下: -it十次）十A制 -it十次）十A制/（3-1）1(M^my+Mrnl-3=3■- -tnlb/(A/+m)'十整理后得到系統(tǒng)狀態(tài)空間方程:OILr—{1+vi產(chǎn))61(Al+用)+-OILr—{1+vi產(chǎn))61(Al+用)+-mlb1/( +用)+血叫/41(M+m)+MmI（3-2）0“V+M+血調產(chǎn)“V+M+AJ調產(chǎn)2（A/+陰）+.包加產(chǎn)mgl(Af+m)布/擺桿的慣量為13m2，代入（1-9）的第一個方程為:倒立擺課程設計報告得:化簡得:(3-4)設x=[xxC忸],u'=x則有:4.實際系統(tǒng)的傳遞函數(shù)與狀態(tài)方程實際系統(tǒng)的模型參數(shù)如下：M 小車質量 0.5Kgm 擺桿質量 0.2Kgb 小車摩擦系數(shù) 0.1N/m/sec擺桿轉動軸心到桿質心的長度0.3mI擺桿慣量 0.006kg*m*m

倒立擺課程設計報告代入上述參數(shù)可得系統(tǒng)的實際模型。擺桿角度和小車位移的傳遞函數(shù)：&（s） 0,06#x（5） 0,0Z4s2-0.58S擺桿角度和小車加速度之間的傳遞函數(shù)為:0.06擺桿角度和小車加速度之間的傳遞函數(shù)為:（4-1）（4-1）擺桿角度和小車所受外界作用力的傳遞函數(shù):以外界作用力作為輸入的系統(tǒng)狀態(tài)方程:-0.181818-04545452.67272731.181818以小車加速度為輸入的系統(tǒng)狀態(tài)方程:U

+

K，x9-,s-

■.

0o

o1

oo

IQ--rxl單

--y二、一階倒立擺matlab仿真實際系統(tǒng)參數(shù)如下，按照上面給出的例子求系統(tǒng)的傳遞函數(shù)、狀態(tài)空間方程，并進行脈沖響應和階躍響應的matlab仿真。

倒立擺課程設計報告1.096Kg0.109Kg0.1N/m/sec0.25m1.096Kg0.109Kg0.1N/m/sec0.25m0.0034kg*m*m0.005秒m 擺桿質量6 小車摩擦系數(shù)l 擺桿轉動軸心到桿質心的長度I 擺桿慣量T 采樣時間.傳遞函數(shù)法Matlab程序如下：M=1.096;m=0.109;b=0.1;I=0.0034;g=9.8;L=0.25;q=(M+m)*(I+m*「2)-(m*L)八2;num=[m*L/q00]den=[1b*(I+m*L^2)/q-(M+m)*m*g*L/q-b*m*g*L/q0];[r,p,k]=residue(num,den);s=p;得到傳遞函數(shù)的分子:num=2.3566 0 0以及傳遞函數(shù)分母：den=1.0000 0.0883-27.8285 -2.3094 0開環(huán)極點：s=10倒立擺課程設計報告-5.27805.2727-0.08300由此可知，系統(tǒng)傳遞函數(shù)的多項式表達式為：G(s).皿_2.3566s2 (2-1)U(s)s4+0,0883s3-27.8285s2—2.3094s系統(tǒng)的開環(huán)極點為(s):[=-5.2780、s2=5.2727、s3=-0.0830、s4=0，由于有一個開環(huán)極點位于S平面的右半部，開環(huán)系統(tǒng)并不是穩(wěn)定的。系統(tǒng)的脈沖響應如下，由圖也可見，系統(tǒng)并不穩(wěn)定。圖2.1開環(huán)系統(tǒng)脈沖響應2.狀態(tài)空間法狀態(tài)空間法可以進行單輸入多輸出系統(tǒng)設計，因此在這個實驗中，我們將嘗試同時對擺桿角度和小車位置進行控制。為了更具挑戰(zhàn)性，給小車加一個階躍輸入信號。我們用Matlab求出系統(tǒng)的狀態(tài)空間方程各矩陣，并仿真系統(tǒng)的開環(huán)階躍響應。在這里給出一個state.m文件，執(zhí)行這個文件，Matlab將會給出系統(tǒng)狀態(tài)空間方程的A，B，C和D矩陣，并繪出在給定輸入為一個0.2N的階躍信號時系統(tǒng)的響應曲線。state.m程序如下：11倒立擺課程設計報告p=I*(M+m)+M*m*LA2;TOC\o"1-5"\h\z>A=[0 1 0 0;0-(I+m*LA2)*b/p(mA2*g*LA2)/p0;0 0 0 1;0 -(m*L*b)/p m*g*L*(M+m)/p 0]A=01.0000000-0.08830.629300001.00000-0.235727.82850>B=[0;(I+m*LA2)/p;0;m*L/p]B=00.883202.3566>C=[1000;0010]D二[0;0]C=10000010D=00matlab仿真的開環(huán)階躍響應曲線如下圖所示，系統(tǒng)并不穩(wěn)定。12

倒立擺課程設計報告圖2.2系統(tǒng)開環(huán)階躍響應曲線三、倒立擺系統(tǒng)的PID控制算法設計.實驗要求與目的?要求：設計PID控制器，使得當在小車上施加1N的脈沖信號時，閉環(huán)系統(tǒng)的響應指標為：(1)穩(wěn)定時間小于5秒(2)穩(wěn)態(tài)時擺桿與垂直方向的夾角變化小于0.1弧度并作PID控制算法的MATLAB仿真?目的：進一步熟悉PID控制器的設計方法，步驟，以及P、I、D三參數(shù)的調節(jié)方法。.理論分析?PID控制原理在模擬控制系統(tǒng)中，控制器最常用的控制規(guī)律是PID控制。常規(guī)PID控制系統(tǒng)原理框圖如下圖所示。系統(tǒng)由模擬PID控制器KD(S)和被控對象G(S)組成。PID控制器是一種線性控制器，它根據(jù)給定值廠(t)與實際輸出值y(t)構成控制偏差e(t)將偏差的比例(P)、積分(I)和微分(D)通過線性組合構成控制量，對被控對象進行控制，故稱PID控制器。其控制規(guī)律為13

倒立擺課程設計報告倒立擺課程設計報告e(t)+—fe(t)dt+Te((t)

T ddtI0或寫成傳遞函數(shù)的形式G(s)=UsE(s)G(s)=UsE(s)=Kpf1+Ts+TDS式中：KP——比例系數(shù)；TI——積分時間常數(shù)；Td——微分時間常數(shù)。在控制系統(tǒng)設計和仿真中，也將傳遞函數(shù)寫成式中：KP——比例系數(shù)；KI——積分系數(shù)；KD——微分系數(shù)。簡單說來，PID控制器各校正環(huán)節(jié)的作用如下：（1）比例環(huán)節(jié)：成比例地反映控制系統(tǒng)的偏差信號e（t），偏差一旦產(chǎn)生，控制器立即產(chǎn)生控制作用，以減少偏差。（2）積分環(huán)節(jié)：主要用于消除穩(wěn)態(tài)誤差，提高系統(tǒng)的型別。積分作用的強弱取決于積分時間常數(shù)Tt,Ti越大，積分作用越弱，反之則越強。（3）微分環(huán)節(jié)：反映偏差信號的變化趨勢（變化速率），并能在偏差信號值變得太大之前，在系統(tǒng)中引入一個有效的早期修正信號，從而加快系統(tǒng)的動作速度，減小調節(jié)時間。擺桿角度控制這個控制問題和我們以前遇到的標準控制問題有些不同，在這里輸出量為擺桿的位置，它的初始位置為垂直向上，我們給系統(tǒng)施加一個擾動，觀察擺桿的響應。系統(tǒng)框圖如下:那）二FCentrailer那）二FCentrailer圖中KD（s）是控制器傳遞函數(shù)，G（s）是被控對象傳遞函數(shù)?？紤]到輸入Ns）=0，結構圖可以很容易地變換成14倒立擺課程設計報告Oontr口歸rKDO)該系統(tǒng)的輸出為numy(s)= G(^ F(s)= % F(s)1+KD(s)G(s) 1+(numPID)(num)(denPID)(den)num(denPID) F(s)(denPID)(den)+(numPID)(num)其中：num——被控對象傳遞函數(shù)的分子項den——被控對象傳遞函數(shù)的分母項numPID——pid控制器傳遞函數(shù)的分子項denPID——pid控制器傳遞函數(shù)的分母項被控對象的傳遞函數(shù)是mls20(s) q numU(s) b(I+ml2) (M+m)mgl bmgldenTOC\o"1-5"\h\zs4+ s3 s2 sq q q其中q-[(M+m)(I+ml2)-(ml)2]其中numPID

denPIDPID控制器的傳遞函數(shù)為numPID

denPID,"kKKs2+Ks+KKD(s)-Ks+K+—I-——d p 1DPs s只需調節(jié)PID控制器的參數(shù)，就可以得到滿意的控制效果。小車位置控制小車位置作為輸出時，系統(tǒng)框圖如下：15

倒立擺課程設計報告其中，G(s)倒立擺課程設計報告其中，G(s)是擺桿傳遞函數(shù)，G(s)是小車傳遞函數(shù)。12由于輸入信號r(s)=0，所以可以把結構圖轉換成:其中，反饋環(huán)代表我們前面設計的擺桿的控制器。從此框圖我們可以看出此處只對擺桿角度進行了控制，并沒有對小車位置進行控制。小車位置輸出為:G2(s)1+KD(s)G1(sG2(s)1+KD(s)G1(s)(denPID)(den)i(num)(denPID)(den)

2 1 (denPID)(den)(den)+(numPID)(num)(den)其中，num1，den1，num2，den2分別代表被控對象1和被控對象2傳遞函數(shù)的分子和分母。numPID和denPID代表pid控制器傳遞函數(shù)的分子和分母。下面我們來求G2(s)，根據(jù)前面實驗二的推導，有X(s)=[(I+ml2)-5]O(s)

mls2可以推出小車位置的傳遞函數(shù)為16

倒立擺課程設計報告倒立擺課程設計報告TOC\o"1-5"\h\z(I+ml2) mglG2G2(()=b(I+ml2) (M+m)mgl bmgls4+ s3 s2 sq q q其中q-[(M+m)(I+ml2)-(ml)2]可以看出，㈣=den2=以，小車的算式可以簡化成:(num)(denPID) 2 (denPID)(den)+k(numPID)(num)13.PID控制算法的MATLAB仿真實際系統(tǒng)參數(shù)如下：M小車質量1.096Kgm擺桿質量0.109Kgb小車摩擦系數(shù)0.1N/m/secl擺桿轉動軸心到桿質心的長度0.25mI擺桿慣量0.0034kg*m*mF加在小車上的力x小車位置T采樣時間擺桿的matlab仿真程序代碼如下:M=0.5;m=0.2;b=0.1;I=0.006;g=9.8;L=0.3;q=(M+m)*(I+m*L八2)-(m*L)八2;num1=[m*L/q00];den1=[1b*(I+m*L八2)/q-(M+m)*m*g*L/q-b*m*g*L/q0];Kp=1;Ki=1;Kd=1;numPID=[KdKpKi];denPID=[10];num=conv(num1,denPID);den=polyadd(conv(denPID,den1),conv(numPID,num1));[r,p,k]=residue(num,den);s=pt=0:0.005:5;impulse(num,den,t)17倒立擺課程設計報告axis([02010])運行程序得到：s=-6.41613.96930.001900并得到仿真圖像如下：ImpulseResponse00 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2Time(sec)圖3.1kp=ki=kd=1時的仿真響應圖可見此時系統(tǒng)并不穩(wěn)定，此時應該首先調整kp,觀察其響應的變化:講kp設置為150，得到并觀察響應圖如下：s=-1.2224+18.0044i-1.2224-18.0044i-0.0000-0.0000-0.000018

倒立擺課程設計報告圖3-2,kp=150系統(tǒng)仿真圖可見此時系統(tǒng)兩個閉環(huán)極點均在S平面做平面，系統(tǒng)穩(wěn)定，系統(tǒng)穩(wěn)定時間約為4秒，滿足要求。此時系統(tǒng)有極小的靜態(tài)誤差，根據(jù)系統(tǒng)對于精度的要求可酌情考慮是否添加積分控制，本文添加積分控制。將積分參數(shù)設為5,得到并觀察閉環(huán)響應圖。在筆者經(jīng)過多次嘗試之后，發(fā)現(xiàn)積分控制對于系統(tǒng)響應的調節(jié)作用極小，筆者給出當積分參數(shù)分別設為10和50的響應圖如下：-0.20 0.5 1 1.5 -0.20 0.5 1 1.5 22.5 3 3.5 4 4.5 5Time(sec)ImpulseResponse圖3-3,ki=10的響應19倒立擺課程設計報告-0.20-0.150.511.5 22.5 33.5 44.5 -0.20-0.150.511.5 22.5 33.5 44.5 5ImpulseResponse51.100051.00.0-eaulDmATime(sec)圖3-4,ki=50系統(tǒng)的響應積分作用通常是用來調整系統(tǒng)的靜態(tài)誤差，使之達到需要的范圍，但是此處明顯積分作用對系統(tǒng)的影響不大，并了解到被控對象的特性屬于變化快的類型，應該考慮改變微分控制，雖然微分控制在實際系統(tǒng)中運用并不多見。筆者將微分作用參數(shù)設置為10,20,50觀察其效果圖。ImpulseResponse0.20.150.1圖3-5，kp=150,ki=50,kd=100.1圖3-5，kp=150,ki=50,kd=10的仿真圖像2)倒立擺課程設計報告eau^umAO.20ImpulseResponse25150.10.00005150.5 1 1.5 2 2.5 3 3.5 4 4.5 eau^umAO.20ImpulseResponse25150.10.0000515Time(sec)ImpulseResponse00.511.522.533.544.55圖3-6,kp=150,ki=50,kd=20的仿真圖像ImpulseResponse00.511.522.533.544.55Time(sec)圖3-7,kp=150,ki=50,kd=50的仿真圖像當微分效果加上去的時候，系統(tǒng)閉環(huán)仿真圖像結果得到了質的改善，瞬間取代了超調，不穩(wěn)定，響應時間也迅速降到了0.5秒，穩(wěn)定時間在1秒，完美地21倒立擺課程設計報告完成了任務。其效果已經(jīng)不能簡單的用好來形容，但是微分作用并非如此普及，并且每次都效果如此良好，要根據(jù)不同的對象來判斷用什么作用。必須要說的是，微分作用在物理實現(xiàn)中是并不容易的，如果只有比例調節(jié)和積分調節(jié)就能達到預想的效果，那就不要使用微分調節(jié)。4.小車位置控制算法仿真pid2.m是仿真小車位置變化的m文件，文件如下：%小車位置PID控制%輸入倒立擺傳遞函數(shù)G1(s)=num1/den1,G2(s)=num2/den2M=1.096;m=0.109;b=0.1;I=0.0034;g=9.8;l=0.25;q=(M+m)*(I+m*1A2)-(m*l)A2;num1=[m*1/q00];den1=[1b*(I+m*1A2)/q-(M+m)*m*g*1/q-b*m*g*1/q0];num2=[-(I+m*1A2)/q0m*g*1/q];den2=den1;%輸入控制器PID數(shù)學模型Gc(s)=numPID/denPIDKp=150;Ki=50;Kd=50;numPID=[KdKpKi];denPID=[10];%計算閉環(huán)系統(tǒng)傳遞函數(shù)G(s)=num/den%多項式相乘num=conv(num2,denPID);%多項式相加den=po1yadd(conv(denPID,den2),conv(numPID,num1));%求閉環(huán)系統(tǒng)極點[r,p,k]=residue(num,den);%顯示閉環(huán)系統(tǒng)極點s=p%求取多項式傳函的脈沖響應t=0:0.005:5;impu1se(num,den,t)%顯示范圍：橫坐標0-5,縱坐標0-10，此條語句參數(shù)可根據(jù)仿真輸出曲線調整axis([05-0.10.5])grid此時系統(tǒng)取Kp=150，Ki=50，Kd=50，階躍響應仿真曲線如下圖所示s=22

倒立擺課程設計報告-115.0953-2.4030-0.417700gdJr-JmA-0.100 0.5 1 1.5 2 2.5 gdJr-JmA-0.100 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5Time(sec)ImpulseResponse.40.30.2.100圖3-8,小車位置仿真由仿真結果能夠看出，當擺桿角度處于很好的閉環(huán)控制下時，小車位置雖然處于失控狀態(tài)，但是上升速度不快。四、倒立擺系統(tǒng)的最優(yōu)控制算法設計.設計目的與要求現(xiàn)代控制理論的最突出特點就是將控制對象用狀態(tài)空間表達式的形式表示出來，這樣便于對多輸入多輸出系統(tǒng)進行分析和設計。線性二次型最優(yōu)控制算法（LQR）是現(xiàn)代控制理論中一種重要的、基本的方法，LQR算法的目的是在一定的性能指標下，使系統(tǒng)的控制效果最佳，即利用最少的控制能量，來達到最小的狀態(tài)誤差。本章主要利用最優(yōu)控制算法實現(xiàn)對一階倒立擺系統(tǒng)的擺桿角度和小車位置的同時控制。設計目的：23

倒立擺課程設計報告學習如何使用狀態(tài)空間法設計系統(tǒng)的控制算法。設計要求：用狀態(tài)空間法設計控制器，使得當在小車上施加0.2N的階躍信號時，閉環(huán)系統(tǒng)的響應指標為：（1）擺桿角度9和小車位移x的穩(wěn)定時間小于5秒（2）x的上升時間小于1秒（3）9的超調量小于20度（0.35弧度）（4）穩(wěn)態(tài)誤差小于2%。.最優(yōu)控制器的設計在PID調節(jié)中，我們的輸入是脈沖量，并且在設計控制器時，只對擺桿角度進行控制，而不考慮小車的位移。然而，對一個倒立擺系統(tǒng)來說，把它作為單輸出系統(tǒng)是不符合實際的，如果把系統(tǒng)當作多輸出系統(tǒng)的話，用狀態(tài)空間法分析要相對簡單一些，和小車位移都進行控制的控制器。系統(tǒng)狀態(tài)方程為號AX+BuY=CX+Du在倒立擺相關參數(shù)為：M小車質量m擺桿質量小車摩擦系數(shù)l 擺桿轉動軸心到桿質心的長度I擺桿慣量在這一章我們將設計一個對擺桿位置1.096Kg0.2109Kg0.1N/m/sec0.25m0.0034kg*m*m0.005秒-0在這一章我們將設計一個對擺桿位置1.096Kg0.2109Kg0.1N/m/sec0.25m0.0034kg*m*m0.005秒-0100一-000.088301.00000.8832A二0001.0000；B二00—0.235727.828502.3566的條件下，狀態(tài)方程系數(shù)矩陣如下:；010000010倒立擺課程設計報告最優(yōu)控制的前提條件是系統(tǒng)是能控的，下面來判斷一下系統(tǒng)的能控能觀性。Matlab仿真程序如下：A=[0100;0-(I+m*「2)*b/p(m^2*g*「2)/p0;0001;0-(m*L*b)/pm*g*L*(m+M)/p0]B=[0;(I+m*L^2)/p;0;(m*L)/p]C=[1000;0010]D=[0;0]Qc=ctrb(A,B);//判斷能控性K=rank(Qc)Qo=obsv(A,C)；〃判斷能觀性I=rank(Qo)1.Matlab仿真結果為：K=4I=4即：系統(tǒng)的能控矩陣的秩rank[BABA2BA3B]=4。系統(tǒng)的能觀矩陣的秩rank[CCACA2CA3]=4。故系統(tǒng)是能控能觀的。因此可以給系統(tǒng)加上最優(yōu)控制器使得系統(tǒng)閉環(huán)穩(wěn)定，且滿足暫態(tài)性能指標。在運用線性二次型最優(yōu)控制算法進行控制器設計時，主要的目的就是獲得反饋向量K的值。由上一小節(jié)的推導知道，設計系統(tǒng)狀態(tài)反饋控制器時，一個關鍵的問題就是二次型性能指標泛函中加權矩陣Q和尺的選取。為了使問題簡化及加權矩陣具有比較明確的物理意義，我們將Q取為對角陣。假設Q1100Q110000Q220000Q330000Q44」8IJ8IJ=JQx2+Q

111,x2+Qx2+Qx2+ru2d222 333 44425倒立擺課程設計報告由上式可以看出，Q,,是對號的平方的加權，Q,,的相對增加就意味著對X,的要求相對其它狀態(tài)變量嚴格，在性能指標中的比重大，X的偏差狀態(tài)相對減小。廠是對控制量u的平方加權，當廠相對較大時，意味著控制費用增加，使得控制能量較小，反饋減弱，而廠取值較小時，系統(tǒng)控制費用減小，反饋增加，系統(tǒng)動態(tài)響應迅速?？紤]到一階倒立擺系統(tǒng)在運行過程中，主要的被控量為系統(tǒng)的輸出量x和*，因此在選取加權對角陣。的各元素值時，由于。11代表小車位置的權重，而Q33是擺桿角度的權重，所以只選取Q11、Q33，而Q22=Q44=0。選取Q和尺時需要注意的幾個方面：（1）由于我們采用的系統(tǒng)模型是線性化的結果，為使系統(tǒng)個狀態(tài)量能夠在線性范圍工作，要求各狀態(tài)量不應過大。（2）閉環(huán)系統(tǒng)最好能有一對共軛復數(shù)極點，這樣有利于克服系統(tǒng)的非線性摩擦，但系統(tǒng)主導極點的模不應太大以免系統(tǒng)頻帶過寬，使得系統(tǒng)對噪聲太敏感，以致系統(tǒng)不能正常工作。（3）加權矩陣尺的減小，會導致大的控制能量，應注意控制。的大小，不要超過系統(tǒng)執(zhí)行機構的能力，使得放大器處于飽和狀態(tài)?？刂葡到y(tǒng)