溫求遒,劉大衛(wèi),夏群利,李然
(1.北京理工大學(xué)宇航學(xué)院,北京 100081;2.中國兵器科學(xué)研究院,北京 100089)
擴(kuò)展的多約束最優(yōu)制導(dǎo)律及其特性研究
溫求遒1,劉大衛(wèi)2,夏群利1,李然1
(1.北京理工大學(xué)宇航學(xué)院,北京 100081;2.中國兵器科學(xué)研究院,北京 100089)
為滿足侵徹攻擊空地導(dǎo)彈末端制導(dǎo)要求,解決當(dāng)前多約束制導(dǎo)律終端攻角控制問題,設(shè)計(jì)了包含受剩余飛行時間決定的控制量權(quán)函數(shù),并引入到最優(yōu)問題的目標(biāo)函數(shù)中,基于線性二次最優(yōu)控制理論推導(dǎo)得到一種擴(kuò)展的多約束最優(yōu)制導(dǎo)律。利用指令隨時間變化解析表達(dá)式及伴隨系數(shù)法,對制導(dǎo)律加速度指令變化規(guī)律及無量綱脫靶量特性進(jìn)行了研究,證明了制導(dǎo)律指令的收斂性,從而為終端攻角控制創(chuàng)造了有利條件。同時,討論了制導(dǎo)律增益n的設(shè)計(jì)原則。結(jié)合工程應(yīng)用的需要,分別提出了一種制導(dǎo)初始條件設(shè)計(jì)方法及最大需用加速度的估計(jì)方法,可有效減小導(dǎo)彈末端機(jī)動。通過仿真驗(yàn)證了制導(dǎo)律及分析結(jié)論的有效性。
控制科學(xué)與技術(shù);落角約束;最優(yōu)制導(dǎo)律;加速度指令;終端加速度
為了滿足對地下堅(jiān)固目標(biāo)打擊的需要,新一代空地制導(dǎo)武器廣泛采用侵徹戰(zhàn)斗部,要求制導(dǎo)控制系統(tǒng)不僅要達(dá)到一定的位置精度,且對終端入射角及攻角也提出了嚴(yán)格的約束[1]。傳統(tǒng)的比例導(dǎo)引(PN)已無法滿足制導(dǎo)任務(wù)的要求,需要發(fā)展多約束制導(dǎo)律。
終端角度約束制導(dǎo)律最初發(fā)展的典型代表為基于最優(yōu)控制理論推導(dǎo)的最優(yōu)制導(dǎo)律,其基本思想是將具有終端角度約束的制導(dǎo)問題轉(zhuǎn)化為含終端約束條件的最優(yōu)控制問題,后通過適當(dāng)?shù)募僭O(shè)和簡化得到顯式的制導(dǎo)方程[2-3]。其中Zarchan采用Schwartz不等式推導(dǎo)了包含落角約束的最優(yōu)制導(dǎo)律,并基于小角度假設(shè),進(jìn)一步轉(zhuǎn)換成彈道成型制導(dǎo)律(OGL/IAC)[3];Song等利用極大值原理推導(dǎo)出了以時間最短為性能指標(biāo)的最優(yōu)導(dǎo)引律[4-5]。
在最優(yōu)制導(dǎo)律取得新進(jìn)展的同時,一些學(xué)者還研究在經(jīng)典比例導(dǎo)引律基礎(chǔ)上增加偏置項(xiàng)的偏置比例導(dǎo)引律來實(shí)現(xiàn)角度控制。Kim等在導(dǎo)彈速度不變和目標(biāo)無機(jī)動的假設(shè)下,研究了具有時變偏差項(xiàng)的偏置比例導(dǎo)引律[6]。根據(jù)彈目相對運(yùn)動的數(shù)學(xué)規(guī)律,在線調(diào)整PN系數(shù),是實(shí)現(xiàn)終端角度約束的另一種思路。Lu等在2005年針對高超聲速飛行器發(fā)表了一種三維空間內(nèi)考慮落角和入射方位角約束的制導(dǎo)律[7]。
變系數(shù)比例導(dǎo)引律、偏置比例導(dǎo)引律和其他類型制導(dǎo)律雖然在理論上能夠滿足角約束制導(dǎo)問題,但存在制導(dǎo)律結(jié)構(gòu)復(fù)雜、制導(dǎo)信息種類和精度要求高等缺點(diǎn),使得其工程實(shí)現(xiàn)困難,與之相比,具有終端多約束的最優(yōu)制導(dǎo)律是目前研究最廣泛且工程應(yīng)用簡便可靠的制導(dǎo)方法,但該類制導(dǎo)律在推導(dǎo)過程中并未考慮到侵徹攻擊對終端攻角的約束,同時在縱向制導(dǎo)平面也未考慮重力的影響,因此并不能完全滿足侵徹攻擊空地導(dǎo)彈末端制導(dǎo)的要求。
為解決當(dāng)前多約束制導(dǎo)律終端攻角控制問題,本文首先以剩余飛行時間倒數(shù)的冪函數(shù)為控制量權(quán)系數(shù),建立新型目標(biāo)函數(shù),并在狀態(tài)方程建立時引入重力項(xiàng),得到了一種擴(kuò)展的多約束最優(yōu)制導(dǎo)律(EOGL/IAC)。該制導(dǎo)律在實(shí)現(xiàn)落點(diǎn)及落角控制的同時,通過在末端加入指令積分權(quán)函數(shù)及調(diào)整重力補(bǔ)償系數(shù)方式實(shí)現(xiàn)終端零加速度指令,為攻角控制創(chuàng)造了有利條件。在此基礎(chǔ)上,進(jìn)一步推導(dǎo)了制導(dǎo)律指令隨時間無量綱表達(dá)形式,并證明了制導(dǎo)律指令的終端收斂性及最大需用加速度對應(yīng)制導(dǎo)時刻。通過建立簡易制導(dǎo)模型及相應(yīng)伴隨分析系統(tǒng),分析了不同誤差源及制導(dǎo)律增益對脫靶量及終端加速度的影響,給出了制導(dǎo)律各項(xiàng)脫靶量收斂條件。結(jié)合工程應(yīng)用需求,給出了滿足最小機(jī)動要求的制導(dǎo)初始條件與最大需用加速度估計(jì)算法。最后通過非線性仿真證明了分析結(jié)論的有效性。
導(dǎo)彈制導(dǎo)問題的線性簡化模型如圖1所示。圖中:am為導(dǎo)彈加速度,ac為導(dǎo)彈加速度指令,g為重力加速度,at為目標(biāo)加速度。
圖1 制導(dǎo)律推導(dǎo)用模型Fig.1 Model for derivation of guidance law
對于靜止目標(biāo)有at=0,則圖1給出的模型可表示為如下狀態(tài)方程的形式:
為保證終端位置和角度均達(dá)到期望約束,可將終端角度約束轉(zhuǎn)化為法向速度約束,因此有期望的終端狀態(tài)式中:tgo為剩余飛行時間,tgo=tf-t,在實(shí)際工程中可以通過彈目相對距離與導(dǎo)彈速度計(jì)算得到。
(2)式為以導(dǎo)彈的位置相關(guān)狀態(tài)量、終端約束、重力加速度及剩余飛行時間表示的最優(yōu)制導(dǎo)律,但這些信息無法全部由導(dǎo)引頭等彈上硬件直接測量,從而限制了制導(dǎo)律的工程應(yīng)用性,因此需對制導(dǎo)律進(jìn)行進(jìn)一步的轉(zhuǎn)換。
假設(shè)視線角足夠小,則視線角及角速度存在如下近似關(guān)系:
n取不同值并帶入(4)式中,如表1所示給出的各項(xiàng)系數(shù)計(jì)算結(jié)果。
表1 不同n取值下對應(yīng)制導(dǎo)律系數(shù)Tab.1 The coefficients of guidance law for different values n
不難發(fā)現(xiàn),當(dāng)n=0時,制導(dǎo)律等同于OGL/IAC[3];由于Np與n成一次關(guān)系,而Nq與n成二次關(guān)系,因此隨著n的增加,落角項(xiàng)相對于PN項(xiàng)在制導(dǎo)指令中所占的比重不斷增大,如圖2所示。這將使導(dǎo)彈在制導(dǎo)初始段便以較大的加速度完成相對于期望落角方向的位置調(diào)整,同時也減小了終端需用加速度。
但是,較大的n值將使得制導(dǎo)權(quán)系數(shù)過大,降低了制導(dǎo)律對制導(dǎo)信號噪聲的魯棒性。由表1可見,當(dāng)n>1時,Np>6,已超過通常PN系數(shù)2~6的取值范圍[2]。
圖2 Np及Nq隨n變化曲線Fig.2 Npand Nqvs.n
2.1 指令變化規(guī)律
通常,導(dǎo)彈在彈目視線坐標(biāo)系下有初始位置y(0)=0,且在小角度假設(shè)下y·(0)=vrε0,y·(tf)= vrqf,將以上初值帶入(2)式中,制導(dǎo)指令可表示為由初始速度方向偏差ε0、終端落角約束qf及重力g三部分產(chǎn)生的指令和
2.1.1 初始加速度指令
由(7)式不難發(fā)現(xiàn),初始加速度與相對速度vr、落角約束qf及制導(dǎo)律增益n呈正比,而與制導(dǎo)時間tf呈反比。
2.1.2 終端加速度指令
由(8)式可見,當(dāng)n>0時,ac(tf)=0,制導(dǎo)律的末端指令總是收斂至 0;對OGL/IAC,對應(yīng)n=0,顯然僅當(dāng)kq=-2,終端指令才會為0,但對于侵徹制導(dǎo)武器,通常要求落角qf<-50°,因此滿足kq=-2的制導(dǎo)條件是很難構(gòu)成的。
2.1.3 最大加速度指令
導(dǎo)彈的最大可用加速度是有限的,因此總是希望最大加速指令盡可能小。同時如果最大需用加速度出現(xiàn)在初始時刻,則在末端將允許導(dǎo)彈有更多的可用加速度用于消除各種外界干擾及制導(dǎo)信號誤差,從而保證獲得更好的精度。
表2 不同kq取值下ac(t)變化特性Tab.2 The change characteristics of ac(t)for different values kq
以上分析表明,只要取足夠大的制導(dǎo)律增益,則制導(dǎo)律在制導(dǎo)初始時刻會出現(xiàn)最大需用加速度,并在制導(dǎo)終端收斂至0.
2.2 脫靶量變化規(guī)律
由于EOGL/IAC是包含終端位置和角度約束的最優(yōu)制導(dǎo)律,因此必須分別對其位置脫靶量及角度脫靶量進(jìn)行分析。
為了研究方便,將控制系統(tǒng)等效為一階動力學(xué)滯后環(huán)節(jié),如圖3所示給出了考慮動力學(xué)滯后環(huán)節(jié)的EOGL/IAC制導(dǎo)回路工作原理框圖。其中:Tg為導(dǎo)彈動力學(xué)時間常數(shù);Δy(tf)為位置脫靶量;Δq(tf)為角脫靶量。
圖3 制導(dǎo)律閉環(huán)原理框圖Fig.3 The functional block diagram of closed loop of guidance law
取Tg=0.3 s,tf=15 s,ε0=5°,qf=-50°,對于不同制導(dǎo)律增益n,如圖4所示給出了對應(yīng)彈體加速度曲線。隨著n值的增大,加速度在初始時刻值越大,而在終端的收斂速度越快。受到控制系統(tǒng)動力學(xué)滯后的影響,如圖5所示,僅當(dāng)n>0.5時才能保證終端加速度小于1個g.
圖4 不同n取值對應(yīng)過載變化曲線Fig.4 The acceleration curves of missile for different values n
為比較在不同干擾下制導(dǎo)律脫靶量變化情況,分別取初始速度指向誤差、終端落角約束、重力加速度干擾為系統(tǒng)主要誤差源,基于伴隨法的思想[3],圖6和圖7分別給出了無量綱位置脫靶量和角度脫靶量伴隨系統(tǒng)工作原理框圖,其中設(shè)無量綱參數(shù)t= t/Tg,=sTg.對應(yīng)不同誤差源,如圖8和圖9所示,分別給出了與之對應(yīng)的無量綱位置脫靶量、
圖5 不同n取值對應(yīng)終端過載值Fig.5 The terminal accelerations for different values n
圖6 位置脫靶量伴隨系統(tǒng)Fig.6 Position miss distance adjoint system
圖7 角度脫靶量伴隨系統(tǒng)Fig.7 Angle miss distance adjoint system
由圖8和圖9可見:
1)制導(dǎo)律無量綱位置脫靶量及角度脫靶量均隨著無量綱末導(dǎo)時間增大而收斂,保證位置及角度脫靶量為0的條件分別是末制導(dǎo)時間至少為控制系統(tǒng)動力學(xué)時間常數(shù)的14倍和16倍。
2)相比于PN(收斂條件為10倍動力學(xué)時間[3]),EOGL/IAC在使用上對制導(dǎo)時間有更為嚴(yán)格的要求。
圖8 不同T/Tg對應(yīng)無量綱位置脫靶量曲線Fig.8 Dimensionless position miss distance curvesfor T/Tg
3)n取值越大,2項(xiàng)脫靶量的相對收斂越慢,且收斂過程中脫靶量值越大,這表明提高制導(dǎo)律增益后,制導(dǎo)律在制導(dǎo)時間不足時魯棒性下降。
3.1 最優(yōu)制導(dǎo)初始條件計(jì)算
對于導(dǎo)彈制導(dǎo)控制系統(tǒng)設(shè)計(jì)者來說,總是希望控制導(dǎo)彈以最小的機(jī)動命中目標(biāo)并滿足各種約束。因此,設(shè)計(jì)一個合理的初始條件、盡量降低導(dǎo)彈的機(jī)動加速度需求具有十分重要的意義。
首先引入函數(shù)E,并有
圖9 不同T/Tg對應(yīng)無量綱角度脫靶量曲線Fig.9 Dimensionless angle miss distance curves forT/Tg
由(10)式可知,E表征了導(dǎo)彈在整個制導(dǎo)過程中消耗的能量。將(6)式帶入(10)式中,有
對于實(shí)際制導(dǎo)過程,如圖10給出的彈目相對幾何關(guān)系,有
式中:θ0為初始速度傾角;q*f為相對視線坐標(biāo)系的落角約束值;qLOS_0為初始彈目視線角。
圖10 彈目相對幾何關(guān)系Fig.10 Intercept geometry
將(14)式帶入(12)式中,并根據(jù)kq定義,可得
由(14)式,對于確定的末制導(dǎo)距離R0、導(dǎo)彈初始速度傾角θ0,即可確定轉(zhuǎn)入制導(dǎo)的最優(yōu)高度Hopt.
3.2 最大需用加速度估計(jì)
根據(jù)(12)式,對于不同的n值,基于最小機(jī)動條件,不難得到期望的kq值,通過對比由(9)式給出最大加速度判定區(qū)間,可知制導(dǎo)律的最大需用加速度必然出現(xiàn)在初始時刻。
考慮重力補(bǔ)償項(xiàng),則最大需用加速度可表示為
在給定氣動特性和飛行狀態(tài)下,在最大攻角限制條件下,導(dǎo)彈的最大可用加速度值不難得到。對比需用加速度與可用加速度值,即可快速判定當(dāng)前制導(dǎo)律增益、制導(dǎo)條件選擇是否合理,并進(jìn)行調(diào)整。
以某遠(yuǎn)程電視制導(dǎo)空地導(dǎo)彈為例[8],相關(guān)的制導(dǎo)初始條件及終端約束要求為:導(dǎo)彈飛行速度vm= 220 m/s,初始彈道傾角θ0=0°,初始彈道偏角ψv0= -2.5°,控制系統(tǒng)時間常數(shù)Tg=0.3 s,導(dǎo)引頭作用距離Rs=4 km,終端落角約束qf=-70°.
由于導(dǎo)彈在中制導(dǎo)段采用定高巡航飛行,因此可以根據(jù)要求爬升至一定的高度轉(zhuǎn)入末制導(dǎo),待導(dǎo)引頭捕獲目標(biāo)才轉(zhuǎn)入末制導(dǎo),從而為構(gòu)造最優(yōu)的初始條件創(chuàng)造了基礎(chǔ)。因此仿真中,制導(dǎo)的初始彈目距離可確定為R0=Rs.
側(cè)向制導(dǎo)采用標(biāo)準(zhǔn)的比例導(dǎo)引制導(dǎo)律。
由于導(dǎo)彈在進(jìn)入末制導(dǎo)階段采用定高平飛,對應(yīng)θ0=0°,則不難預(yù)估制導(dǎo)時間tf≈R0/vm,結(jié)合其他制導(dǎo)輸入?yún)?shù),帶入(14)式和(15)式中,可得制導(dǎo)初始高度及估計(jì)最大需用過載Hopt=1 902 m, acmax=1.45g.
為了便于對比,在初始彈目距離不變的前提下,將進(jìn)入高度分別取為2 500 m、1 500 m.如圖11和圖12所示,給出了彈道仿真結(jié)果。可見,制導(dǎo)律可保證導(dǎo)彈命中目標(biāo)并達(dá)到期望落角。且導(dǎo)彈加速度在末端能快速收斂并接近于0,為實(shí)現(xiàn)攻角約束創(chuàng)造了很好的條件。對比不同初始條件對應(yīng)仿真結(jié)果可見,采用最優(yōu)高度轉(zhuǎn)入末制導(dǎo)的彈道變化最平滑,且制導(dǎo)過程消耗能量明顯小于其他條件。對制導(dǎo)最大需用加速度的估計(jì)與對應(yīng)實(shí)際仿真結(jié)果符合,從而證明了估計(jì)算法的準(zhǔn)確性。
圖11 縱向彈道曲線Fig.11 Vertical trajectory curves of missile
圖12 導(dǎo)彈機(jī)動過載曲線Fig.12 Acceleration curves of missile
為進(jìn)一步驗(yàn)證制導(dǎo)律的魯棒性,采用白噪聲的形式,引入兩通道制導(dǎo)指令噪聲及剩余飛行時間解算誤差,并取方差σΔayc=σΔazc=0.15g,σΔtgo=0.5 s.
采用蒙特卡洛仿真,取仿真次數(shù)為500.如圖13~圖15所示,給出了對應(yīng)落點(diǎn)、終端落角及彈體加速度散布情況。不難看出,制導(dǎo)律在存在制導(dǎo)信息噪聲情況下依然很好地滿足各項(xiàng)終端約束要求。
圖13 落點(diǎn)散布曲線Fig.13 Dispersion of terminal impact points
圖14 終端落角散布曲線Fig.14 Dispersion of terminal impact angles
圖15 終端彈體加速度散布曲線Fig.15 Terminal acceleration of missile dispersion
針對導(dǎo)彈終端位置與落角約束制導(dǎo)問題,推導(dǎo)得到一種擴(kuò)展的多約束最優(yōu)制導(dǎo)律,研究了制導(dǎo)律指令變化規(guī)律及無量綱脫靶量特性,給出了制導(dǎo)律增益n的設(shè)計(jì)原則。通過理論分析與數(shù)學(xué)仿真,得出如下結(jié)論:
1)擴(kuò)展的大落角制導(dǎo)律能同時滿足終端位置及角度約束條件,當(dāng)n>0時,制導(dǎo)律終端加速度指令能收斂至0,有利于末端小攻角約束的實(shí)現(xiàn)。同時對多數(shù)制導(dǎo)條件,制導(dǎo)律的最大需用加速度出現(xiàn)在初始時刻,有利于提高命中精度。
2)制導(dǎo)律位置及角度脫靶量均收斂至0的條件是末制導(dǎo)時間至少應(yīng)大于16倍控制回路動力學(xué)時間常數(shù),因此大落角制導(dǎo)律使用的條件需保證足夠的末制導(dǎo)距離。
3)系數(shù)n的取值對制導(dǎo)律性能影響較大,當(dāng)n取值偏小時,加速度指令末端收斂速度變慢;而n取值偏大時,制導(dǎo)律對各種干擾的魯棒性下降,位置及角度脫靶量增大,因此建議n取值在0.5~1.0之間。
4)在已知末制導(dǎo)距離、期望落角及初始速度傾角條件下,給出了使導(dǎo)彈制導(dǎo)過程中機(jī)動最小制導(dǎo)初始條件計(jì)算方法及最大需用加速度估計(jì)策略,對制導(dǎo)律的工程化應(yīng)用具有重要的意義。
References)
[1] 蔡洪,胡正東,曹淵.具有終端角度約束的導(dǎo)引律綜述[J].宇航學(xué)報(bào),2010,31(2):315-323.
CAI Hong,HU Zheng-dong,CAO Yuan.A survey of guidance law with terminal impacts angle constraints[J].Journal of Astronautics,2010,31(2):315-323.(in Chinese)
[2] 劉大衛(wèi),夏群利,崔瑩瑩,等.具有終端位置和角度約束的廣義彈道成型制導(dǎo)律[J].北京理工大學(xué)學(xué)報(bào),2011,31(12): 1408-1413.
LIU Da-wei,XIA Qun-li,CUI Ying-ying,et al.Generalized trajectory shaping guidance law with both impact position and angle constrains[J].Transactions of Beijing Institute of Technology,2011, 31(12):1408-1413.(in Chinese)
[3] Zarchan P.Tactical and strategic missile guidance[M].Reston: American Institute of Aeronautics and Astronautics,1997.
[4] Song T L,Shin S J,Cho H.Impact angle control for planar engagements[J].IEEE Transactions on Aerospace and Electronic Systems,1999,35(4):1439-1444.
[5] Song T L,Shin S J.Time-optimal impact angle control for vertical plane engagements[J].IEEE Transactions on Aerospace and Electronic Systems,1999,35(2):738-742.
[6] Kim B S,Lee J G,Han H S.Biased PNG law for impact with angular constrain[J].IEEE Transactions on Aerospace and Electronic Systems,1998,34(1):277-288.
[7] Lu P,Doman D B,Schierman J D.Adaptive terminal guidance for hypervelocity impact in specified direction[J].Journal of Guidance,Control,and Dynamics,2006,29(2):269-278.
[8] 溫求遒,夏群利,祁載康.圖像制導(dǎo)空地導(dǎo)彈攻頂彈道方案研究[J].彈箭與制導(dǎo)學(xué)報(bào),2010,30(3):8-10.
WEN Qiu-qiu,XIA Qun-li,QI Zai-kang.Research of trajectory scheme with large impact angle for imaging guided AGM[J].Journal of Projectiles,Rockets,Missile and Guidance,2010,30(3): 8-10.(in Chinese)
Research on an Extended Optimal Guidance Law with Multiple Constraints
WEN Qiu-qiu1,LIU Da-wei2,XIA Qun-li1,LI Ran1
(1.School of Aerospace Engineering,Beijing Institute of Technology,Beijing 100081,China;
2.Ordnance Science and Research Academy of China,Beijing 100089,China)
An extended optimal guidance law with terminal miss distance and impact angle constrains is derived.The guidance law is obtained as the solution of a linear quadratic optimal control problem with the goal function weighted by a power of the time-to-go.Based on the analytical expression for the change of guidance command with time and the adjoint system analysis method,the command characteristics and dimensionless miss distance of guidance law are analyzed.The result shows that the acceleration command of guidance law can be converged into zero in the final time of guidance,which may create a good situation for terminal angle of attack control.A design principle for selection of guidance law gain is discussed.Finally,according to the requirements of engineering application,the methods on calculating the guidance initial condition and maximal required acceleration are given.The effectiveness and practicality of the guidance law are demonstrated through simulation.
control science and technology;impact angle constraint;optimal guidance law;acceleration command;terminal acceleration
V488.133
:A
1000-1093(2014)05-0662-08
10.3969/j.issn.1000-1093.2014.05.013
2013-08-06
中國博士后科學(xué)基金一等項(xiàng)目(2008M00006);中國博士后科學(xué)基金特別項(xiàng)目(2012T50048)
溫求遒(1982—),男,講師,博士后。E-mail:wenqiuqiu82@gmail.com;
夏群利(1971—),男,副教授。E-mail:1010@bit.edu.cn