李　炯, 張　濤, 雷虎民, 葉繼坤, 王華吉

(空軍工程大學(xué)防空反導(dǎo)學(xué)院, 陜西 西安 710051)

0　引　言

近年來,彈道導(dǎo)彈和高超聲速飛行器等高速目標(biāo)不斷涌現(xiàn),給各國的防空反導(dǎo)系統(tǒng)帶來了嚴(yán)峻的挑戰(zhàn)。攔截高速目標(biāo)時(shí),導(dǎo)彈的末制導(dǎo)時(shí)間只限于幾秒,為了實(shí)現(xiàn)對(duì)目標(biāo)直接碰撞殺傷,需要使彈目視線(line of sight, LOS)角速率在有限時(shí)間內(nèi)收斂到零附近的較小鄰域內(nèi),從而使導(dǎo)彈以準(zhǔn)平行接近狀態(tài)殺傷目標(biāo)[1]。實(shí)際應(yīng)用中,尋的導(dǎo)彈的自動(dòng)駕駛儀特性通常會(huì)使制導(dǎo)精度變差,尤其是對(duì)機(jī)動(dòng)目標(biāo)。因此,研究考慮自動(dòng)駕駛儀動(dòng)態(tài)特性的有限時(shí)間收斂制導(dǎo)律具有重要的意義。

文獻(xiàn)[2-4]針對(duì)傳統(tǒng)基于有限時(shí)間Lyapunov穩(wěn)定性理論獲得的導(dǎo)引規(guī)律只能保證當(dāng)時(shí)間趨于無窮時(shí)視線角速率收斂到零的問題,基于非線性控制有限時(shí)間穩(wěn)定理論,設(shè)計(jì)了簡潔的有限時(shí)間收斂變結(jié)構(gòu)導(dǎo)引規(guī)律,并提出了制導(dǎo)系統(tǒng)有限時(shí)間收斂的充分條件,但收斂速度較慢。文獻(xiàn)[5-7]針對(duì)制導(dǎo)律設(shè)計(jì)時(shí)選擇線性滑模面,跟蹤誤差收斂時(shí)間較長的問題。采用Terminal滑?？刂撇呗?在滑模面中引入非線性函數(shù),提高了收斂速度,但造成了系統(tǒng)的奇異問題。文獻(xiàn)[7-8]針對(duì)上述問題,基于非線性終端控制理論設(shè)計(jì)了非奇異終端滑模制導(dǎo)律,解決了奇異問題,但將目標(biāo)機(jī)動(dòng)設(shè)為干擾因素,只適用于靜止目標(biāo)或弱機(jī)動(dòng)目標(biāo),不適用于目標(biāo)做大機(jī)動(dòng)場景,而且未知擾動(dòng)會(huì)造成系統(tǒng)強(qiáng)烈的抖振。文獻(xiàn)[9-10]設(shè)計(jì)了非線性干擾觀測器來估計(jì)目標(biāo)機(jī)動(dòng),但需要目標(biāo)機(jī)動(dòng)的上界,這通常無法獲得,且對(duì)噪聲敏感。文獻(xiàn)[11]考慮了測量噪聲的干擾,設(shè)計(jì)了擴(kuò)張觀測器對(duì)不確定項(xiàng)進(jìn)行估計(jì)和補(bǔ)償,雖不需要任何先驗(yàn)信息,但并未證明估計(jì)誤差能在有限時(shí)間收斂。

LOS角是制導(dǎo)律設(shè)計(jì)的關(guān)鍵參數(shù),通常通過導(dǎo)引頭測量獲取,但在測量過程中存在噪聲干擾,且其微分量通常無法獲得。近年來,跟蹤微分器(tracking differentiator, TD)被廣泛采用解決上述問題[12-18]。TD的基本概念最先由我國韓京清研究員提出,并給出了3種具體的TD[19],但其跟蹤和微分效果并不理想,國內(nèi)外學(xué)者對(duì)TD的設(shè)計(jì)方法進(jìn)行了深入研究,已提出多種形式的TD[15-16]。文獻(xiàn)[16]提出了混合微分器,即在設(shè)計(jì)微分器時(shí),同時(shí)引入線性環(huán)節(jié)和非線性環(huán)節(jié),非線性環(huán)節(jié)確保了微分器收斂的快速性,線性環(huán)節(jié)則有效避免了輸出顫振,但是形式過于復(fù)雜,參數(shù)鎮(zhèn)定困難,不利于工程應(yīng)用。文獻(xiàn)[17]設(shè)計(jì)了反正切形式的新型跟蹤微分器,但是設(shè)計(jì)參數(shù)過多,且噪聲抑制能力不強(qiáng)。

針對(duì)上述問題,首先建立了包含導(dǎo)彈自動(dòng)駕駛儀動(dòng)態(tài)特性的非線性彈目運(yùn)動(dòng)模型;針對(duì)普通快速終端滑模控制產(chǎn)生的奇異問題和抖振問題,設(shè)計(jì)了非奇異快速終端二階滑模制導(dǎo)律(nonsingular fast terminal second-order sliding mode guidance law,NFTG),并對(duì)其穩(wěn)定性和有限時(shí)間收斂特性進(jìn)行了嚴(yán)格證明,給出了收斂時(shí)間的具體表達(dá)式;隨后設(shè)計(jì)了新型有限時(shí)間收斂微分器(finite-time-convergent differentiator, FD),用于抑制LOS角速率測量誤差和估計(jì)其一階微分量,并將其應(yīng)用到擴(kuò)張觀測器當(dāng)中,用來對(duì)不確定項(xiàng)進(jìn)行估計(jì);最后通過數(shù)字仿真對(duì)所設(shè)計(jì)的制導(dǎo)律進(jìn)行了仿真驗(yàn)證。

1　導(dǎo)彈-目標(biāo)相對(duì)運(yùn)動(dòng)描述模型

導(dǎo)彈與目標(biāo)的相對(duì)運(yùn)動(dòng)如圖1所示。

圖1　導(dǎo)彈目標(biāo)三維攔截幾何關(guān)系圖

其中OxIyIzI為慣性坐標(biāo)系,OxLyLzL為視線坐標(biāo)系,r為導(dǎo)彈和目標(biāo)的相對(duì)距離,qε和qβ分別為視線傾角和視線偏角,θm、θt、φm和φt分別為導(dǎo)彈和目標(biāo)的彈道傾角和彈道偏角。為便于制導(dǎo)律研究,可將末制導(dǎo)過程解耦成縱向平面和側(cè)向平面運(yùn)動(dòng)分別進(jìn)行研究,本文主要針對(duì)導(dǎo)彈縱向平面展開研究。

假設(shè)在充分短的時(shí)間Δt內(nèi),xi、yi、zi、qε的增量分別為Δxi、Δyi、Δzi、Δqε,那么

(1)

若Δt充分小,則Δqε(t)為一個(gè)充分小的量,因此式(1)可化簡為

(2)

對(duì)式(2)兩端進(jìn)行二次求導(dǎo)并化簡,可得

(3)

將導(dǎo)彈自動(dòng)駕駛儀視作一階慣性環(huán)節(jié),則

(4)

式中,τ為導(dǎo)彈自動(dòng)駕駛儀時(shí)間常數(shù);amy為獲得的導(dǎo)彈加速度;u(t)為提供給導(dǎo)彈自動(dòng)駕駛儀的制導(dǎo)指令加速度。

(5)

由式(5)可得

(6)

(7)

對(duì)式(5)兩端進(jìn)行微分,可得

(8)

結(jié)合式(4)、式(6)、式(8),化簡可得

(9)

考慮導(dǎo)彈自動(dòng)駕駛儀延遲的彈目相對(duì)運(yùn)動(dòng)學(xué)模型可表示為

(10)

2　非奇異快速終端二階滑模有限時(shí)間收斂制導(dǎo)律設(shè)計(jì)

2.1　制導(dǎo)律設(shè)計(jì)

選取非奇異快速終端滑模面設(shè)計(jì)為

(11)

式中,α>0；β>0；p和q為正的奇數(shù),且1

(12)

設(shè)計(jì)二階滑模制導(dǎo)律為

(13)

式中,k1>0,k2>0,λ>2為制導(dǎo)律設(shè)計(jì)的參數(shù);由于λ>2, |s|1-1/λsgn(s)和|s|1-2/λsgn(s)均為非光滑的連續(xù)函數(shù),因此制導(dǎo)律是連續(xù)控制信號(hào),進(jìn)而可以大幅度地削弱滑?？刂频母哳l抖振,有利于實(shí)際的工程應(yīng)用。

2.2　穩(wěn)定性分析

將式(13)代入式(12)中可得

(14)

定義以下

w1=s

(15)

則

(16)

考慮Lyapunov函數(shù)，即

(17)

V正定,則

(w2-k1|w1|1-1/λsgn(w1))+

(2w2-k1|w1|(λ-1)/λsgn(w1))

(-k2|s|1-2/λsgn(w1))-

(18)

將式(18)寫成如下矩陣形式

(19)

其中,w=[|w1|1-1/λsgn(w1),w2]T

2.3　有限時(shí)間收斂特性證明

(1)V是正定函數(shù);

(2) 存在一個(gè)實(shí)數(shù)c>0、κ∈(0,1)和原點(diǎn)開鄰域V?D,滿足

(20)

則原點(diǎn)是系統(tǒng)的有限時(shí)間的穩(wěn)定平衡點(diǎn),且

(21)

證明將式(17)寫成如下矩陣形式,即

V=wTPw

(22)

其中

由于k2>0、λ>2,易驗(yàn)證矩陣P正定且函數(shù)V徑向無界,即

ρmin(P)‖w‖2≤V≤ρmax(P)‖w‖2

(23)

其中,ρmin(·)和ρmax(·)分別表示矩陣(·)的最小和最大特征值,‖·‖表示矩陣(·)的歐幾里得范數(shù)。

-ρmin(Q)‖w‖(2λ-3)/(λ-1)≤-ρmin(Q)V(2λ-3)/(λ-1)

(24)

即

(25)

式中,c=ρmin,κ=(2λ-3)/(λ-1)

其收斂時(shí)間為

(26)

故s可在有限時(shí)間tr內(nèi)收斂到零。下面證明當(dāng)t=tr、s(tr)=0、x2(tr)≠0時(shí),x2可在有限時(shí)間ts內(nèi)收斂到零。

取Lyapunov函數(shù)為

(27)

對(duì)式(27)進(jìn)行微分,可得

(28)

由于當(dāng)t≥tr時(shí),s(tr)=0,故

化簡可得

化簡可得

(29)

由1

根據(jù)引理1,易知x2可達(dá)到有限時(shí)間收斂,其收斂時(shí)間為

(30)

證畢

3　有限時(shí)間收斂微分器ESO設(shè)計(jì)

3.1　有限時(shí)間收斂微分器FD設(shè)計(jì)

對(duì)于如下系統(tǒng)

(31)

式中,x1,x2,…,xn∈R為狀態(tài)變量；fA(·)為連續(xù)函數(shù)且f(0,…,0)=0。

參考文獻(xiàn)[14]可得如下新型FD

(32)

式中,ζ1,ζ2,…,ζn為系統(tǒng)狀態(tài)變量；υ(t)為帶有噪聲的輸入信號(hào)；ζ1為去除噪聲后的跟蹤信號(hào)；ζi為υ(t)的第i-1階導(dǎo)數(shù)的估計(jì)值,i=2,3,…,n。R、χi(i=1,2,…,n)∈R+為待設(shè)計(jì)參數(shù)。則存在φ>0與ιφ>n使得

(33)

式中,O((1/R)ιφ-i+1)表示ζi與υ(i-1)(t)的近似程度是(1/R)ιφ-i+1階的,φ=(1-?)/?,?∈(0,min{ι/(ι+n),1/2}),n≥2。估計(jì)誤差為(1/R)ιφ-i+1的高階無窮小。

通過選取足夠大的設(shè)計(jì)參數(shù)R,估計(jì)誤差可以任意小。誤差有限時(shí)間收斂特性具體證明見文獻(xiàn)[18]。

3.2　基于FD的擴(kuò)張觀測器設(shè)計(jì)

(34)

(35)

根據(jù)式(31)、式(32)及式(34),可得擴(kuò)張后的系統(tǒng)為

(36)

根據(jù)擴(kuò)張觀測器(extended state observer,ESO)的設(shè)計(jì)原理可知,系統(tǒng)基于FD的ESO(ESO based on FD, FESO)為

(37)

式中,e為系統(tǒng)狀態(tài)量的觀測誤差;zi為FESO對(duì)系統(tǒng)狀態(tài)的觀測值,βi1、βi2、βi3、βi4為觀測增益;非線性函數(shù)fal(ei,αi,δi)是FESO的核心部分,它是連續(xù)非光滑的,對(duì)模型不確定性及外界干擾具有較強(qiáng)的適應(yīng)性,其表達(dá)式為

(38)

式中,αi=1/2n-1,δi=h,n為FESO的階數(shù),h為積分步長。由于FESO所涉及的參數(shù)較多,對(duì)其進(jìn)行穩(wěn)定性分析難度較大,為保證觀測誤差趨近于零,文獻(xiàn)[19-21]中擴(kuò)張觀測器參數(shù)大致取值為βi1=4ω、βi2=6ω2、βi3=4ω3、βi4=ω4。不確定項(xiàng)估計(jì)值可用atr⊥=r·z4(t)求出,從而達(dá)到對(duì)制導(dǎo)律進(jìn)行有效補(bǔ)償?shù)哪康摹?/p>

根據(jù)式(13),基于跟蹤微分濾波器ESO的有限時(shí)間收斂制導(dǎo)律表達(dá)式為

(39)

3.3　FESO估計(jì)結(jié)果

測量噪聲為均值為零、方差為1.7×10-4的高斯白噪聲,FESO的參數(shù)取值為R=60、χ1=15、χ2=1、h0=0.01 ms、δ=0.01、β01=100、β02=150、β03=300、β04=2 000、α1=0.9、α2=0.8、α3=0.7。仿真結(jié)果如圖2和圖3所示。

圖2　視線角速率濾波曲線 Fig2　LOS angular rate filtering curve

圖3　不確定項(xiàng)估計(jì)曲線 Fig3　Uncertainty estimates curve

由圖(2)可知，有限時(shí)間收斂微分具有良好的視線角濾波特性。圖(3)中的部分不確定性真值為Cf,雖然不能代表完全的不確定性,但在一定程度上可以看出不確定估計(jì)值與真值的關(guān)系,該值雖小,但它是控制量的分子,若與1/B1相乘,將會(huì)有很大程度增大。因此,基于有限時(shí)間收斂的微分濾波器FESO的有限時(shí)間具有良好的視線角速率濾波特性及不確定性補(bǔ)償能力。

4　仿真分析

圖4　彈目相對(duì)運(yùn)動(dòng)道曲線 Fig4　Target-missle trajectory curve

由圖4可知,無論目標(biāo)做哪種類型的機(jī)動(dòng),NFTG彈道相比于SMG、FTCG和文獻(xiàn)[6]中的彈道,在初始階段較為彎曲,但末端比較平直,這主要是因?yàn)镹FTG使角速率在有限時(shí)間內(nèi)收斂到零附近的鄰域的速度最快。彈目視線角速率曲線如圖5所示。導(dǎo)彈過載曲線如圖6所示。

圖5　LOS角速率曲線 Fig5　The LOS angular rate curve

圖6　導(dǎo)彈過載曲線

由圖6可知,NFTG和FTCG在視線角速率未達(dá)到有限時(shí)間收斂之前,相比于SMG導(dǎo)彈的過載比較大,但當(dāng)視線角速率達(dá)到有限時(shí)間收斂之后,NFTG和FTCG的過載明顯比SMG小,且由于NFTG收斂速度比FTCG更快,過載更小。從能量分配的角度解釋,為使導(dǎo)彈的某些狀態(tài),如視線角速率,在末制導(dǎo)初期便達(dá)到有限時(shí)間收斂,必然需要更大的過載,消耗更多的能量,但是一旦視線角速率達(dá)到有限時(shí)間收斂狀態(tài),控制量便會(huì)降低為很小值,這樣可使導(dǎo)彈在末制導(dǎo)初期充分利用機(jī)動(dòng)能力和能量,而在末端保證導(dǎo)彈的過載比較小,這無疑會(huì)提高導(dǎo)彈的制導(dǎo)精度和作戰(zhàn)性能,另外由于本文采取了二階滑?？刂品椒?相比于另外幾種方法,其過載抖振明顯減小,具有重要的工程應(yīng)用價(jià)值。由表1可直觀看到3種制導(dǎo)律具體的視線角速率收斂時(shí)間和平均脫靶量,無論導(dǎo)彈做什么樣的機(jī)動(dòng),FTCG和NFTG均能保證直接碰撞殺傷,而SMG面對(duì)方波機(jī)動(dòng)和正弦機(jī)動(dòng)出現(xiàn)了脫靶。

表1　蒙特卡羅仿真分析

5　結(jié)　論

針對(duì)高速機(jī)動(dòng)目標(biāo)攔截問題,基于終端滑模控制理論和二階滑?？刂评碚?設(shè)計(jì)了零化視線角速率的非奇異快速終端二階滑模制導(dǎo)律,并嚴(yán)格證明了系統(tǒng)的穩(wěn)定性和有限時(shí)間收斂特性;為抑制測量噪聲和估計(jì)彈目視線角速率,設(shè)計(jì)了新型有限時(shí)間收斂微分器,將其與擴(kuò)張觀測器結(jié)合來估計(jì)不確定項(xiàng)。仿真結(jié)果表明:所設(shè)計(jì)的微分器收斂速度快,估計(jì)精度高,且具有較強(qiáng)的抗干擾能力,目標(biāo)做不同類型機(jī)動(dòng)的情況下,所設(shè)計(jì)的制導(dǎo)律均能保證視線角速率在有限時(shí)間收斂,達(dá)到準(zhǔn)平行接近,且末端需用過載小,可實(shí)現(xiàn)直接碰撞殺傷。

參考文獻(xiàn)：

[1] 丁世宏, 李世華. 有限時(shí)間控制問題綜述[J].控制與決策, 2011, 26(2):161-169.

DING S H, LI S H. A survey for finite-time control problems[J].Control and Decision,2011, 26(2):161-169.

[2] SUN S, ZHOU D, HOU W T. A guidance law with finite time convergence accounting for autopilot lag[J]. Aerospace Science and Technology, 2013, 35(25): 132-137.

[3] ZHOU D, SUN S. Guidance laws with finite time convergence[J].Journal of Guidance,Control,and Dynamics,2009,32(6):1838-1846.

[4] SUN L H, WANG W H, YI R. A novel guidance law using fast terminal sliding mode control with impact angle constraints[J]. ISA Transaction, 2016,64(2):12-23.

[5] SONG J, SONG S, GUO Y, et al. Nonlinear disturbance observer-based fast Terminal sliding mode guidance law with impact angle constraints[J].International Journal of Innovative Computing, Information and Control, 2015,11(3):787-802.

[6] 朱戰(zhàn)霞, 韓沛, 陳鵬. 基于非線性終端滑模的動(dòng)能攔截器末制導(dǎo)律設(shè)計(jì)[J]. 西北工業(yè)大學(xué)學(xué)報(bào), 2013, 31(2): 233-238.

ZHU Z X,HAN P,CHEN P. Design of nonlinear terminal SMGL(sliding-mode guidance law) for KKV (kinetic kill vehicle)[J]. Journal of Northwestern Polytechnical University,2013,31(2):233-238.

[7] SONG J H, SONG M S, ZHOU H B. Adaptive nonsingular fast terminal sliding mode guidance law with impact angle constraints[J]. International Journal of Control, Automation and Systems, 2016, 14(2):99-114.

[8] 張旭,雷虎民,李炯.非奇異快速終端滑模有限時(shí)間收斂制導(dǎo)律[J].固體火箭技術(shù),2016,39(2):281-286.

ZHANG X, LEI H M, LI J. Nonsingular fast terminal sliding mode guidance law with finite-time convergence[J]. Journal of Solid Rocket Technology, 2016,39(2): 281-286.

[9] HE S M, WANG J, LIN D F. Composite guidance laws using higher order sliding mode differentiator and disturbance observer[J]. Journal of Aerospace Engineering, 2015, 229(13), 2397-2415.

[10] HE S M, LIN D F. Robust terminal angle constraint guidance law with autopilot lag for intercepting maneuvering targets[J]. Nonlinear Dynamic, 2015, 81(1/2):881-892.

[11] 王華吉,簡金蕾,雷虎民. 帶擴(kuò)張觀測器的新型滑模導(dǎo)引律[J].固體火箭技術(shù),2015,38(5):622-627.

WANG H J, JIAN J L, LEI H M. A new sliding mode guidance law based on extended state observer[J]. Journal of National University of Defense Technology,2015,38(5):622-627.

[12] ZHAO B, ZHOU J. Smooth adaptive finite time guidance law with impact angle constraints[J]. International Journal of Aerospace Engineering, 2016,2016(4):1-19.

[13] 張旭,雷虎民,李炯. 變論域模糊自適應(yīng)滑模有限時(shí)間收斂制導(dǎo)律[J].國防科技大學(xué)學(xué)報(bào),2015,37(2):149-155.

ZHANG X, LEI H M, LI J. Variable universe fuzzy adaptive sliding mode guidance law with finite time convergence[J].Journal of National University of Defense Technology, 2015, 37(2):149-155.

[14] WANG X H, CHEN Z Q, YANG G. Finite-time-convergent differentiator based on singular perturbation technique[J]. IEEE Trans.on Automatic Control, 2007, 52(9): 1731-1737.

[15] BU X W, WU X Y, ZHANG R, et al. Tracking differentiator design for the robust backstepping control of a flexible air-breathing hypersonic vehicle[J]. Journal of the Franklin Institute, 2015, 352(4): 1739-1765.

[16] ZHANG L,ZHANG Z, HUANG L. Hybrid non-linear diffe-rentiator design for a permanent-electro magnetic suspension maglev system[J]. IET Signal Process, 2012,6(6):559-567

[17] 卜祥偉,吳曉燕,馬震.改進(jìn)的反正切跟蹤微分器設(shè)計(jì)[J].上海交通大學(xué)學(xué)報(bào), 2015, 49(2): 164-168.

BU X W, WU X Y, MA Z, et al. Design of a modified arctangent-based tracking differentiator[J]. Journal of Shanghai Jiaotong University, 2015, 49(2): 164-168.

[18] WANG X H, CHEN Z Q, YANG G. Finite-time-convergent differentiator based on singular perturbation technique[J]. IEEE Trans.on Automatic Control, 2007,52(9):1731-1737.

[19] 韓京清.自抗擾控制技術(shù)[M].北京:國防工業(yè)出版社,2008.

HAN J Q. Active disturbance rejection control technique[M]. Beijing: National Defence Industry Press, 2008.

[20] 雷虎民.導(dǎo)彈制導(dǎo)與控制原理[M].北京:國防工業(yè)出版社,2009.

LEI H M. Theory of guidance and control for missile[M]. Beijing: National Defense Industry Press, 2009.

[21] 卜祥偉,吳曉燕,陳永興.非線性干擾觀測器的高超聲速飛行器自適應(yīng)反演控制[J].國防科技大學(xué)學(xué)報(bào),2014,36(5):44-49.

BU X W, WU X Y, CHEN Y X. Adaptive backstepping control of hypersonic vehicles based on nonlinear disturbance observer[J]. Journal of National University of Defense Technology, 2014, 36(5): 44-49.