花文華,孟慶齡,張金鵬,
(1. 中國空空導(dǎo)彈研究院,河南 洛陽 471009; 2. 航空制導(dǎo)武器航空科技重點(diǎn)實(shí)驗(yàn)室,河南 洛陽 471009)
?
高階控制導(dǎo)彈自適應(yīng)滑模制導(dǎo)律
花文華1,孟慶齡2,張金鵬1,2
(1. 中國空空導(dǎo)彈研究院,河南 洛陽471009; 2. 航空制導(dǎo)武器航空科技重點(diǎn)實(shí)驗(yàn)室,河南 洛陽471009)
為改善制導(dǎo)精度,提高對目標(biāo)信息濾波器估計誤差的魯棒性,提出了一種濾波器加自適應(yīng)滑模制導(dǎo)律的設(shè)計方法。濾波器提供制導(dǎo)律執(zhí)行所需的必要信息,如目標(biāo)加速度等,而自適應(yīng)滑模制導(dǎo)律進(jìn)一步增強(qiáng)對信息估計誤差的魯棒性,同時由于采用了自適應(yīng)設(shè)計,避免了對干擾或誤差上界保守估計所帶來的制導(dǎo)性能損失。濾波器和滑模制導(dǎo)律從一般意義上進(jìn)行設(shè)計,可適用于攔截導(dǎo)彈和目標(biāo)具有高階控制動態(tài)的情形?;贛onter Carlo法進(jìn)行了仿真驗(yàn)證,結(jié)果表明相比于最優(yōu)制導(dǎo)律具有較強(qiáng)的魯棒性和制導(dǎo)性能優(yōu)勢。
制導(dǎo)律;滑??刂?;高階控制;自適應(yīng)控制;濾波器估計誤差;Monter Carlo仿真
經(jīng)典制導(dǎo)律,如比例導(dǎo)引并不要求準(zhǔn)確的目標(biāo)加速度信息,脫靶量可通過相對目標(biāo)的機(jī)動性能優(yōu)勢保證,彈目機(jī)動性能比一般大于3。而對于現(xiàn)代制導(dǎo)律,對機(jī)動性能的要求下降,但為保證脫靶量,往往就需要目標(biāo)的相關(guān)信息[1-2],如加速度等,而目標(biāo)加速度是無法直接量測的,需要基于相關(guān)量,如視線角的噪聲量測進(jìn)行觀測或重構(gòu)。因此最終的制導(dǎo)精度受限于濾波器的性能,包括精度、延遲等。為進(jìn)一步改善制導(dǎo)精度,提高對目標(biāo)加速度估計誤差的魯棒性,本文提出一種濾波器加滑模制導(dǎo)律的設(shè)計方法,濾波器提供制導(dǎo)律執(zhí)行所需的信息,而通過滑模制導(dǎo)律[3-8]設(shè)計增強(qiáng)對濾波器估計誤差的魯棒性,從而改善制導(dǎo)性能。
制導(dǎo)末端的彈目相對運(yùn)動關(guān)系如圖1所示,x軸沿初始視線方向,下標(biāo)P和E分別表示攔截導(dǎo)彈和目標(biāo)的相關(guān)狀態(tài),a,v和γ為相應(yīng)的加速度、速度和航向角,y表示攔截導(dǎo)彈和目標(biāo)相對于初始視線方向的位移?;谙率黾僭O(shè)進(jìn)行問題的分析:
(1) 攔截導(dǎo)彈和目標(biāo)二者可近似為具有線性動態(tài)特性的質(zhì)點(diǎn),并可沿初始視線方向進(jìn)行線性化;
(3) 二者控制系統(tǒng)動態(tài)滿足最小相位特性。
圖1 平面相對運(yùn)動關(guān)系Fig.1 Planar engagement geometry
基于圖1和假設(shè)(1),攔截導(dǎo)彈和目標(biāo)相對運(yùn)動關(guān)系可近似表示為
(1)
(2)
假設(shè)攔截導(dǎo)彈控制系統(tǒng)階數(shù)為n,則其控制系統(tǒng)可表示為
(3)
參考攔截導(dǎo)彈,具有m階的目標(biāo)控制系統(tǒng)可表示為
(4)
式中:d1,d2≥0;uEc為目標(biāo)控制命令。
定義狀態(tài)變量x=(y,v,aE,pE,aP,pP)T,則系統(tǒng)狀態(tài)方程可表示為
(5)
基于假設(shè)(1)和假設(shè)(2),攔截導(dǎo)彈飛行時間為
tf≈r0/vc,
(6)
式中:r0為彈目初始距離;vc為接近速度,近似為(vP+vE)。剩余飛行時間可表示為
tgo=tf-t.
(7)
2.1系統(tǒng)降階
基于式(5)求解零控脫靶量z(t),z(t)表示攔截導(dǎo)彈和目標(biāo)由給定的時間t起不施加任何控制,以該瞬時參數(shù)飛行,至命中時所產(chǎn)生的脫靶量,也即式(5)的奇次解。所求解的z(t)可表示為
z(t)=κ(t)x(t),
(8)
式中:
(9)
對式(8)兩邊關(guān)于時間t求導(dǎo),可以得到:
(10)
式中:
(11)
(12)
原系統(tǒng)(5)被降階為以零控脫靶量作為變量的標(biāo)量形式。文獻(xiàn)[9]基于對最優(yōu)控制理論的分析,給出了相似的變換過程,稱為終端投射變換(terminal projection transformation)。
2.2滑模制導(dǎo)律推導(dǎo)
式(10)中包含目標(biāo)控制量部分uEc,是未知的,因此在制導(dǎo)律的執(zhí)行過程中需要對這一量進(jìn)行在線估計。無論采用何種濾波方式,估計結(jié)果卻總是存在誤差和延遲的,從而影響最終的脫靶量。本文設(shè)計了一種自適應(yīng)滑模制導(dǎo)律,與目標(biāo)信息濾波器集成使用以增強(qiáng)對估計誤差的魯棒性。
基于降階后的狀態(tài)方程(10)進(jìn)行自適應(yīng)滑模制導(dǎo)律的推導(dǎo)。由于z(tf)=y(tf),所以選取零控脫靶量z(t)作為滑模面可以實(shí)現(xiàn)零脫靶量。定義滑模面:
s=z(t).
(13)
由于目標(biāo)控制量uEc及其估計誤差總是有界的,基于滑??刂品椒?,將其當(dāng)作有界干擾對待,并且取其界值為Δ。定義Lyapunov函數(shù):
(14)
對式(14)兩邊關(guān)于時間t求導(dǎo),并結(jié)合式(10)可以得到:
(15)
選取控制量和自適應(yīng)律:
(16)
(17)
(18)
(19)
(20)
式(19),(20)和(8)即構(gòu)成了所設(shè)計的高階控制自適應(yīng)滑模制導(dǎo)律(high-order control adaptive sliding-mode guidance law, HOASM)。該制導(dǎo)律設(shè)計中既考慮到了目標(biāo)加速度及其估計誤差的影響,因此對這2種干擾都具有較強(qiáng)的魯棒性,同時由于采用了自適應(yīng)設(shè)計,避免了對干擾或誤差上界Δ保守估計所帶來的制導(dǎo)性能損失。
假設(shè)攔截導(dǎo)彈和目標(biāo)具有相互獨(dú)立的過程噪聲且符合高斯分布,均值為0,標(biāo)準(zhǔn)方差分別為σP和σE。結(jié)合圖1,采用一定的彈上量測設(shè)備可對彈目距離r、視線角q和導(dǎo)彈橫向加速度aP進(jìn)行量測。假設(shè)r是可精確量測的,q和aP具有一定的量測噪聲,并且假設(shè)噪聲為白噪聲且符合高斯分布,標(biāo)準(zhǔn)方差分別為σq和σap。量測方程表示為
(21)
由于考慮非完全信息情形,主要應(yīng)用成型濾波器(shaping filter, SF)表示目標(biāo)的隨機(jī)機(jī)動策略,采用任意且不局限于白噪聲的隨機(jī)輸入驅(qū)動整個系統(tǒng),進(jìn)而實(shí)現(xiàn)系統(tǒng)的擴(kuò)展。擴(kuò)展后的系統(tǒng),包括原系統(tǒng)和一個SF,與原系統(tǒng)具有相同的一階矩和二階矩。基于式(5),經(jīng)過擴(kuò)展后的系統(tǒng)狀態(tài)方程可以表示為
(22)
[10-12],假設(shè)攔截導(dǎo)彈和目標(biāo)具有一階控制系統(tǒng)動態(tài),則零控脫靶量可表示為
(23)
ψ(α)=exp(α)+α-1,
(24)
式中:τP和τE分別為攔截導(dǎo)彈和目標(biāo)的控制系統(tǒng)時間常數(shù)。結(jié)合式(10),可以得到
κP=τPψ(tgo/τP),
(25)
κE=τEψ(tgo/τE),
(26)
用于制導(dǎo)律(19)和自適應(yīng)律(20)的執(zhí)行。
濾波器量測方程(21)和狀態(tài)方程(22)可表示為
(27)
(28)
式中:
如圖1所示,針對一類末端迎面攔截情形進(jìn)行了仿真研究,仿真框圖如圖2所示,假設(shè)目標(biāo)機(jī)動為具有一次時間切換的“bang-bang”類型[10],γP(0)≈0,γE(0)≈0,其他仿真參數(shù)如表1所示。仿真結(jié)果如圖3~6所示。
圖2 仿真框圖Fig.2 Simulation block diagram
表1 仿真參數(shù)
Table 1 Simulation parameter
參數(shù)值導(dǎo)彈飛行速度vP/(m·s-1)1200目標(biāo)飛行速度vE/(m·s-1)800導(dǎo)彈控制系統(tǒng)時間常數(shù)τP/s0.2目標(biāo)控制系統(tǒng)時間常數(shù)τE/s0.2導(dǎo)彈最大機(jī)動性能amaxP30g目標(biāo)最大機(jī)動性能amaxE10g彈目初始距離r0/m6000過程噪聲σP,σE0.1g,1g量測噪聲σq,σap1mrad,0.1g
Kalman濾波器可以實(shí)現(xiàn)估計誤差的均方根最小,能夠隨著噪聲的大小進(jìn)行帶寬的自適應(yīng)調(diào)整,然而當(dāng)狀態(tài)變量發(fā)生切變時,例如“bang-bang”目標(biāo)機(jī)動[13],這一變量的估計誤差會變大,需要一定的時間才能夠收斂到新值,即存在估計延遲,如圖3所示為tsw=1.5 s時的目標(biāo)加速度估計結(jié)果。圖4和圖5分別為采用所設(shè)計的自適應(yīng)滑模制導(dǎo)律和最優(yōu)制導(dǎo)律的脫靶量變化曲線和導(dǎo)彈加速度變化曲線,相應(yīng)的脫靶量為0.21 m和1.30 m。
圖3 目標(biāo)加速度估計Fig.3 Estimation of target acceleration
圖4 脫靶量Fig.4 Miss distance
圖5 導(dǎo)彈加速度Fig.5 Missile accelerations
圖6為所設(shè)計的高階控制導(dǎo)彈自適應(yīng)滑模制導(dǎo)律(HOASM)和最優(yōu)制導(dǎo)律[14](optimal guidance law, OPG)的制導(dǎo)性能統(tǒng)計比較。仿真中兩者取相同的目標(biāo)機(jī)動命令切換時間tsw和隨機(jī)數(shù)產(chǎn)生器種子,采用單發(fā)命中概率[12, 15]作為衡量指標(biāo),Monte Carlo仿真次數(shù)為500次。從圖6中可以看出,由于增強(qiáng)了對目標(biāo)估計誤差的魯棒性,HOASM制導(dǎo)性能優(yōu)于OPG。當(dāng)濾波器具有足夠收斂時間的情況下,濾波精度較高,OPG和HOASM的制導(dǎo)性能基本相當(dāng),但當(dāng)收斂時間不足時,如制導(dǎo)尾端的目標(biāo)機(jī)動命令切換,HOASM的魯棒性則較強(qiáng),性能較好。
圖6 單發(fā)命中概率Fig.6 Single shoot kill probability
本文考慮攔截導(dǎo)彈和目標(biāo)具有任意高階控制的情形,設(shè)計了具有一般性的自適應(yīng)滑模制導(dǎo)律和濾波器。濾波器提供制導(dǎo)律執(zhí)行所需的估計信息,而自適應(yīng)滑模制導(dǎo)律增強(qiáng)了對目標(biāo)加速度及其估計誤差的魯棒性。仿真結(jié)果表明,該制導(dǎo)律相比于最優(yōu)制導(dǎo)律具有較為明顯的性能優(yōu)勢。
在制導(dǎo)律推導(dǎo)過程中,僅將濾波器的目標(biāo)加速度及其估計誤差考慮到制導(dǎo)律的設(shè)計當(dāng)中,并未進(jìn)一步考慮估計延遲的影響,還有待進(jìn)一步的研究。
參考文獻(xiàn):
[1]SHINAR J, TIRETSKY V, OSHMAN Y. Integrated Estimation/ Guidance Design Approach for Improved Homing Against Randomly Maneuvering Targets[J]. Journal of Guidance, Control and Dynamics, 2007, 30(1): 154-161.
[2]SHINAR J, TIRETSKY V. Three-Dimensional Validation of an Integrated Estimation/Guidance Algorithm Against Randomly Maneuvering Target[J]. Journal of Guidance, Control and Dynamics, 2009, 32(3): 1034-1038.
[3]ZHOU Di, MU Chun-di, XU Wen-li. Adaptive Sliding-Mode Guidance of a Homing Missile[J]. Journal of Guidance, Control and Dynamics, 1999, 22 (4): 589-594.
[4]ZHOU Jun, WANG Ting. Integrated Guidance Control System for Beam-Riding Guidance Missiles Based on Second Order Sliding Mode Control[J].Journal of Astronautics, 2007, 28(6): 1632-1637.
[5]BRIERLEY S D, LONGCHAMP R. Application of Sliding-Mode Control to Air-Air Interception Problem[J].IEEE Transactions on Aerospace and Electronic Systems, 1990, 26(2): 306-325.
[6]MOON J, KIM Y. Design of Missile Guidance Law via Variable Structure Control[J]. Journal of Guidance, Control, and Dynamics, 2001, 24(4): 659-664.
[7]花文華, 陳興林. 前向攔截自適應(yīng)滑模制導(dǎo)律[J]. 哈爾濱工業(yè)大學(xué)學(xué)報, 2011, 43(11): 30-33.
HUA Wen-hua, CHEN Xing-lin. Adaptive Sliding-Mode Guidance Law for Head Pursuit[J]. Journal of Harbin Institute of Technology, 2011, 43(11): 30-33.
[8]花文華, 陳興林. 自適應(yīng)二階滑模制導(dǎo)律[J].現(xiàn)代防御技術(shù),2011, 39(6):121-125,143.
HUA Wen-hua, CHEN Xing-lin. Self-Adaptive Second Order Sliding-Mode Guidance Law[J].Modern Defence Technology,2011, 39(6):121-125,143.
[9]BRYSON Jr A E, HO Y C. Applied Optimal Control: Optimization, Estimation and Control[M]. Waltham, MA: Blaisdell, 1969:148-176.
[10]SHINAR J, SHIMA T. Nonorthodox Guidance Law Development Approach for Intercepting Maneuvering Targets[J]. Journal of Guidance, Control and Dynamics, 2002, 25(4): 658-666.
[11]花文華, 孟慶齡. 尋的導(dǎo)彈范數(shù)型微分對策制導(dǎo)律[J]. 高技術(shù)通訊, 2013, 23(4):392-399.
HUA Wen-hua, MENG Qing-ling. Norm Differential Game Guidance Laws for Homing Missiles[J].Chinese High Technology Letters, 2013, 23(4):392-399.
[12]花文華, 孟慶齡. 有界控制導(dǎo)彈隨機(jī)最優(yōu)制導(dǎo)律[J]. 固體火箭技術(shù), 2015, 38(1):7-11,17.
HUA Wen-hua, MENG Qing-ling. Stochastic Optimal Guidance Law for Bounded-Control Missiles[J].Journal of Solid Rocket Technology, 2015, 38(1):7-11,17.
[13]SHINAR J, STEINBERG D. Analysis of Optimal Evasive Maneuvers Based on a Linearized Two-Dimensional Kinematic Model[J]. Journal of Aircraft, 1977, 14(8): 795-802.
[14]趙善友. 防空導(dǎo)彈武器尋的制導(dǎo)控制系統(tǒng)設(shè)計[M]. 北京:中國宇航出版社, 1992:315-319.
ZHAO Shan-you. Antiaircraft Missiles Weapons Homing Guidance Control System Design[M].Beijing:China Aerospace Press, 1992:315-319.
[15]SHAFERMAN V, SHIMA T. Cooperative Multiple Model Adaptive Guidance for an Aircraft Defending Missile[C]∥ AIAA Guidance, Navigation, and Control Conference, Toronto, Canada: AIAA Press, 2010: 1-22.
Adaptive Sliding-Mode Guidance Law for High-Order Controlled Missiles
HUA Wen-hua1, MENG Qing-ling2, ZHANG Jin-peng1,2
(1. China Airborne Missile Academy,Henan Luoyang 471009, China;2. Aviation Key Laboratory of Science and Technology on Airborne Guided Weapons, Henan Luoyang 471009, China)
In order to improve guidance performance and robustness of the estimation error of target information, an approach of integrated filter and adaptive sliding-mode guidance law is presented. The filter provides necessary information for the guidance law, such as target acceleration et al, and the adaptive sliding-mode guidance law improves robustness of the estimation error of target information. Adaptive control method is introduced to guidance law design which can avoid guidance performance lost from conservative estimation of system disturbances or errors bounds. The filter and sliding-mode guidance law are deduced in general form and are adapted to interception missile and target with high-order linear control dynamics. Based on Monte Carlo method, simulations are carried out and the results show that as compared to optimal guidance law, the proposed approach has better guidance performance and improved robustness.
guidance law; sliding-mode control; high-order control; adaptive control; filter estimation error; Monter Carlo simulation
2015-08-12;
2015-11-13
航空科學(xué)基金資助項(xiàng)目(2015ZC12006)
花文華(1983-),男,安徽淮北人。高工,博士,主要研究方向?yàn)轱w行器制導(dǎo)與控制。
通信地址:471009河南省洛陽市030信箱5分箱E-mail:huawh6611@163.com
10.3969/j.issn.1009-086x.2016.04.006
TJ765.3
A
1009-086X(2016)-04-0031-06