高欽和,董家臣
(火箭軍工程大學(xué) 兵器發(fā)射理論與技術(shù)軍隊重點實驗室, 陜西 西安 710025)
在非線性系統(tǒng)的控制中,使用狀態(tài)觀測器估計系統(tǒng)狀態(tài)以實現(xiàn)前饋、反饋、解耦或補償是一種實用而有效的控制思想。韓京清等提出的自抗擾控制(Active Disturbance Rejection Control, ADRC)技術(shù)[1-3]通過設(shè)計擴張狀態(tài)觀測器(Extended State Observer, ESO),在不依賴擾動模型的前提下能夠?qū)崟r觀測系統(tǒng)“總擾”并反饋補償控制率,具有極強的擾動抑制能力。ESO作為ADRC的核心,通過觀測誤差方程的迅速收斂實現(xiàn)對系統(tǒng)各階狀態(tài)的跟蹤,然而采用的誤差非線性收斂形式fal(e,α,δ)在獲得高觀測效率的同時也帶來了參數(shù)整定煩瑣的弊端。為此,Gao等[4]基于帶寬思想將ADRC的控制器和ESO均以線性形式實現(xiàn),將需整定的參數(shù)由7個以上減少至2個,使得線性自抗擾控制器的廣泛工程應(yīng)用成為可能。
在構(gòu)建ESO時采取了忽略擾動的處理方式,故在擾動存在動態(tài)變化的情況下觀測將存在誤差。利用非線性函數(shù)的“大誤差、小增益,小誤差、大增益”特點可以有效減小這種觀測誤差的影響。而線性擴張狀態(tài)觀測器(Linear Extended State Observer, LESO)為了獲取更簡便的參數(shù)整定效率放棄了非線性形式,在觀測精度上不得不做出讓步[4]。作為反饋補償?shù)妮斎朐?,LESO觀測誤差的存在會降低伺服系統(tǒng)的控制精度,因此在光刻機、高精度數(shù)控機床等精密領(lǐng)域,線性自抗擾控制(Linear ADRC, LADRC)技術(shù)的應(yīng)用相對受限。提高LESO的觀測精度成為LADRC研究的熱點之一。
當前,許多學(xué)者已經(jīng)對LESO的觀測能力展開了研究。文獻[5-7]在時域內(nèi)給出了被控對象動態(tài)模型未知時觀測誤差有界的理論證明;文獻[8]對二階系統(tǒng)LESO收斂性和頻帶特性和濾波性能進行了分析,并通過仿真進一步分析了LADRC的穩(wěn)定性和抗擾性;文獻[9]則使用頻域分析法分析了LESO的跟蹤性能,通過非“3w”法參數(shù)整定原則對LESO做出了改進;文獻[10]證明了高階LESO的收斂性,通過仿真得出增加擴張階數(shù)和提高帶寬均能提高觀測精度的結(jié)論。
LESO的濾波能力、觀測誤差的收斂性和有界性、觀測系統(tǒng)的穩(wěn)定性等性質(zhì)已經(jīng)得到了較多的研究證明,然而在如何有效提高觀測精度上,尚缺少文獻進行策略設(shè)計并給出理論分析。然而,在實際應(yīng)用中,往往更需要對LESO的觀測誤差有一個量化的表述,以據(jù)此做出相應(yīng)的改善,增強觀測器的跟蹤能力,并最終提高整個LADRC系統(tǒng)的控制效果。在這一方面的研究中,目前只有文獻[11]做出了嘗試,提出使用誤差的多階微分改進ESO的策略,但這種方式本質(zhì)上變更了經(jīng)典ESO的結(jié)構(gòu),因此傳統(tǒng)ESO的穩(wěn)定性研究成果不再適用,為此該文給出了二、三階ESO的穩(wěn)定證明,但對更高階的觀測器則未進行討論;同時誤差項的多階微分的使用并不適用于含噪聲的系統(tǒng),這也限制了這種改進策略的使用。
為此,本文從分析LESO的觀測機理入手,通過對擾動項的線性化、誤差系統(tǒng)動態(tài)響應(yīng)的忽略,推導(dǎo)出LESO觀測靜差的量化表達形式,并據(jù)此提出了一種前饋補償器。隨后從理論上分析了補償思路的可行性,對誤差幅值和相位滯后的補償效果分別進行了討論,進而將這種補償思路擴展至NESO中,最后通過仿真和實驗對補償器的有效性進行驗證。
不失一般性,考慮如下一類單輸入單輸出(Single-Input-Single-Output, SISO)的非線性時變系統(tǒng):
y(n)(t)=f(y(n-1)(t),…,y(t),w(t))+bu(t)
(1)
(2)
其矩陣形式可表達為:
(3)
在h未知、干擾模型無法利用的前提下,按照ESO的設(shè)計思路[1],采取忽略擾動的處理方式,建立式(4)所示觀測模型:
(4)
式中:zi(t)為xi(t)的觀測值(i=1,…,n+1),βi為ESO的增益系數(shù),gi(e1(t))代表設(shè)計的誤差函數(shù)。由系統(tǒng)模型(2)與觀測模型(4)作差,可以得到觀測誤差系統(tǒng):
(5)
式中,ei(t)=xi(t)-zi(t)。當e1(t)gi(e1(t))>0,?e1(t)≠0且gi(0)=0時,誤差系統(tǒng)(5)是漸近收斂的[10]。此時模型(4)能夠以一定精度實現(xiàn)對模型(2)各階狀態(tài)的跟蹤。可通過調(diào)整βi來調(diào)整誤差收斂的速度,以獲得期望的觀測效果。目前,對于gi(e1(t))主要有兩種設(shè)計方法:
1)非線性函數(shù)。經(jīng)典連續(xù)冪次函數(shù)fal(e1,α,δ)應(yīng)用較多,其形式為:
(6)
式中:α表示放大因子,δ表示原點附近線性區(qū)間長度。該函數(shù)具有“大誤差、小增益,小誤差、大增益”的收斂特點,線性段的引入能夠有效減輕高頻顫振現(xiàn)象,以此構(gòu)造的非線性擴張狀態(tài)觀測器(Nonlinear ESO, NESO),在觀測上具有誤差衰減快、觀測精度高、觀測帶寬實時自調(diào)整等顯著優(yōu)勢,但在實際應(yīng)用中,參數(shù)整定復(fù)雜、穩(wěn)定性分析也較為困難。
2)線性函數(shù)。最簡線性函數(shù)可取gi(e1(t))=e1(t),此時模型(4)中的觀測部分可列寫為式(7)所示矩陣形式:
(7)
(8)
求出其特征方程f(λ),并基于文獻[4]的帶寬整定思想配置觀測增益:
f(λ)=|Ae-λIn+1|=(λ+wo)n
(9)
式中,wo∈R+為設(shè)置的觀測器帶寬。通過這種方式配置L使得式(9)滿足Lyapunov第一穩(wěn)定條件,即可使LESO以一定精度實時跟蹤系統(tǒng)狀態(tài)。至此,對任意階數(shù)的LESO均只存在一個待整定參數(shù)wo。LESO設(shè)計簡單,時域、頻域分析理論均可使用,同時參數(shù)整定過程較NESO得到極大簡化,這使得LESO的廣泛工程應(yīng)用成為可能。因此后文以LESO為主要研究對象展開分析。
LESO是LADRC的核心部分,其估計精度和速度決定了擾動補償?shù)男?,直接影響整個系統(tǒng)的控制效果。由于系統(tǒng)總擾項在動態(tài)變化時存在不確定性和非線性,觀測誤差的直接計算存在一定困難。文獻[6]指出,在h(t)有界時,按式(7)構(gòu)造的LESO觀測誤差是一致收斂的,同時給出了誤差的有界性證明。在此前提下,如果能進一步將觀測系統(tǒng)做線性處理,就可以使用成熟的線性系統(tǒng)分析理論對觀測誤差做量化分析。
2.1.1 總擾項的線性化
假設(shè)總擾項f(y(n-1)(t),…,y(t),w(t))各階導(dǎo)數(shù)存在且有界,在t0時刻對其泰勒展開:
=f(t0)+h(t0)(t-t0)+ο(t-t0)
(10)
類比微分,在觀測步長Δt=t-t0足夠小,近似誤差ο(Δt)可忽略時,可以將未知擾動按線性變化來處理。因而在分析誤差系統(tǒng)時做以下近似:
近似1:在計算步長Δt內(nèi),視h(t)=h(t0)=h0為恒值。
這種近似產(chǎn)生的截斷誤差不會超過:
(11)
此時,在Δt內(nèi)誤差方程(8)變?yōu)槌O禂?shù)一階線性非齊次矩陣微分方程:
(12)
2.1.2 誤差動態(tài)響應(yīng)的忽略
將式(12)展開,得到誤差微分方程組:
(13)
可見,各階誤差在誤差系統(tǒng)中相互嵌套,同時存在著動態(tài)響應(yīng)和穩(wěn)態(tài)靜差。動態(tài)響應(yīng)影響觀測速度,靜差大小則決定LESO最終觀測精度的高低。動態(tài)響應(yīng)的客觀存在使得量化表示某一時刻的觀測誤差十分困難。
注意到式(9)中基于帶寬wo的參數(shù)整定方法使得式(12)中系數(shù)矩陣Ae是Hurwitz的、誤差方程能夠?qū)崿F(xiàn)漸近穩(wěn)定,即
(14)
這意味著隨著時間的推移,誤差的動態(tài)響應(yīng)分量在LESO的觀測誤差中所占比重將逐漸減小,直至最終無限趨近于0。因此將式(14)代入式(12)中能夠得到:
(15)
誤差(15)即為最終的穩(wěn)態(tài)觀測靜差。然而對控制系統(tǒng)而言,嚴格滿足t→∞這一收斂條件是不實際的。事實上,LESO觀測誤差的收斂速度由帶寬wo決定,在不考慮噪聲引入的情況下,wo越大,對應(yīng)的收斂速度越快[8,10]。在實際應(yīng)用中,通過整定wo實現(xiàn)對系統(tǒng)各階狀態(tài)的迅速觀測是保證觀測系統(tǒng)正常發(fā)揮作用的前提。因而在此基礎(chǔ)上做出進一步的近似,認為在計算步長Δt內(nèi)式(12)已能達到穩(wěn)態(tài)。
經(jīng)過以上近似,在單次計算步長內(nèi)可以將動態(tài)響應(yīng)略去,使用式(16)來描述LESO的觀測精度:
(16)
對式(16)展開并化簡,得:
(17)
按照帶寬配置原則,由二項式定理可得觀測增益:
(18)
將其代入式(17)并化簡,得到觀測靜差的最終表達式:
(19)
至此,通過近似1、近似2,將LESO的誤差系統(tǒng)進行了線性處理,極大地簡化了時變系統(tǒng)中擾動項的非線性和LESO觀測誤差收斂過程中的動態(tài)響應(yīng)帶來的分析困難。在此基礎(chǔ)上推導(dǎo)出的靜差表達式(19),即可認為是近似后LESO的觀測誤差量化表達式。
結(jié)論1:LESO在本質(zhì)上屬于有差觀測系統(tǒng),忽略f的構(gòu)造方式使得觀測過程存在如式(19)所示的近似觀測誤差,其大小與整定的觀測器帶寬wo、擴張階數(shù)n以及總擾變化率h有關(guān)。在LESO階數(shù)確定時,總擾變化過快將使得LESO觀測精度降低,而提高帶寬wo是提高觀測精度的有效辦法。
注2:實際應(yīng)用中,受觀測噪聲的影響,wo的整定存在上限,此時,總和擾動變化較大的系統(tǒng),誤差的動態(tài)響應(yīng)也會相對劇烈,近似2由于忽略誤差的動態(tài)響應(yīng)帶來的偏差也會越大。因此,將靜差表達式(19)看作LESO的觀測誤差量化表達式,對于擾動變化極為劇烈、LESO無法及時完成觀測的系統(tǒng)而言并不適用。
(20)
LESO的目標是實現(xiàn)對被觀測系統(tǒng)各階狀態(tài)的實時估計,該過程依賴e1(t)的收斂,而e1(t)=x1(t)-z1(t)是可以實時獲得的。為避免微分,做以下代換:
(21)
將其代入補償器的表達式(20)中化簡,并補充定義β0=1,補償器最終可以用式(22)表達(Di表示第i階狀態(tài)對應(yīng)的觀測補償量):
{Di=βi-1e1i=1,2,…,n+1}
(22)
LESO的前饋補償結(jié)構(gòu)如圖1所示。
圖1 LESO的前饋補償結(jié)構(gòu)設(shè)計Fig.1 Design of feedforward compensation structure of LESO
由式(3)、式(7)、式(20)可得補償后的誤差方程:
后一項展開后為零矩陣:
(24)
故將Ae展開代入并繼續(xù)化簡,得到:
(25)
聯(lián)立誤差微分方程組(13),最終可化簡為:
(26)
結(jié)合第2節(jié)中所做的近似,最終能夠得到:
(27)
式(26)中,即便觀測誤差未及時收斂,恒有e′1=0。這正是使用e1補償各階觀測誤差的特點。由于LESO采用借助e1構(gòu)造誤差收斂系統(tǒng)的結(jié)構(gòu)形式,基于可測真值y=x1修正觀測值z1,同時也實現(xiàn)了對其他各階觀測量的修正。
LESO的觀測存在相位滯后,且觀測器階數(shù)越高,滯后越嚴重[9]。補償器使用e1前饋補償各階狀態(tài),使得輸入量與補償后的輸出量之間的傳遞關(guān)系發(fā)生了變化。接下來對補償前后觀測系統(tǒng)的時延做分析。
對模型(13)取拉式變換,化簡后可以得到:
(28)
特別地,聯(lián)立模型(28)中的最后兩個公式,可以推導(dǎo)出擾動項與n+1階觀測誤差之間的傳遞函數(shù):
(29)
按照同樣的分析方式,求出補償后模型(26)的拉式變換式為:
(30)
將式(28)與式(30)聯(lián)立,得到引入補償器后LESO在觀測第i階狀態(tài)時,補償前、后觀測誤差之間的傳遞函數(shù):
(31)
若采用式(18)所示的基于帶寬的參數(shù)整定方式,并定義相對頻率Ω=ω/ωo,可進一步化簡出:
(32)
據(jù)此繪制出誤差傳遞函數(shù)的Bode圖(以4階觀測器為例),如圖2所示。
圖2表明,各階狀態(tài)的觀測誤差經(jīng)過補償器的傳遞,幅值減小、相角滯后有所減輕,且這種補償作用隨頻率的降低、觀測的狀態(tài)階數(shù)的增高而更加明顯;在Ω=5.128 6時,A(Ω)=1.43,φ(Ω)=43.592 9°,此時對各階狀態(tài)的補償曲線已基本重合,補償作用較為微弱;在Ω>13.3的高頻區(qū),|A(Ω)|<0.1,φ(Ω)<17.52°,此時補償作用幾乎喪失。當然,由于觀測帶寬存在上限,通常無法達到如此高的相對頻率,因此補償器在LESO的工作區(qū)是能夠正常發(fā)揮作用的。
圖2 誤差傳遞函數(shù)的Bode圖Fig.2 The Bode diagram of error transfer function
注3:補償器以串聯(lián)形式對觀測值加以修正,并不影響LESO原有的收斂性、頻帶特性和濾波性能等固有性質(zhì)。若通過整定觀測增益,使得原系統(tǒng)的觀測器滿足BIBO(bound-in-bound-out)穩(wěn)定[6-7],此時在步長Δt內(nèi),對于系統(tǒng)第一階狀態(tài)的觀測,下式是成立的(es指觀測靜差值):
由補償器的結(jié)構(gòu)形式(22)可知,此時各階補償量同樣是收斂且有界的,因此補償環(huán)節(jié)的引入并不會造成觀測系統(tǒng)的發(fā)散,即:補償器與擴張狀態(tài)觀測器具有相同的穩(wěn)定性,二者通過串聯(lián)作用,共同實現(xiàn)對系統(tǒng)狀態(tài)的無靜差觀測。
LESO的結(jié)構(gòu)特點使得通過線性近似后可以量化系統(tǒng)的觀測靜差,并可使用時頻分析方法驗證前饋補償器的有效性;而對NESO,誤差收斂選用的是非線性函數(shù),不僅在推導(dǎo)觀測靜差上存在困難,頻域分析法也無法使用。
圖3給出了對LESO進行前饋補償?shù)倪^程示意。對比可見,經(jīng)過前饋補償,狀態(tài)觀測的綜合過程已不存在誤差項,補償后的模型與真實系統(tǒng)形式相同,即便e1→0不成立,仍然不會存在觀測靜差。傳統(tǒng)LESO通過誤差系統(tǒng)的漸近收斂性提供觀測驅(qū)動力,補償器D則依據(jù)真實輸入值y對各階觀測偏差進行實時修正。將這種補償思路類比至NESO,有:
(33)
因此前饋補償器應(yīng)該取如式(34)所示形式(同樣補充定義:g0(e1)=e1):
{Di=βi-1gi-1(e1)i=1,2,…,n+1}
(34)
圖3 補償過程示意Fig.3 Compensation process
本節(jié)分別通過仿真和實驗驗證補償器的有效性。設(shè)計仿真系統(tǒng),對各階狀態(tài)的觀測誤差補償效果進行分析,同時比較補償器對LESO和NESO的補償能力。實驗則重點考慮在整個LADRC系統(tǒng)中引入補償器對控制精度的改善作用。
在參考文獻[11]的基礎(chǔ)上,設(shè)計如下含隨機擾動的三階非線性系統(tǒng):
v(t)+4·u(t)
(35)
1)LESO按帶寬整定思想配置,wo=100 Hz。
① LESO:
(36)
② D:
(37)
2)NESO的誤差收斂函數(shù)取為fal形式,具體參數(shù)設(shè)置如下:δ=0.05,β1=40,β2=8×103,β3=8×104,β4=3×106。
① NESO:
(38)
② D:
(39)
圖4~6詳細給出了補償器作用效果的仿真曲線。圖4中橫向?qū)Ρ瓤梢园l(fā)現(xiàn),在補償上D對x1實現(xiàn)了完全補償,對x2、x3觀測精度也存在兩個量級的提升,補償作用非常明顯。通過縱向?qū)Ρ?,不論是使用LESO還是LESO+D,均存在觀測狀態(tài)的階數(shù)越高精度越低的規(guī)律,且各階狀態(tài)觀測誤差的曲線形狀相似,任意時刻誤差之間的比值與觀測器增益近似一致(補償后e1除外)。這是因為觀測器在結(jié)構(gòu)設(shè)計上使用e1構(gòu)成誤差收斂項,補償前狀態(tài)觀測值與真值間的各階誤差必然按βi的比例遞增,補償后由于算例中擾動項的非線性特征較為明顯,同時帶寬wo的取值并不大、誤差動態(tài)響應(yīng)在單步計算中不能完全忽略,所以仍存在部分殘留靜差以及動態(tài)響應(yīng)誤差。隨著帶寬的增大,這部分誤差可以繼續(xù)減小。
(a) 補償前(a) Before compensation
(b) 補償后(b) After compensation圖4 補償前后LESO對各階狀態(tài)的觀測誤差對比Fig.4 Comparison of observation error of LESO for each order state before and after compensation
圖5表明,在對x2的觀測補償上,穩(wěn)定后最大觀測誤差LESO由2.839E-5減小至8.046E-8,NESO由4.38E-5減小至5.76E-7,精度均獲得了百倍左右的提高。5 s加載擾動后,補償器對狀
(a) v(t)為0(a) v(t) is set to zero
(b) v(t)為階躍信號(b) v(t) is set to step signal
(c) v(t)為噪聲信號(c) v(t) is set to noise signal圖5 補償器對x2的作用效果Fig.5 Effect of the compensator on x2
態(tài)的瞬時觀測則只提升了約10倍,這是因為在擾動加載的瞬間,系統(tǒng)的非線性特征很強,補償器完全補償靜差的兩個近似條件不能嚴格滿足,因此效果較圖5(a)中的精度提升有所下降。圖5(c)中系統(tǒng)存在噪聲擾動的情況下,在提高觀測精度的同時,觀測器對噪聲還產(chǎn)生了一定的濾波作用。在觀測器的比較上,本文仿真中整定的參數(shù)使得LESO與NESO的觀測精度相仿,但NESO的觀測增益卻比LESO小兩個量級,這有力地證明了NESO在觀測上的高效性。在圖6中對x3的觀測,LESO+D的觀測滯后程度明顯優(yōu)于LESO,這與前文補償器對相位滯后存在校正作用的推導(dǎo)是一致的。
圖6 對x3相位滯后的校正Fig.6 Correction of x3 phase lag
ESO通常作為ADRC的一個重要環(huán)節(jié),在實際應(yīng)用中更關(guān)心的是補償?shù)脑O(shè)計對整體控制精度是否有提高。為此,針對PMLSM易受擾動影響而精度不高的問題,引入補償器改進直線電機的LADRC伺服回路。系統(tǒng)中存在的紋波力、摩擦力、負載力等多種非線性擾動成為制約控制精度的主要原因。
直線電機的位置模型為二階非線性系統(tǒng)[13],引入補償器后的改進LADRC控制系統(tǒng)設(shè)計如圖7所示。
圖7 改進LADRC在PMLSM控制中的結(jié)構(gòu)圖Fig.7 Structure of improved LADRC in PMLSM control
實驗中使用了定制的永磁直線同步電機半實物仿真平臺。在上位機中利用MATLAB/Simulink的XPC Target系統(tǒng)模塊導(dǎo)入Simulink模型,經(jīng)編譯后下載至運動控制卡中,輸出信號送入伺服驅(qū)動器以控制電機運行,采集數(shù)據(jù)并處理繪圖。驅(qū)動器系數(shù)Ka=0.84 A/V,力常數(shù)Km=15 N/A,小車與砝碼的總質(zhì)量M=3.8 kg,摩擦力系數(shù)B≈1.2 N·s/m。電機行程1.0 m,光柵尺定位精度為±2 μm。
實驗中,伺服系統(tǒng)控制參數(shù)最終確定見表1。
在上位機的MATLAB/Simulink中搭建圖7所示的控制系統(tǒng),利用RTW工具箱自動生成C代碼,編譯、下載到目標機。為同時驗證補償器對誤差幅值大小、相位滯后的補償有效性,期望信號設(shè)成頻率為1 Hz、幅值0.1的正弦時變信號y=0.1sin(t),過程持續(xù)10 s。
表1 改進LADRC測試系統(tǒng)參數(shù)設(shè)置
圖8給出了實驗中補償器對動子位置的控制誤差的作用效果曲線。由圖可以看出,在追蹤正弦時變信號時,補償器對控制精度有明顯提高。位置追蹤在相位上得到了校正,且最大追蹤誤差由41 μm補償至9 μm(見圖9),這是因為傳統(tǒng)LESO始終將總擾變化率按h=0處理,對于時變信號這種處理方式帶來的觀測靜差是無法避免的。引入補償器后,觀測靜差得到了補償、LESO反饋至控制器的觀測量精度提高,這使得系統(tǒng)的控制輸入更準確,因而LADRC系統(tǒng)的整體控制精度得到了整體提高。
(a) 動子位置控制曲線(a) Position control curves
(b) 位置控制誤差曲線(b) Position control error curves圖8 補償器在PMLSM實驗平臺中的應(yīng)用效果Fig.8 Application effect of compensator on PMLSM experimental platform
圖9 補償后位置追蹤誤差的局部放大圖Fig.9 Local large map of position tracking error after compensation
在分析LESO觀測原理的基礎(chǔ)上,通過對誤差系統(tǒng)的線性近似,推導(dǎo)出狀態(tài)觀測靜差的量化表達式,進而據(jù)此設(shè)計了誤差前饋補償器。通過理論推導(dǎo),證明了補償?shù)目尚行浴跁r域內(nèi)能消除觀測靜差,頻域上也能夠減輕LESO的相位滯后,進而將這種補償思想引入NESO中。仿真驗證了補償器對LESO、NESO均有效,實驗結(jié)果則進一步表明,補償器的引入能大幅提高整個LADRC系統(tǒng)的控制精度。
這種補償器的設(shè)計源自觀測靜差表達式的推導(dǎo),形式簡單,沒有積分、微分等環(huán)節(jié),計算量?。?ESO與補償器一一對應(yīng),不存在多樣性;以串聯(lián)的形式引入ADRC中,與其他環(huán)節(jié)相互獨立,且對LESO、NESO均有效;在觀測足夠迅速的前提下,理論上能完全消除觀測靜差,顯著提高系統(tǒng)的控制精度。該前饋觀測補償設(shè)計可為實際工程應(yīng)用提供思路參考。