1、精品文檔研究生現代控制理論及其應用課程小論文一級倒立擺的建模與控制分析學院： 機械工程學院班級： 機研 131姓名： 尹潤豐學號： 2013212020162014年6月2日.精品文檔目錄1. 問題描述及狀態空間表達式建立 .- 1 -1.1問題描述 .- 1 -1.2狀態空間表達式的建立 .- 1 -1.2.1直線一級倒立擺的數學模型.- 1 -1.2.2直線一級倒立擺系統的狀態方程.- 5 -2.應用 MATLAB 分析系統性能 .- 6 -2.1直線一級倒立擺閉環系統穩定性分析.- 6 -2.2系統可控性分析 .- 7 -2.3系統可觀測性分析 .- 8 -3. 應用 matlab 進行

2、綜合設計 .- 8 -3.1狀態反饋原理 .- 8 -3.2全維狀態反饋觀測器和 simulink 仿真 .- 9 -4.應用 Matlab 進行系統最優控制設計 .-11-5.總結.-13-.精品文檔1.問題描述及狀態空間表達式建立1.1 問題描述倒立擺是機器人技術、 控制理論、計算機控制等多個領域、 多種技術的有機結合，其被控系統本身又是一個絕對不穩定、 高階次、多變量、強耦合的非線性系統，可以作為一個典型的控制對象對其進行研究。倒立擺系統作為控制理論研究中的一種比較理想的實驗手段，為自動控制理論的教學、實驗和科研構建一個良好的實驗平臺，以用來檢驗某種控制理論或方法的典型方案，促進了控制系

3、統新理論、新思想的發展。下對于倒立擺系統，經過小心的假設忽略掉一些次要的因素后，它就是一個典型的運動的剛體系統，可以在慣性坐標系內應用經典力學理論建立系統的動力學方程。下面采用其中的牛頓歐拉方法建立直線一級倒立擺系統的數學模型。1.2 狀態空間表達式的建立1.2.1直線一級倒立擺的數學模型.精品文檔圖1.1 直線一級倒立擺系統1.1 所示。本文中倒立擺系統描述中涉及的符號、物理意義及相關數值如表圖 1.2 是系統中小車的受力分析圖。 其中，N和P為小車與擺桿相互作用力的水平和垂直方向的分量。.精品文檔圖1.2 系統中小車的受力分析圖圖 1.3 是系統中擺桿的受力分析圖。 Fs是擺桿受到的水平方

4、向的干擾力 , F h是擺桿受到的垂直方向的干擾力，合力是垂直方向夾角為的干擾力 Fg。圖 1.3 擺桿受力分析圖分析小車水平方向所受的合力，可以得到以下方程：MxFfxN11設擺桿受到與垂直方向夾角為的干擾力 Fg，可分解為水平方向、 垂直方向的干擾力，所產生的力矩可以等效為在擺桿頂端的水平干擾力FS、垂直干擾力 Fh產生的力矩。Fh12FS Fg sinFg cos對擺桿水平方向的受力進行分析可以得到下面等式：2NFSm d 2x l sin1 3dt.精品文檔即：N mx ml cos ml 2 sin F f sin1 4對圖 1.3 擺桿垂直方向上的合力進行分析，可以得到下面方程：P

5、mgFhd 2l cos1 5m2 ldt即PmgFg cosml sinml 2 cos16力矩平衡方程如下：Fgl sin cosFg l cossinPl sinNl cos I017代入 P和N，得到方程：2Fgl sin cos 2Fgl cossinIml2 cos2mglsinml22 sin2mlxcos0 18設，（是擺桿桿與垂直向上方向之間的夾角，單位是弧度） ，代入上式。假設 1，則可進行近似處理：2cos1, sin,d0,cos21, sin 2dt由于： I1 ml 23方程化為：2Fgsincos4 mlmgmx193令： F fFg sincos，則 19 可化

6、為：2F f4 mlmgmx11031 10 即是化簡后的直線一級倒立擺系統微分方程。帶入實際數據后， 微分方程為：29.43x2F f111m當忽略了 F 時，系統的微分方程如式（ 1-12 ）所示f29.43x112忽略干擾力后，直線一級倒立擺系統是單輸入二輸出的四階系統，考慮干擾力后，.精品文檔直線一級倒立擺系統是二輸入二輸出的四階系統。 其內部的 4個狀態量分別是小車的位移 x、小車的速度 x 、擺桿的角度、擺桿的角速度 。系統輸出的觀測量為小車的位移 x、擺桿的角度。其控制量為小車的加速度將微分方程（ 1-12 ）化為關于加速度輸入量和角度輸出量的傳遞函數：s31 13R ss229

7、.41.2.2直線一級倒立擺系統的狀態方程實驗所使用的直線一級倒立擺系系統是加速度x 作為系統的控制輸入，所以根據式（ 1-12 ）建立系統的狀態方程為：xxxx3g3 x4l4l整理后得到系統狀態方程：x0100 x0 x0000 x1x00010003g03g4l4lxyx1000 x0 x00100將實際參數代入得到一級倒立擺系統的狀態空間方程為：.精品文檔x0100 x0 x0000 x10001x00029.403xyx1000 x00010 x0010000000110000A001BC010D00000029.4032.應用 MATLAB分析系統性能2.1 直線一級倒立擺閉環系統

8、穩定性分析構建如圖 1.4 所示閉環系統，則系統的閉環極點為（-5.1381 ）、（5.1381 ） :圖 1.4 閉環系統結構圖由于有實部為正的極點，所以閉環系統不穩定，必須設計控制器使系統穩定。可以通過 MATLAB Simulink中對其進行仿真，判斷其穩定性。構建圖 1.4 所示系統的仿真程序 e1，加入 1m/s2的階躍信號.精品文檔由上圖也能清楚的知道一級倒立擺系統是不穩定的。2.2系統可控性分析系統的可控性可根據秩判據進行可控性判斷。線性定常連續系統完全可控的充分必要 條件 是： rank (BABAn 1B)n ， 其中n 為系 統矩陣A 的階 次，M( B ABAn 1 B)

9、 為系統的可控性矩陣。matlab 程序及運行結果如下：A=0 1 0 0;0 0 0 0;0 0 0 1;0 0 29.4 0;B=0;1;0;3;T=ctrb(A,B);rank(T)ans =4由于 rank （Ic ） =4，可見該系統是完全可控的。.精品文檔2.3系統可觀測性分析系統的可控性可根據秩判據進行可控性判斷。線性定常連續系統完全可控的充分必要條件是：CCArankNrankn 或 rank (C TAT C T ( AT )2 C T( AT ) n 1C T )nCAn 1其中 n 為系數矩陣 A 的階次。matlab 程序及運行結果如下：A=0 1 0 0;0 0 0

10、0;0 0 0 1;0 0 29.4 0;C=1 0 0 0;0 0 1 0;T0=obsv(A,C);rank(T0)ans =4由于 rank （T0） =4，故該系統是可觀測的。3.應用 matlab 進行綜合設計3.1 狀態反饋原理設維線性定常系統：xAxBu , yCx其中 x,u,y 分別是 n維、 p維、 q維向量； A、 B、 C分別是 n*n 維， n*p 維， n*q 維實數矩陣。狀態反饋系統的控制量 u取為狀態 x的線性函數：.精品文檔uvKx其中， v為p參考輸入向量， K為p*n 維實反饋增益矩陣。加入狀態反饋后系統的結構圖如圖3.1 所示：圖3.1 系統的全狀態反饋

11、結構圖則系統狀態反饋的動態方程為：A BK x Bv, y Cx3.2 全維狀態反饋觀測器和simulink仿真狀態反饋的的實現是利用狀態反饋使系統的閉環極點位于所希望的極點位置。而狀態反饋任意配置閉環極點的充分必要條件是被控系統可控。直線一級倒立擺系統是可控的。設系統期望極點為 1 2 34 =234 3i4 3i ，則系統期望特征多項式為：a* ss1 s2 s3 s4列寫狀態反饋系統的特征多項式：det SIA BK令兩個特征多項式各項系數對應相等，則可解出 K 陣。由 matlab 求出狀態反饋矩陣K，編程如下：A=0 1 0 0;0 0 0 0;0 0 0 1;0 0 29.4 0;

12、B=0;1;0;3;K=acker(A,B,-2 -3 -4+3i -4-3i) K =.精品文檔-5.1020-5.884435.16736.2948系統加入 0.1m/s 2的階躍輸入， 在構成的狀態反饋調節器控制下， MATLAB中進行系統的階躍響應仿真，編程如下：A=0100000000010029.40;B1=0103;C=1000010000100001;D1=0 0 0 0;dt=0.005;ieof=801;for i=1:ieof;U(:,i)=0.1;T(i)=i*dt;end;%離散化op=-2%期望極點-3-4+3i-4-3i;K=place(A,B1,op)Ak0=(

13、A-B1*K);Bk0=B1;Ck0=C;Dk0=D1;lqrop=eig(Ak0);x=0 0 0 0;dt=0.005;% 離散時dA,dB=c2d(Ak0,Bk0,dt);%經離散化得到離散狀態方程Ak1=(A-B1*K);Bk1=B1;Ck1=C;Dk1=D1;sys=ss(Ak1,Bk1,Ck1,Dk1);.精品文檔Y,X=lsim(sys,U,T);plot(T,-Y),grid;legend(Cart,VCart,single,Vs);圖3.2極點配置為 -2 -3 -4+3i -4-3i時的全狀態反饋仿真圖橫軸時間單位秒，從圖中可以看出，系統穩定。4.應用 Matlab 進行系

14、統最優控制設計最優控制問題就是尋找一個控制系統的最優控制方案或最優控制規律，使系統能最優地達到預期的目標。對于線性連續系統，提出二次型目標函數：J1xT (t f ) Sx(t f )1t fxT t Q t x t uT t R t u t dt22t 0其中， R(t) 正定， S 及 Q（t) 半正定，且設它們為對稱矩陣， t0 ,t f 固定。當 t f 趨近無窮時，在 y(t) x(t ) 情況下，該問題即為無限時間輸出調節器問題。 此時穩態誤差項趨于零，在此題目中假設二次型最優控制性能指標為：J xT QxuT Rudt0.精品文檔50000003000其中： Q050R=1000

15、0010Matlab 編程如下：A=0 1 0 0;0 0 0 0;0 0 0 1;0 0 29.4 0;B=0;1;0;3;C=1000;0100;0010;0001;D=0 0 0 0;Q=500 0 0 0;0 30 0 0;0 0 50 0;0 0 0 10;R=1;K,P,e=lqr(A,B,Q,R) K =-22.3607 -17.4697 70.1041 13.2462在 simulink下進行仿真模型的建立，如圖4.1 ：圖 4.1 LQR 仿真模型將 K 輸入后，進行仿真，結果如圖4.2 ：.精品文檔圖 4.2 LQR 仿真結果由圖可見，在二次型最優控制下系統穩定性得到明顯改善。5.總結通過對一級倒立擺的分析可知， 在開環情況下，倒立擺的平衡系統是不穩定的的；通過秩判據可知，其系統是可控