徐秋坪，王中原，常思江

(南京理工大學 能源與動力工程學院， 江蘇 南京　210094)

?

控制速度方向的彈道修正導引方法*

徐秋坪，王中原，常思江

(南京理工大學 能源與動力工程學院， 江蘇 南京210094)

由于制導炮彈由身管武器發(fā)射，其飛行控制能力和導引信息量有限，故基于預測落點位置偏差量來修正速度方向并在控制時間內(nèi)連續(xù)分配導引指令的思想提出一種新的三維末制導方法。根據(jù)非線性彈道方程組的級數(shù)解預測彈丸落點位置，得到落點與目標的偏差，并提出兩種通過此偏差解算當前速度方向修正量的方法。取剩余飛行時間為修正時間，通過將速度方向修正量分配到整個剩余導引段建立加速度修正公式，從而減小導引指令飽和的可能性。通過連續(xù)地預測落點和分配加速度指令來實時地導引飛行。仿真結(jié)果表明：該導引方法簡單可行，精度高，對控制能力要求較低，且具備較好的制導效果和毀傷效果，可為該體制制導炮彈的應(yīng)用提供參考依據(jù)。

制導炮彈；導引方法；彈道修正；落點預測；剩余飛行時間

為適應(yīng)現(xiàn)代化戰(zhàn)爭的需要，將現(xiàn)有制式常規(guī)炮彈以較低成本改裝成具有一定彈道控制能力的制導炮彈，使其具備效費比高、首發(fā)命中率高、能高效攻擊靜止和低速運動目標等優(yōu)點，目前已成為許多國家研究的熱點課題。導引律設(shè)計是制導炮彈導引控制系統(tǒng)設(shè)計中的關(guān)鍵技術(shù)之一，所選擇的導引方法的優(yōu)劣會直接影響到命中目標的精度和制導炮彈的作戰(zhàn)性能。由于制導炮彈成本低、體積小，因此其在飛行控制能力及系統(tǒng)復雜度等方面與導彈有較大差別，并且在射擊過程中存在諸多隨機擾動的影響，故有必要開展適配制導炮彈在復雜飛行環(huán)境下的導引方法研究。國內(nèi)外已開展了大量關(guān)于制導炮彈導引律的相關(guān)研究工作，提出了不少導引方案。文獻[1]在傳統(tǒng)比例導引規(guī)律的基礎(chǔ)上，對視線角速度施加一個偏置量設(shè)計了偏執(zhí)比例導引律。文獻[2]設(shè)計了一種三維聯(lián)合偏置比例制導律，該制導律結(jié)合了順軌、逆軌攔截模式，采用時變偏置角速率和時變比例系數(shù)。文獻[3-4]基于廣義卡爾曼濾波多步估計算法，在經(jīng)典的比例導引方程中引入了視線角加速度，提出了在末制導段采用指向預測命中點的導引方式，以減小在遭遇點附近法向過載的跳動。比例導引律及其改進形式(如時變增益、引入偏置量等)，這些導引方法設(shè)計的主要出發(fā)點是減小脫靶量，對初始視線轉(zhuǎn)率的精度要求較高且需要消除初始導引誤差。隨著現(xiàn)代控制理論的發(fā)展，不少學者利用優(yōu)化控制算法研究了新的導引律[5-9]。文獻[10]以艦炮發(fā)射帶有GPS導航和火箭助推的旋轉(zhuǎn)彈為背景對比研究了兩種落角控制導引律(運用最優(yōu)控制理論建立的廣義顯示導引律和采用重力補償比例縮放的終端狀態(tài)向前積分導引律)。文獻[11]基于模型預測靜態(tài)規(guī)劃技術(shù)，提出了對地面目標的一種3-D帶落角約束的非線性次優(yōu)導引律。文獻[12]基于傳統(tǒng)滑模控制理論和非奇異終端滑?？刂评碚?，提出了一種對固定目標的三維空間耦合帶落角約束的導引律。文獻[13]將彈丸線性化模型和預測控制理論相結(jié)合建立了一種導引律，以減小落點散布。然而，這類導引律需要明確的幾何分析和最優(yōu)控制理論的支撐，并且建立模型相對復雜，對導引信息輸入量的要求較多?？紤]制導炮彈由身管武器發(fā)射，其飛行控制能力有限、抗干擾能力弱，彈丸導引信息量有限，對彈載計算機性能提出了較高的要求，因而模型簡單、有效、精度高，對傳感器和執(zhí)行機構(gòu)要求低的導引方法更適用于制導炮彈。

本文基于實時預測落點位置偏差來修正速度方向和連續(xù)分配導引指令的思想，提出了一種新的三維彈道修正導引(Ballistic Correction Guidance, BCG)方法。根據(jù)制導炮彈非線性動力學模型的級數(shù)解快速有效地預測彈丸落點，用預測的落點近似代替彈丸的實際落點，以求得預測落點與目標之間的位置偏差量，并根據(jù)此偏差量解算當前飛行位置處的速度方向修正量，通過在控制時間內(nèi)連續(xù)分配彈道傾角和彈道偏角修正量的方式建立導引關(guān)系。同時，還提出了兩種根據(jù)位置偏差計算速度方向修正量的不同處理方法。通過數(shù)值仿真對該導引方法的可行性和有效性進行了初步驗證，分析了該導引方法各組成部分的特點，結(jié)果表明基于此落點預測算法的導引方法能在此類制導炮彈上有效地工作，其導引精度高，控制過程平緩，末段控制余量較大，對導引信息要求低，且具備較大的落角，從而為該類制導炮彈的導引控制方案設(shè)計提供一定的參考。

1　基于彈道方程組級數(shù)解預測落點

預測落點方法有多種，可分成兩大類型：數(shù)值積分法和函數(shù)逼近外推法。數(shù)值積分法的實質(zhì)在于使用數(shù)值積分算法對相應(yīng)的外彈道方程組進行求解，如積分6-D模型、積分3-D模型和積分改進的質(zhì)點模型等。該方法計算負擔較大，耗時較多，解算精度依賴彈載計算機的性能和解算步長，不易實時修正相關(guān)系數(shù)。函數(shù)逼近外推法通過對彈道方程組進行多元函數(shù)線性化(或非線性函數(shù))逼近求解，文獻[14-15]中將六自由度剛體彈道模型線性化處理，建立了彈道諸元的解析表達式，但這些表達式涉及參數(shù)較多且形式復雜，不適宜實際應(yīng)用。采用本文導引律需實時預測飛行落點，這就要求落點預測算法簡單、準確而快速。考慮實際中對諸多彈道參數(shù)的測試也難滿足剛體彈道的計算需求，因而實際中一般采用質(zhì)點彈道方程組。以質(zhì)點彈道方程組的級數(shù)解法為基礎(chǔ)來預測彈丸落點，計算簡潔，快速有效且通用性強?？紤]風的3-D質(zhì)點彈道模型[16-17]描述為：

(1)

其中

(2)

式中：v, vr分別為彈丸地速和風速；m為彈體質(zhì)量；ρ為大氣密度；S為特征面積；g為重力加速度；CD為全彈阻力系數(shù)；θ, ψ分別為彈道傾角和偏角；x, y, z分別為彈丸位置在地面坐標系下的投影分量；wx, wz分別為縱風和橫風風速。

(3)

將各位置變量在當前預測點處關(guān)于時間變量t泰勒級數(shù)展開并略去二階導數(shù)以上各項，可得如式(4)所示彈道方程級數(shù)解析解：

(4)

式中帶下標i的參數(shù)為當前預測點處的諸彈道參數(shù)，可由跟蹤雷達或彈載衛(wèi)星定位裝置實時測量提供，此處假設(shè)測量信息是準確的，且在彈丸后半段飛行過程中相應(yīng)參數(shù)值不變。則令y=0，可得從預測點到彈丸落地的剩余飛行時間，用彈道傾角和彈道偏角表示可寫為：

(5)

將tgo代入式(4)可預測彈丸落點為：

(6)

若已知目標位置(xT,zT)，可預測出彈丸落點與目標之間的位置誤差：Δx=x-xT,Δz=z-zT，此位置誤差將作為本文導引方法的輸入量。

2　彈道修正導引律

彈丸在發(fā)射及飛行過程中會受到諸多不確定因素的干擾，如初始擾動，隨機風等，都會導致命中精度降低。圖1給出了基于上述落點預測方法的彈道修正導引律示意圖。圖中V，V′分別表示修正前后的速度矢量，二者大小相等方向不同，法向和側(cè)向分別相差角度Δθ,Δψ。無控時，彈丸以V方向沿著軌跡1飛行，不能命中目標。在A點處預測落點得其與目標之間的偏差為(Δx,Δz)。根據(jù)彈道修正的思想，在縱向平面內(nèi)，若落點在目標前方(沿射擊方向)則需減小A點處彈道傾角，若落點在目標點后方則需增大其值，但是彈道傾角修正量存在一個較大值和一個較小值，由于應(yīng)用于末制導且較大的修正值不符合飛行實際情況則需舍去，側(cè)向平面內(nèi)彈道偏角的修正量也存在相同特點。因此，根據(jù)偏差(Δx,Δz)可解算出相應(yīng)唯一的速度方向修正量(Δθ,Δψ)。根據(jù)(Δθ,Δψ)以某種方法求得相應(yīng)法向和側(cè)向的加速度修正量aθ和aψ，則彈丸以修正后的加速度沿V′方向(軌跡2)飛行并命中目標。

圖1　彈道修正導引律示意圖Fig.1　Diagram for ballistic correction guidance

實際飛行中將V改變(Δθ,Δψ)到V′方向是不可能瞬時完成的，需在一定修正時間Δt內(nèi)完成該任務(wù)。因此，可建立如式(7)所示形式的加速度修正量：

(7)

圖2　縱向平面修正量單步離散示意圖Fig.2　Single-step discrete diagram of corrections in vertical plane

式中：K為導引系數(shù)。Δt的值越大則導引指令值越小，飛行軌跡修正越緩慢。Δt的值可取為剩余飛行時間tgo，意味著將Δθ和Δψ的改變量分配到剩余的整個導引段中執(zhí)行，而每一步只需要執(zhí)行一個較小的修正量。圖2給出了縱向平面內(nèi)分攤導引的單步離散過程。第i步預測落點Pi位于目標T的后方(沿射擊方向)，相應(yīng)的理想修正角度為Δθi，通過分配后實際改變的角度為Δθ′i，沿著相應(yīng)導引指令飛行至第i+1步，預測落點為Pi+1，根據(jù)上述彈道修正思想，Pi+1比Pi更接近目標點，即有Δxi+1<Δxi，此時理想彈道傾角修正量Δθi+1就越小，即Δθi+1<Δθi，再次分配，第i+1步彈道傾角的實際修正量為Δθ′i+1，沿著相應(yīng)導引指令飛行預測的落點Pi+2就越趨于目標。這樣通過連續(xù)的預測和分配導引指令，Δθi逐漸減小，相應(yīng)射擊偏差量也逐漸趨于零。

考慮制導炮彈控制能力有限，每次分配的導引指令不宜過小或過大，過小則會導致修正能力不足，過大則會使得導引指令飽和，這就需要選擇合適的K和Δt，以降低導引指令飽和的可能性。設(shè)acmax為導引指令的最大控制能力，則加速度修正指令可寫為：

(8)

如何根據(jù)預測的偏差量(Δx,Δz)解算當前狀態(tài)下(Δθ,Δψ)是建立本文導引律的關(guān)鍵所在，這里提出了兩種解算方法。

方法A：利用彈道方程組的級數(shù)解建立(Δx,Δz)與(Δθ,Δψ)的非線性耦合關(guān)系。

根據(jù)上述落點預測算法，以當前(θi,ψi)預測落點位置為(x,z)。式(6)可寫為：

(9)

預測落點偏離目標Δx=x-xT,Δz=z-zT。假設(shè)當前(θi,ψi)改變?yōu)?θi+Δθ,ψi+Δψ)并預測其落點為(x′,z′)，則落點位置改變量為Δx′=x′-x,Δz′=z′-z。若此時的(Δx′,Δz′)恰巧等于(或在一定精度下近似等于)(-Δx, -Δz)，則有x′=xT,z′=zT。

記θ′=θi+Δθ,ψ′=ψi+Δψ。根據(jù)式(9)可建立二元非線性方程組為：

(10)

此二元常系數(shù)非線性方程組只有θ′i,ψ′i為未知量，其余參數(shù)均為該預測落點處相應(yīng)參數(shù)。若解得θ′i,ψ′i，則Δθ=θ′i-θi,Δψ=ψ′i-ψi。記方程組(10)中右邊為f1(x1,x2)和f2(x1,x2)，其中x1=θ′i,x2=ψ′i，則方程組(10)的解可等價為如式(11)所示方程組的解：

(11)

根據(jù)前面的分析，此方程組有解且唯一。對于此非線性方程組的求解問題，本文將其轉(zhuǎn)化為解非線性最小二乘問題，即與之等價的目標函數(shù)

(12)

的極小值問題，搜索方向采用Gauss-Newton法，可減小計算復雜程度，且收斂速度快，計算精度高[18-19]。

方法B：采用線性化近似處理方法建立(Δx,Δz)與(Δθ,Δψ)的耦合關(guān)系。

設(shè)F為某質(zhì)點彈道方程組的解函數(shù)，根據(jù)外彈道理論，縱向和側(cè)向射程[20]可寫為：

(13)

假定只在ti處改變(Δθi,Δψi)來影響(Δx,Δz)，則線性化(X,Z)有：

(14)

假定在當前位置處引入兩組微小變化量(Δθ1,Δψ1)和(Δθ2,Δψ2)，分別預測相應(yīng)的落點偏差量為(Δx1,Δz1)和(Δx2,Δz2)。根據(jù)式(14)可建立方程組：

(15)

解出

(16)

則方程組(14)可解為

(17)

進一步反解可求得ti時刻速度方向角的理想修正量(Δθi,Δψi)，如式(18)所示。

(18)

上述兩種求解方法既考慮了縱向和側(cè)向的耦合關(guān)系，又能根據(jù)當前飛行環(huán)境實時地建立(Δθ,Δψ)和(Δx,Δz)的關(guān)系。根據(jù)上述討論可建立彈道修正導引方案，其流程如圖3所示。

圖3　彈道修正導引方案流程圖Fig.3　Flow diagram of BCG strategy

3　算例仿真與分析

在MATLAB環(huán)境下對某制導炮彈采用此預測算法和彈道修正導引方法進行數(shù)值仿真，并對此導引方法的可行性和有效性進行評估。仿真條件：彈重m0=33.305 kg，彈徑130 mm，初速v0=930 m/s，發(fā)射角θ0=45°,ψ0=0°。發(fā)射坐標[-27 734, 0, 0]m，目標坐標[0, 0, 0]m。忽略科氏力。假設(shè)測量信息是準確的，加速度修正量由鴨舵控制機構(gòu)提供，其最大修正能力acmax=±1 g，控制系統(tǒng)理想工作。發(fā)射及飛行過程中主要擾動源如表1所示。

表1　主要彈道擾動源

預測精度受到起始預測高度及相應(yīng)飛行狀態(tài)參數(shù)的影響。取一組上述擾動源進行仿真，在高度為7 km到50 m的飛行段預測落點，其預測誤差如圖4所示。圖中δx,δz分別為預測落點與其實際落點的縱向和橫向之差。離目標越遠進行預測，剩余飛行時間越長且預測誤差越大；隨著彈丸越接近目標預測誤差呈快速收斂趨勢，預測誤差的相對誤差在1.7%以內(nèi)且也呈逐漸減小的趨勢。當高度到達1 km后縱向和橫向預測誤差均縮小到1 m的范圍內(nèi)，均可視為滿足精度要求。

(a) 縱向預測誤差(a) Prediction error of down-range

(b) 橫向預測誤差(b) Prediction error of cross-range圖4　落點預測偏差Fig.4　Impact point prediction error

為了驗證本文導引方法的可行性和有效性，考慮上述隨機擾動，將不采用末制導和采用上述導引方法末制導的結(jié)果進行對比分析。取3000組上述隨機擾動源進行Monte Carlo模擬打靶，不采用末制導時彈丸落點的縱向和橫向誤差最大達到700 m，其圓概率偏差CEP=315.14 m，射擊精度低。在上述模擬打靶中選取10組隨機擾動，采用本文導引方法進行末制導，導引起始高度為5 km，導引系數(shù)選為K=2，采用方法A解算加速度指令，飛行軌跡如圖5所示。為避免接近目標時加速度指令過大，當高度y≤50 m后就停止末制導而采用自由飛行，后面采用比例導引律對比分析時也做相同處理。可以看出，存在擾動時，尤其當擾動較大時，如圖中編號為1的隨機擾動，彈丸無控飛行的射擊偏差為(-530.70, 578.08)m，無法命中目標，采用本文末制導方法其落點偏差僅(-1.75×10-2, 3.73×10-2)m，且在其余擾動下均能有效地命中目標。

圖5　10組隨機擾動下導引飛行軌跡Fig.5　Guided trajectories under 10 stochastic perturbations

(a) 縱向加速度指令曲線(a) Histories of the pitch acceleration commands

在上述編號為1的擾動下，采用不同導引系數(shù)進行末制導，相應(yīng)加速度修正量變化情況如圖6所示，射擊誤差對比如表2所示?？梢钥闯?，當K=1時每次加速度分攤量過小導致修正能力不足，且加速度指令呈逐漸增大的趨勢，甚至超過其修正范圍，射擊精度較低，因此需要K大于1。隨著K的增大，導引指令初始值增大，但隨著飛行時間的增加導引指令呈快速收斂趨勢，最終趨于零。這意味著導引過程中加速度修正量的控制余量逐漸增大，其末段機動性能較強；但K的值過大會導致導引指令飽和(如K=5)，并且整個控制過程加速度修正量的變化范圍也較大。從精度上講，K≥2時命中精度已相當高，可視為直擊命中目標?？紤]制導精度、導引指令的變化范圍及其變化過程的平穩(wěn)度，導引系數(shù)可選在2～3之間。

(b) 側(cè)向加速度指令曲線(b) Histories of the yaw acceleration commands圖6　不同導引系數(shù)下導引指令變化曲線Fig.6　Guidance command profile under different gains

K=1K=2K=3K=4K=5縱向誤差/m-18.34-1.75×10-24.46×10-42.92×10-4-8.28×10-5側(cè)向誤差/m31.953.73×10-21.20×10-4-5.31×10-51.94×10-5

(a) 縱向加速度指令曲線(a) Histories of the pitch acceleration commands

(b) 側(cè)向加速度指令曲線(b) Histories of the yaw acceleration commands圖7　不同末制導高度處導引指令變化曲線Fig.7　Guidance command profile under different initially guided altitudes

在編號為1的擾動下，取K=2在不同高度下進行末制導，相應(yīng)加速度指令變化情況如圖7所示。末制導起始高度影響著修正時間Δt的值。在整個導引過程中Δt的值隨著高度不斷地變化，越接近目標其值越小?？紤]落點預測誤差以及制導炮彈控制能力有限，若起始導引高度越接近目標則軌跡修正時間越短，單步分配的指令就越大，甚至會超過其修正范圍，并且可能導致導引指令處于持續(xù)飽和狀態(tài)(如末制導初始高度為3 km時的側(cè)向?qū)б噶?，其命中精度也越低；若導引起始位置離目標越遠則預測精度相對較差且軌跡修正越緩慢，故末制導起始高度可選在5 km左右。

在不同高度、導引系數(shù)和隨機擾動下，對方法A和方法B解算導引指令進行對比仿真，如圖8～10所示。結(jié)果發(fā)現(xiàn)：采用方法B的計算量比方法A小，二者的射擊精度幾乎一樣，均能有效地命中目標，相應(yīng)加速度修正量也很相近。但采用方法B解算的末段導引指令略有增大的趨勢，同時其縱向加速度指令在導引初始段存在微小段畸變現(xiàn)象。由于ψ0=0°，即使存在擾動時其值也很小，同時彈道偏角和由其引起的側(cè)向偏差相對于彈道傾角及其引起的縱向偏差而言均非常小，根據(jù)兩次微小擾動分別預測落點的偏差而建立起(Δθ,Δψ)與(Δx,Δz)之間的關(guān)系，考慮了法向和側(cè)向的耦合，導致線性近似解算(Δθ,Δψ)時縱向加速度修正量存在波動現(xiàn)象。當ψ0和θ0相差不大時可避免加速度指令振蕩現(xiàn)象，如將ψ0設(shè)定大于15°而θ0不變時加速度指令無振蕩現(xiàn)象。若采用方法A則不存在這一現(xiàn)象，整個控制過程變化平緩且無振蕩，雖然兩種方法精度相差不大，但從射擊要求和控制穩(wěn)定出發(fā)采取方法A處理為佳。本文與比例導引末制導比較時均采用方法A處理。

(a) 縱向加速度指令比較(a) Comparison of the pitch acceleration commands

(b) 側(cè)向加速度指令比較(b) Comparison of the yaw acceleration commands圖8　不同導引系數(shù)下方法A和方法B導引指令對比Fig.8　Guidance command comparision between method A and method B under different gains

(a) 縱向加速度指令比較(a) Comparison of the pitch acceleration commands

(b) 側(cè)向加速度指令比較(b) Comparison of the yaw acceleration commands圖9　不同末制導高度下方法A和方法B導引指令對比Fig.9　Guidance command comparision between method A and method B under different initially guided altitudes

(a) 縱向加速度指令比較(a) Comparison of the pitch acceleration commands

(b) 側(cè)向加速度指令比較(b) Comparison of the yaw acceleration commands圖10　不同擾動下方法A和方法B導引指令對比Fig.10　Guidance command comparision between method A and method B under different perturbations

(19)

式中：rx, ry, rz為彈目距離矢量在地面系下的各分量。將視線角速率轉(zhuǎn)到速度坐標系下有：

(20)

則三維比例導引律加速度指令[21-22]為：

(21)

式中：N為比例導引系數(shù)，V為彈丸飛行速度。

在上述編號為1的隨機擾動下采用PNG末制導，結(jié)果如圖11所示。取N為3，對比仿真PNG和BCG兩種末制導，如圖12、圖13所示。采用BCG末制導的射擊精度相對較好，且其軌跡修正更加平緩，尤其在導引初始段，從軌跡的彎曲程度可看出BCG對控制能力的要求更低。從圖12可以看出，用PNG末制導的彈道傾角和彈道偏角初始段突變較大而后趨于某個值，中間段其值的變化速率較大；而采用BCG末制導的彈道傾角和彈道偏角初始段突變較小，整個飛行過程中其值變化很平穩(wěn)且呈逐漸增加的趨勢，同時可獲得更大的落角，這說明經(jīng)過連續(xù)分配導引指令后BCG可取得更好的導引效果。

(a) 縱向加速度指令曲線(a) Histories of the pitch acceleration commands

(b) 側(cè)向加速度指令曲線(b) Histories of the yaw acceleration commands圖11　不同導引系數(shù)下PNG末制導指令變化曲線Fig.11　Command histories of PNG under different N

(a) 彈道傾角曲線(a) Pitch angle profile

(b) 彈道偏角曲線(b) Yaw angle profile圖12　不同擾動下BCG和PNG末制導的速度方向角變化曲線(取圖5中擾動的編號為1,9,10)Fig.12　Attitude angle profile for comparing BCG and PNG under different perturbations from fig.5 (1, 9, 10)

(a) 縱向軌跡(a) Vertical trajectories

(b) 側(cè)向軌跡(b) Lateral trajectories圖13　BCG和PNG末制導彈道曲線對比Fig.13　Trajectory profile comparision between BCG and PNG

4　結(jié)論

1)基于彈道方程組級數(shù)解的彈丸飛行落點預測模型提出了一種連續(xù)修正速度方向的末制導方法，該導引律通過適當分配加速度指令以減少導引指令飽和的可能性。

2)在考慮隨機擾動和控制能力受限的條件下對所提導引方法進行了仿真分析，驗證了該導引方法的可行性和有效性，分析了導引律中各參數(shù)對制導效果的影響并給出了相應(yīng)參數(shù)的選取條件(導引系數(shù)取在2～3之間，末制導起始高度取在5 km左右為佳)，這些參數(shù)都影響著導引指令每次分配量的大小。

3)對比分析了根據(jù)落點處彈目偏差量解算速度方向修正量的兩種方法，采用方法B求解的加速度修正量會出現(xiàn)畸變現(xiàn)象且需滿足彈道傾角和彈道偏角相差不大的要求，但是其計算量較小，解算速度較快，更適用于低等級彈載計算機；而采用方法A的求解量較大但精度更高，控制效果更好。

4)與比例導引法相比，采用BCG末制導的射擊精度相對較高，對控制能力的要求較低，具備更好的制導效果和毀傷效果。

5)該導引方法簡單可行且有效，可與其他落點預測算法相結(jié)合，可為制導炮彈導引律的設(shè)計提供一定的參考。

References)

[1]王輝, 章虹虹. 高精度偏置比例導引末制導律研究[J]. 航天控制, 2009, 27(6): 19-22.

WANG Hui, ZHANG Honghong. The development of high-precision biased proportional navigation terminal guidance control[J]. Aerospace Control, 2009, 27(6): 19-22.(in Chinese)

[2]閆梁, 趙繼廣, 沈懷榮, 等. 帶末端碰撞角約束的三維聯(lián)合偏置比例制導律設(shè)計[J]. 航空學報, 2014, 35(7):1999-2010.

YAN Liang, ZHAO Jiguang, SHEN Huairong, et al.Three-dimensional united biased proportional navigation guidance law for interception of targets with angular constraints[J]. Acta Aeronautica et Astronautica Sinica, 2014, 35(7): 1999-2010. (in Chinese)

[3]金學英. 基于多點估計的比例導引法的改進[D]. 沈陽:沈陽航空航天大學, 2009.

JIN Xueying.The improving of proportional navigation law based on multi-step estimating[D]. Shenyang: Shenyang Institute of Aeronautical Engineering, 2009. (in Chinese)

[4]趙文成, 金學英, 那嵐. 末制導段比例導引法的改進[J]. 指揮控制與仿真, 2009, 31(4): 97-99.

ZHAO Wencheng, JIN Xueying, NA Lan.Modifying of proportional guidance law at terminal guidance[J]. Command Control & Simulation, 2009, 31(4): 97-99.(in Chinese)

[5]Maity A, Oza H B, Padhi R.Generalized model predictive static programming and angle-constrained guidance of air-to-ground missiles [J]. Journal of Guidance, Control and Dynamics, 2014, 37(6): 1897-1913.

[6]Lee C H, Kim T H, Tahk M J. Interception angle control guidance using proportional navigation with error feedback [J]. Journal of Guidance, Control and Dynamics, 2013, 36(5): 1556-1561.

[7]Kumar S R, Rao S, Ghose D. Nonsingular terminal sliding mode guidance with impact angle constraints[J]. Journal of Guidance, Control, and Dynamics, 2014, 37(4): 1114-1130.

[8]Alkaher D, Moshaivo A. Guidance laws based on optimal feedback linearization pseudocontrol with time-to-go estimation[J]. Journal of Guidance, Control, and Dynamics, 2014, 37(4): 1298-1305.

[9]Hablani H B. Endgame guidance and relative navigation of strategic interceptors with delays [J]. Journal of Guidance, Control, and Dynamics, 2006, 29(1): 82-94.

[10]Pamadi K B, Ohlmeyer E J. Evaluation of two guidance laws for controlling the impact flight path angle of a naval gun launched spinning projectile [C]//Proceedings of AIAA Guidance, Navigation, and Control Conference and Exhibit, 2006: AIAA 2006-6081.

[11]Oza H B, Padhi R. Impact-angle-constrained suboptimal model predictive static programming guidance of air-to-ground missiles [J]. Journal of Guidance, Control, and Dynamics, 2012, 35(1): 153-164.

[12]Kumar S R, Ghose D. Three dimensional impact angle constrained guidance law using sliding mode control [C]//Proceedings of American Control Conference, 2014: 2474-2479.

[13]Ollerenshaw D, Costello M. Model predictive control of a direct fire projectile equipped with canards [J]. Journal of Dynamic Systems, Measurement, and Control, 2008, 130(6): 061010-061020.

[14]Hainz L, Costello M. In flight projectile impact point prediction[C]//Proceedings of AIAA Atmospheric Flight Mechanics Conference and Exhibit, Providence, Rhode Island, 2004: 1-40.

[15]Hainz L C, Costello M.Modified projectile linear theory for rapid trajectory prediction [J]. Journal of Guidance, Control, and Dynamics, 2005, 28(5): 1006-1014.

[16]McCoy R L. Modern exterior ballistics: the launch and flight dynamics of symmetric projectiles [M]. Atglen, PA,USA: Schiffer Publishing Ltd., 1999: 165-186.

[17]韓子鵬. 彈箭外彈道學[M]. 北京：北京理工大學出版社, 2008: 84-143.

HAN Zipeng. Exterior ballistics for projectiles[M]. Beijing: Beijing Institute of Technology Press, 2008: 84-143. (in Chinese)

[18]Ortega J M, Rheinbolbt W C.多元非線性方程組迭代解法[M]. 朱季納, 譯. 北京： 科學出版社, 1983: 20-26.

Ortega J M, Rheinbolbt W C. Iterative solution of nonlinear equations in several variables[M]. Translated by ZHU Jina. Beijing: Science Press, 1983: 20-26. (in Chinese)

[19]王德人. 非線性方程組解法與最優(yōu)化方法[M]. 北京：人民教育出版社, 1979: 238-258.

WANG Deren. Solution of nonlinear equations and optimization methods[M]. Beijing: People′s Education Press, 1979: 238-258. (in Chinese)

[20]王中原. 彈道修正中的控制算法[J]. 彈道學報, 2011, 23(2): 19-21.WANG Zhongyuan. Control method for trajectory correction[J]. Journal of Ballistics, 2011, 23(2): 19-21. (in Chinese)

[21]錢杏芳, 林瑞雄, 趙亞男. 導彈飛行力學[M]. 北京：北京理工大學出版社, 2008: 90-111.

QIAN Xingfang, LIN Ruixiong, ZHAO Yanan. Missile flight dynamics[M]. Beijing: Beijing Institute of Technology Press, 2008: 90-111. (in Chinese)

[22]Paul Z. Tactical and strategic missile guidance[M]. Washington,USA: American Institute of Aeronautics and Astronautics, 2002: 26-43.

Ballistic correction guidance law based on the control of velocity direction

XU Qiuping, WANG Zhongyuan, CHANG Sijiang

(School of Energy and Power Engineering, Nanjing University of Science and Technology, Nanjing 210094, China)

Taking the limited control authority and guidance information of a gun-launched guided projectile into account, a novel three-dimension terminal guidance law based on the combination of the correction of the velocity direction via impact point prediction and continuous distribution of acceleration command was proposed. The deviations between the impact point of the projectile and the target were predicted on the basis of the series solutions of the nonlinear ballistic equations. According to the deviations, two methods to calculate the direction angle corrections of the current speed were addressed. The remaining flight time was designed as the correction time. The acceleration correction formulas were established through sharing the direction angle corrections of the current speed into the whole remaining guided flight to reduce the possibility of command saturation. By predicting the impact point and distributing the acceleration corrections continuously, the trajectory was shaped in real time. The simulation results show that the proposed guidance law is feasible and effective, and provides the performances of high precision with little requirements of control authority, and has great guidance and damage effects, which can provide reference for the application of the guided projectile.

guided projectile; guidance law; trajectory correction; impact point prediction; remaining flight time

10.11887/j.cn.201604023http://journal.nudt.edu.cn

2015-04-15

國家自然科學基金資助項目(11402117)；中國博士后基金資助項目(2013M541676)

徐秋坪(1990—)，男，重慶開縣人，博士研究生，E-mail：qiupxu@163.com；王中原(通信作者)，男，教授，博士，博士生導師，E-mail：zywang@njust.edu.cn

TJ765.3

A

1001-2486(2016)04-143-10