球棒系統(tǒng)的建模及反饋控制

1、球棒系統(tǒng)的建模及反饋控制題目：球棒系統(tǒng)的建模及反饋控制姓 名：學 院：工學院班 級：學 號：指導教師：李玉民 林相澤20年 6月7日南京農(nóng)業(yè)大學教務(wù)處制自動控制原理n實習報告由剛性球和連桿臂構(gòu)成的球棒系統(tǒng)，如圖一所示。連桿在驅(qū)動力矩工作用下繞軸心點O做旋轉(zhuǎn)運動。連桿的轉(zhuǎn)角和剛性球在連桿上的位置分別用日，r表示，設(shè)剛性球的半徑為 Ro當小球轉(zhuǎn)動時，球的移動和棒的運動構(gòu)成復(fù)合運動。剛性球與機械臂的動態(tài)方程由下式描述選取剛性球的位移r和其速度r| ,以及機械的轉(zhuǎn)角8及其角速度作為狀態(tài)變量，令 x = x1,x2,x3,x4 T =",r,e,dT,可得系統(tǒng)的狀態(tài)空間表達式設(shè)球棒系統(tǒng)各參數(shù)如

2、下：m=0.05kg, R=0.01m, J=0.02kgm2, Jb =2父10*kgm2, G = 9.81m/s2。一、將系統(tǒng)在平衡點x = 0處線性化，求解線性系統(tǒng)模型。首先求系統(tǒng)的平衡點，令G(x) =0 ,2=014 mR2 x4=0/2(x1x4 -G Sin x3)=02mxix2M -mGxiCOS&2：m%J J2 =0m% J Jbx1=mG，解得x2=0x3 = 0x4 =0x = 0x? = 0若要維持系統(tǒng)穩(wěn)定，平衡狀態(tài)時 =0,既得x3 =0x4 =0用李雅普諾夫第一方法將系統(tǒng)在平衡點處線性化處理如下:經(jīng)過線性化處理，系統(tǒng)模型為: 利用matlab可求得:e

3、ig(A) =-7.657 7.657i-7.657i 7.657,可知該系統(tǒng)是不穩(wěn)定的。二、利用狀態(tài)反饋將線性系統(tǒng)極點配置于 -1±2j , -1±2j ,求解狀態(tài)反饋增益，并 畫出小球初試狀態(tài)為r=0.3,橫桿角度為日=30。和初始狀態(tài)r = -0.3,橫桿角度為 3 3 -30時的仿真圖像t -xo先判斷系統(tǒng)是否完全能控UcB AB A2B A3B =-0007007.1500-7007.1500500050000可知該系統(tǒng)是完全能控的，可進行狀態(tài)反饋。極點配置于-1 ±2 j, -2 ± j的閉環(huán)特征多項式為:狀態(tài)反饋設(shè)置令u =v-kx ,則狀

4、態(tài)反饋后系統(tǒng)的狀態(tài)空間表達式為: 利用Matlab 編程，最后求得系統(tǒng)狀態(tài)反饋控制矩陣為: 即所求的狀態(tài)反饋增益。則狀態(tài)反饋后系統(tǒng)的狀態(tài)空間表達式為：狀態(tài)反饋后的模擬結(jié)構(gòu)圖為:V201234567圖3小球初試狀態(tài)為r = 0.3 ,9 = 30時系統(tǒng)的仿真圖像t - x圖4初始狀態(tài)為r 0.3 8 =30,時simulink仿真圖n編寫M程序畫出小球初試狀態(tài)為r:一0.3,10 =-30'時系統(tǒng)的仿真圖像t-x,程序中只需將程序一中的x0=0.3 0 pi/6 0改為 xO-0.3 0 -pi/6 0即可，見圖 525Simulink仿真的圖像女6所示:15圖6初始)10三、設(shè)計具有，

5、但為'r 0.330時simulink仿真圖適極義的狀態(tài)觀測器，實現(xiàn)狀態(tài)反饋，給出狀態(tài)反饋增益和觀測器增益，并畫出力、-6桿角度為日= 30；3T橫桿角度為30g初始狀態(tài)r = -0.3,橫時的仿真圖像x,以及觀測器輸出與系統(tǒng)狀態(tài)差值圖像(t - e)由分離性原理-20別設(shè)計狀態(tài)反饋增益與觀測器增益，下面先設(shè)計狀態(tài)反饋增益，4后設(shè)計觀測器增益23456靜75曲楸妙懶椀澗落后0條同聞謔0帆系統(tǒng)的仿真圖像LxPart 1 .狀態(tài)反饋增益的設(shè)計由上從求得的仿真圖可知，系統(tǒng)的調(diào)節(jié)時間和超調(diào)量都比較大，運行 matlab時，系統(tǒng)還提示：Warning: Pole locations are mo

6、re than 10% in error.t - 1s 一因此很有必要通過限制超調(diào)量和調(diào)整時間重新配置極點。設(shè)定系統(tǒng)的超調(diào)量為仃5%,調(diào)整時間為ts 。得=0.69-1-2.e 1- <5%到不等式 /,解不等式，取 八 A7QG4 : 1sn = 5.796(- -n所以6,2 =-亡。n + jag * =用±4.2 j ,將其作為主導極點，另外兩個極點可選為任意實部大于此處選擇-40 ±4.2 j 。在matlab中通過acker函數(shù)【附錄2】直接求得k和A-BK :求得狀態(tài)反饋增益為 k - -8.0871 -2.1906 45.1200 1.7600,反饋后

7、的系統(tǒng)矩陣為:Part 2設(shè)計觀測器增益首先判斷系統(tǒng)能觀性:Rank(Uo) =4 = n 系統(tǒng)完全能觀，可設(shè)計狀態(tài)觀測器。狀態(tài)觀測器為取得較為合適的特征值，根據(jù)Re ' A - EC = (3 5)Re肛A - BK的原則選擇觀測器的極點“2=_15±4.2j, s3,4 =65±4.2j。直接求得 E和A-EC :求得E =一75.710.4 1一-75.70-10.4-24.51836.5-75.5435.5 ,A-EC =075.5012.684.3-12.6-140.1-84.30出57.51298.7/57.50-1297.70 _附錄四畫出小球初試狀態(tài)

8、為r =0.3,9 =30時系統(tǒng)place函數(shù)【附錄3】O程序【的仿真圖像tx,見圖由分離性原理知 e =(A EC)e 在matlab中通過圖8.初試狀態(tài)為r = 0.3 ,6=30時系統(tǒng)的仿真圖像 t xSimulink搭建e = (A-EC)e系統(tǒng)圖如圖99simulink 搭建系統(tǒng)的觀測器輸出與系統(tǒng)狀態(tài)差值t-e初試狀態(tài)為r =0.3,日=30時系統(tǒng)觀測器輸出與系統(tǒng)狀態(tài)差值t-e見圖10。圖10初試狀態(tài)為r =0.3 5 =30時系統(tǒng)的觀測器輸出與系統(tǒng)狀態(tài)差值圖像t - ep把上面程序中的x0=0.3 0 pi/6 0改為x0=-0.3 0 -pi/6 0即為小球初試狀態(tài)為r = -0

9、.3,9 = 一30時系統(tǒng)的仿真圖像t -x ,見圖11。圖11小球初試狀態(tài)為r = -0.3,6 = -30C時系統(tǒng)的仿真圖像觀測器輸出與系統(tǒng)狀態(tài)差值圖像t -e,見圖11圖11球初試狀態(tài)為r = -0.3,9 = -30c時分析與總結(jié)：系統(tǒng)的觀測器輸出與系統(tǒng)狀態(tài)差值圖像t - e該系統(tǒng)搭建出來是一個非線性系統(tǒng)，需要用李雅普諾夫第一方法將系統(tǒng)在平衡點處線性化為四階線性系統(tǒng)；用能控性判據(jù)判斷出該系統(tǒng)是完全能控的，可進行狀態(tài)反饋，第二問中給出了兩對目標極點，可利用matlab求得狀態(tài)反饋增益 K,我們得到了反饋后的系統(tǒng)。然后利用 simulink仿真，題目中給出了球棒的兩種初始狀態(tài)， 我們通過仿

10、真圖可以發(fā)現(xiàn)系統(tǒng)性能很不理想，超調(diào)量過大，調(diào)整時間過長，實際上是由于極點選擇不當造成的， 這樣才有了第三問中全維觀測器的設(shè)計。對原系統(tǒng)進行能觀性判斷，可知系統(tǒng)完全能觀測，可進行觀測器設(shè)計。由分離性原理，可分開設(shè)計狀態(tài)反饋增益與觀測器增益，兩者互不干擾，我們自己設(shè)定了超調(diào)量（5%）和調(diào)整時間（1s）,然后求出一對極點，我們運用主導極點的思想，設(shè)計了另外一對極點，這樣狀態(tài)反饋增益k就得到了；然后為狀態(tài)觀測器選取特征值， 進而用matlab求得觀測器增益 E,我們用m程序畫出t-x仿真圖，用simulink 畫出t-e仿真圖，發(fā)現(xiàn)系統(tǒng)性能得到了很大提高，符合設(shè)計要求。M程序附錄：程序一：>&g

11、t; A=0 1 0 0;0 0 -140.14 0;0 0 0 1;-24.52 0 0 0;>> B=0;0;0;50;>> C=1 0 0 0;0 0 1 0;» D=0;» P=-1-2*j,-1+2*j,-2-j,-2+j;» K=acker(A,B,P)» A1 =A-B*K» u=0;» G=ss(A1,B,C,D);» x0=0.3 0 pi/6 0;» y,t,x=initial(G,xO);» plot(t,x)程序二：»A=0 1 0 0;0 0 -

12、140.143 0;0 0 0 1 ;-24.523 0 0 0;»B=0;0;0;50;»C=1 0 0 0;0 0 1 0;»D=0;»p=-4-4.2*j,-4+4.2*j,-40-4.2*j,-40-4.2*j;»K=acker(A,B,P)»A-B*K程序三：»A=0 1 0 0;0 0 -140.14 0;000 1 ;-24.52 0 0 0;»B=0;0;0;50;»C=1 0 0 0;0 0 1 0;»D=0;»P=-15+4.2*j -15-4.2*j -65+4.

13、2*j -65-4.2*j;»C=C;»A=A'»E=place(A,C,P);»E'»A=A-(E')*(C)程序四» A=0 1 0 0;0 0 -140.14 0;000 1 ;-24.52 0 0 0;» B=0;0;0;50;» C=1 0 0 0;001 0;» D=0;» P=-15+4.2*j -15-4.2*j -65+4.2*j -65-4.2*j;» C=C;» A=A'» G=place(A,C,P);»A=A'-(G')*(C