一級倒立擺的建模與控制分析

1、 控制工程與仿真課程設計報告報告題目 直線一級倒立擺建模、分析及控制器的設計 組員1專業(yè)、班級 14自動化1 班 姓名 朱永遠 學號 1405031009 組員1專業(yè)、班級 14自動化1 班 姓名 王憲孺 學號 1405031011 組員1專業(yè)、班級 14自動化1 班 姓名 孫金紅 學號 1405031013 報告評分標準評分項目權重評價內容評價結果項目得分內容70設計方案較合理、正確，內容較完整70-50分設計方案基本合理、正確，內容基本完整50-30分設計方案基本不合理、正確，內容不完整0-30分語言組織15語言較流順，標點符號較正確10-15分語言基本通順，標點符號基本正確5-10分語言

2、不通順，有錯別字，標點符號混亂5分以下格式15報告格式較正確，排版較規(guī)范美觀10-15分報告格式基本正確，排版不規(guī)范5-10分報告格式不正確，排版混亂5分以下總 分 直線一級倒立擺建模、分析及控制器的設計一 狀態(tài)空間模型的建立1.1直線一級倒立擺的數(shù)學模型 圖1.1 直線一級倒立擺系統(tǒng) 本文中倒立擺系統(tǒng)描述中涉及的符號、物理意義及相關數(shù)值如表1.1所示。 圖1.2是系統(tǒng)中小車的受力分析圖。其中，N和P為小車與擺桿相互作用力的水平和垂直方向的分量。圖1.2 系統(tǒng)中小車的受力分析圖圖1.3是系統(tǒng)中擺桿的受力分析圖。Fs是擺桿受到的水平方向的干擾力, Fh是擺桿受到的垂直方向的干擾力，合力是垂直方向

3、夾角為的干擾力Fg。圖1.3 擺桿受力分析圖 分析小車水平方向所受的合力，可以得到以下方程： 設擺桿受到與垂直方向夾角為 的干擾力Fg，可分解為水平方向、垂直方向的干擾力，所產生的力矩可以等效為在擺桿頂端的水平干擾力FS、垂直干擾力Fh產生的力矩。 對擺桿水平方向的受力進行分析可以得到下面等式： 即： 對圖1.3擺桿垂直方向上的合力進行分析，可以得到下面方程： 即 力矩平衡方程如下： 代入P和N，得到方程： 設，（是擺桿桿與垂直向上方向之間的夾角，單位是弧度），代入上式。假設<<1，則可進行近似處理： 由于：方程化為： 令：，則可化為： 即是化簡后的直線一級倒立擺系統(tǒng)微分方程。帶入

4、實際數(shù)據(jù)后，微分方程為： 當忽略了Ff時，系統(tǒng)的微分方程如式（1-12）所示 忽略干擾力后，直線一級倒立擺系統(tǒng)是單輸入二輸出的四階系統(tǒng)，考慮干擾力后，直線一級倒立擺系統(tǒng)是二輸入二輸出的四階系統(tǒng)。其內部的4個狀態(tài)量分別是小車的位移x、小車的速度、擺桿的角度、擺桿的角速度。系統(tǒng)輸出的觀測量為小車的位移x、擺桿的角度。其控制量為小車的加速度將微分方程（1-12）化為關于加速度輸入量和角度輸出量的傳遞函數(shù)： 1.2 直線一級倒立擺系統(tǒng)的狀態(tài)方程 實驗所使用的直線一級倒立擺系系統(tǒng)是加速度作為系統(tǒng)的控制輸入，所以根據(jù)式（1-12）建立系統(tǒng)的狀態(tài)方程為： 整理后得到系統(tǒng)狀態(tài)方程： 將實際參數(shù)代入得到一級倒立

5、擺系統(tǒng)的狀態(tài)空間方程為： 二 運動分析、能控性及能觀性分析2.1 運動分析線性定常系統(tǒng)非齊次狀態(tài)方程為：則其解為： 系統(tǒng)的輸出方程為： 則運動分析可以借助計算機的 MATLAB 進行。用 MATLAB 仿真求線性非齊次狀態(tài)方程的解實例如例 1 所示。 例1 已知系統(tǒng)狀態(tài)方程為 用以下 MATLAB 程序求系統(tǒng)方程的解。其中，collect( )函數(shù)的作用是合并同類項，而 ilaplace( )函數(shù)的作用是求取拉普拉斯逆變換， 函數(shù) det( )的作用是求方陣的行列式， 語句 phi=subs(phi0,t ,(t-tao)表示將符號變量 phi0 中的自變量 t 用(t-tao)代換就構成了符

6、號變量 phi， 而語句x2=int(F,tao,0,t)表示符號變量 F 對 tao 在 0 到 t 的積分區(qū)間上求積分， 運算結果返回到 x2。 程序執(zhí)行結果為 這表示 2.2 系統(tǒng)能控性分析 系統(tǒng)的可控性可根據(jù)秩判據(jù)進行可控性判斷。線性定常連續(xù)系統(tǒng)完全可控的充分必要條件是：，其中n為系統(tǒng)矩陣A的階次，為系統(tǒng)的可控性矩陣。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）=

7、4，可見該系統(tǒng)是完全可控的。2.3 系統(tǒng)能觀測性分析系統(tǒng)的可控性可根據(jù)秩判據(jù)進行可控性判斷。線性定常連續(xù)系統(tǒng)完全可控的充分必要條件是：或其中n為系數(shù)矩陣A的階次。matlab程序及運行結果如下：>> A=0 1 0 0;0 0 0 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，故該系統(tǒng)是可觀測的。 三 狀態(tài)反饋與狀態(tài)觀測器設計3.1狀態(tài)反饋原理設維線性定常系統(tǒng)： 其中x,u,y分別是n維、p維、q維向量；A、B、C分別是n*n維，n*

8、p維，n*q維實數(shù)矩陣。狀態(tài)反饋系統(tǒng)的控制量u取為狀態(tài)x的線性函數(shù)：其中，v為p參考輸入向量，K為p*n維實反饋增益矩陣。 加入狀態(tài)反饋后系統(tǒng)的結構圖如圖3.1所示：圖3.1 系統(tǒng)的全狀態(tài)反饋結構圖 則系統(tǒng)狀態(tài)反饋的動態(tài)方程為： 3.2狀態(tài)反饋觀測器和simulink仿真狀態(tài)反饋的的實現(xiàn)是利用狀態(tài)反饋使系統(tǒng)的閉環(huán)極點位于所希望的極點位置。而狀態(tài)反饋任意配置閉環(huán)極點的充分必要條件是被控系統(tǒng)可控。直線一級倒立擺系統(tǒng)是可控的。 設系統(tǒng)期望極點為=，則系統(tǒng)期望特征多項式為： 列寫狀態(tài)反饋系統(tǒng)的特征多項式： 令兩個特征多項式各項系數(shù)對應相等，則可解出K陣。由matlab求出狀態(tài)反饋矩陣K，編程如下： A

9、=0 1 0 0;0 0 0 0;0 0 0 1;0 0 29.4 0;>> B=0;1;0;3;>> K=acker(A,B,-2 -3 -4+3i -4-3i)K = -5.1020 -5.8844 35.1673 6.2948系統(tǒng)加入0.1m/s2的階躍輸入，在構成的狀態(tài)反饋調節(jié)器控制下，MATLAB中進行系統(tǒng)的階躍響應仿真，編程如下：A=0 1 0 0 0 0 0 0 0 0 0 1 0 0 29.4 0;B1=0 1 0 3;C=1 0 0 0 0 1 0 0 0 0 1 0 0 0 0 1;D1=0 0 0 0'dt=0.005;ieof=801;f

10、or 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=(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);%經離散化得到離散狀態(tài)方程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('

11、Cart','VCart','single','Vs');圖3.2 極點配置為-2 -3 -4+3i -4-3i時的全狀態(tài)反饋仿真圖 橫軸時間單位秒，從圖中可以看出，系統(tǒng)穩(wěn)定。四 總結 通過對一級倒立擺的分析可知，在開環(huán)情況下，倒立擺的平衡系統(tǒng)是不穩(wěn)定的的；通過秩判據(jù)可知，其系統(tǒng)是可控可觀測的；以上都是利用MATLAB對其進行分析和設計，對其系統(tǒng)進行了穩(wěn)定性、可控性、可觀測性分析，以及極點配置和最優(yōu)控制設計，從中我們可以看出，MATLAB作為一種交互式計算分析軟件，其強大的運算分析功能，集科學計算、程序設計和可視化于一體的高度集成化軟件環(huán)

12、境，為控制系統(tǒng)的分析設計，特別是高階系統(tǒng)綜合設計，提供了一種方便可靠的途徑。參考文獻1 李國勇，控制系統(tǒng)數(shù)字仿真與CADM，北京：電子工業(yè)出版社，2003，92 王丹力，MATLAB控制系統(tǒng)設計仿真應用M，北京：中國電力出版社，2007，93 薛定宇，控制系統(tǒng)仿真與計算機輔助設計M，北京：機械工業(yè)出版社，2005，14 金以慧，過程控制M，北京：清華大學出版社，2003，65 劉金琨. 先進PID控制及其MATLAB仿真M . 北京：電子工業(yè)出版社，2003，6 薛定宇. 控制系統(tǒng)計算機輔助設計MATLAB語言及應用M. 北京：清華大學出版社，19967 易繼鍇. 智能控制技術M. 北京：北京工業(yè)大學出版社，2