郭 杰，宋滿金，柳 青，唐勝景

(1. 北京理工大學(xué)宇航學(xué)院，北京 100081；2. 北京空天技術(shù)研究所，北京 100074)

0 引 言

隨著助推-吸氣式高超聲速飛行器朝著多任務(wù)、多約束的方向發(fā)展[1-2],面對復(fù)雜終端約束的大氣層內(nèi)上升段精確制導(dǎo)是目前研究的重點(diǎn)。為了保障助推器與載荷分離時的交班點(diǎn)約束,飛行器需要在上升過程中下壓彈道飛行,并在彈道終端實(shí)現(xiàn)轉(zhuǎn)平,該低彈道轉(zhuǎn)平特性會導(dǎo)致較大的軸向過載。此外,為了滿足載荷后續(xù)飛行條件,上升段終端攻角和動壓需保持在一定約束范圍內(nèi)。而大氣層內(nèi)上升段存在高度較低、氣動擾動較大、動壓變化劇烈等問題,極易導(dǎo)致軌跡偏移、抖動甚至發(fā)散,給制導(dǎo)帶來巨大挑戰(zhàn)。

針對運(yùn)載器上升段制導(dǎo)問題,學(xué)者們已經(jīng)進(jìn)行了相關(guān)研究。攝動制導(dǎo)[3]是一類被廣泛應(yīng)用的標(biāo)稱軌跡制導(dǎo)方法,通過將實(shí)際彈道在標(biāo)準(zhǔn)彈道附近泰勒展開,控制目標(biāo)量與理論值的偏差為零,實(shí)現(xiàn)約束滿足,但該方法依賴標(biāo)稱軌跡,適應(yīng)能力和魯棒性較差[4]。為了提高自主性和制導(dǎo)精度,迭代制導(dǎo)、凸優(yōu)化制導(dǎo)和能量管理等自適應(yīng)制導(dǎo)方法陸續(xù)被提出。呂新廣等[5]、韓雪穎等[6]提出了能夠約束終端入軌姿態(tài)的迭代制導(dǎo)方法;王洪波等[7]基于改進(jìn)的序列凸優(yōu)化設(shè)計了固體火箭入軌制導(dǎo)方法,有較高的求解效率;Patha等[8]提出一種交變姿態(tài)控制的能量管理方法,陳喆等[9]、陳思遠(yuǎn)等[10]對能量管理方法進(jìn)行完善,實(shí)現(xiàn)了終端姿態(tài)約束;張遷等[11-12]在傳統(tǒng)速度管控模型的基礎(chǔ)上引入定點(diǎn)制導(dǎo)算法,有效提高了入軌精度。上述自適應(yīng)算法能夠根據(jù)飛行器當(dāng)前狀態(tài)在線計算制導(dǎo)指令,提高運(yùn)載器的自主飛行能力。然而,上述方法在進(jìn)行建模時或不考慮氣動力影響,或在推導(dǎo)過程中對氣動力進(jìn)行簡化,大多適用于高海拔大氣稀薄的飛行階段,在低海拔氣動不確定情況下會有較大偏差。

對于大氣層內(nèi)上升段制導(dǎo)方法,除已經(jīng)實(shí)際應(yīng)用的標(biāo)稱軌跡跟蹤制導(dǎo)外,國內(nèi)外學(xué)者主要集中在基于最優(yōu)控制理論的運(yùn)載器大氣層內(nèi)軌跡在線規(guī)劃與閉環(huán)制導(dǎo)的研究上,其求解思路分為間接法與直接法。間接法將最優(yōu)軌跡上升問題轉(zhuǎn)化為兩點(diǎn)邊值問題進(jìn)行求解[13-15],但存在推導(dǎo)繁瑣、收斂半徑小和對初值敏感等不足,且應(yīng)用在運(yùn)載器指數(shù)攻角轉(zhuǎn)彎后的飛行階段。直接法將最優(yōu)軌跡規(guī)劃問題轉(zhuǎn)化為有限維參數(shù)優(yōu)化問題,離散狀態(tài)量或控制變量,利用數(shù)值計算方法進(jìn)行軌跡規(guī)劃,避免了大量的過程推導(dǎo)。崔乃剛等[16]采用兩步梯度投影算法(MGPA)非線性規(guī)劃方法進(jìn)行在線軌跡規(guī)劃,并應(yīng)用基于線性二次型調(diào)節(jié)器(LQR)的閉環(huán)制導(dǎo)方法實(shí)現(xiàn)軌跡跟蹤;賀前偉等[17]提出一種基于模型預(yù)測靜態(tài)規(guī)劃算法的自適應(yīng)制導(dǎo)方法,實(shí)現(xiàn)不確定情況下的末段狀態(tài)高精度制導(dǎo)。隨著凸優(yōu)化理論日漸完善,其也被應(yīng)用于大氣內(nèi)上升段制導(dǎo),郝澤明等[18]針對固體火箭上升段實(shí)時軌跡優(yōu)化問題,提出一種基于鄰近-牛頓-康托維奇凸規(guī)劃的軌跡優(yōu)化方法,用內(nèi)點(diǎn)法求解二階錐規(guī)劃問題,保障軌跡優(yōu)化實(shí)時性。在智能方法方面,何潤林[19]用粒子群優(yōu)化(PSO)算法對射角、全程攻角進(jìn)行優(yōu)化,并設(shè)計了自適應(yīng)動態(tài)逆制導(dǎo)策略;周宏宇等[20]提出一種全新的飛行剖面,使用改進(jìn)PSO求解剖面參數(shù),并引入強(qiáng)化學(xué)習(xí)機(jī)制提高求解效率。上述基于數(shù)值求解的優(yōu)化算法雖能夠求得最優(yōu)或次優(yōu)軌跡,但一般求解參數(shù)較多,且存在求解精度與計算效率的矛盾,在線應(yīng)用困難。

綜上所述,對于上升段制導(dǎo)問題已有較多研究,但存在以下不足:部分方法可以對終端姿態(tài)進(jìn)行約束或能夠在線應(yīng)用,但是不適用于稠密大氣層內(nèi)制導(dǎo);或者能夠通過優(yōu)化的方法求解大氣層內(nèi)上升段最優(yōu)軌跡或制導(dǎo)指令,但在線應(yīng)用困難。本文針對固體助推器大氣層內(nèi)上升段制導(dǎo)問題,考慮推力不可調(diào)和耗盡關(guān)機(jī)特性,重點(diǎn)研究了制導(dǎo)指令設(shè)計與終端姿態(tài)約束問題,提出一種閉環(huán)制導(dǎo)方法。設(shè)計了解析形式的俯仰角剖面,能夠更新剖面約束、精確控制終端攻角,且只需通過數(shù)值方法校正兩個剖面參數(shù)即可更新整個剖面并直接獲得控制量,有效提高在線計算效率;采用在線更新策略,根據(jù)飛行器當(dāng)前狀態(tài)與目標(biāo)位置實(shí)時更新下一制導(dǎo)時刻俯仰角指令,能夠在氣動參數(shù)不確定情況下有較好的魯棒性。與傳統(tǒng)方法相比,該閉環(huán)制導(dǎo)方法在大氣層內(nèi)具有較高的制導(dǎo)精度,且具有工程應(yīng)用潛力。

本文結(jié)構(gòu)如下:首先,設(shè)計了一種多項(xiàng)式形式的俯仰角剖面,通過合理地選擇剖面終端值保證了終端攻角約束。然后,以數(shù)值算法校正俯仰角剖面參數(shù)保證高度和彈道傾角約束,同時設(shè)計剖面在線更新流程。最后,進(jìn)行仿真分析驗(yàn)證該方法的制導(dǎo)精度與魯棒性。

1 上升段數(shù)學(xué)模型

1.1 運(yùn)動模型

本文研究固體助推器大氣層內(nèi)上升段制導(dǎo)問題,整個上升過程高度較低、耗時較短,可忽略地球自轉(zhuǎn),基于“瞬時平衡”假設(shè),只考慮縱向平面運(yùn)動,得到飛行器在速度坐標(biāo)系下的質(zhì)心運(yùn)動方程為:

(1)

式中:r為位置;G為重力;T為推力;L為升力;D為阻力;m為質(zhì)量;mc為秒耗量。

運(yùn)動方程的控制量為攻角α。重力、推力、升力和阻力可以寫為飛行時間、位置、速度和攻角α的函數(shù)。其中,重力表達(dá)式為

(2)

式中:μ為地球引力常數(shù);R為地心到初始發(fā)射位置的矢量。

推力表達(dá)式為

T=T(t)Γ(α)Iv

(3)

式中:T為推力幅值;Γ(x)為旋轉(zhuǎn)矩陣;Iv為速度的單位矢量,表達(dá)式為

(4)

式中:v為速度矢量。Γ(x)表達(dá)式如下:

(5)

升力和阻力表達(dá)式為

(6)

式中:L,D分別為升力幅值和阻力幅值,表達(dá)式如下:

(7)

式中:ρ為大氣密度;V為速度幅值;S為飛行器參考面積;Ma為馬赫數(shù);CL,CD分別為升力系數(shù)和阻力系數(shù),是馬赫數(shù)和攻角的函數(shù),表達(dá)式如下:

(8)

1.2 約束條件

大氣層內(nèi)上升段氣動環(huán)境復(fù)雜,大氣密度隨高度變化范圍大,對流層和同溫層以內(nèi)大氣密度變化超過40倍;且助推段馬赫數(shù)變化劇烈,經(jīng)歷亞聲速、跨聲速、超聲速甚至高超聲速等階段,為了保證飛行器飛行安全與結(jié)構(gòu)完整性,飛行器大氣層內(nèi)上升段需要滿足一定的過程約束。此外,飛行器在助推器關(guān)機(jī)時需要滿足交班點(diǎn)條件等任務(wù)要求,因此還需滿足一定的終端約束。

(1)過程約束

考慮飛行器結(jié)構(gòu)強(qiáng)度和安全等因素,飛行過程中需要考慮過載約束:

(9)

式中:nx,ny分別為彈體坐標(biāo)系下的軸向過載和法向過載;G為飛行器重量。

(2)終端約束

從飛行器的飛行任務(wù)考慮,助推段終端需要滿足高度約束和彈道傾角約束。同時為了滿足載荷后續(xù)工作條件,還需要終端攻角、馬赫數(shù)-動壓保持在一定窗口約束范圍內(nèi),綜上可得終端約束如下:

(10)

式中:h為飛行器高度;θ為彈道傾角;tf為終端時間;q為動壓,qfmin和qfmax分別為動壓窗口的下界與上界。

(3)約束轉(zhuǎn)化

助推器上升過程中,法向過載大小決定著細(xì)長軸體所受彎矩大小,過大會導(dǎo)致軸體斷裂,造成嚴(yán)重后果,因此法向過載是重點(diǎn)關(guān)注的約束量。由式(7)和式(9)可得:

(11)

定義CLcosα+CDsinα為“過載系數(shù)”,式(11)可寫為

(12)

上升段為一壓低彈道的過程,在大動壓段攻角基本為負(fù)值,且過載系數(shù)是速度和攻角的函數(shù),其變化規(guī)律如圖1所示,表明在一定范圍內(nèi),過載系數(shù)與速度和攻角呈現(xiàn)單調(diào)函數(shù)關(guān)系。在速度一定時,過載系數(shù)絕對值與攻角絕對值正相關(guān),因此可通過限制攻角大小來滿足法向過載約束。

圖1 過載系數(shù)與速度和攻角的關(guān)系

在飛行器實(shí)際飛行過程中,已知當(dāng)前高度H和速度V,可通過求解式(13)得到滿足約束的當(dāng)前最小攻角值。

(13)

若當(dāng)前α不滿足幅值約束,則通過式(14)進(jìn)行限幅處理

(14)

式中:αt為實(shí)際攻角值;αmin為當(dāng)前滿足約束的攻角最小值。

2 上升段閉環(huán)制導(dǎo)方法

2.1 控制量選擇

由固體助推飛行器的動力學(xué)方程可知,攻角和俯仰角都可作為飛行控制量,因此需要從數(shù)值計算的角度分析攻角和俯仰角對飛行軌跡的影響能力,確定剖面選擇[21]。

圖2為攻角改變時飛行器體軸以及軌跡改變情況示意圖,攻角從α1改變到α2,彈道傾角從θ1改變到θ2。除飛行器體軸改變造成的正增量Δα2外,還有速度方向改變產(chǎn)生的攻角負(fù)增量Δα1;圖3為俯仰角改變時飛行器體軸以及軌跡改變情況示意圖,俯仰角從φ1改變到φ2,彈道傾角同樣從θ1改變到θ2,但是過程中只有體軸變化產(chǎn)生的俯仰角正增量Δφ。

圖2 攻角改變時軌跡變化

圖3 俯仰角改變時軌跡變化

2.2 飛行剖面設(shè)計

基于上節(jié)分析,對于大氣層內(nèi)上升段制導(dǎo),考慮大氣密度分布特點(diǎn)和飛行器速度規(guī)律,本文設(shè)計了如下分段多項(xiàng)式形式的俯仰角剖面:

(15)

式中:ki(i=1,2,3,4)分別為3次多項(xiàng)式系數(shù);t1為垂直上升段結(jié)束時間;tf為飛行總時間,剖面形狀如圖4所示。確定式(15)中的3次多項(xiàng)式系數(shù)需要4組(t,φ)形式的約束條件,其求解方法如下。

圖4 俯仰角剖面

初始上升段中,t1可通過人為選擇給定,考慮到飛行器發(fā)射高度低,大氣密度大,初始飛行階段處于大氣稠密區(qū),氣動力和推力之間存在較強(qiáng)耦合,選擇合適的t1可以使飛行器在跨聲速之后進(jìn)行轉(zhuǎn)彎,避免受到較大的氣動載荷和氣動擾動,降低載荷、控制系統(tǒng)設(shè)計難度。根據(jù)上升段姿態(tài)角關(guān)系φ=α+θ,可通過終端彈道傾角約束與終端攻角約束得到終端俯仰角大小:

(16)

設(shè)θ′f為上一制導(dǎo)周期預(yù)測得到的終端彈道傾角值,則θ′f會隨著制導(dǎo)進(jìn)程逐漸接近實(shí)際彈道傾角終端值θf,因此可在第一個制導(dǎo)周期內(nèi)采用式(16)計算剖面終端值,后續(xù)采用下式更新剖面終端值,實(shí)現(xiàn)Δθf的誤差消除:

φ(tf)=θ′f+(αfmin+αfmax)/2

(17)

綜上,可得到兩組約束條件:(t1,π/2)、(tf,φ(tf))。

另外兩組約束條件通過設(shè)計剖面參數(shù)獲得。在上述分析的基礎(chǔ)上,增加(t2,φ2)、(t3,φ3)兩個控制點(diǎn)。其中t2,t3為人為給定的時間節(jié)點(diǎn),且滿足t1≤t2≤t3≤tf;φ2,φ3為2個待設(shè)計剖面參數(shù)。一旦確定φ2與φ3,則可得到如下方程組:

(18)

求解式(18)即可得到式(15)中的3次多項(xiàng)式系數(shù),進(jìn)而確定整個俯仰角剖面。該剖面分為兩段,其中第一段常值俯仰角用于將飛行器渡過跨聲速階段;第二段多項(xiàng)式形式俯仰角充分利用飛行器性能,進(jìn)行轉(zhuǎn)彎以及調(diào)整飛行狀態(tài)來滿足終端約束。

對于t2,t3的選擇,理論上只要滿足t2≠t3的條件,就能夠求解式(18)得到完整的俯仰角剖面。但若|t2-t3|在數(shù)值上過小,求解過程中可能會出現(xiàn)矩陣奇異現(xiàn)象,導(dǎo)致無解;同理,|t1-t2|和|t3-tf|的值也不能過小。因此,本文選擇t2,t3的策略如下:

(19)

2.3 剖面參數(shù)更新策略

傳統(tǒng)基于在線軌跡規(guī)劃的閉環(huán)制導(dǎo)思路為:在飛行過程中根據(jù)當(dāng)前狀態(tài)和終端約束規(guī)劃軌跡,將軌跡設(shè)計由離線過程變?yōu)樵诰€過程,并設(shè)計制導(dǎo)律對軌跡進(jìn)行跟蹤[22]。這類方法在實(shí)際應(yīng)用中需要合理選擇軌跡規(guī)劃周期與制導(dǎo)周期,才能兼顧計算效率與制導(dǎo)精度。本文所設(shè)計的俯仰角剖面為解析形式,且完全由2個剖面參數(shù)(φ2,φ3)確定,并且實(shí)際飛行中飛行器可直接根據(jù)剖面得到制導(dǎo)指令,即將閉環(huán)制導(dǎo)問題轉(zhuǎn)化為剖面參數(shù)(φ2,φ3)的搜索問題,大幅提高求解效率。

在每個制導(dǎo)周期內(nèi),給定初始剖面參數(shù)(φ2,φ3),求解得到完整的俯仰角剖面;以當(dāng)前狀態(tài)為初始狀態(tài),積分式(1)得到終端狀態(tài),從而得到終端高度h(tf)和終端彈道傾角θ(tf)。由于(φ2,φ3)決定了整個俯仰角剖面,也即決定了終端高度與終端彈道傾角,因此可以利用二元非線性方程組求根的牛頓迭代法搜索得到滿足終端約束的剖面參數(shù)。

在當(dāng)前時刻與終端時刻確定的情況下,終端高度和終端彈道傾角是兩個剖面參數(shù)(φ2,φ3)的函數(shù):

(20)

本文在每個制導(dǎo)周期內(nèi),以高度、彈道傾角雙約束,基于俯仰角剖面同時對兩個剖面參數(shù)進(jìn)行校正:

(21)

式中:hf為期望終端高度,θf為期望終端彈道傾角,二者可由終端約束得到。上述兩個變量在每個制導(dǎo)周期內(nèi)均為已知量,則方程組式(21)可化為關(guān)于俯仰角參數(shù)(φ2,φ3)的二元非線性方程組:

(22)

式中:F(φ2,φ3)=h(tf)-hf,G(φ2,φ3)=θ(tf)-θf。利用牛頓迭代法可快速求解上式,且能得到收斂解[23-24]：

(23)

式中:F,G分別為式(22)中F(φ2,φ3),G(φ2,φ3)函數(shù);φ2,i和φ3,i為第i次迭代時的φ2,φ3值;F′φ2,F′φ3,G′φ2,G′φ3為F,G函數(shù)分別對φ2,φ3的偏導(dǎo)數(shù)。

考慮到非線性函數(shù)的復(fù)雜性,無法直接求得準(zhǔn)確的偏導(dǎo)數(shù)表達(dá)式,本文采用有限差分法近似得到偏導(dǎo)數(shù)值,且精度滿足如下要求。

(24)

式中:Δ為一大于0的小量。實(shí)際計算過程中,通過式(23)得到下一次迭代的φ2,φ3值,重復(fù)迭代直至F<ε1且G<ε2,即可得到滿足精度要求的φ2,φ3解。ε1,ε2為可接受的終端高度與終端彈道傾角誤差。若在飛行過程中因參數(shù)擾動過大,或因控制量限幅導(dǎo)致后續(xù)制導(dǎo)周期得到不滿足精度的解,此時取目標(biāo)函數(shù):

(25)

利用參數(shù)優(yōu)化的牛頓迭代法可快速求解使目標(biāo)函數(shù)式(25)最小的剖面參數(shù)[25]：

(26)

(27)

式中:a1,a2,a3,b1和b2為濾波器待定參數(shù)。式(27)的時域表達(dá)式如下:

(28)

式中:x(t)為輸入信號;y(t)為輸出信號。將上式轉(zhuǎn)換成對應(yīng)的離散域差分方程,并將時域離散信號轉(zhuǎn)變?yōu)樾蛄行盘柨傻?

y(n)=λ1x(n)+λ2x(n-1)+λ3x(n-2)+

λ4y(n-1)+λ5y(n-2)

(29)

式中:λi(i=1,2,3,4,5)為相應(yīng)的系數(shù),表達(dá)式如下:

(30)

式中:Ts為采樣周期。使用式(29)對所求得的俯仰角進(jìn)行濾波,最終可以得到平滑的制導(dǎo)指令。整個基于俯仰角剖面更新的閉環(huán)制導(dǎo)算法總體流程如圖5所示。

圖5 閉環(huán)制導(dǎo)方法流程

在制導(dǎo)過程中,為了提高預(yù)測環(huán)節(jié)計算效率,減少對箭上計算能力的占用,前期可采用定步數(shù)積分,積分步長Δh取(tf-t)/N,t為當(dāng)前時刻,N為積分總步數(shù),可取200;當(dāng)后期Δh減小到與制導(dǎo)周期一致時,保持不變。另外,為減少剖面更新迭代次數(shù),可取上一制導(dǎo)周期剖面參數(shù)作為迭代初值,提高搜索效率;還可以在上升段前期多個制導(dǎo)周期更新一次俯仰角剖面。隨著飛行時間增加,剖面更新耗時減少,可減少為每個制導(dǎo)周期內(nèi)更新一次剖面。本文采取剖面更新頻率如下:

(31)

上式表示κ個制導(dǎo)周期更新一次剖面參數(shù)。

上述基于俯仰角剖面參數(shù)更新的閉環(huán)制導(dǎo)核心思路是將牛頓迭代與剖面設(shè)計相結(jié)合,將每個制導(dǎo)周期內(nèi)制導(dǎo)指令求解轉(zhuǎn)化為終端高度、終端彈道傾角雙約束的雙剖面參數(shù)搜索問題。這種思路還可以適用于離線軌跡規(guī)劃,既可基于攻角-時間剖面,也可基于俯仰角-高度剖面,甚至基于俯仰角-速度剖面進(jìn)行設(shè)計。剖面參數(shù)也可以選擇任意兩個同時影響整個剖面形狀的參數(shù)。

3 仿真校驗(yàn)

以固體火箭助推飛行器為研究對象,地球半徑取6 371 km;地球引力常數(shù)μ取3.986 005×1014m3/s2;g為重力加速度;聲速模型采用美國標(biāo)準(zhǔn)大氣1976,在50 km以下具有較高的擬合精度。

飛行器總飛行時間為90 s;垂直上升段時間t1取20 s;初始質(zhì)量m0為4 150 kg;秒耗量mc為30 kg/s;推力幅值T為95 kN;參考面積S為0.8 m2;制導(dǎo)周期取0.1 s;初始剖面參數(shù)的迭代初值由線性插值得到,φ2取60°,φ3取30°;濾波器參數(shù)a1,a2,a3,b1和b2分別取0.1, 0.2, 1, 1, 1.4,采樣周期Ts取0.1 s。

以飛行器出發(fā)射筒時狀態(tài)作為初始狀態(tài),如表1所示;發(fā)動機(jī)關(guān)機(jī)時飛行器需處于轉(zhuǎn)平狀態(tài),終端狀態(tài)約束如表2所示。過載約束為:軸向過載最大值nxmax為3;法向過載最大值nymax為2。

表1 初始狀態(tài)

表2 終端狀態(tài)

設(shè)置3組仿真條件:第1組為標(biāo)準(zhǔn)條件;第2組為大氣密度、升力系數(shù)和阻力系數(shù)各拉偏-10%,推力拉偏-5%,質(zhì)量秒耗量拉偏-2%;第3組為大氣密度、升力系數(shù)和阻力系數(shù)各拉偏+10%,推力拉偏+5%,質(zhì)量秒耗量拉偏+2%。

本文數(shù)值計算在Intel i5 3.10 GHz臺式機(jī)電腦下進(jìn)行,程序均在MATLAB 2020b環(huán)境下編譯運(yùn)行。

3.1 濾波效果分析

為驗(yàn)證本文所提出的閉環(huán)制導(dǎo)方法中的濾波效果,分別進(jìn)行有濾波器和無濾波器的對比仿真。第3組條件下仿真曲線如圖6所示,所有組仿真結(jié)果見表3。

表3 濾波前后仿真結(jié)果

圖6 濾波前后對比仿真曲線

由表3可知,濾波器使用前后,飛行器終端狀態(tài)接近且均具有較高精度,而由圖6中(a)、(b)可知,濾波器使用前,俯仰角和攻角出現(xiàn)震蕩現(xiàn)象,這是因?yàn)樵诟蓴_條件下,為保證終端精度,相鄰兩次剖面更新所得的俯仰角剖面存在差異,導(dǎo)致時序制導(dǎo)指令產(chǎn)生波動。加入濾波器后,俯仰角和攻角較為平滑,符合實(shí)際飛行需求。

3.2 對比仿真分析

為驗(yàn)證本文所提方法的有效性,選取基于導(dǎo)引系數(shù)快速求取的攝動制導(dǎo)[3]、基于PD的最優(yōu)軌跡跟蹤[26]和本文閉環(huán)制導(dǎo)3種制導(dǎo)方法進(jìn)行仿真對比。其中最優(yōu)軌跡以終端速度最大作為目標(biāo)函數(shù),通過Gauss偽譜+序列二次規(guī)劃(SQP)方法在標(biāo)準(zhǔn)條件下離線規(guī)劃。第3組條件下仿真曲線如圖7所示,所有組仿真結(jié)果見表4。

表4 不同仿真條件下的仿真結(jié)果

圖7 第3組拉偏情況下仿真曲線

由表4中3組仿真結(jié)果的高度誤差可知,3種制導(dǎo)方法在標(biāo)準(zhǔn)狀況下均有較高精度,但在干擾較大的情況下,基于導(dǎo)引系數(shù)快速求取的攝動制導(dǎo)高度誤差接近80 m,說明簡化氣動力的該方法不適用于大氣層內(nèi)上升段制導(dǎo)?；赑D的最優(yōu)軌跡跟蹤和閉環(huán)制導(dǎo)方法均能較好地約束終端高度和終端彈道傾角,其中閉環(huán)制導(dǎo)方法的終端高度誤差在10 m以內(nèi),終端彈道傾角誤差不超過0.1°,相比于PD跟蹤均提高了一個數(shù)量級。這是因?yàn)楸疚奶岢龅拈]環(huán)制導(dǎo)方法,能夠在每一個制導(dǎo)周期內(nèi),通過搜索雙剖面參數(shù)實(shí)現(xiàn)對終端高度和彈道傾角的精確控制,魯棒性較強(qiáng)。由馬赫數(shù)和動壓值仿真結(jié)果可知,飛行全程動壓值較小,3種制導(dǎo)方法均滿足終端窗口約束;3組終端攻角也均滿足窗口約束,且在標(biāo)準(zhǔn)條件下攻角波動均不超過0.1°。在有干擾的情況下,閉環(huán)制導(dǎo)的終端攻角波動比PD跟蹤更小,說明本文提出的更新剖面終端值方法能更好地約束終端攻角。

由圖7(a)(d)可知,標(biāo)稱最優(yōu)軌跡與3種制導(dǎo)方法所得軌跡平滑、變化平穩(wěn);圖7(b)(e)(f)表明所有軌跡均滿足過程約束;圖7(c)表明4種方法得到的攻角曲線連續(xù)且沒有抖振出現(xiàn),其中基于PD的最優(yōu)軌跡跟蹤攻角曲線變化趨勢與標(biāo)稱最優(yōu)攻角接近,且與閉環(huán)制導(dǎo)攻角曲線差異較大。這是因?yàn)镻D跟蹤依賴標(biāo)稱軌跡,在干擾存在時調(diào)整能力有限,而閉環(huán)制導(dǎo)自主性較強(qiáng),能夠根據(jù)狀態(tài)實(shí)時調(diào)整控制量,充分發(fā)揮飛行器飛行能力;俯仰角剖面平均更新時間為28 ms,證明該方法具有在線應(yīng)用價值。

3.3 制導(dǎo)精度與魯棒性分析

針對氣動系數(shù)偏差、大氣密度偏差、推力偏差和質(zhì)量秒耗量偏差進(jìn)行200次蒙特卡洛仿真。假設(shè)各項(xiàng)參數(shù)擾動符合正態(tài)分布,擾動參數(shù)如表5所示。仿真結(jié)果如圖8所示,終端約束平均值見表6。

表5 擾動參數(shù)

表6 終端約束蒙特卡洛仿真平均值

由圖8(a)(d)可知,高度和彈道傾角曲線平滑、軌跡無震蕩;圖8(b)(e)(f)表明在氣動不確定情況下,所有仿真均滿足過程約束,且動壓、過載變化平緩,終端動壓均在窗口范圍內(nèi);圖8(c)表明所有仿真攻角曲線無抖振出現(xiàn),終端攻角均滿足窗口約束;圖8(g)(h)表明200組仿真終端高度誤差均不超過10 m、終端彈道傾角誤差均不超過0.15°,具有較高精度;圖8(i)為終端攻角分布,各種隨機(jī)擾動下,所有終端攻角的最大波動值不超過0.3°,證明本文所提方法能夠較好地約束終端攻角,且具有較強(qiáng)的魯棒性。

4 結(jié) 論

本文將具有復(fù)雜終端約束的固體火箭助推飛行器大氣層內(nèi)上升段制導(dǎo)問題,通過設(shè)計制導(dǎo)指令與動態(tài)更新策略,轉(zhuǎn)化為參數(shù)實(shí)時搜索問題,提出一種閉環(huán)制導(dǎo)方法。理論分析和仿真結(jié)果表明:

1) 閉環(huán)制導(dǎo)方法能夠在線生成控制量,且控制量曲線平滑,滿足飛行器上升段飛行任務(wù)需求,具有在線應(yīng)用價值。

2) 方法對終端攻角有較強(qiáng)的約束能力,能夠?yàn)轱w行器后續(xù)工作創(chuàng)造良好環(huán)境。

3) 所設(shè)計的方法在擾動條件下具有一定的精度和魯棒性。