基于旋量方法的高超聲速飛行器三維非線性偽最優(yōu)制導(dǎo)律設(shè)計*

彭雙春，朱建文，湯國建，陳克俊

(國防科技大學(xué)航天科學(xué)與工程學(xué)院，湖南長沙 410073)

高超聲速飛行器采用傾側(cè)轉(zhuǎn)彎(Bank-To-Turn，BTT)方式機動飛行。相對于側(cè)滑轉(zhuǎn)彎(Skid-To-Turn，STT)機動控制方式，BTT控制方式在氣動效率、機動能力、控制性能、穩(wěn)定性能、命中精度等方面具有明顯優(yōu)勢［1］，但BTT飛行器通常面臨通道間運動耦合作用［2］。對于高超聲速飛行器而言，由于在末制導(dǎo)過程中進行的是高速及大空域飛行，通道間的運動耦合作用非常嚴重。而在大多數(shù)制導(dǎo)律的推導(dǎo)過程中，一般都假設(shè)飛行器控制系統(tǒng)是穩(wěn)定的，即飛行器的姿控系統(tǒng)使得飛行器穩(wěn)定、視線的俯仰和偏航通道相互解耦，卻忽略了通道耦合對制導(dǎo)律設(shè)計的影響［3－4］。顯然在BTT飛行器的實際作戰(zhàn)過程中，這種假設(shè)是不成立的。因此，需要針對高超聲速飛行器的末制導(dǎo)過程構(gòu)建包含運動耦合信息的制導(dǎo)模型，設(shè)計新型三維制導(dǎo)律來避免這種假設(shè)的不合理性。

更進一步，在實際應(yīng)用中，高超聲速飛行器制導(dǎo)通常需要獲得最佳的制導(dǎo)性能，如脫靶量最小、能量最省、時間最短等，同時，高超聲速飛行器的彈道特性對制導(dǎo)參數(shù)更加敏感，因此為了保證制導(dǎo)過程中彈道平穩(wěn)、光滑，需要對制導(dǎo)參數(shù)進行優(yōu)化。從制導(dǎo)的角度來看，為了保證制導(dǎo)信息的完整性，有些學(xué)者基于李群［5－6］、微分幾何［7－8］、球面幾何［9－10］、微分平坦［11］、矢量描述［12－13］等非線性方法進行了制導(dǎo)模型的構(gòu)建，但這些方法雖然理論完整卻不夠簡潔，因而，制導(dǎo)律的形式復(fù)雜，使得對其直接進行參數(shù)優(yōu)化存在很大的難度。通常的做法是在制導(dǎo)律設(shè)計完成后，參照基于雙平面解耦方法獲得的線性最優(yōu)制導(dǎo)律，完成對制導(dǎo)參數(shù)的設(shè)定，但這實質(zhì)上是一種經(jīng)驗方法，缺乏必要的理論支持，不能夠從理論上保證制導(dǎo)律具有優(yōu)良的制導(dǎo)性能。文獻［14］中設(shè)計了一種能夠較好地描述視線方位的飛行器－目標(biāo)視線矢量的幾何旋量，并最終設(shè)計了一種考慮制導(dǎo)參數(shù)優(yōu)化的新型三維非線性制導(dǎo)律。

1 制導(dǎo)問題分析

構(gòu)建如圖1所示的飛行器對目標(biāo)進行俯沖攻擊的示意圖，目標(biāo)T固定于坐標(biāo)系的原點O，r為彈目視線矢量，其長度為r，從目標(biāo)質(zhì)心T指向飛行器質(zhì)心M。M'為M在xoz平面的投影。qd和qt分別為視線高低角和視線方位角，qtt為視線矢量在轉(zhuǎn)彎平面內(nèi)的方向角。ec，et，ed，er，ett為單位矢量，ec與矢量 OM'同向，et與 y軸同向，er與 r同向，O－eceted構(gòu)成右手直角坐標(biāo)系，O－ederett構(gòu)成右手直角坐標(biāo)系。飛行器M速度為v，ηd為速度矢量在俯沖平面與轉(zhuǎn)彎平面的夾角，θd為速度矢量在俯沖平面內(nèi)的方向角;對應(yīng)地，ηt為速度矢量在轉(zhuǎn)彎平面與俯沖平面的夾角，θt為速度矢量在轉(zhuǎn)彎平面內(nèi)的方向角。

圖1 制導(dǎo)模型示意圖Fig.1 Sketch map of guidance model

制導(dǎo)問題可以描述為彈目視線方位和視線角速度的控制問題:在飛行器接近目標(biāo)的過程中，當(dāng)無終端約束時，制導(dǎo)的目的是使視線轉(zhuǎn)動穩(wěn)定下來，即控制視線角速度收斂至零(ω→0)，從而實現(xiàn)對目標(biāo)的瞄準(zhǔn)式攻擊;而當(dāng)存在終端視線方位約束時，制導(dǎo)的目的是使視線轉(zhuǎn)動到一個確定的方向，即 qd→qdf、qd→qtf，并保持視線角速度的穩(wěn)定，即ω→0。

2 視線旋量與視線旋量速度

2.1 旋量的相關(guān)定義

為了在保證制導(dǎo)信息完整性的同時簡化模型結(jié)構(gòu)，在此參照李群旋量結(jié)構(gòu)［5］，引入角度矢量、視線旋量、視線旋量速度等概念，以實現(xiàn)視線方位和視線角速度的控制。

定義1(角度矢量) 坐標(biāo)平面內(nèi)角度值與垂直于所在平面的單位矢量的乘積稱為角度矢量，單位矢量的方向由坐標(biāo)平面內(nèi)角度值的符號唯一確定(如圖1中，qded，qtet分別為視線高低角矢量和視線方位角矢量)。

定義2(視線旋量) 視線高低角矢量和視線方位角矢量的矢量和稱為視線旋量，記為σ。

定義3(視線旋量速度) 視線旋量的導(dǎo)數(shù)稱為視線旋量速度，記為~ω。

根據(jù)以上定義，視線旋量可以表達為

視線旋量速度為

視線旋量的引入能夠為設(shè)計同時滿足入射方位角和落角約束的制導(dǎo)律提供便利，同時，從式(1)可知，視線旋量具有明確的物理意義，便于進行制導(dǎo)參數(shù)的優(yōu)化。

2.2 等價性分析

為了說明視線旋量、視線旋量速度控制分別與視線方位、視線角速度控制的一致性，給定如下的等價性定理及證明。

定理1(等價性定理) 視線旋量控制與視線方位控制等價;視線旋量速度控制與視線角速度控制等價。

證明:(Ⅰ)假設(shè) σf=qdfedf+qtfetf，視線旋量控制的目標(biāo)為σ→σf，則

從而視線旋量控制與視線方位控制等價。 □

(Ⅱ)根據(jù)定義3，視線旋量速度為

根據(jù)視線角速度加法定理［12，15］，飛行器－目標(biāo)視線角速度矢量ω可以表示為視線高低角速度和視線方位角速度的矢量和，即

視線角速度的控制目標(biāo)為ω→0，即

則視線旋量速度控制與視線角速度控制等價?！?/p>

綜上所述，定理1得證。

基于等價性定理，可以將視線方位和角速度控制問題轉(zhuǎn)化為視線旋量和旋量速度控制問題。

3 三維非線性制導(dǎo)模型構(gòu)建

對式(4)求導(dǎo)可得視線旋量速度變化模型為

從式(7)可以看出，求解模型的關(guān)鍵是確定參數(shù)¨qd，¨qt，˙ed，¨ed的表達式。

1)計算¨qd。設(shè)θd＜0，則在俯沖平面內(nèi)有

由圖1可得

將式(9)中第二式兩邊同時對時間求導(dǎo)，并將式(8)和式(9)代入，即可得

在實際飛行過程中，由于˙v/v≈0，定義Tg=－r/˙r(r＞0)，則式(10)可改寫為

2)計算¨qt。設(shè)r1，v1，θt1分別為轉(zhuǎn)彎平面內(nèi)參數(shù)r、v、θt在水平面內(nèi)的投影分量。同理，在轉(zhuǎn)彎平面的水平投影平面內(nèi)有

由圖1可得

運用與俯沖平面相同的推導(dǎo)方式，可得

式(14)中，˙v1/v1≈0，r1=rcosqd，則

將式(15)代入式(14)得

3)計算˙ed，¨ed。根據(jù)圖1，有

將式(11)、式(15)、式(17)、式(18)代入式(7)，并令u，經(jīng)整理可得

式(19)中，u為控制項，Ω為運動耦合項。在飛行器進行高速大空域機動制導(dǎo)時，Ω將具有較大的值，在制導(dǎo)律設(shè)計過程中不可簡單忽略。

由此，基于視線旋量和旋量速度，可得三維非線性制導(dǎo)模型為

從式(20)可以看出，基于視線旋量和視線旋量速度的模型描述方式較好地分離了控制量和耦合量，從而使得三維非線性制導(dǎo)模型結(jié)構(gòu)相對簡單，便于進行后續(xù)制導(dǎo)參數(shù)優(yōu)化。

4 三維非線性偽最優(yōu)制導(dǎo)律設(shè)計

從式(20)可以看出:若直接求解最優(yōu)制導(dǎo)問題，將面臨難以克服的Riccati微分方程求解困難，難以獲得解析解。引入偽控制變量［6］，將復(fù)雜的非線性微分方程轉(zhuǎn)化為線性微分方程，然后進行最優(yōu)制導(dǎo)律的設(shè)計。定義偽控制變量~u為

則模型可以簡化為

從而，在不損失制導(dǎo)信息的前提下，制導(dǎo)模型轉(zhuǎn)化為線性形式，可以方便地基于二次型最優(yōu)方法進行三維制導(dǎo)律設(shè)計。設(shè)計相應(yīng)的二次型目標(biāo)函數(shù)為

4.1 無終端約束情況

基于等價性定理，無終端約束制導(dǎo)問題可以等價于視線旋量速度趨于零(~ω→0)的問題。取狀態(tài)變量x=~ω，則可得狀態(tài)方程

結(jié)合目標(biāo)函數(shù)式(23)，根據(jù)極大值原理，線性系統(tǒng)二次型性能指標(biāo)的最優(yōu)控制為

式中P可由逆Riccati方程求解得到:

參照參考文獻［3］的求解過程，解式(26)得

則

則無終端約束情況下的偽最優(yōu)三維非線性制導(dǎo)律為

從式(29)可以看出，在忽略耦合補償項－TgΩ的情況下，式(29)與文獻［3］的結(jié)論是一致的。

4.2 有終端約束情況

對于有終端約束情況，除了要求視線角速度趨于零外，還要求視線方向轉(zhuǎn)移到一個指定的方位，基于等價性定理，即~ω→0且σ→σf，令

則可得到形如式(24)的狀態(tài)方程

其中:

則最優(yōu)控制為

類似4.1節(jié)的推導(dǎo)過程，可得有終端約束情況下經(jīng)過參數(shù)優(yōu)化的三維非線性制導(dǎo)律為

在忽略耦合補償?shù)那闆r下，式(33)與文獻［3］的結(jié)論亦是一致的。

5 仿真驗證

為了驗證制導(dǎo)律有效性，以某BTT－180型飛行器為對象進行相關(guān)驗證實驗，基本參數(shù)設(shè)置如表1所示。

表1 仿真基本參數(shù)Tab.1 Basic parameters for simulation

5.1 仿真算例1:無終端約束攻擊目標(biāo)

初始速度方向設(shè)為－20°(以正北為基準(zhǔn)，逆時針為正)進行仿真實驗，飛行器經(jīng)過112.67s到達目標(biāo)，彈道平穩(wěn)光滑，脫靶量為1.29m，得到無終端約束情況下的仿真結(jié)果如圖2～4所示。從圖2可以看出:飛行彈道末段平直，說明在所設(shè)計制導(dǎo)律的作用下，飛行器能夠?qū)崿F(xiàn)對目標(biāo)的瞄準(zhǔn)式攻擊。從圖3和圖4可以看出:攻角、傾側(cè)角在整個飛行過程中變化平穩(wěn)，在飛行末段均收斂為較小值，這說明制導(dǎo)指令是收斂的，制導(dǎo)系統(tǒng)輸出的制導(dǎo)指令對通道耦合較好地進行了實時補償與控制。

圖2 無終端約束彈道(本文方法)Fig.2 Trajectory without ending constraint in the proposed method

忽略耦合項影響，采用傳統(tǒng)通道解耦方法［3］來進行相應(yīng)對比仿真，得到仿真結(jié)果如圖5～7所示。

飛行器經(jīng)過111.43s到達目標(biāo)，脫靶量為10.51m。從仿真結(jié)果可以看出:在傳統(tǒng)制導(dǎo)律的作用下，飛行器仍保持了較高的制導(dǎo)精度，但當(dāng)制導(dǎo)指令不對通道耦合進行實時補償時，飛行彈道末段不再嚴格收斂，攻角、傾側(cè)角在接近目標(biāo)時才趨于較小值，這說明傳統(tǒng)制導(dǎo)律對彈道的調(diào)整效率相對較低，在初始射向與射面具有較大的偏差情況下，傳統(tǒng)方法難以實現(xiàn)對目標(biāo)的瞄準(zhǔn)式攻擊。

圖3 無終端約束下攻角－射程變化曲線(本文方法)Fig.3 Attack angle versus range without ending constraint in proposed method

圖4 無終端約束下傾側(cè)角－射程變化曲線(本文方法)Fig.4 Bank angle versus range without ending constraint in proposed method

圖5 無終端約束彈道(傳統(tǒng)方法)Fig.5 Trajectory without ending constraint in traditional method

圖6 無終端約束下攻角－射程變化曲線(傳統(tǒng)方法)Fig.6 Attack angle versus range without ending constraint in traditional method

圖7 無終端約束下傾側(cè)角－射程變化曲線(傳統(tǒng)方法)Fig.7 Bank angle versus range without ending constraint in traditional method

5.2 仿真算例2:有終端約束攻擊目標(biāo)

初始條件同仿真算例1，假設(shè)目標(biāo)位于山谷中，依靠山峰作為天然屏障，為了對目標(biāo)實施有效攻擊，需要避開山峰的障礙、通過設(shè)置合適的入射方位角來降低對彈道落角的要求。設(shè)預(yù)定入射方位角為 －20°，預(yù)定落角為 －60°。導(dǎo)彈經(jīng)過126.51s到達目標(biāo)，脫靶量為1.33m，實際入射方位角為 － 19.58°，實際落角為 59.98°，基于式(33)所示的制導(dǎo)律，得到的結(jié)果如圖8～12所示。從圖8可以看出:飛行器彈道光滑，有效地避開了山峰的障礙，能夠?qū)δ繕?biāo)實施有效的“點穴式”打擊。從圖9、圖10可以看出:在有終端約束條件下，彈道能夠精確地調(diào)整到期望的速度傾角和方位角，從而滿足同時存在入射方位角和落角約束情況下的制導(dǎo)需求。從圖11、圖12可以看出:制導(dǎo)指令變化比較平穩(wěn)，末端攻角、傾側(cè)角收斂，這說明，飛行器在本文制導(dǎo)方法的作用下，通道耦合得到了較好的實時補償控制，不再影響制導(dǎo)系統(tǒng)的魯棒性。

圖8 有終端約束彈道(本文方法)Fig.8 Trajectory with ending constraints in proposed method

圖9 有終端約束下入射方位角－射程變化曲線(本文方法)Fig.9 Incident azimuth angle versus range with ending constraints in proposed method

圖10 有終端約束下落角－射程變化曲線(本文方法)Fig.10 Impact angle versus range with ending constraints in proposed method

圖11 有終端約束下攻角－射程變化曲線(本文方法)Fig.11 Attack angle versus range with ending constraints in proposed method

圖12 有終端約束下傾側(cè)角－射程變化曲線(本文方法)Fig.12 Bank angle versus range with ending constraints in proposed method

在同樣背景下，采用傳統(tǒng)解耦方法進行對比仿真?？紤]到傳統(tǒng)方法不具備按預(yù)定入射方位角攻擊目標(biāo)的能力［3］，而為了避開山峰的障礙，設(shè)預(yù)定落角為 －85°。通過仿真，飛行器經(jīng)過177.05s到達目標(biāo)，脫靶量為11.53m，終端落角為－82.99°，得到的結(jié)果如圖13～16所示。

圖13 有終端約束彈道(傳統(tǒng)方法)Fig.13 Trajectory with ending constraints in traditional method

圖14 有終端約束下落角－射程變化曲線(傳統(tǒng)方法)Fig.14 Impact angle versus range with ending constraints in traditional method

圖15 有終端約束下攻角－射程變化曲線(傳統(tǒng)方法)Fig.15 Attack angle versus range with ending constraints in traditional method

圖16 有終端約束下傾側(cè)角－射程變化曲線(傳統(tǒng)方法)Fig.16 Bank angle versus range with ending constraints in traditional method

從圖15、圖16可以看出:在飛行器接近目標(biāo)時，制導(dǎo)指令發(fā)散，這會影響到制導(dǎo)的穩(wěn)定性，甚至可能導(dǎo)致脫靶。仿真結(jié)果表明:通道耦合對制導(dǎo)系統(tǒng)的影響顯著，需要對其進行實時補償。

6 結(jié)論

面向高超聲速飛行器末制導(dǎo)過程中的運動耦合問題，基于旋量方法進行了三維非線性偽最優(yōu)制導(dǎo)律的設(shè)計。該制導(dǎo)律的設(shè)計具有以下幾點意義:

1)該制導(dǎo)律對通道耦合進行了補償，避免了傳統(tǒng)解耦方法帶來的制導(dǎo)信息損失，保證了制導(dǎo)信息的完整，在理論上具有較高的制導(dǎo)精度;

2)該制導(dǎo)律能夠適應(yīng)同時存在入射方位角和落角約束的情況，降低飛行器制導(dǎo)對落角的控制需求，同時也可以選擇目標(biāo)最薄弱部位進行有效攻擊;

3)該制導(dǎo)律對制導(dǎo)參數(shù)行了優(yōu)化，保證了制導(dǎo)參數(shù)的“偽最優(yōu)”性能，能夠提高制導(dǎo)性能。

需要說明的是:高超聲速飛行器在實際制導(dǎo)過程中，其飛控系統(tǒng)不可避免地受到各種擾動的影響，導(dǎo)引頭/慣導(dǎo)系統(tǒng)的制導(dǎo)信息的測量、傳輸與估計存在偏差和噪聲，目標(biāo)機動也常常被看成是未知的有界擾動，在這些干擾和攝動的作用下，制導(dǎo)系統(tǒng)參數(shù)存在較大的不確定性，這將降低制導(dǎo)律的穩(wěn)定性和魯棒性，影響高超聲速飛行器的制導(dǎo)效果，甚至導(dǎo)致飛行器失穩(wěn)和脫靶。在下一步工作中，將重點針對參數(shù)擾動問題，基于魯棒控制理論，研究設(shè)計三維非線性自適應(yīng)制導(dǎo)律，進一步提高制導(dǎo)系統(tǒng)的穩(wěn)定性。

References)

［1］ Reichert R T.Homing performance comparison of selected airframe configurations using skid-to-turn and bank-to-turn steering policies［R］.NationalAeronautics and Space Administration，1981.

［2］ 佘文學(xué)，周鳳岐.三維非線性變結(jié)構(gòu)尋的制導(dǎo)律［J］.宇航學(xué)報，2004，25(6):681－685.SHE Wenxue，ZHOU Fengqi.High precision 3D nonlinear variable structure guidance law for homing missile［J］.Journal of Astronautics，2004，25(6):681 － 685.(in Chinese)

［3］ 陳克俊，趙漢元.一種適用于攻擊地面固定目標(biāo)的最優(yōu)再入機動制導(dǎo)律［J］.宇航學(xué)報，1994，15(1):1－7.CHEN Kejun，ZHAO Hanyuan.An optimal guidance law of maneuvering reentry vehicle attacking ground fixed targets［J］.Journal of Astronautics，1994，15(1):1 －7.(in Chinese)

［4］ 徐明亮，劉魯華，湯國建，等.高超聲速臨近空間飛行器鉸鏈力矩最小俯沖彈道設(shè)計［J］.彈道學(xué)報，2011，23(3):1－6.XU Mingliang，LIU Luhua，TANG Guojian，et al.Design of dive trajectory of hypersonic near-space vehicle with minimum hinge moment［J］.Journal of Ballistics，2011，23(3):1 －6.(in Chinese)

［5］ 韓大鵬，孫未蒙，鄭志強，等.一種基于李群方法的新型三維制導(dǎo)律設(shè)計［J］.航空學(xué)報，2009，30(3):468－475.HAN Dapeng，SUN Weimeng，ZHEN Zhiqiang，et al.A new 3D guidance law based on a lie-group method［J］.Acta Aeronautica et Astronautica Sinica，2009，30(3):468 －475.(in Chinese)

［6］ 韓大鵬，韋慶，楊樂平，等.任務(wù)空間實時軌跡規(guī)劃的旋量方法［J］.機器人，2008，30(4):304－310.HAN Dapeng，WEI Qing，YANG Leping，et al.A twist-based method for real-time trajectory planning in task space［J］.Robot，2008，30(4):304 －310.(in Chinese)

［7］ Kuo C Y，Chiou Y C.Geometric analysis of missiles guidance command［J］. IEEE Proceedings—ControlTheoryand Applications，2000，147(2):205 －211.

［8］ 張友安，胡云安，蘇身榜.三維制導(dǎo)的幾何方法與魯棒控制方法［J］.航空學(xué)報，2002，23(1):88－90.ZHANG Youan， HU Yunan， SU Shenbang. Geometric approach and robust control approach to three-dimensional missile guidance［J］.Acta Aeronautica et Astronautica Sinica，2002，23(1):88－90.(in Chinese)

［9］ Han Y H，Xu B.Variable structure guidance law for attacking surface maneuver targets［J］.Journal of Systems Engineering and Electronics，2008，19(2):337 －341.

［10］ 史小平，常瑩瑩.非線性三維自適應(yīng)模糊變結(jié)構(gòu)制導(dǎo)規(guī)律的研究［J］.宇航學(xué)報，2009，30(6):2171－2175.SHI Xiaoping，CHANG Yingying.Study on nonlinear threedimensional adaptive fuzzy variable structure guidance law［J］.Journal of Astronautics，2009，30(6):2171 －2175.(in Chinese)

［11］ 韓大鵬，孫未蒙，鄭志強，等.基于微分平坦方法的三維制導(dǎo)律設(shè)計［J］.宇航學(xué)報，2008，29(6):1798－1803.HAN Dapeng，SUN Weimeng，ZHEN Zhiqiang，et al.A flatness based method for 3D guidance law design［J］.Journal of Astronautics，2008，29(6):1798－1803.(in Chinese)

［12］ 彭雙春，孫未蒙，王楠，等.考慮運動耦合的BTT導(dǎo)彈三維制導(dǎo)律設(shè)計［J］.航空學(xué)報，2010，31(5):968－974.PENG Shuangchun，SUN Weimeng，WANG Nan，et al.3D guidance law of BTT missile considering movement coupling［J］.Acta Aeronautica et Astronautica Sinica，2010，31(5):968－974.(in Chinese)

［13］ 彭雙春，潘亮，韓大鵬，等.一種新型三維制導(dǎo)律設(shè)計的非線性方法［J］.航空學(xué)報，2010，31(10):2018－2025.PENG Shuangchun，PAN Liang，HAN Dapeng，et al.A new 3D guidance law based on nonlinear method［J］.Acta Aeronautica et Astronautica Sinica，2010，31(10):2018 －2025.(in Chinese)

［14］ 彭雙春，韓大鵬，潘亮，等.考慮參數(shù)優(yōu)化的BTT導(dǎo)彈三維非線性制導(dǎo)律［J］.控制理論與應(yīng)用，2011，28(9):1069－1074.PENG Shuangchun，HAN Dapeng，PAN Liang，et al.Threedimensional nonlinear guidance law of BTT missile considering parametric optimization［J］.Control Theory ＆ Applications，2011，28(9):1069－1074.(in Chinese)

［15］ Kane T R，Likins P W，Levinson D A.Spacecraft dynamics［M］.New York，USA:McGraw-Hill Book Company，1983.