垂直侵徹深度計(jì)算算法研究

令系統(tǒng)的總擾動(dòng)項(xiàng)a(t)=f(y，t)+w(t)+(b-b0)u(t)，該擾動(dòng)項(xiàng)包括內(nèi)部擾動(dòng)f(y,t)+(b-b0)u(t)，也包含外部擾動(dòng)W (t)。把a(bǔ)(t)作為一個(gè)擴(kuò)張的狀態(tài)，令x1=y，x2=a(t)，則式(6)的動(dòng)態(tài)系統(tǒng)可寫成如下狀態(tài)方程：

式(7)中，令c(t)=a(t)，則可以構(gòu)造出線性ESO：

式中，-p為觀測(cè)器二重極點(diǎn)，p>0。

對(duì)應(yīng)的線性控制律為：

式中，y*為系統(tǒng)的參考輸入。

這是一個(gè)二階連續(xù)系統(tǒng)，其穩(wěn)定的充要條件是二重極點(diǎn)P>0。只要選擇合適的期望閉環(huán)極點(diǎn)-P>(p>0)，就能保證ESO的觀測(cè)效果。

根據(jù)永磁同步電機(jī)的一階微分方程模型，結(jié)合擴(kuò)張狀態(tài)觀測(cè)器的設(shè)計(jì)方法，設(shè)計(jì)控制器，分析如下：

由式(11)~(12)可看出，負(fù)載轉(zhuǎn)矩、摩擦系數(shù)、慣量的擾動(dòng)以及由于b0估計(jì)誤差所造成的擾動(dòng)都可在a(t)中反映出來。如果能對(duì)a(t)進(jìn)行觀測(cè)并予以補(bǔ)償，則可顯著的提高系統(tǒng)的抗擾動(dòng)能力?？刂破鹘Y(jié)構(gòu)圖如1所示。

于是得到基于擴(kuò)張狀態(tài)觀測(cè)器的比例控制器的表達(dá)式：

(1)ESO表達(dá)式：

(2)控制律表達(dá)式：

根據(jù)理論分析，ESO的觀測(cè)效果取決于極點(diǎn)-p>(p>0)。和ESO的跟蹤速度有關(guān)，P越大，ESO跟蹤輸出信號(hào)響應(yīng)就越快，即z1對(duì)速度w的響應(yīng)就越快。比例增益kp通常應(yīng)取得較大，但過大會(huì)使速度響應(yīng)振蕩，造成系統(tǒng)不穩(wěn)定。

4 基于擴(kuò)張狀態(tài)觀測(cè)器的控制器算法仿真

在Matlab／Simulink平臺(tái)仿真驗(yàn)證基于擴(kuò)張狀態(tài)觀測(cè)器的控制器設(shè)計(jì)方案。根據(jù)圖1搭建控制器的Matlab／Simulink仿真模塊，如圖2所