現(xiàn)代控制理論大作業(yè)倒立擺

實(shí)用文檔摘要倒立擺系統(tǒng)是一個(gè)復(fù)雜的、高度非線性的、不穩(wěn)定的高階系統(tǒng)，是學(xué)習(xí)和研究現(xiàn)代控制理論最合適的實(shí)驗(yàn)裝置。倒立擺的控制是控制理論應(yīng)用的一個(gè)典型范例，一個(gè)穩(wěn)定的倒立擺系統(tǒng)對(duì)于證實(shí)狀態(tài)空間理論的實(shí)用性是非常有用的。本文主要研究的是二級(jí)倒立擺的極點(diǎn)配置方法，首先用Lagrange方程建立了二級(jí)倒立擺的數(shù)學(xué)模型，然后對(duì)二級(jí)倒立擺系統(tǒng)的穩(wěn)定性進(jìn)行了分析和研究，并給出了系統(tǒng)能控能觀性的判別。基于現(xiàn)代控制理論中的極點(diǎn)配置理論，根據(jù)超調(diào)量和調(diào)整時(shí)間來(lái)配置極點(diǎn)，求出反饋矩陣并利用Simulink對(duì)其進(jìn)行仿真，得到二級(jí)倒立擺的變化曲線，實(shí)現(xiàn)了對(duì)閉環(huán)系統(tǒng)的穩(wěn)定控制。關(guān)鍵詞：二級(jí)倒立擺；極點(diǎn)配置；Simulink目錄HYPERLINK1.緒論 1HYPERLINK2數(shù)學(xué)模型的建立和分析 1HYPERLINK2.1數(shù)學(xué)建模的方法 1HYPERLINK2.2二級(jí)倒立擺的結(jié)構(gòu)和工作原理 2HYPERLINK2.3拉格朗日運(yùn)動(dòng)方程 3HYPERLINK2.4推導(dǎo)建立數(shù)學(xué)模型 4HYPERLINK3二級(jí)倒立擺系統(tǒng)性能分析 10HYPERLINK3.1穩(wěn)定性分析 10HYPERLINK3.2能控性能觀性分析 11HYPERLINK4狀態(tài)反饋極點(diǎn)配置 12HYPERLINK4.1二級(jí)倒立擺的最優(yōu)極點(diǎn)配置1 12HYPERLINK4.2二級(jí)倒立擺最優(yōu)極點(diǎn)配置2 13HYPERLINK5.二級(jí)倒立擺matlab仿真 15HYPERLINK5.1Simulink搭建開環(huán)系統(tǒng) 15HYPERLINK5.2開環(huán)系統(tǒng)Simulink仿真結(jié)果 15HYPERLINK5.3Simulink搭建極點(diǎn)配置后的閉環(huán)系統(tǒng) 16HYPERLINK5.4極點(diǎn)配置Simulink仿真結(jié)果 17HYPERLINK5.4.1第一組極點(diǎn)配置仿真結(jié)果 17HYPERLINK5.4.2第二組極點(diǎn)配置仿真結(jié)果 19HYPERLINK6.結(jié)論 20HYPERLINK7.參考文獻(xiàn) 21HYPERLINK附錄一 22緒論倒立擺最初誕生于麻省理工學(xué)院，僅有一級(jí)擺桿，另一端鉸接于可以在直線導(dǎo)軌上自由滑動(dòng)的小車上。后來(lái)在此基礎(chǔ)上，人們又進(jìn)行拓展，設(shè)計(jì)出了直線二級(jí)倒立擺、環(huán)型倒立擺、平面倒立擺、柔性連接倒立擺、多級(jí)倒立擺等實(shí)驗(yàn)設(shè)備。在控制理論的發(fā)展過(guò)程中，為驗(yàn)證某一理論在實(shí)際應(yīng)用中的可行性需要按其理論設(shè)計(jì)的控制器去控制一個(gè)典型對(duì)象來(lái)驗(yàn)證。倒立擺系統(tǒng)作為一個(gè)實(shí)驗(yàn)裝置，形象直觀，結(jié)構(gòu)簡(jiǎn)單，成本低廉；作為一個(gè)控制對(duì)象，他又相當(dāng)復(fù)雜，同時(shí)就其本身而言，是一個(gè)高階次、不穩(wěn)定、多變量、非線性、強(qiáng)耦合系統(tǒng)，只有采取行之有效的控制方法才能使之穩(wěn)定，因此倒立擺裝置被公認(rèn)為是自動(dòng)控制理論中的典型實(shí)驗(yàn)設(shè)備。綜合文獻(xiàn)資料，倒立擺控制的方法主要有：PID控制，狀態(tài)反饋，利用云模型，神經(jīng)網(wǎng)絡(luò)控制，遺傳算法，自適應(yīng)控制，模糊控制，變論域自適應(yīng)模糊控制理論，智能控制等多種算法來(lái)實(shí)現(xiàn)倒立擺的控制。本文主要構(gòu)建二級(jí)倒立擺的數(shù)學(xué)模型的建立與分析，對(duì)倒立擺系統(tǒng)進(jìn)行控制方法的研究。本文就以下幾個(gè)問(wèn)題進(jìn)行了論述。1.二級(jí)倒立擺的數(shù)學(xué)模型的建立與分析。在建模部分，首先采用拉格朗日方程推導(dǎo)數(shù)學(xué)模型，并對(duì)系統(tǒng)的可控性可觀性進(jìn)行分析，并分析倒立擺系統(tǒng)控制的難易程度。2.二級(jí)倒立擺的控制原理及方法的研究。本文主要采用狀態(tài)反饋極點(diǎn)配置的方法對(duì)二級(jí)倒立擺進(jìn)行研究。3.采用Matlab語(yǔ)言進(jìn)行數(shù)字仿真，分析仿真結(jié)果。2數(shù)學(xué)模型的建立和分析2.1數(shù)學(xué)建模的方法所謂系統(tǒng)的數(shù)學(xué)模型就是利用數(shù)學(xué)結(jié)構(gòu)來(lái)反映系統(tǒng)內(nèi)部之間、內(nèi)部與外部某些因素之間的精確的定量的表示。它是分析、設(shè)計(jì)、預(yù)報(bào)和控制一個(gè)系統(tǒng)的基礎(chǔ)，所以要對(duì)一個(gè)系統(tǒng)進(jìn)行研究，首先要建立它的數(shù)學(xué)模型。建立倒立擺系統(tǒng)的模型時(shí)，一般采用牛頓運(yùn)動(dòng)規(guī)律，結(jié)果要解算大量的微分方程組，而且考慮到質(zhì)點(diǎn)組受到的約束條件，建模問(wèn)題將更加復(fù)雜，為此本文采用分析力學(xué)方法中的Lagrange方程推導(dǎo)倒立擺的系統(tǒng)模型。Lagrange方程有如下特點(diǎn)：1.它是以廣義坐標(biāo)表達(dá)的任意完整系統(tǒng)的運(yùn)動(dòng)方程式，方程式的數(shù)目和系統(tǒng)的自由度是一致的。2.理想約束反力不出現(xiàn)在方程組中，因此在建立運(yùn)動(dòng)方程式時(shí)，只需分析已知的主動(dòng)力，而不必分析未知的約束反力。3.Lagrange方程是以能量觀點(diǎn)建立起來(lái)的運(yùn)動(dòng)方程，為了列出系統(tǒng)的運(yùn)動(dòng)方程，只需要從兩個(gè)方面去分析，一個(gè)是表征系統(tǒng)運(yùn)動(dòng)的動(dòng)力學(xué)量－系統(tǒng)的動(dòng)能，另一個(gè)是表征主動(dòng)力作用的動(dòng)力學(xué)量－廣義力。因此用Lagrange方程來(lái)求解系統(tǒng)的動(dòng)力學(xué)方程可以大大簡(jiǎn)化建模過(guò)程。2.2二級(jí)倒立擺的結(jié)構(gòu)和工作原理如圖2.1，系統(tǒng)包括計(jì)算機(jī)、運(yùn)動(dòng)控制卡、伺服機(jī)構(gòu)、倒立擺本體（小車，上擺，下擺，皮帶輪等）和光電碼盤幾大部分，組成了一個(gè)閉環(huán)系統(tǒng)。光電碼盤1將小車的位移、速度信號(hào)反饋給伺服驅(qū)動(dòng)器和運(yùn)動(dòng)控制卡，下面一節(jié)擺桿（和小車相連）的角度、角速度信號(hào)由光電碼盤2反饋回控制卡和伺服驅(qū)動(dòng)器，上面一節(jié)擺桿的角度和角速度信號(hào)則由光電碼盤3反饋。計(jì)算機(jī)從運(yùn)動(dòng)控制卡中讀取實(shí)時(shí)數(shù)據(jù)，確定控制決策（小車向哪個(gè)方向移動(dòng)、移動(dòng)速度、加速度等），并由運(yùn)動(dòng)控制卡來(lái)實(shí)現(xiàn)該控制決策，產(chǎn)生相應(yīng)的控制量，使電機(jī)轉(zhuǎn)動(dòng)，帶動(dòng)小車運(yùn)動(dòng)，保持兩節(jié)擺桿的平衡。圖2.1系統(tǒng)結(jié)構(gòu)和工作原理圖2.3拉格朗日運(yùn)動(dòng)方程拉格朗日提出了用能量的方法推導(dǎo)物理系統(tǒng)的數(shù)學(xué)模型，首先我們引入廣義坐標(biāo)，拉格朗日方程。廣義坐標(biāo)：系統(tǒng)的廣義坐標(biāo)是描述系統(tǒng)運(yùn)動(dòng)必需的一組獨(dú)立坐標(biāo)，廣義坐標(biāo)數(shù)等同于系統(tǒng)自由度數(shù)。如果系統(tǒng)的運(yùn)動(dòng)用n維廣義坐標(biāo)q1,q2,…qn來(lái)表示，我們可以把這n維廣義坐標(biāo)看成是n維空間的n位坐標(biāo)系中的坐標(biāo)。對(duì)于任一系統(tǒng)可由n維空間中的一點(diǎn)來(lái)表征。系統(tǒng)在n維空間中運(yùn)動(dòng)形成的若干系統(tǒng)點(diǎn)連成一條曲線，此曲線表示系統(tǒng)點(diǎn)的軌跡。拉格朗日方程： Lq,q=T式中， —— 拉格朗日算子， —— 系統(tǒng)的廣義坐標(biāo)， —— 系統(tǒng)的動(dòng)能， —— 系統(tǒng)的勢(shì)能。拉格朗日方程由廣義坐標(biāo)和表示為:ddt(2.2)式中，，——系統(tǒng)沿該廣義坐標(biāo)方向上的外力，在本系統(tǒng)中，設(shè)系統(tǒng)的三個(gè)廣義坐標(biāo)分別是。2.4推導(dǎo)建立數(shù)學(xué)模型在推導(dǎo)數(shù)學(xué)模型之前，我們需要幾點(diǎn)必要的假設(shè)：1.上擺、下擺及小車均是剛體；2.皮帶輪與傳動(dòng)帶之間無(wú)相對(duì)滑動(dòng)；傳動(dòng)皮帶無(wú)伸長(zhǎng)現(xiàn)象；3.小車運(yùn)動(dòng)時(shí)所受的摩擦力正比于小車的速度；4.小車的驅(qū)動(dòng)力與直流放大器的輸入成正比，且無(wú)滯后，忽略電機(jī)電樞繞組中的電感；5.下擺轉(zhuǎn)動(dòng)時(shí)所受到的摩擦力矩正比于下擺的轉(zhuǎn)動(dòng)速度；6.上擺運(yùn)動(dòng)時(shí)所受到的摩擦力矩正比于上擺對(duì)下擺的相對(duì)角速度；二級(jí)倒立擺的運(yùn)動(dòng)分析示意圖如圖2.2yxyxxFm1m3θmM圖2.2二級(jí)倒立擺運(yùn)動(dòng)分析示意圖倒立擺系統(tǒng)參數(shù)如下：小車系統(tǒng)的等效質(zhì)量M=1.32Kg擺桿1質(zhì)量=0.04Kg 擺桿1轉(zhuǎn)動(dòng)中心到桿質(zhì)心距離=0.09m擺桿2質(zhì)量m2=0.132Kg 擺桿2轉(zhuǎn)動(dòng)中心到桿質(zhì)心距離l2=0.27m質(zhì)量塊質(zhì)量=0.208Kg 作用在系統(tǒng)上的外力F擺桿1與垂直向上方向的夾角 擺桿2與垂直向上方向的夾角首先，計(jì)算系統(tǒng)的動(dòng)能： (2.3)小車動(dòng)能： TM=12Mx擺桿1動(dòng)能： (2.5)式中，Tm1'--Tm1''--擺桿1繞 (2.6) (2.7)則 (2.8)擺桿2動(dòng)能： (2.9)式中，Tm2'--Tm2''--擺桿1繞 (2.10) (2.11) (2.12)質(zhì)量塊動(dòng)能： (2.13)因此，可以得到系統(tǒng)總動(dòng)能： (2.14)系統(tǒng)的勢(shì)能為： (2.15)至此得到拉格朗日算子： (2.16)由于因?yàn)樵趶V義坐標(biāo)上均無(wú)外力作用，有以下等式成立： (2.17) (2.18)展開(2.17)、(2.18)式，分別得到(2.19)、(2.20)式 (2.19) (2.20)將(2.19)、(2.20)式對(duì)求解代數(shù)方程，得到以下兩式 (2.21) (2.22)表示成以下形式： (2.23) (2.24)取平衡位置時(shí)各變量的初值為零， (2.25)將(2.23)式在平衡位置進(jìn)行泰勒級(jí)數(shù)展開，并線性化，令 (2.26) (2.27) (2.28) (2.29) (2.30) (2.31) (2.32)得到線性化之后的公式 (2.33)將在平衡位置進(jìn)行泰勒級(jí)數(shù)展開，并線性化，令 (2.34) (2.35) (2.36) (2.37) (2.38) (2.39) (2.40)得到 (2.41)即: (2.42) (2.43)現(xiàn)在得到了兩個(gè)線性微分方程，由于我們采用加速度作為輸入，因此還需加上一個(gè)方程: (2.44)取狀態(tài)變量如下： (2.45)則狀態(tài)空間方程如下： (2.46)將以下參數(shù)代入求出各個(gè)值：得到狀態(tài)方程各個(gè)參數(shù)矩陣：3二級(jí)倒立擺系統(tǒng)性能分析3.1穩(wěn)定性分析二級(jí)倒立擺的特征方程為:(3.1)Matlab中，用函數(shù)eig(A)來(lái)計(jì)算系統(tǒng)矩陣的特征值，經(jīng)過(guò)計(jì)算，系統(tǒng)的特征值為：(3.2)開環(huán)系統(tǒng)有兩個(gè)開環(huán)極點(diǎn)位于平面右半平面上，所以系統(tǒng)是不穩(wěn)定的。同時(shí)，根據(jù)前面的狀態(tài)空間表達(dá)式，在matlab中，用step(A,B,C,D)函數(shù)對(duì)系統(tǒng)的階躍響應(yīng)進(jìn)行分析：圖1開環(huán)系統(tǒng)單位階躍響應(yīng)從上圖可以看出，在階躍響應(yīng)的作用下，系統(tǒng)是發(fā)散的。3.2能控性能觀性分析 對(duì)于線形狀態(tài)方程 (3.3)其能控性矩陣為： (3.4)求的秩 (3.5)所以系統(tǒng)是完全能控的。其能觀性矩陣為：C0=[C,CA,CA2求的秩 (3.7)所以系統(tǒng)是完全能觀的。（代碼見附錄）由上述計(jì)算結(jié)果可知，二級(jí)倒立擺系統(tǒng)是開環(huán)不穩(wěn)定系統(tǒng)，但它的狀態(tài)是完全能控且完全能觀測(cè)的。因此，可以對(duì)其實(shí)現(xiàn)閉環(huán)最優(yōu)控制。4狀態(tài)反饋極點(diǎn)配置4.1二級(jí)倒立擺的最優(yōu)極點(diǎn)配置1在式3.3中，A為6*6陣；B為6*1陣；C為3*6陣。是一個(gè)單輸入系統(tǒng)，且完全能控、能觀測(cè)。因此，可按照最優(yōu)控制系統(tǒng)的極點(diǎn)配置方法進(jìn)行設(shè)計(jì)。對(duì)于一般控制系統(tǒng)，閉環(huán)主導(dǎo)極點(diǎn)的選取應(yīng)使0.4≤ε≤0.8。但二級(jí)倒立擺是一個(gè)特殊的高階系統(tǒng)，穩(wěn)定性是主要矛盾，因此可適當(dāng)增加ε，即適當(dāng)降低響應(yīng)速度，來(lái)彌補(bǔ)系統(tǒng)穩(wěn)定性要求。相應(yīng)在選擇性能指標(biāo)時(shí)，應(yīng)適當(dāng)減小系統(tǒng)的超調(diào)量。對(duì)于二階倒立擺系統(tǒng)，主要針對(duì)如下兩個(gè)主要的性能指標(biāo)進(jìn)行設(shè)計(jì)：超調(diào)量：σ≤0.005調(diào)節(jié)時(shí)間：tsσ=e?ε1?ε2π ts=4?ln1?ε2εωn 這里，誤差范圍取為2%,將上述性能指標(biāo)代入式4.1和式4.2得到二級(jí)倒立擺系統(tǒng)的2個(gè)性能指標(biāo)滿足ε≥0.826，ωn≥2.17，取ε=0.826，將得到的阻尼比與自然角頻率代入下式：s1,s2=?ωn得到二級(jí)倒立擺系統(tǒng)的2個(gè)主導(dǎo)極點(diǎn)為：s1=?1.87+1.11j,s2=?1.87?1.11j 對(duì)于其他四個(gè)非主導(dǎo)極點(diǎn)，不妨設(shè)為四重極點(diǎn)，且距主導(dǎo)極點(diǎn)10倍以上，即滿足下式：s3=s4=s5所以，另外四個(gè)非主導(dǎo)極點(diǎn)取為：s3到此，二級(jí)倒立擺的6個(gè)極點(diǎn)都已確定。P=[-1.87+1.11j-1.87-1.11j-22-22-22-22] （4.6）在matlab中輸入K=acker(A,B,P)可求得:K=1.0e+03*0.52810.4618-2.63790.5136-0.0797-0.4476至此，完成了二級(jí)倒立擺控制器的設(shè)計(jì)。接下來(lái)在matlab中仿真得到：圖2極點(diǎn)配置后單位階躍響應(yīng)14.2二級(jí)倒立擺最優(yōu)極點(diǎn)配置2在上述基礎(chǔ)上，繼續(xù)調(diào)整超調(diào)量和調(diào)整時(shí)間，使二級(jí)倒立擺達(dá)到穩(wěn)定。第二次?。撼{(diào)量：σ≤0.05調(diào)節(jié)時(shí)間：ts這里，誤差范圍仍取為2%,代入式4.1和式4.2得到二級(jí)倒立擺系統(tǒng)的2個(gè)性能指標(biāo)滿足ε≥0.69，ωn≥2.51，取ε=0.69，將得到的阻尼比與自然角頻率式4.3得到第二組主導(dǎo)極點(diǎn)：s1=?1.73+1.81j,s2=?1.73?1.81j 對(duì)于其他四個(gè)非主導(dǎo)極點(diǎn)，不妨設(shè)為四重極點(diǎn)，且距主導(dǎo)極點(diǎn)10倍以上，即滿足下式：s3=s4=s5所以，另外四個(gè)非主導(dǎo)極點(diǎn)取為：s3因此，第二組極點(diǎn)P2=[-1.73+1.81j-1.73-1.81j-30-30-30-30]在matlab中輸入K2=acker(A,B,P2)可求得:K2=1.0e+03*2.42050.5209-7.49771.6587-0.2846-1.2008接下來(lái)繪制極點(diǎn)配置后系統(tǒng)的單位階躍響應(yīng)圖：圖3極點(diǎn)配置后單位階躍響應(yīng)25.二級(jí)倒立擺matlab仿真5.1Simulink搭建開環(huán)系統(tǒng)圖4開環(huán)系統(tǒng)仿真圖5.2開環(huán)系統(tǒng)Simulink仿真結(jié)果圖5開環(huán)系統(tǒng)matlab仿真結(jié)果圖由上圖可知，在Simulink中搭建的開環(huán)系統(tǒng)是發(fā)散的，與理論計(jì)算的結(jié)果吻合。5.3Simulink搭建極點(diǎn)配置后的閉環(huán)系統(tǒng)圖6極點(diǎn)配置優(yōu)化后的系統(tǒng)結(jié)構(gòu)圖5.4極點(diǎn)配置Simulink仿真結(jié)果5.4.1第一組極點(diǎn)配置仿真結(jié)果圖7極點(diǎn)配置優(yōu)化后的結(jié)果圖圖8小車位移曲線圖9一級(jí)倒立擺角度曲線圖10二級(jí)倒立擺角度曲線從以上的圖片可以看出，系統(tǒng)在給定輸入的情況下，1秒左右恢復(fù)到平衡點(diǎn)的位置附近，系統(tǒng)較好的快速性、穩(wěn)定性和精確性都非常理想，且無(wú)超調(diào)量，符合要求。5.4.2第二組極點(diǎn)配置仿真結(jié)果圖11極點(diǎn)配置優(yōu)化后的結(jié)果圖圖12小車位移曲線圖13一級(jí)倒立擺角度曲線圖14二級(jí)倒立擺角度曲線與第一組極點(diǎn)相比，超調(diào)量略有增加，但調(diào)整時(shí)間有所下降，且都達(dá)到穩(wěn)定狀態(tài)符合要求。6.結(jié)論倒立擺系統(tǒng)就其本身而言，是一個(gè)多變量、快速、嚴(yán)重非線性和絕對(duì)不穩(wěn)定系統(tǒng)，必需采用有效的控制法使之穩(wěn)定，對(duì)倒立擺系統(tǒng)的研究在理論上和方法論上均有著深遠(yuǎn)的意義。本文借助拉格朗日方程，建立了二級(jí)倒立擺的數(shù)學(xué)模型，并通過(guò)線性化，得到了二級(jí)倒立擺系統(tǒng)的狀態(tài)空間模型。應(yīng)用現(xiàn)代控制理論，分析了倒立擺的穩(wěn)定性、能控性、能觀性。隨后采用二次型最優(yōu)控制理論研究了倒立擺控制問(wèn)題,并且運(yùn)用狀態(tài)反饋極點(diǎn)配置的方法得到較好的控制效果。最后進(jìn)行了Matlab仿真，通過(guò)優(yōu)化前后優(yōu)化后的響應(yīng)曲線可以看出經(jīng)過(guò)極點(diǎn)配置算法優(yōu)化后的系統(tǒng)響應(yīng)的速度加快，超調(diào)量明顯減少，穩(wěn)定時(shí)間和上升時(shí)間有所減少，系統(tǒng)的動(dòng)態(tài)性能和靜態(tài)性能要比沒有優(yōu)化的控制效果好了很多。7.參考文獻(xiàn)[1]劉豹唐萬(wàn)生現(xiàn)代控制理論（第三版）機(jī)械工業(yè)出版社[2]HYPERLINK夏德鈐HYPERLINK翁貽方自動(dòng)控制理論（第4版）機(jī)械工業(yè)出版社[3]李國(guó)勇程永強(qiáng)計(jì)算機(jī)仿真技術(shù)與CAD—基于matlab的控制系統(tǒng)（第三版）電子工業(yè)出版社[4]基于LQR的二級(jí)倒立擺控制系統(tǒng)研究[本科畢業(yè)論文][5]湯唯基于直線二級(jí)倒立擺控制系統(tǒng)的研究[碩士學(xué)位論文][6]基于極點(diǎn)配置的倒立擺控制器設(shè)計(jì)[碩士學(xué)位論文]附錄一%-------------------------階躍響應(yīng)下系統(tǒng)的穩(wěn)定性------------------A=[000100;000010;000001;000000;077.0642-21.1927000;0-38.532137.8186000];B=[0;0;0;1;5.7012;-0.0728];C=[100000;010000;001000];D=[0;0;0];step(A,B,C,D) %繪制階躍響應(yīng)%--------------------------能控能觀性判斷-------------------------A=[000100;000010;000001;000000;077.0642-21.1927000;0-38.532137.8186000];B=[0;0;0;1;5.7012;-0.0728];C=[100000;010000;001000];D=[0;0;0];Uc=ctrb(A,B)%求能控矩陣rank