控制系統(tǒng)課程設計---直線一級倒立擺控制器設計_第1頁
已閱讀1頁,還剩22頁未讀, 繼續(xù)免費閱讀

下載本文檔

版權說明:本文檔由用戶提供并上傳,收益歸屬內容提供方,若內容存在侵權,請進行舉報或認領

文檔簡介

1、<p>  課程設計說明書(論文)</p><p>  課程名稱: 控制系統(tǒng)設計課程設計 </p><p>  設計題目:直線一級倒立擺控制器設計</p><p>  院 系: </p><p>  班 級: </p><p

2、>  設 計 者: </p><p>  學 號: </p><p>  指導教師: </p><p>  設計時間: 2013.9.2——2013.9.13 </p><p><b>  課程設計任務書</b></p&g

3、t;<p>  *注:此任務書由課程設計指導教師填寫。</p><p>  第一章 直線一級倒立擺數學模型的推導及建立</p><p>  1.1直線一階倒立擺數學模型的推導</p><p>  系統(tǒng)建??梢苑譃閮煞N:機理建模和實驗建模。實驗建模就是通過在研究對象上加上一系列的研究者事先確定的輸入信號,激勵研究對象并通過傳感器檢測其可觀測的輸出,

4、應用數學手段建立起系統(tǒng)的輸入-輸出關系。這里面包括輸入信號的設計選取,輸出信號的精確檢測,數學算法的研究等等內容。機理建模就是在了解研究對象的運動規(guī)律基礎上,通過物理、化學的知識和數學手段建立起系統(tǒng)內部的輸入-狀態(tài)關系。 </p><p>  對于倒立擺系統(tǒng),由于其本身是自不穩(wěn)定的系統(tǒng),實驗建模存在一定的困難。但是經過小心的假設忽略掉一些次要的因素后,倒立擺系統(tǒng)就是一個典型的運動的剛體系統(tǒng),可以在慣性坐標系內應用

5、經典力學理論建立系統(tǒng)的動力學方程。下面我們采用其中的牛頓-歐拉方法建立直線型一級倒立擺系統(tǒng)的數學模型。 </p><p>  在忽略了空氣阻力,各種摩擦之后,可將直線一級倒立擺系統(tǒng)抽象成小車和勻質桿組成的系統(tǒng). 下圖是系統(tǒng)中小車和擺桿的受力分析圖。其中,N和P為小車與擺桿水平和垂直方向的分量。</p><p>  圖1-1(a)小車隔離受力圖 (b)擺桿隔離受力圖<

6、/p><p>  本系統(tǒng)相關參數定義如下: </p><p>  M : 小車質量 m:擺桿質量 </p><p>  b:小車摩擦系數 l:擺桿轉動軸心到桿質心的長度 </p><p>  I:擺桿慣量 F:加在小車上的力 &l

7、t;/p><p>  x:小車位置 φ:擺桿與垂直向上方向的夾角 </p><p>  θ:擺桿與垂直向下方向的夾角(考慮到擺桿初始位置為豎直向下)</p><p>  注意:在實際倒立擺系統(tǒng)中檢測和執(zhí)行裝置的正負方向已經完全確定,因而矢量方向定義如圖所示,圖示方向為矢量正方向。</p><p>  應用牛頓方法來建立系統(tǒng)

8、的動力學方程過程如下:</p><p>  分析小車水平方向受到的合力,可以得到下面等式:</p><p><b> ?。?-1)</b></p><p>  由擺桿水平方向的受力進行分析可以得到下面等式:</p><p><b>  (1-2)</b></p><p>&l

9、t;b> ?。?-3)</b></p><p>  把這個等式代入上式中,就得到系統(tǒng)的第一個運動方程:</p><p><b> ?。?-4)</b></p><p>  為了推出系統(tǒng)的第二個運動方程,我們對擺桿垂直方向上的合力進行分析,可以得到下面方程: </p><p><b> ?。?-

10、5)</b></p><p><b> ?。?-6)</b></p><p><b>  力矩平衡方程如下:</b></p><p><b> ?。?-7)</b></p><p>  注意:此方程中力矩的方向,由于 ,故等式前面有負號。</p>&

11、lt;p>  合并這兩個方程,約去P和N ,得到第二個運動方程:</p><p><b> ?。?-8)</b></p><p>  1.1.1微分方程模型</p><p>  設 (是擺桿與垂直向上方向之間的夾角),假設與1(單位是弧度)相比很小,即,則可以進行近似處理: 。用u來代表被控對象的輸入力F ,線性化后兩個運動方程如下:&

12、lt;/p><p><b> ?。?-9)</b></p><p>  1.1.2傳遞函數 </p><p>  對以上微分方程組進行拉普拉斯變換,得到</p><p><b> ?。?-10)</b></p><p>  注意:推導傳遞函數時假設初始條件為0。 </p&g

13、t;<p>  由于輸出為角度為,求解方程組上述方程組的第一個方程,可以得到</p><p><b> ?。?-11)</b></p><p><b>  或者</b></p><p><b> ?。?-12)</b></p><p><b>  如果令

14、,則有</b></p><p><b> ?。?-13)</b></p><p>  把上式代入10式,則有:</p><p><b> ?。?-14)</b></p><p>  整理得到以輸入力為輸入量,擺桿角度為輸出量的傳遞函數:</p><p><b

15、> ?。?-15)</b></p><p><b>  其中 </b></p><p>  1.1.3狀態(tài)空間數學模型</p><p>  由現(xiàn)代控制原理可知,控制系統(tǒng)的狀態(tài)方程可寫成如下形式:</p><p><b> ?。?-16)</b></p><p&g

16、t;  可得代數方程,得到如下解:</p><p><b> ?。?-17)</b></p><p>  整理后得到系統(tǒng)狀態(tài)空間方程:</p><p><b> ?。?-18)</b></p><p>  由(1-9)的第二個方程為:</p><p>  對于質量均勻分布的擺

17、桿有:</p><p><b>  于是可以得到:</b></p><p><b>  化簡得到:</b></p><p><b> ?。?-19)</b></p><p><b>  設,,則有:</b></p><p><

18、b> ?。?-20)</b></p><p><b>  實際系統(tǒng)參數如下:</b></p><p>  M : 小車質量 0.5kg m:擺桿質量 0.2kg </p><p>  b:小車摩擦系數 0.1N/m/sec l:擺桿轉動軸心到桿質心的

19、長度 0.3m </p><p>  I:擺桿慣量 0.006kg*m*m </p><p>  把上述參數帶入,可以得到系統(tǒng)的實際模型。</p><p>  擺桿角度和小車位移的傳遞函數:</p><p><b> ?。?-21)</b></p><p>  擺桿角

20、度和小車加速度之間的傳遞函數:</p><p><b> ?。?-22)</b></p><p>  擺桿角度和小車所受外界作用力的傳遞函數</p><p><b> ?。?-23)</b></p><p>  以外界作用力作為輸入的系統(tǒng)狀態(tài)方程:</p><p><b

21、> ?。?-24)</b></p><p>  以小車加速度作為輸入系統(tǒng)的系統(tǒng)狀態(tài)方程:</p><p><b> ?。?-25)</b></p><p>  1.2系統(tǒng)階躍響應分析</p><p>  在matlab中鍵入以下命令:</p><p><b>  得到如

22、下結果:</b></p><p>  圖1-2 直線一階倒立擺單位階躍響應仿真</p><p>  可以看出,在單位階躍響應作用下,小車位置和擺桿角度都是發(fā)散的。</p><p>  第二章 直線一級倒立擺PID控制器設計</p><p>  本章主要利用PID控制算法對直線一級倒立擺系統(tǒng)進行控制器設計。在設計的過程中,要求熟悉控

23、制參數、、對系統(tǒng)性能的影響,然后按照所要求的控制指標并綜合實際響應結果恰當地調整參數。運用MATLAB仿真軟件可以快捷地進行系統(tǒng)仿真和參數調整,本章第2節(jié)的內容即是運用MATLAB軟件對PID控制系統(tǒng)的設計和仿真。第3節(jié)中,將對控制系統(tǒng)進行實際的運行和參數調試,以獲得一組最佳的PID控制參數。</p><p><b>  設計目的:</b></p><p>  學習P

24、ID控制器的設計方法,了解控制器各個參數對系統(tǒng)性能的影響,學會根據控制指標要求和實際響應調整PID控制器的參數。</p><p><b>  設計要求:</b></p><p>  設計PID控制器,使得當在小車上施加0.1N的階躍信號時,閉環(huán)系統(tǒng)的響應指標為:</p><p> ?。?)穩(wěn)定時間小于5秒;</p><p&g

25、t; ?。?)穩(wěn)態(tài)時擺桿與垂直方向的夾角變化小于0.1 弧度。</p><p><b>  設計報告要求:</b></p><p> ?。?)給出系統(tǒng)擺桿角度和小車位置的仿真圖形及控制器參數,并對各個參數對系統(tǒng)控制效果的影響進行說明;</p><p> ?。?)給出實際控制曲線和控制器參數,對響應的動態(tài)和靜態(tài)指標進行分析。</p>

26、<p>  D控制系統(tǒng)原理框圖如下所示,系統(tǒng)由模擬PID控制器KD(S)和被控對象G(S)組成。</p><p>  PID控制器是一種線性控制器,它根據給定值r(t)與實際輸出值y(t)構成控制偏差e(t)</p><p>  將偏差的比例(P),積分(I)和微分(D)通過線性組個構成控制量,對被控對象進行控制,谷稱為PID控制器。其控制規(guī)律為:</p><

27、;p>  或寫成傳遞函數的形式:</p><p>  在控制系統(tǒng)設計和仿真中,也將傳遞函數寫成:</p><p>  簡單來說,PID控制器各個校正環(huán)節(jié)的作用如下:</p><p>  (1) 比例環(huán)節(jié):成比例的反應控制系統(tǒng)的偏差信號e(t),偏差一旦產生,控制器立即產生控制作用,以減少偏差。</p><p> ?。?)積分環(huán)節(jié):主要用

28、于消除穩(wěn)態(tài)誤差,提高系統(tǒng)的型別。積分作用的強弱取決于積分時間常數T1,T1越大,積分作用越弱,反之則越強。</p><p> ?。?) 微分環(huán)節(jié):反映偏差信號的變化趨勢(變化速率),并能在偏差信號值變得太大之前,在系統(tǒng)中引入一個有效的早期修正信號,從而加快系統(tǒng)的動作速度,減小調節(jié)時間。</p><p>  這個控制問題,輸出量為擺桿的位置,它的初始位置為垂直向上,我們給系統(tǒng)一個擾動,觀察擺

29、桿的響應,系統(tǒng)框圖如下:</p><p>  圖2-1直線一級倒立擺PID控制系統(tǒng)框</p><p>  圖中KD(s)是控制器傳遞函數,G(s)是被控對象傳遞函數。</p><p>  考慮到輸入r(s)=0,結構圖可以很容易的變換成</p><p>  圖2-2 直線一級倒立擺PID控制簡化系統(tǒng)框圖</p><p>

30、;<b>  該系統(tǒng)的輸出為 </b></p><p>  其中,num——被控對象傳遞函數的分子項 </p><p>  den——被控對象傳遞函數的分母項 </p><p>  numPID——PID 控制器傳遞函數的分子項 </p><p>  denPID——PID 控制器傳遞函數的分母項 </p>

31、;<p>  通過分析上式可以得到系統(tǒng)的各項性能。</p><p>  由(2-13)可以得到擺桿角度和小車加速度的傳遞函數:</p><p>  PID控制器的傳遞函數為:</p><p>  只需調節(jié)PID控制器的參數,就可以得到滿意的效果。</p><p><b>  小車的位置輸出為:</b><

32、;/p><p>  通過對控制量雙重積分可以得到小車的位置。</p><p>  2.2 PID控制參數設定及MATLAB仿真</p><p>  通過不斷的調試,最后=120,=100,=20。</p><p>  系統(tǒng)MATLAB仿真模型如下:</p><p>  圖2-3一階倒立擺PID控制MATLAB仿真模型&l

33、t;/p><p>  其輸入0.1N的脈沖響應如下:</p><p>  圖2-4直線一階倒立擺PID控制仿真結果圖</p><p>  可以看出,在3.68s的時候系統(tǒng)已經穩(wěn)定了,并且在穩(wěn)態(tài)時擺桿與垂直方向的夾角變化小于0.1弧度。由于PID控制器為單輸入單輸出系統(tǒng),所以只能控制小車擺桿的角度,并不能控制小車的位置。</p><p>  2.3

34、 PID控制實驗</p><p>  MATLAB版實驗軟件下的實驗步驟:</p><p>  (1) 打開直線一級倒立擺PID控制界面如圖2-5所示:(進入MATLAB Simulink 實時控制工具箱“Googol Education Products”打開“Inverted Pendulum\Linear Inverted Pendulum\Linear 1-Stage IP E

35、xperiment\ PID Experiments”中的“PID Control Demo”) 2) 雙擊“PID”模塊進入PID 參數設置,如圖2-6所示,把仿真得到的參數輸入PID控制器,點擊“OK”保存參數。</p><p>  圖2-5直線一級倒立擺MATLAB 實時控制界面 圖2-6 參數設計調整</p><p>  (3) 點擊編譯程序,完成后點擊使計

36、算機和倒立擺建立連接。</p><p>  (4) 點擊運行程序,檢查電機是否上伺服。緩慢提起倒立擺的擺桿到豎直向上的位置,在程序進入自動控制后松開,當小車運動到正負限位的位置時,用工具擋一下擺桿,使小車反向運動。 </p><p>  (5) 實驗結果如下圖所示:</p><p>  圖2-7 PID控制實驗結果1</p><p>  圖2

37、-8 PID控制實驗結果2(施加干擾)</p><p>  從圖2-7中可以看出,倒立擺可以實現(xiàn)較好的穩(wěn)定性,擺桿的角度在3.14(弧度)左右。PID控制器并不能對小車的位置進行控制,小車會沿滑桿有稍微的移動。在給定干擾的情況下,小車位置和擺桿角度的變化曲線如圖2-8所示,可以看出,系統(tǒng)可以較好的抵換外界干擾,在干擾停止作用后,系統(tǒng)大約3.2s達到穩(wěn)態(tài),穩(wěn)態(tài)時擺桿與垂直方向的夾角變化遠小于0.1弧度。</p

38、><p>  2.4 PID系統(tǒng)的優(yōu)缺點</p><p>  優(yōu)點:PID控制優(yōu)點明顯,應用廣泛。PID能消除穩(wěn)態(tài)誤差;同時可以減少超調量,克服振蕩,使系統(tǒng)的穩(wěn)定性提高;并且能加快系統(tǒng)的動態(tài)響應速度,減小調整時間,從而改善系統(tǒng)的動態(tài)性能。</p><p>  缺點:PID控制的過度期比較長,上升過程中波動明顯;當然,較好的PID控制效果是以已知被控對象的精確數學模型為前

39、提的,當被控對象的數學模型未知時,PID控制的調試將會有很大的難度。</p><p>  第三章 狀態(tài)空間極點配置控制器設計</p><p>  經典控制理論的研究對象主要是單輸入單輸出的系統(tǒng),控制器設計時一般需要有關被控對象的較精確模型,現(xiàn)代控制理論主要是依據現(xiàn)代數學工具,將經典控制理論的概念擴展到多輸入多輸出系統(tǒng)。極點配置法通過設計狀態(tài)反饋控制器將多變量系統(tǒng)的閉環(huán)系統(tǒng)極點配置在期望的

40、位置上,從而使系統(tǒng)滿足瞬態(tài)和穩(wěn)態(tài)性能指標。</p><p><b>  設計目的:</b></p><p>  學習狀態(tài)空間極點配置控制器的設計方法,分析各個極點變化對系統(tǒng)性能的影響,學會根據控制指標要求和實際響應調整極點的位置和控制器的參數。</p><p><b>  設計要求:</b></p><

41、p>  設計狀態(tài)空間極點配置控制器,使得當在小車上施加0.2m的階躍信號時,閉環(huán)系統(tǒng)的響應指標為:</p><p> ?。?)擺桿角度和小車位移的穩(wěn)定時間小于3秒</p><p> ?。?)的上升時間小于1秒</p><p> ?。?)的超調量小于20度(0.35弧度)</p><p> ?。?)穩(wěn)態(tài)誤差小于2%。</p>

42、<p><b>  設計報告要求:</b></p><p> ?。?)給出系統(tǒng)擺桿角度和小車位置的仿真控制圖形及控制器參數,并對極點的位置和各個參數對系統(tǒng)控制效果的影響進行分析;</p><p> ?。?)給出實際控制曲線和控制器參數,并對響應的動態(tài)和靜態(tài)指標進行分析。</p><p>  3.1 狀態(tài)空間分析</p>

43、<p>  狀態(tài)反饋閉環(huán)控制系統(tǒng)原理圖如圖3-1所示。</p><p>  圖3-1 狀態(tài)反饋閉環(huán)控制原理圖</p><p><b>  狀態(tài)方程為:</b></p><p>  式中:為狀態(tài)向量(維),為控制向量(純量),為維常數矩陣,為維常數矩陣。</p><p><b>  選擇控制信號:&

44、lt;/b></p><p><b>  求解上式,得到</b></p><p><b>  方程解為:</b></p><p>  可以看出,如果系統(tǒng)狀態(tài)完全可控,選擇適當,對于任意的初始狀態(tài),當趨于無窮時,都可以使趨于0。</p><p>  極點配置的設計步驟:</p>&

45、lt;p>  (1) 檢驗系統(tǒng)的可控性條件。</p><p>  (2) 從矩陣的特征多項式</p><p><b>  來確定的值。</b></p><p>  (3) 確定使狀態(tài)方程變?yōu)榭煽貥藴市偷淖儞Q矩陣:</p><p><b>  其中為可控性矩陣,</b></p>&

46、lt;p>  (4) 利用所期望的特征值,寫出期望的多項式</p><p><b>  并確定的值。</b></p><p>  (5) 需要的狀態(tài)反饋增益矩陣由以下方程確定:</p><p>  3.2 極點配置及MATLAB仿真</p><p>  前面我們已經得到了直線一級倒立擺的狀態(tài)空間模型,以小車加速度作

47、為輸入的系統(tǒng)狀態(tài)方程為:</p><p><b>  于是有:</b></p><p><b>  ,,,</b></p><p>  直線一級倒立擺的極點配置轉化為:</p><p>  選,,解得=0.59,wn=3.39,=0.804,符合要求。</p><p>  求

48、得閉環(huán)主導極點為:,選取另兩個極點為-14,-14。則:</p><p>  對于如上所述的系統(tǒng),設計控制器,要求系統(tǒng)具有較短的調整時間(約3秒)和合適的阻尼。</p><p>  下面采用四種不同的方法計算反饋矩陣。</p><p><b>  方法一: </b></p><p>  倒立擺極點配置原理圖如圖3-2所示

49、。</p><p>  圖3-2 倒立擺極點配置原理圖</p><p><b>  極點配置步驟如下:</b></p><p>  (1) 檢驗系統(tǒng)可控性(略)</p><p><b>  (2) 計算特征值</b></p><p>  根據要求,并留有一定的裕量(設調整時間

50、為2秒),我們選取期望的閉環(huán)極點,其中:</p><p>  其中,是一對具有的主導閉環(huán)極點,位于主導閉環(huán)極點的左邊,因此其影響較小,因此期望的特征方程為:</p><p><b>  因此可以得到:</b></p><p><b>  由系統(tǒng)的特征方程:</b></p><p><b>

51、  因此有</b></p><p>  系統(tǒng)的反饋增益矩陣為:</p><p>  (3) 確定使狀態(tài)方程變?yōu)榭煽貥藴市偷淖儞Q矩陣:</p><p><b>  式中:</b></p><p><b>  于是可以得到:</b></p><p>  (4) 狀態(tài)反

52、饋增益矩陣為:</p><p>  得到控制量為:;以上計算可以采用MATLAB編程計算。直線一級倒立擺狀態(tài)空間極點配置MATLAB 程序1: </p><p><b>  clear;</b></p><p>  A=[0 1 0 0;0 0 0 0;0 0 0 1;0 0 24.5 0];</p><p>  B=[

53、0 1 0 2.5]';</p><p>  C=[1 0 0 0;0 0 1 0];</p><p><b>  D=[0 0]';</b></p><p>  J=[-14 0 0 0;0 -14 0 0;0 0 -2-2.74*i 0;0 0 0 -2+2.74*i];</p><p>  pa=p

54、oly(A);pj=poly(J);</p><p>  M=[B A*B A^2*B A^3*B];</p><p>  W=[pa(4) pa(3) pa(2) 1;pa(3) pa(2) 1 0;pa(2) 1 0 0;1 0 0 0];</p><p><b>  T=M*W;</b></p><p>  K=[

55、pj(5)-pa(5) pj(4)-pa(4) pj(3)-pa(3) pj(2)-pa(2)]*inv(T);</p><p>  Ac=[(A-B*K)];</p><p>  Bc=[B];Cc=[C];Dc=[D];</p><p>  T=0:0.005:5;</p><p>  U=0.2*ones(size(T));</p

56、><p>  Cn=[1 0 0 0];</p><p>  Nbar=rscale(A,B,Cn,0,K);</p><p>  Bcn=[Nbar*B];</p><p>  [Y,X]=lsim(Ac,Bcn,Cc,Dc,U,T);</p><p>  plot(T,X(:,1),'-');hold

57、on;</p><p>  plot(T,X(:,2),'-.');hold on;</p><p>  plot(T,X(:,3),'.');hold on;</p><p>  plot(T,X(:,4),'-');hold on;</p><p>  legend('CartPos

58、','CartSpd','PendAng','PendSpd')</p><p> ?。ㄟM入MATLAB Simulink 實時控制工具箱“Googol Education Products”打開“Inverted Pendulum\Linear Inverted Pendulum\Linear 1-Stage IP Experiment\ Poles Ex

59、periments”中的“Poles Control M File1”)運行得到以下結果:</p><p><b>  運行結果如下:</b></p><p>  K = [-92.0608 -45.1515 174.4274 30.8606]</p><p>  圖3-3極點配置仿真結果</p><p>  可

60、以看出,給定系統(tǒng)干擾后,倒立擺可以在2s內很好的回到平衡位置</p><p><b>  方法二: </b></p><p>  矩陣(A-BK)的特征值是方程式的根:</p><p>  這是s的四次代數方程式,可表示為</p><p>  適當選擇反饋系數系統(tǒng)的特征根可以取得所希望的值。</p><

61、;p>  把四個特征根設為四次代數方程式的根,則有</p><p>  比較兩式有下列聯(lián)立方程式</p><p>  如果給出的是實數或共軛復數,則聯(lián)立方程式的右邊全部為實數。據此可求解出實數。</p><p>  當將特征根指定為下列兩組共軛復數時</p><p><b>  又 </b></p>

62、;<p>  利用方程式可列出關于的方程組:</p><p>  利用如下直線一級倒立擺狀態(tài)空間極點配置MATLAB程序2。</p><p><b>  clear;</b></p><p>  syms a s b k1 k2 k3 k4;</p><p>  A=[0 1 0 0;0 0 0 0;0 0

63、 0 1;0 0 a 0];</p><p>  B=[0 1 0 b]';</p><p>  SS=[s 0 0 0;0 s 0 0;0 0 s 0;0 0 0 s];</p><p>  K=[k1 k2 k3 k4];</p><p>  J=[-14 0 0 0;0 -14 0 0;0 0 -2-2.74*i 0;0 0 0

64、 -2+2.74*i];</p><p>  ans=A-B*K;</p><p>  P=poly(ans)</p><p>  PJ=poly(J)</p><p> ?。ㄟM入MATLAB Simulink 實時控制工具箱“Googol Education Products”打開“Inverted Pendulum\Linear Inve

65、rted Pendulum\Linear 1-Stage IP Experiment\ Poles Experiments”中的“Poles Control M File2”)</p><p>  求解后得K = [-92.0608 -45.1515 174.4274 30.8606]。</p><p>  即施加在小車水平方向的控制力:</p><p> 

66、 可以看出,和方法一的計算結果一樣。</p><p>  方法三:利用愛克曼公式計算</p><p>  愛克曼方程所確定的反饋增益矩陣為:</p><p><b>  其中 </b></p><p>  利用MATLAB 可以方便的計算,程序如下:直線一級倒立擺狀態(tài)空間極點配置MATLAB 程序3(愛克曼公式)<

67、;/p><p><b>  clear;</b></p><p>  A=[0 1 0 0;0 0 0 0;0 0 0 1;0 0 24.5 0];</p><p>  B=[0 1 0 2.5]';</p><p>  M=[B A*B A^2*B A^3*B];</p><p>  J=[

68、-14 0 0 0;0 -14 0 0;0 0 -2-2.74*i 0;0 0 0 -2+2.74*i];</p><p>  phi=polyvalm(poly(J),A);</p><p>  K=[0 0 0 1]*inv(M)*phi </p><p> ?。ㄟM入MATLAB Simulink 實時控制工具箱“Googol Education

69、 Products”打開“Inverted Pendulum\Linear Inverted Pendulum\Linear 1-Stage IP Experiment\ Poles Experiments”中的“Poles Control M File3”)</p><p>  運行可以得到:K = [-92.0608 -45.1515 174.4274 30.8606]。</p><

70、;p>  可以看出,計算結果和前面兩種方法一致。</p><p><b>  方法四:</b></p><p>  可以直接利用MATLAB的極點配置函數[K,PREC,MESSAGE] = PLACE(A,B,P)來計算。直線一級倒立擺狀態(tài)空間極點配置MATLAB 程序4(愛克曼公式)如下所示。</p><p><b>  c

71、lear;</b></p><p>  A=[0 1 0 0;0 0 0 0;0 0 0 1;0 0 24.5 0];</p><p>  B=[0 1 0 2.5]';</p><p>  M=[B A*B A^2*B A^3*B];</p><p>  J=[-14 0 0 0;</p><p>

72、;  0 -14 0 0;</p><p>  0 0 -2-2.74*i 0;</p><p>  0 0 0 -2+2.74*i];</p><p>  phi=polyvalm(poly(J),A);</p><p>  K=[0 0 0 1]*inv(M)*phi</p><p> ?。ㄟM入MATLAB Sim

73、ulink 實時控制工具箱“Googol Education Products”打開“Inverted Pendulum\Linear Inverted Pendulum\Linear 1-Stage IP Experiment\ Poles Experiments”中的“Poles Control M File4”)為匹配place()函數,把-14,-14兩個極點改成了-14-0.0001j,-14+0.0001j,因為增加的虛部很

74、小,可以忽略不計,運行得到如下結果:</p><p>  K =[-92.0608 -45.1515 174.4274 30.8606]。</p><p>  可以看出,以上四種方法計算結果都保持一致。</p><p><b>  3.3極點配置實驗</b></p><p><b>  實驗步驟如下:&

75、lt;/b></p><p>  (1) 進入MATLAB Simulink 中“ \\matlab6p5\toolbox\GoogolTech\InvertedPendulum \ Linear Inverted Pendulum, ”目錄,打開直線一級倒立擺狀態(tài)空間極點配置控制程序如下:</p><p> ?。ㄟM入MATLAB Simulink 實時控制工具箱“Googol Ed

76、ucation Products”打開“Inverted Pendulum\Linear Inverted Pendulum\Linear 1-Stage IP Experiment\Poles Experiments”中的“Poles </p><p>  Control Demo”)</p><p>  圖3-8狀態(tài)空間極點配置實時控制程序 圖3-9 極點配置

77、控制參數設定</p><p>  (2) 點擊“Controller”模塊設置控制器參數,把前面仿真結果較好的參數輸入到模塊中:</p><p>  點擊“OK”完成設定。</p><p>  (3) 點擊編譯程序,完成后點擊使計算機和倒立擺建立連接。</p><p>  (4) 點擊運行程序,檢查電機是否上伺服。緩慢提起倒立擺的擺桿到豎直向

78、上的位置,在程序進入自動控制后松開。</p><p>  (5) 雙擊“Scope”觀察實驗結果如下圖所示:</p><p>  圖3-10狀態(tài)空間極點配置實時控制結果(平衡) </p><p>  圖3-11狀態(tài)空間極點配置實時控制結果(施加干擾)</p><p>  可以看出,系統(tǒng)可以在很小的振動范圍內保持平衡,小車振動幅值約為4

79、5;10-3 m,擺桿振動的幅值約為0.01弧度。在給定倒立擺干擾后,系統(tǒng)如響應如圖3-11所示,從上圖可以看出,系統(tǒng)穩(wěn)定時間約為2.1秒,X的上升時間約為0.4s,的超調量約為0.15弧度。達到設計要求。</p><p>  狀態(tài)反饋系統(tǒng)的主要優(yōu)點是極點的任意配置,無論開環(huán)極點和零點在什么位置,都可以任意配置期望的閉環(huán)極點。這為我們提供了控制系統(tǒng)的手段,假如系統(tǒng)的所有狀態(tài)都可以被測量和反饋的話,狀態(tài)反饋可以提供

80、簡單而適用的設計</p><p>  第四章 總結及心得體會</p><p><b>  總結:</b></p><p>  PID的MATLAB仿真結果和實驗結果基本是吻合的。在MATLAB仿真時,通過不斷的調試,可以找到很多組滿足實驗要求的PID參數,這就要求在眾多的參數中選取最優(yōu)解。但是實際系統(tǒng)和仿真還是有出入的,在實際系統(tǒng)中調試時,仿

81、真好的參數不一定效果好。所以,要調試出好的參數,前期要進行仿真調試出比較合適的參數組,然后在實驗室取最優(yōu)解。最終的PID參數為:120,100,20。實驗結果為:在干擾停止作用后,系統(tǒng)大約3.2s達到穩(wěn)態(tài),穩(wěn)態(tài)時擺桿與垂直方向的夾角變化遠小于0.1弧度。滿足設計要求。</p><p>  極點配置中對極點的選取很重要。通過這次課設,我學會了很多求極點配置參數的辦法。最終求得到的參數為:K =[-92.0608

82、-45.1515 174.4274 30.8606]。這組參數最后調出的系統(tǒng)穩(wěn)定時間約為2.1秒,X的上升時間約為0.4s,的超調量約為0.15弧度。滿足了設計要求。</p><p>  PID由于是單輸入單輸出系統(tǒng),只能控制擺桿的角度,不能控制小車的位移,而極點配置兩個變量都可以控制。</p><p><b>  心得體會:</b></p>&l

溫馨提示

  • 1. 本站所有資源如無特殊說明,都需要本地電腦安裝OFFICE2007和PDF閱讀器。圖紙軟件為CAD,CAXA,PROE,UG,SolidWorks等.壓縮文件請下載最新的WinRAR軟件解壓。
  • 2. 本站的文檔不包含任何第三方提供的附件圖紙等,如果需要附件,請聯(lián)系上傳者。文件的所有權益歸上傳用戶所有。
  • 3. 本站RAR壓縮包中若帶圖紙,網頁內容里面會有圖紙預覽,若沒有圖紙預覽就沒有圖紙。
  • 4. 未經權益所有人同意不得將文件中的內容挪作商業(yè)或盈利用途。
  • 5. 眾賞文庫僅提供信息存儲空間,僅對用戶上傳內容的表現(xiàn)方式做保護處理,對用戶上傳分享的文檔內容本身不做任何修改或編輯,并不能對任何下載內容負責。
  • 6. 下載文件中如有侵權或不適當內容,請與我們聯(lián)系,我們立即糾正。
  • 7. 本站不保證下載資源的準確性、安全性和完整性, 同時也不承擔用戶因使用這些下載資源對自己和他人造成任何形式的傷害或損失。

評論

0/150

提交評論