趙亮博，朱廣生，莊 凌，宋加洪，盧寶剛

（1.北京航天長征飛行器研究所，北京，100076；2.中國運(yùn)載火箭技術(shù)研究院，北京，100076）

0 引 言

再入飛行器的機(jī)動制導(dǎo)問題，一直是再入飛行器制導(dǎo)控制領(lǐng)域的研究熱點[1～3]。飛行器再入制導(dǎo)過程具有非線性、時變性和不確定性等特點，其飛行路徑除了需要滿足過載、動壓、熱流率約束外，還需要滿足由自然、軍事等因素造成的禁飛區(qū)約束。

禁飛區(qū)約束是一種復(fù)雜的路徑約束，現(xiàn)有禁飛區(qū)規(guī)避方法主要集中在離線最優(yōu)軌跡解算中，如經(jīng)典的數(shù)值求解方法偽譜法[4]，通過不同配點和多項式插值方式實現(xiàn)全局軌跡的優(yōu)化求解。但是離線求解方法解算效率低，無法滿足實時制導(dǎo)需求。隨著探測技術(shù)發(fā)展，對禁飛區(qū)域的實時或近似實時探測成為可能，因此需要研究實現(xiàn)禁飛區(qū)在線規(guī)避的制導(dǎo)算法。文獻(xiàn)[5]提出了一種考慮禁飛區(qū)的預(yù)測校正制導(dǎo)方法，利用航向角誤差走廊的形式控制飛行器的側(cè)向運(yùn)動，當(dāng)禁飛區(qū)等約束急劇變化時預(yù)測校正的制導(dǎo)方法易產(chǎn)生性能退化。文獻(xiàn)[6]利用一種基于三觸角預(yù)測方法的側(cè)滑角瞬變策略，實現(xiàn)了禁飛區(qū)的規(guī)避，但機(jī)動軌跡的生成依賴于飛行器動力學(xué)方程積分而來的3個“觸角”，計算代價大。

基于Dubins曲線的路徑規(guī)劃方法在機(jī)器人、無人機(jī)的軌跡規(guī)劃中得到了廣泛應(yīng)用[7～9]。文獻(xiàn)[10]第1次提出Dubins路徑的概念，在轉(zhuǎn)彎半徑對車輛運(yùn)動影響的分析上，設(shè)計了滿足約束條件的最短路徑并進(jìn)行了理論證明，即滿足曲率限制的最短曲線由圓弧與直線構(gòu)成。文獻(xiàn)[11]設(shè)計了基于 Dubins曲線的高超聲速飛行器離線路徑規(guī)劃方法，但未結(jié)合具體的飛行器轉(zhuǎn)彎能力和終端約束進(jìn)行分析。

本文在對再入飛行器轉(zhuǎn)彎能力分析的基礎(chǔ)上，得出飛行器轉(zhuǎn)彎半徑和傾側(cè)角的近似解析關(guān)系，結(jié)合Dubins曲線的路徑規(guī)劃方法生成禁飛區(qū)規(guī)避的制導(dǎo)策略。同時為修正規(guī)避引起的終端誤差，建立基于能量運(yùn)動模型來解析預(yù)測航程，通過割線法對傾側(cè)角指令進(jìn)行迭代修正，實現(xiàn)航程校正控制。通過速度傾角的反饋控制設(shè)計，滿足終端高度約束。最后基于CAV-H的數(shù)學(xué)模型仿真驗證了該算法在禁飛區(qū)繞飛規(guī)避的有效性，滿足終端約束條件且計算效率高、實時性好。

1 飛行器運(yùn)動建模

1.1 再入運(yùn)動方程

本文研究的飛行器采用無動力滑翔的方式再入，采取傾斜轉(zhuǎn)彎（Bank To Turn，BTT）的機(jī)動策略。為研究飛行器在大氣層內(nèi)的運(yùn)動規(guī)律、分析飛行器轉(zhuǎn)彎能力、設(shè)計制導(dǎo)策略，在不考慮地球自轉(zhuǎn)影響的情況下，建立飛行器再入運(yùn)動方程組為

式中r,λ,φ,V,θ,ψ分別為地心距、經(jīng)度、緯度、速度、速度傾角和航向角；σ為傾側(cè)角；g為重力加速度；L，D分別為氣動升力和阻力，且：

式中ρ為大氣密度；Sref為參考面積；CL，CD分別為升力系數(shù)和阻力系數(shù)。

由于飛行結(jié)束時間不確定，給航程解析預(yù)測帶來了困難。為此，定義如下形式的無量綱變量e能量：

式中為無量綱的地心距，無量綱化參數(shù)為地球半徑R0；為無量綱速度，無量綱化參數(shù)為，g0為海平面重力加速度。為解析預(yù)測航程需要，建立如下歸一化的基于能量的運(yùn)動方程：

式中為無量綱阻力加速度，無量綱系數(shù)為g0。

1.2 再入約束建模

本文考慮的終端約束有高度約束、速度約束及終端位置約束，以能量為自變量時表達(dá)式如下：

式中ef,rf,Vf,λf,φf分別為以能量為自變量描述的終端能量、地心距、速度、經(jīng)度和緯度。

由于地理、軍事等因素會造成飛行器不能在某些區(qū)域飛行，即禁飛區(qū)，通常用無限高圓柱表示。用經(jīng)緯度及禁飛區(qū)半徑rN描述禁飛區(qū)如下：

式中λz,φz分別為禁飛區(qū)中心的經(jīng)度和緯度。

函數(shù)s((λz,φz), (λ,φ) )表示兩點間的大地線長度：

2 制導(dǎo)策略

本文將制導(dǎo)策略分為禁飛區(qū)規(guī)避制導(dǎo)和完成規(guī)避后的校正策略兩部分設(shè)計，具體算法流程如圖1所示。

圖1 制導(dǎo)算法流程 Fig.1 Guidance Algorithm Flow

2.1 轉(zhuǎn)彎能力分析

為設(shè)計禁飛區(qū)規(guī)避策略，需要對飛行器的轉(zhuǎn)彎能力進(jìn)行分析。對于采用BTT機(jī)動方式的飛行器，通過傾斜升力面的方式使升力產(chǎn)生側(cè)向分量，提供轉(zhuǎn)彎的需用向心力。

假設(shè)轉(zhuǎn)彎過程為無側(cè)滑的平衡飛行狀態(tài)，即轉(zhuǎn)彎過程中速度傾角近似為零：

轉(zhuǎn)彎過程中的需用向心力由升力的分量Lsinσ提供，定義轉(zhuǎn)彎半徑為rz，可得：

聯(lián)立式（8）、式（9）可得：

在水平轉(zhuǎn)動平面內(nèi)忽略離心力項，可得機(jī)動轉(zhuǎn)彎半徑的近似解析解：

因此，一定轉(zhuǎn)彎半徑rz下傾側(cè)角σ的近似解析解：

為驗證該公式，針對CAV-H飛行器在高度50 km、速度 5000 m/s和高度 55 km、速度 5500 m/s兩組不同的工況進(jìn)行仿真驗證。

圖2 工況一：高度 50 km，速度 5000 m/s Fig.2 Condition 1: height 50 km, velocity 5000 m/s

圖3 工況二：高度 55 km，速度 5500 m/s Fig.3 Condition 2: height 55 km, velocity 5500 m/s

該公式建立在平衡滑翔飛行的基礎(chǔ)上，可以用作該狀態(tài)下傾側(cè)角和轉(zhuǎn)彎半徑的解析計算。從圖2、圖3中可以看出，當(dāng)傾側(cè)角大于25°時解析解和數(shù)值解誤差較小，式（12）可為機(jī)動策略的選取提供依據(jù)。

此外，在實際轉(zhuǎn)彎過程中由于升力在鉛垂方向上的分量減小，如果不對攻角加以調(diào)節(jié)會引起飛行高度的下降。為方便設(shè)計參考，本文給出了無攻角聯(lián)合調(diào)節(jié)時機(jī)動轉(zhuǎn)彎引起的高度損失近似估算公式。

假設(shè)轉(zhuǎn)彎前后飛行器的高度分別為h1,h2，大氣密度分別為ρ1,ρ2，根據(jù)大氣密度的近似估算公式可得：

轉(zhuǎn)彎后為維持平衡飛行，推導(dǎo)出大氣密度變化規(guī)律：

因此，高度變化量Δh和傾側(cè)角間的近似解析關(guān)系為

該關(guān)系式可用做轉(zhuǎn)彎引起高度損失的近似估算，對機(jī)動策略的選取具有參考意義。

2.2 基于Dubins曲線的禁飛區(qū)規(guī)避策略

飛行器由起始狀態(tài)調(diào)整至目標(biāo)狀態(tài)所經(jīng)過的路徑是經(jīng)計算選擇的一個起始轉(zhuǎn)向圓rz1與一個目標(biāo)轉(zhuǎn)向圓rz2之間通過合適的公切線相連得到的有向曲線，此有向曲線即是一條Dubins路徑[10]，如圖4所示。

圖4 Dubins路徑 Fig.4 Dubins Path

依據(jù) Dubins曲線的組成原理確定本文的繞飛策略，其中需要求解的變量包括 2次轉(zhuǎn)彎的轉(zhuǎn)彎半徑rz1,rz2及轉(zhuǎn)彎角度θ1,θ2。同時，針對轉(zhuǎn)彎過程中可能出現(xiàn)的高度損失，采用攻角和傾側(cè)角聯(lián)合調(diào)整的方法設(shè)計攻角大小。具體的規(guī)避流程如圖5所示。

圖5 基于Dubins曲線的規(guī)避流程 Fig.5 Avoiding Process Based on Dubins Curve

假設(shè)對禁飛區(qū)的探測距離為rdet，即在距離rdet時發(fā)現(xiàn)禁飛區(qū)。對于半徑為rz大小的禁飛區(qū)，Dubins曲線起始圓的最小轉(zhuǎn)彎半徑rz1計算公式為

由式（16）可得，飛行器探測到禁飛區(qū)的時機(jī)越早、探測距離越遠(yuǎn)，需用機(jī)動轉(zhuǎn)彎半徑越大。聯(lián)合式（12）與式（16）即可求出規(guī)避禁飛區(qū)的需用傾側(cè)角σrz1。同時，根據(jù)相切點位置通過解析幾何的方式可求出轉(zhuǎn)彎角度1θ的大小。

通過目標(biāo)圓的半徑rz2選取對應(yīng)傾側(cè)角σrz2大小時需進(jìn)行判斷，假設(shè)當(dāng)前飛行狀態(tài)下轉(zhuǎn)彎半徑rz對應(yīng)的傾側(cè)角為σrz，通過式（23）得出的傾側(cè)角大小為σcmd，則：

然后，通過判斷航向角誤差是否為0，即飛行器是否瞄準(zhǔn)目標(biāo)點，作為轉(zhuǎn)彎結(jié)束的標(biāo)志并進(jìn)入校正環(huán)節(jié)，不再計算目標(biāo)圓旋轉(zhuǎn)角度2θ。

由式（15）可得，轉(zhuǎn)彎時如果不對總升力進(jìn)行調(diào)節(jié)，會引起飛行器的高度損失。本文通過聯(lián)合調(diào)整攻角的方式來調(diào)整升力，補(bǔ)償高度損失，近似平衡滑翔飛行時存在如下關(guān)系式：

可求得該飛行條件下的需用升力，通過氣動反插值的方式求出需用攻角。

需要指出的是，當(dāng)傾側(cè)過大時為了補(bǔ)償高度損失所需用的攻角較大，大攻角飛行時升阻比低會產(chǎn)生較大的速度損失。因此需設(shè)定合理的攻角聯(lián)合調(diào)節(jié)范圍［αlow,αmax］，針對CAV-H飛行器，本文選取的攻角調(diào)節(jié)區(qū)間為[8°，15°]。

2.3 航程解析預(yù)測校正控制

完成禁飛區(qū)規(guī)避后，飛行器高度和速度會產(chǎn)生相應(yīng)的損失。為滿足終端約束，需對航程及高度進(jìn)行校正。本文通過傾側(cè)角大小的調(diào)節(jié)，實現(xiàn)航程的校正。根據(jù)文獻(xiàn)[12]的推導(dǎo)，基于能量的運(yùn)動模型進(jìn)行航程預(yù)測：

式中(ef)為從能量e到能量ef的歸一化預(yù)測航程，歸一化變量為地球半徑R0。此時，預(yù)測航程和待飛航程的差值：

式中s為當(dāng)前真實的待飛航程，可通過式（7）并結(jié)合當(dāng)前點和終點的經(jīng)緯度坐標(biāo)求出。

通過調(diào)節(jié)傾側(cè)角大小的方式實現(xiàn)對航程的在線校正，采用割線法不斷迭代傾側(cè)角大?。?/p>

2.4 終端高度控制

在再入飛行的大部分時間內(nèi)，飛行攻角處于最大升阻比大小附近，通常采用攻角剖面的形式設(shè)計攻角大小，同時實現(xiàn)滿足過程約束：

式中αm為較大攻角，使飛行器在初始階段快速達(dá)到平衡滑翔的飛行狀態(tài)；αL/D為最大升阻比攻角；VL/D和Vm為設(shè)計變量，實現(xiàn)對不同飛行階段攻角大小的控制。

在飛行末段，為實現(xiàn)滿足終端高度約束，不采用攻角剖面的形式。本文通過設(shè)計一種速度傾角反饋控制的策略調(diào)整攻角大小，期望速度傾角dθ設(shè)計為

設(shè)計線性反饋跟蹤控制律：

聯(lián)合式（1）可求得需用升力Lc：

同樣，通過氣動反插值的方式求出需用攻角：

對于航向的控制采用傳統(tǒng)航向角誤差走廊的形式實現(xiàn)，在此不做贅述。

3 仿真結(jié)果及分析

本文采用CAV-H飛行器的數(shù)學(xué)模型，進(jìn)行仿真驗證[14]，仿真初始及終端條件見表1。

表1 初始條件及終端條件 Tab.1 Initial Conditions and Terminal Conditions

假設(shè)飛行器探測距離為2000 km，探測到禁飛區(qū)中心經(jīng)緯度為（30°，40°），禁飛區(qū)半徑500 km。通過Dubins曲線的路徑規(guī)劃策略生成的起始圓起點經(jīng)緯度（20.92°，23.71°），旋轉(zhuǎn)角度θ1=28.07°，旋轉(zhuǎn)半徑rz1=3750 km，對應(yīng)的近似解析傾側(cè)角大小σrz1=46.99°；校正制導(dǎo)起點經(jīng)緯度（50.34°，48.80°），具體仿真結(jié)果如圖6～9所示。

圖6 CAV-H規(guī)避禁飛區(qū)三維軌跡 Fig.6 Three-dimensional Trajectory Formed by CAV-H Avoiding the No-fly Zone

圖7 CAV-H規(guī)避禁飛區(qū)星下點軌跡 Fig.7 Subsatellite Track Formed by CAV-H Avoiding the No-fly Zone

由圖6、圖7可得，飛行器能夠有效實現(xiàn)禁飛區(qū)的規(guī)避，其終端脫靶量611.80 m，精度較高。

圖8為飛行器的高度、速度曲線，終端高度誤差15.42 m、速度誤差14.03 m/s，均在合理偏差范圍內(nèi)，且高度及速變化平穩(wěn)。

圖8 高度和速度曲線 Fig.8 Height and Velocity Curve

圖9為飛行器的攻角和傾側(cè)角曲線。

圖9 攻角和傾側(cè)角曲線 Fig.9 Angle of Attack and Bank Curve

飛行器分別在519.8 s和809.8 s進(jìn)行了機(jī)動轉(zhuǎn)彎，實現(xiàn)了禁飛區(qū)的繞飛規(guī)避和目標(biāo)的重新瞄準(zhǔn)。在接近目標(biāo)時，攻角逐漸增大校正終端高度，同時連續(xù)調(diào)整傾側(cè)符號修正航向誤差。

4 結(jié) 論

本文提出了一種基于近似解析解的制導(dǎo)方法，能夠有效實現(xiàn)禁飛區(qū)的繞飛規(guī)避，同時滿足終端航程及高度約束，該方法具有以下特點：

a）對飛行器的轉(zhuǎn)彎能力進(jìn)行了分析，得到了機(jī)動轉(zhuǎn)彎半徑和傾側(cè)角的近似解析關(guān)系；

b）結(jié)合 Dubins曲線的路徑規(guī)劃方法設(shè)計規(guī)避策略，結(jié)構(gòu)簡單、效率高；

c）通過對航程的解析預(yù)測和速度傾角的反饋設(shè)計，實現(xiàn)了終端航程及高度的控制，計算效率高、誤差小。

通過數(shù)學(xué)仿真驗證了算法的有效性，得到的近似解析關(guān)系對機(jī)動制導(dǎo)算法的設(shè)計也具有參考價值，工程實用性強(qiáng)。