張濤,李炯,王華吉,雷虎民,葉繼坤
1. 空軍工程大學 研究生院,西安 710051 2. 空軍工程大學 防空反導學院,西安 710051
臨近空間高超聲速飛行器飛行速度快、巡航高度高、突防能力強,可突破我國幾乎所有的防御體系,對我國的空天安全構成了嚴重威脅,必須研究相應的防御方法[1-3]。動能攔截器(Kinetic Kill Vehicle,KKV)技術已在彈道導彈防御系統(tǒng)中得到了廣泛的應用,如美國地基攔截彈大氣層外殺傷飛行器(EKV)、美國末端高空防御動能殺傷器和海基標準3攔截彈的大氣層外輕型彈射攔截器(LEAP)[4-5]。
與傳統(tǒng)大氣層內(nèi)制導武器利用空氣動力改變自身姿態(tài)不同,KKV通過安裝在彈體尾部的姿控發(fā)動機來改變彈體姿態(tài)。為了搜索目標,KKV通常需要大角度調(diào)整,目標鎖定之后,需要根據(jù)不同的制導策略,控制KKV姿態(tài)角跟蹤期望的姿態(tài)角,從而實現(xiàn)直接碰撞殺傷[6-7]。此外,強烈的氣動加熱會嚴重影響導引頭的探測精度[8],因此KKV通常將導引頭安裝在攔截器的側(cè)面來避開導彈頭部的熱流密集區(qū),即采用側(cè)窗探測技術,側(cè)窗探測對KKV的姿態(tài)控制產(chǎn)生了一定的約束和限制[9-10]。因此,研究側(cè)窗約束下高精度的姿態(tài)控制是動能殺傷的關鍵技術。
針對動能攔截器的姿態(tài)控制問題,國內(nèi)外學者取得了諸多可借鑒的成果。文獻[11]利用相平面法,設計了用于攔截器姿態(tài)穩(wěn)定的控制器,文獻[12]用描述函數(shù)方法分析了幾種常用的脈沖調(diào)制器特性,并設計了穩(wěn)定控制器。但是,由于描述函數(shù)方法采用一階近似,所以控制精度受到了限制,且穩(wěn)態(tài)抖動較大。文獻[13]基于時標分離原理,將姿態(tài)分為快慢回路,設計了一種比例積分控制器,文獻[14]基于反饋線性化方法將非線性、強耦合、多輸入多輸出的姿態(tài)控制系統(tǒng)解耦成3個獨立的子系統(tǒng),并設計了神經(jīng)網(wǎng)絡PID控制器,但均未考慮外部干擾、參數(shù)攝動和質(zhì)心漂移等未知擾動對控制系統(tǒng)的影響。文獻[15-16]基于預測控制理論,設計了一種開關式的姿態(tài)控制律,該方法在建模中考慮了攔截器各個通道存在干擾力矩及推力偏心的情況,將系統(tǒng)模型簡化為線性模型,并設計了預測控制器,取得了很好的效果,但要求攔截器的轉(zhuǎn)動慣量實時可測,這在工程中很難獲取。
滑模變結構方法對干擾和不確定性具有良好的魯棒性,因而在各個領域得到了廣泛的應用[17-18]。通過選擇適當?shù)幕W兘Y構控制律參數(shù)可以實現(xiàn)對姿態(tài)的精確控制,并具有較強的魯棒性,但如果存在較大干擾時,容易在滑模面上發(fā)生抖振現(xiàn)象,控制精度不高,且發(fā)動機頻繁開關機易引起彈性振動,這也限制了它的應用。
反演控制易于處理系統(tǒng)中的不確定性和未知參數(shù),同時又避免抵消系統(tǒng)中有用的非線性項,因而在非線性控制中得到了廣泛的應用,但魯棒性不強及“微分膨脹”問題制約了其發(fā)展[19-24]。文獻[19-20]采用動態(tài)面控制,利用低通濾波器或微分跟蹤器估計虛擬控制量的一階導數(shù),很好的解決了“微分膨脹”問題。文獻[21-22]將反演控制與滑??刂平Y合,增強了系統(tǒng)的魯棒性。文獻[23-24]通過采用干擾觀測器或神經(jīng)網(wǎng)絡來對誤差進行估計和補償,取得了良好的控制效果。
由于利用非線性控制理論設計的控制器得到的是連續(xù)時變的控制量,并不能直接應用于動能攔截器的姿控系統(tǒng)中。針對該問題,眾多學者提出了將連續(xù)控制量轉(zhuǎn)變?yōu)閿?shù)字變量的脈沖調(diào)制方式,如脈沖寬度調(diào)制(PWM),脈沖頻率調(diào)制(PFM),脈寬脈頻調(diào)制(PWPF)等不同方式[25-27],其中PWPF調(diào)制方式以其良好的控制性能被廣泛應用于飛行器的姿態(tài)控制系統(tǒng)中。文獻[25]針對飛行器姿態(tài)控制問題,分別從近似線性空間、燃料消耗、發(fā)動機工作頻率等方面討論了PWPF調(diào)制器的性能;文獻[26]針對PWPF調(diào)節(jié)器參數(shù)設置上的局限性,提出了一種非線性目標優(yōu)化函數(shù),綜合考慮了PWPF調(diào)制器的線性工作區(qū)要求、脫靶量和燃料消耗等制導系統(tǒng)的性能指標要求,應用遺傳算法對PWPF調(diào)制器的參數(shù)進行了優(yōu)化設計;文獻[27]設計了變死區(qū)的PWPF調(diào)制器,并用描述函數(shù)法證明了調(diào)制器的穩(wěn)定性,仿真結果證明了該算法在燃料消耗和控制精度上的優(yōu)越性。盡管PWPF調(diào)制器可以輸出不同寬度的脈沖指令,且靜態(tài)特性與飛行器的參數(shù)無關,但其存在相位滯后的問題。
針對以上問題,本文首先建立了臨近空間動能攔截器的三通道耦合模型,其次,基于反演控制理論設計了自適應神經(jīng)反演姿態(tài)控制器;然后,采用PSR脈沖調(diào)制器將連續(xù)的控制律轉(zhuǎn)化為脈沖控制律,實現(xiàn)了常值推力控制;最后,仿真驗證了所提方法的有效性。本文的主要創(chuàng)新工作有:(1)建立了姿控發(fā)動機側(cè)向噴流干擾模型,并推導了包含質(zhì)心漂移、參數(shù)攝動和外界干擾等不確定因素的三通道強耦合模型。(2)為提高控制精度,采用了RBF神經(jīng)網(wǎng)絡對對各個通道的不確定項進行估計和補償,并基于最小學習參數(shù)的思想,將神經(jīng)網(wǎng)絡學習參數(shù)擬合為一個參數(shù),提高了RBF計算效率,保證了估計的實時性。(3)采用了PSR脈沖調(diào)制器,將連續(xù)控制律轉(zhuǎn)化為脈沖控制律,實現(xiàn)了常值推力控制,并克服了PWPF調(diào)制器相位滯后的問題。
動能攔截器體積較小,可忽略彈性振動,將彈體作為剛體進行研究。描述攔截器質(zhì)心轉(zhuǎn)動的動力學和運動學方程為[28]
(1)
式中:Jx、Jy、Jz分別為攔截器相對于彈體系3個軸的轉(zhuǎn)動慣量;wx、wy、wz分別為彈體系相對于慣性系的轉(zhuǎn)動角速度在彈體坐標系3個軸上的分量;Mx、My、Mz分別為作用在KKV彈體系3個軸上的控制力矩;dx、dy、dz分別為氣動干擾、推力偏心等引起的姿態(tài)干擾力矩在彈體系3個軸的分量;γ、ψ、?分別為滾轉(zhuǎn)角、偏航角和俯仰角。
動能攔截器無舵無翼,其姿態(tài)調(diào)整僅依靠安裝在彈體后部的姿態(tài)控制系統(tǒng)實現(xiàn)。姿控系統(tǒng)發(fā)動機的安裝方式如圖1所示,通過6個發(fā)動機組合工作實現(xiàn)對3個通道的穩(wěn)定。(2+5)發(fā)動機控制俯仰,(1+6)和(3+4)控制偏航,(1+4)和(3+6)控制滾轉(zhuǎn)。姿態(tài)控制發(fā)動機屬于直接側(cè)向噴氣式推進器,不能擺轉(zhuǎn)而只能輸出垂直攔截器各軸的恒定推力。
姿態(tài)控制發(fā)動機在彈體坐標系下產(chǎn)生的控制力分量為
(2)
姿態(tài)控制發(fā)動機在彈體坐標系下產(chǎn)生的控制力矩為
(3)
式中:Fzi(i=1,2,…,6)為每個姿控發(fā)動機產(chǎn)生的推力大??;r為一對差動式滾動發(fā)動機推力作用線之間的垂直距離;l為俯仰/偏航姿控推力作用線到質(zhì)心的垂直距離。
結合發(fā)動機布局圖1可知,在實際的工作過程中,為保證工作的穩(wěn)定,減小發(fā)動機工作對系統(tǒng)的影響,通常姿控發(fā)動機成對工作,考慮發(fā)動機性能基本一致,則式(3)可簡化為
(4)
式中:Fz為單臺姿控發(fā)動機開機時產(chǎn)生的推力;δFx、δFy、δFz決定發(fā)動機是否開關機。
圖1 姿控發(fā)動機布局Fig.1 Layout of attitude control thruster
當姿控發(fā)動機開機時,側(cè)向噴流與外部流場發(fā)生干擾,形成結構復雜的干擾流場。噴流使來流產(chǎn)生強烈的附面層分離,使流場內(nèi)出現(xiàn)斜激波、分離激波、弓形激波、再附激波、分離渦和二次分離渦,在噴口兩側(cè)出現(xiàn)膨脹波,噴流區(qū)內(nèi)可能有內(nèi)激波和馬赫盤等復雜物理現(xiàn)象,這種現(xiàn)象稱為側(cè)向噴流干擾效應。典型的側(cè)向噴流和外部流場干擾現(xiàn)象如圖2所示。
干擾流場非常復雜,具有分布參數(shù)特性,目前尚無準確的數(shù)學模型來進行描述,幾乎所有文獻在提到由于側(cè)向噴流與來流相互干擾在飛行器上產(chǎn)生的力及力矩時,都采用推力放大因子KT和力矩放大因子KM來描述。其定義為
(5)
式中:Td為噴流引起的干擾力;Tc為發(fā)動機的靜態(tài)推力;Md為噴流引起的干擾力矩;Mc為發(fā)動機在地面的靜態(tài)力矩;KM也反映了由于噴流干擾引起的壓心變化,則直接控制力和力矩的大小為
(6)
因此,考慮噴流干擾情況下,實際力矩可表示為
(7)
式中:Mjx、Mjy、Mjz分別為在考慮噴流干擾情況下,實際力矩在彈體坐標系下各個軸的分量,
圖2 側(cè)向噴流干擾效應示意圖Fig.2 Diagram for jet interaction effects
ΔMjy、ΔMjz分別為噴流產(chǎn)生的干擾力矩在彈體坐標系Oy1軸和Oz1軸上的分量。
(8)
式中:
由于攔截器在姿態(tài)調(diào)整或軌道控制時,需要姿軌控發(fā)動機開機提供推力,消耗燃料導致攔截器自身轉(zhuǎn)動慣量的變化及質(zhì)心漂移,故式(8)中的參數(shù)存在如下的關系:
(9)
式中:J0、F0、L0分別為J、F、L的初始值;ΔJ、ΔF、ΔL分別為由轉(zhuǎn)動慣量攝動及質(zhì)心漂移產(chǎn)生的各參數(shù)的變化量。
假設2姿態(tài)控制力矩的推力矢量作用距離不確定量滿足Δli≤lθi,其中l(wèi)θi為正實數(shù),且i=r,l。
聯(lián)立式(8)和式(9)可得
(L0+ΔL)u+D(t)
(10)
(11)
式中:
可看出式(11)新變量H(t)為系統(tǒng)的總不確定項,包含外界擾動、轉(zhuǎn)動慣量攝動、質(zhì)心漂移等未知不確定信息。
定義角度跟蹤誤差為
(12)
(13)
設計虛擬控制量為
(14)
定義角速度跟蹤誤差為
(15)
對其求一階導數(shù)可得
(16)
設計實際的控制量為
(17)
實際控制量式(17)為連續(xù)時變控制量,并不適用于KKV控制,這里采用偽速率調(diào)制器將連續(xù)的量轉(zhuǎn)化為數(shù)字式的控制量,實現(xiàn)變推力控制。PSR調(diào)制器的結構與PWPF調(diào)制器相似,只是一階慣性環(huán)節(jié)的位置不同,一階慣性環(huán)節(jié)用于補償施密特觸發(fā)器在反饋回路中的輸出。PSR調(diào)制器的原理圖如圖3所示。
當施密特觸發(fā)器的輸入e(t)大于開機門限uon,輸出一個定值1。調(diào)制器輸入E與1經(jīng)過指數(shù)衰減后相減得新的e(t),當e(t)繼續(xù)增大或減小到關機門限uoff之前,調(diào)制器的輸出始終為1;觸發(fā)器輸入e(t)小于uon或減小到uoff后,調(diào)制器的輸出為0。同理,e(t)為負值時,調(diào)制器輸出0或-1(負號表示調(diào)制器反向開),由此得出調(diào)制器的輸出。
根據(jù)圖3寫出e(t)的表達式,當繼電器開啟時
e(t)=Km(E-um)(1-e-t1/Tm)+uone-t1/Tm
0≤t1≤Ton
(18)
當繼電器關閉時
e(t)=Km(E-um)(1-e-t2/Tm)+uoffe-t2/Tm
0≤t2≤Toff
(19)
圖3 PSR調(diào)制器結構圖Fig.3 Diagram for PSR modulator
由此得出輸出脈沖寬度為
(20)
繼電器在一個周期內(nèi)的關閉時間為
(21)
開關頻率為
(22)
最小脈沖寬度為
(23)
PSR調(diào)制器繼承了PWPF的優(yōu)點,其靜態(tài)特性與飛行器的參數(shù)無關,輸出脈沖與誤差幅值和誤差速度有關,并且還提供相位超前性能[25,30]。
為解決“微分膨脹”問題,這里設計有限時間收斂微分器來估計虛擬控制量一階導數(shù),不失一般性,先構造如下系統(tǒng)
(24)
式中:x1,x2,…,xn∈R為狀態(tài)變量;f(·)為連續(xù)函數(shù)且f(0,…,0)=0。
引理1[31]對于如下系統(tǒng):
(25)
式中:z1∈R,z2∈R,如果系統(tǒng)式(25)滿足z1(t)→0,z2(t)→0(t→∞),對于任意的有界輸入v(t),R>0,T>0,存在如下的系統(tǒng):
(26)
滿足:
(27)
定理1υ(t)滿足假設4,則得到如下新型FD:
(28)
式中:R、ai(i=1,2,…,n)∈R+為待設計參數(shù)。則存在φ>0與ιφ>n使得
(29)
式中:O((1/R)ιφ-i+1)為ζi與υ(i-1)(t)的近似程度是(1/R)ιφ-i+1階的,φ=(1-?)/?,?∈(0,min{ι/(ι+n),1/2}),n≥2。
證明:根據(jù)引理1可知,定理1成立。證畢。
注1式(28)中,ζ1,ζ2,…,ζn為系統(tǒng)狀態(tài)變量,υ(t)為帶有噪聲的輸入信號,ζ1為去除噪聲后的跟蹤信號,ζi(i=2,3,…,n)為υ(t)的第i-1階導數(shù)的估計值。式(29)進一步表明,估計誤差為(1/R)ιφ-i+1的高階無窮小。則通過選取足夠大的設計參數(shù)R,估計誤差可以任意小。
故虛擬控制量的一階微分量可以通過式(30)進行獲?。?/p>
(30)
式中:A1=diag(a11,a12,a13),a1i>0,i=1,2,3;A2=diag(a21,a22,a23),a2i>0,i=1,2,3為待設計的參數(shù);ζ1為X2d的估計值;ζ2為X2d的一階微分量估計矩陣。
神經(jīng)網(wǎng)絡已經(jīng)被證明具有萬能逼近特性,采用神經(jīng)網(wǎng)絡實現(xiàn)模型未知部分的自適應逼近,在控制器中予以補償,可有效地降低模糊增益,減小滑模抖振。RBF神經(jīng)網(wǎng)絡結構簡單、學習與容錯能力強,具備對任意非線性連續(xù)函數(shù)的全局逼近能力[24]。RBF神經(jīng)網(wǎng)絡由輸入層、隱含層與輸出層構成,其基本結構如圖4所示。
RBF神經(jīng)網(wǎng)絡可表示為輸入到輸出的一種映射關系:
y=WTh(X)
(31)
(32)
式中:n、p分別為輸入向量的維數(shù)和節(jié)點個數(shù)。
F(X)=W*Th(X)+μ|μ|≤μM
(33)
式中:μ∈R為逼近誤差;μM∈R+為逼近誤差的上界。當取足夠大的p時,μM可以任意小[24]。
圖4 RBF神經(jīng)網(wǎng)絡結構示意圖Fig.4 Schematic drawing of RBF neural network structure
若將b與c的取值設置在X的有效映射范圍內(nèi),則只需在線調(diào)節(jié)W的元素,即可實現(xiàn)對F(X)的有效逼近。再基于Lyapunov穩(wěn)定性理論,為w1,w2,…,wp設計使閉環(huán)系統(tǒng)穩(wěn)定的自適應律,即可保證逼近誤差的有界性與收斂性。
由于H(t)為未知函數(shù),引入RBF神經(jīng)網(wǎng)絡對其進行逼近
(34)
(35)
(36)
式中:λ=diag(λ1,λ2,λ3)為待設計參數(shù)。
定義估計誤差為
(37)
將式(14)代入式(13)中可得
(38)
將式(17)和式(34)代入式(16)中可得
(39)
選取如下所示的Lyapunov函數(shù):
(40)
對式(40)求導,并將式(12)、式(14)、式(38)與式(39)代入可得
(41)
考慮到
(42)
有
(43)
又由于
則式(43)變?yōu)?/p>
(44)
定義如下密集:
(45)
為驗證本文所設計的自適應神經(jīng)反演姿態(tài)控制律的有效性,以本文典型動能攔截器姿控發(fā)動機布局方式為例,針對不同的控制指令信號和干擾進行數(shù)字仿真,仿真的初始參數(shù)如表1所示,外部干擾和仿真參數(shù)攝動值如表2所示。
表1 仿真初始參數(shù)Table 1 Initial parameters of simulation
表2 仿真參數(shù)攝動值Table 2 Simulation parameters perturbation
圖5 動能攔截器姿態(tài)角響應曲線(仿真1)Fig.5 Response curves of KKV attitude angle (Simulation 1)
圖6 發(fā)動機推力曲線(仿真1)Fig.6 Thruster force curves (Simulation 1)
由圖5可知,姿態(tài)調(diào)整分為姿態(tài)調(diào)節(jié)階段和姿態(tài)保持2個階段,俯仰通道和偏航通道跟蹤正弦指令時,其調(diào)節(jié)時間均較短為0.1 s,跟蹤誤差俯仰通道不超過±0.1°,偏航通道不超過±0.2°,跟蹤性能良好。觀察偏航通道跟蹤曲線可知,其調(diào)節(jié)時間0.21 s,穩(wěn)定控制誤差不超過±0.2°。滿足姿態(tài)控制快速性和準確性的要求。觀察偏航通道姿態(tài)角跟蹤曲線可知,姿態(tài)角進入穩(wěn)態(tài)后處于微幅振蕩狀態(tài),其振蕩頻率與脈沖開關次數(shù)成正比。
由圖6可知,發(fā)動機開關機序列開始時有一段飽和工作區(qū),這時的脈沖寬度較大,之后進入占空比線性工作區(qū),推力脈沖的寬度也逐漸減小,這反映了PSR脈沖調(diào)制器對推力脈沖的調(diào)寬調(diào)頻作用。整個姿態(tài)控制階段,發(fā)動機開機頻率較低, KKV變推力姿態(tài)控制精度高,所設計的控制器控制性能良好。
圖7 動能攔截器姿態(tài)角響應曲線(仿真2)Fig.7 Response curves of KKV attitude angle (Simulation 2)
圖8 發(fā)動機推力曲線(仿真2)Fig.8 Thruster force curves (Simulation 2)
圖9 動能攔截器無干擾補償姿態(tài)角響應曲線Fig.9 Response curves of KKV attitude angle without disturbance compensation
圖10 無干擾補償發(fā)動機推力曲線Fig.10 Thruster force curves without disturbance compensation
圖11 縱向平面RBF估計值及誤差Fig.11 Estimated values and error of RBF neural network
由圖7可知,俯仰角跟蹤正弦指令時,在有不確定項估計和補償情況下,俯仰和偏航通道的調(diào)節(jié)時間較短為0.1 s,俯仰通道跟蹤誤差不超過±0.15°,偏航通道跟蹤誤差不超過±0.4°。由圖9可以看出,在無不確定項和補償?shù)那闆r下,俯仰通道跟蹤誤差為±0.5°,偏航通道跟蹤誤差為±1.5°,跟蹤誤差幾乎為有不確定項補償控制器的3倍。
由圖8發(fā)動機推力曲線可知,強擾動情況下,發(fā)動機開關機頻率明顯增多,但最小開機時間為50 ms,仍然滿足工程實際的要求。由圖10可知,在無不確定項補償情況下,開機頻率更高,姿控發(fā)動機需要更頻繁開機來修正誤差。頻繁的發(fā)動機開機不僅會影響KKV的姿態(tài)控制精度,甚至會激發(fā)KKV的彈性振動,引起攔截器的失穩(wěn)。
根據(jù)圖11可以看出,RBF網(wǎng)絡對未知擾動的逼近精度高,其估計誤差較小,精確的誤差估計和補償極大的提高了姿態(tài)控制的精度,同時發(fā)現(xiàn),縱向平面未知擾動的干擾力矩已經(jīng)達到了控制力矩的50%。
仿真3將設計的姿態(tài)控制器與文獻[19]中的控制器進行對比,仿真初始設定與仿真2相同,文獻[19]仿真結果如圖12和圖13所示。
由圖12可知,在強干擾情況下,文獻[19]中的控制精度出現(xiàn)了較大的誤差,其主要原因在于盡管其對誤差進行了一定的估計和補償,但是僅估計了其誤差的上界,估計精度不高,故造成了較大的跟蹤誤差。由圖13可知,由于沒有精確的誤差估計和實時的補償,使得了姿控發(fā)動機頻繁開機,造成了嚴重的能源浪費,且由于采用了PWPF調(diào)制器,造成了一定的相位延遲,初始收斂時間更長。
圖12 動能攔截器姿態(tài)角響應曲線[19]Fig.12 Response curves of KKV attitude angle[19]
圖13 發(fā)動機推力曲線[19]Fig.13 Thruster force curves[19]
仿真4PSR調(diào)制器與PWPF調(diào)制器對比分析,PWPF與PSR最優(yōu)參數(shù)取值范圍如文獻[25]中TableⅡ所示,本文仿真參數(shù)選擇如表3所示,以典型的階躍信號為參考信號,PWPF和PSR調(diào)制器調(diào)制曲線如圖14所示。
由圖14可得,PSR調(diào)制器和PWPF調(diào)制器的調(diào)制曲線最大的不同點在初始階段,PSR調(diào)制器在初始階段便開機,直到將誤差降低到關機門限時關機,而PWPF調(diào)制器則是在初始階段關機直到誤差達到開機門限才開機,這樣相比于PSR調(diào)制器存在相位延遲,這將可能造成系統(tǒng)的不穩(wěn)定。同時由圖14可以清晰地看到,PWPF調(diào)制器的開機時間明顯長于PSR,這將會造成燃料的浪費。因此PSR調(diào)制器相比于PWPF調(diào)制器,其性能有明顯的優(yōu)勢。
表3 調(diào)制器仿真初始參數(shù)Table 3 Initial parameters of modulator
圖14 PSR和PWPF調(diào)制器響應曲線Fig.14 Modulators of PSR and PWPF response curves
1) 本文基于反演控制理論設計的自適應神經(jīng)反演姿態(tài)控制器,姿態(tài)跟蹤速度快,控制精度高,對擾動具有較強的魯棒性。
2)所設計的RBF神經(jīng)網(wǎng)絡能夠?qū)Ω鱾€通道的不確定項進行有效的估計和補償,收斂速度快,估計精度高,且基于最小學習參數(shù)思想將神經(jīng)網(wǎng)絡學習參數(shù)擬合為一個參數(shù)后,提高了RBF計算效率,保證了估計的實時性。
3) 所設計的PSR脈沖調(diào)制器實現(xiàn)了攔截器的變推力控制,并克服了PWPF調(diào)制器相位滯后問題。