倒立擺線性二次型最優(yōu)控制方法研究

夏浩軍，邱榮華

(1. 楊凌職業(yè)技術(shù)學(xué)院，陜西 楊凌 712100； 2. 西安工程大學(xué)，陜西 西安 710048)

0 引言

倒立擺系統(tǒng)為不穩(wěn)定、多變量和非線性的高階系統(tǒng)[1]，其穩(wěn)定控制存在諸多問(wèn)題，表現(xiàn)為系統(tǒng)參數(shù)的不確定性及系統(tǒng)受到不確定因素干擾[2]。近年來(lái)，國(guó)內(nèi)外學(xué)者針對(duì)倒立擺系統(tǒng)控制方法進(jìn)行了大量研究，使倒立擺控制方法廣泛用于軍工、航天、機(jī)器人領(lǐng)域和一般工業(yè)過(guò)程中，如精密儀器加工、機(jī)器人平衡控制、火箭垂直度控制、導(dǎo)彈攔截控制、航空對(duì)接及衛(wèi)星姿態(tài)控制等方面[3]。相關(guān)研究在倒立擺系統(tǒng)控制的快速性和穩(wěn)定性等方面仍存在一些問(wèn)題，如導(dǎo)彈攔截快速性和準(zhǔn)確性問(wèn)題、機(jī)器人平衡控制的穩(wěn)定性等問(wèn)題，需進(jìn)一步改進(jìn)和完善，以實(shí)現(xiàn)倒立擺系統(tǒng)的最優(yōu)控制。

有關(guān)倒立擺系統(tǒng)控制的研究成果主要集中在模型和控制方法等方面，LB Prasad等[4]先后應(yīng)用線性化方法及最優(yōu)狀態(tài)調(diào)節(jié)器理論，分析了二級(jí)倒立擺控制方法；ME Mousa等[5]探討了LQR (linear quadratic regulator)倒立擺系統(tǒng)控制理論問(wèn)題，李雪冰等[6]應(yīng)用智能控制理論研究了二級(jí)倒立擺系統(tǒng)的控制方法；唐永川等[7]針對(duì)二級(jí)倒立擺系統(tǒng)穩(wěn)定控制問(wèn)題，分析了系統(tǒng)起擺和控制方法；黃彥海等[8]研究了單級(jí)倒立擺動(dòng)平衡姿態(tài)控制問(wèn)題；陳富國(guó)等[9]對(duì)三級(jí)倒立擺進(jìn)行了仿真和實(shí)驗(yàn)研究；韓鋒等[10]探討了應(yīng)用變步長(zhǎng)預(yù)測(cè)控制實(shí)現(xiàn)系統(tǒng)實(shí)時(shí)非線性控制方法，并對(duì)二級(jí)倒立擺的起動(dòng)及穩(wěn)定控制進(jìn)行了仿真分析；郭丙君等[11]建立了多級(jí)旋轉(zhuǎn)倒立擺動(dòng)力學(xué)模型，為研究倒立擺最優(yōu)控制方法奠定了理論基礎(chǔ)。

由于倒立擺在實(shí)際應(yīng)用中可做線性化處理，得到系統(tǒng)近似線性模型，應(yīng)用LQR線性二次型調(diào)節(jié)器可得狀態(tài)反饋的最優(yōu)控制規(guī)律。故本文首先建立單級(jí)倒立擺系統(tǒng)線性化狀態(tài)空間模型，并設(shè)計(jì)LQR線性二次型狀態(tài)反饋調(diào)節(jié)器，優(yōu)化系統(tǒng)響應(yīng)速度和穩(wěn)定性，實(shí)現(xiàn)單級(jí)倒立擺的最優(yōu)控制。

1 單級(jí)倒立擺線性模型

若忽略空氣阻力等影響因素，可將單級(jí)倒立擺簡(jiǎn)化為小車和勻質(zhì)桿模型[12]，如圖1所示。單級(jí)倒立擺中，小車由絲杠傳動(dòng)，其頂端通過(guò)鉸鏈連接擺桿；小車沿水平軌道左右運(yùn)動(dòng)，同時(shí)擺可在垂直平面內(nèi)自由運(yùn)動(dòng)。

圖1 單級(jí)倒立擺結(jié)構(gòu)示意圖

擺桿及小車都是剛體，采用絲杠傳動(dòng)方式。小車所受摩擦力正比于小車運(yùn)動(dòng)速度，擺桿運(yùn)動(dòng)時(shí)所受摩擦力矩正比于下擺轉(zhuǎn)動(dòng)速度。本文單級(jí)倒立擺參數(shù)如表1所示。

表1 單級(jí)倒立擺參數(shù)

圖2 單級(jí)倒立擺系統(tǒng)受力分析圖

分析圖2(a)、圖2(b)中小車和擺桿水平方向受力，可得小車運(yùn)動(dòng)方程為：

(1)

根據(jù)圖2(b)擺桿豎直方向受力，可得擺桿運(yùn)動(dòng)方程為：

(2)

若圖2(b)中，擺桿與豎直方向夾角φ<<1(rad)，則：cosθ=-1，sinθ=-φ，(dθ/dt)2=0。用u表示被控對(duì)象的輸入力F，對(duì)式(1)和式(2)線性化，得：

(3)

由式(3)得單級(jí)倒立擺位移x、角度φ的解。

對(duì)質(zhì)量均勻分布的擺桿有：

(4)

由式(3)可得：

(5)

(6)

(7)

2 LQR最優(yōu)控制系統(tǒng)設(shè)計(jì)

2.1 倒立擺控制要求

應(yīng)用LQR狀態(tài)反饋法設(shè)計(jì)倒立擺控制器，當(dāng)在小車上作用0.2m階躍信號(hào)時(shí)，閉環(huán)控制系統(tǒng)的響應(yīng)指標(biāo)為：擺桿角度φ和小車位移x的穩(wěn)定時(shí)間<5s，位移x的上升時(shí)間<1s，超調(diào)量<0.35rad，穩(wěn)態(tài)誤差<2%。

2.2 LQR控制器

圖3 系統(tǒng)控制框圖

假設(shè)全狀態(tài)反饋可以實(shí)現(xiàn)(4個(gè)狀態(tài)量均可測(cè))，需確定反饋控制規(guī)律的向量K。應(yīng)用Matlab軟件中的LQR函數(shù)，可得最優(yōu)控制器的向量K。LQR函數(shù)可選擇2個(gè)參數(shù)R和Q，這2個(gè)參數(shù)用于平衡系統(tǒng)對(duì)輸入量和狀態(tài)量的敏感程度[13]。

若Q取為對(duì)角陣，表示為：

設(shè)：

R=[r]

則系統(tǒng)性能指標(biāo)泛函為：

(8)

對(duì)于單級(jí)倒立擺系統(tǒng)，被控量為輸出x和φ，由于Q11表示小車位置敏感程度，Q22表示擺桿敏感程度，R表示輸入敏感程度[15]。若r=1，在選取對(duì)角陣Q的各元素時(shí)，可取Q11、Q22，Q33=Q44=0。

3 控制系統(tǒng)仿真

在Matlab軟件中，由單級(jí)倒立擺線性模型式(7)和目標(biāo)泛函式(8)，應(yīng)用LQR函數(shù)編寫控制系統(tǒng)m程序[16]。當(dāng)取Q11=0、Q22=0時(shí)，調(diào)用LQR函數(shù)得：

K=[-0.863 7 -2.350 5 -54.669 4 -7.936 8]

則LQR控制系統(tǒng)階躍響應(yīng)如圖4所示。

圖4 LQR控制系統(tǒng)階躍響應(yīng)

由圖4可知，小車位移連續(xù)增大，響應(yīng)時(shí)間不滿足要求，不符合設(shè)計(jì)指標(biāo)，故需調(diào)整控制器參數(shù)。

取Q11=1、Q22=1，調(diào)用LQR函數(shù)得：

K=[ -0.869 3 -2.390 9 -55.869 9 -8.498 8]

則系統(tǒng)階躍響應(yīng)如圖5所示。

圖5 系統(tǒng)階躍響應(yīng)曲線

圖5中，小車階躍響應(yīng)上升時(shí)間>1s，不符合設(shè)計(jì)要求，需繼續(xù)調(diào)整控制器參數(shù)。

取Q11=200、Q22=400，調(diào)用LQR函數(shù)得：

K=[-11.860 0 -11.421 7 -78.934 7 -11.273 5]

此時(shí)系統(tǒng)階躍響應(yīng)曲線如圖6所示。

圖6 控制系統(tǒng)階躍響應(yīng)

圖6中，小車階躍響應(yīng)上升時(shí)間<1s，調(diào)節(jié)時(shí)間<5s，超調(diào)量為0.25rad，小于設(shè)計(jì)目標(biāo)值 0.35rad，系統(tǒng)性能指標(biāo)滿足要求，LQR狀態(tài)反饋控制器達(dá)到設(shè)計(jì)要求。

應(yīng)用Matlab中GUI工具箱，對(duì)倒立擺LQR狀態(tài)反饋控制系統(tǒng)進(jìn)行動(dòng)態(tài)仿真，可進(jìn)一步驗(yàn)證本文設(shè)計(jì)方法的有效性。使用GUI工具箱建立倒立擺物理模型，系統(tǒng)參數(shù)按表1取值，設(shè)小車初始水平位置為0，擺桿角度為0.15rad?？刂破鲄?shù)設(shè)定為：Q11=8、Q22=8和R=1。利用LQR設(shè)計(jì)方法，計(jì)算得控制器增益K=[-65.790 5 -8.364 98 -2.828 43 -5.548 15 ]；設(shè)定仿真時(shí)間為10s，步長(zhǎng)0.1。啟動(dòng)仿真得GUI動(dòng)畫(huà)演示仿真圖，系統(tǒng)動(dòng)態(tài)仿真結(jié)果如圖7所示。

圖7 GUI動(dòng)態(tài)仿真圖

動(dòng)態(tài)仿真結(jié)果顯示，小車和擺桿運(yùn)動(dòng)狀態(tài)、響應(yīng)時(shí)間與解析模型仿真結(jié)果一致，證明本文線性二次型最優(yōu)控制方法有效。

4 結(jié)語(yǔ)

1) 對(duì)單級(jí)倒立擺進(jìn)行動(dòng)力學(xué)分析，建立了倒立擺線性狀態(tài)空間模型。

2) 分析了倒立擺系統(tǒng)最優(yōu)控制性能指標(biāo)泛函，在Matlab中應(yīng)用LQR函數(shù)設(shè)計(jì)了線性二次型狀態(tài)反饋控制器。

3) 分析了倒立擺控制系統(tǒng)階躍響應(yīng)指標(biāo)，優(yōu)化狀態(tài)反饋控制器參數(shù)，并應(yīng)用Matlab GUI開(kāi)發(fā)工具完成系統(tǒng)動(dòng)態(tài)仿真。結(jié)果表明，本文設(shè)計(jì)的線性二次型狀態(tài)反饋控制系統(tǒng)，階躍響應(yīng)上升時(shí)間<1 s，調(diào)節(jié)時(shí)間<5 s，實(shí)現(xiàn)了單級(jí)倒立擺快速、穩(wěn)定控制。

[1] 蒲建波，彭曉樂(lè)，尹彥東，等. 倒立擺控制方法的比較研究[J]. 工業(yè)儀表與自動(dòng)化裝置，2016(2)：11-15.

[2] Y Zhang,Z Miao,H Li,et al. Stabilising the triple inverted pendulum by variable gain linear quadratic regulator [J]. International Journal of Systems Control & Communications,2012,4(4): 208-223.

[3] 尹遜和，樊雪麗，杜洋，等. 二級(jí)直線倒立擺系統(tǒng)的實(shí)物控制[J]. 計(jì)算機(jī)工程與應(yīng)用，2016，52(20)：242-250.

[4] LB Prasad, B Tyagi, Ho Gupta. Optimal control of nonlinear inverted pendulum dynamical system with disturbance input using PID controller & LQR [J]. IEEE International Conference on Control System, 2011:540-545.

[5] ME Mousa, MA Ebrahim, MAM Hassan. Stabilizing and Swinging-Up the Inverted Pendulum Using PI and PID Controllers Based on Reduced Linear Quadratic Regulator Tuned by PSo [J]. International Journal of System Dynamics Applications,2015,4(4): 52-69.

[6] 李雪冰，馬莉，丁世宏. 一類新的二階滑?？刂品椒捌湓诘沽[控制中的應(yīng)用[J]. 自動(dòng)化學(xué)報(bào)，2015，41(1)：193-202.

[7] 唐永川，劉楓，祁虔，等. 平面倒立擺系統(tǒng)的自校正仿人協(xié)調(diào)控制[J]. 西南大學(xué)學(xué)報(bào)，2013，35(10)：94-104.

[8] 黃彥海，張鐳，張朋朋，等. 單級(jí)倒立擺模糊控制研究[J]. 制造業(yè)自動(dòng)化，2015，37(1)：1-3.

[9] 陳富國(guó)，鄧冠男，譚彥華. 一種改進(jìn)的三級(jí)倒立擺變論域模糊控制器設(shè)計(jì)[J]. 控制理論與應(yīng)用，2010，27(2)：233-237.

[10] 韓鋒，聞新. 基于Simulink的單級(jí)倒立擺的參考模型控制仿真研究[J]. 工業(yè)控制計(jì)算機(jī)，2016，29(8)：72-73.

[11] 郭丙君. 倒立擺的串級(jí)控制系統(tǒng)設(shè)計(jì)[J]. 科技世界，2016(7)：151-152.

[12] 賈欣樂(lè). 倒立擺分段控制方法[J]. 控制工程，2016，23(10)：6-12.

[13] 于昊天，時(shí)寶. 非線性系統(tǒng)分?jǐn)?shù)階滑?？刂品治雠c設(shè)計(jì)[J]. 海軍工程學(xué)院學(xué)報(bào)，2016，31(4)：407-414.

[14] 朱秋國(guó)，伍浩賢，吳俊，等. 基于三連桿動(dòng)力模型的仿真機(jī)器人站立平衡控制[J]. 機(jī)器人，2016，38(4)：451-457.

[15] 王來(lái)志，楊雨濃. 一級(jí)旋轉(zhuǎn)倒立擺及其控制裝置的研究與實(shí)現(xiàn)[J]. 西南師范大學(xué)學(xué)報(bào)，2016，41(8)：145-150.

[16] 姜洪發(fā). 基于MATLAB的倒立擺最優(yōu)控制設(shè)計(jì)和仿真[J]. 智能機(jī)器人，2016(10)：47-50.