張 龍，崔乃剛，王小剛，白俞亮

（哈爾濱工業(yè)大學(xué) 航天工程系，哈爾濱 150001）

強(qiáng)跟蹤-容積卡爾曼濾波在彈道式再入目標(biāo)跟蹤中的應(yīng)用

張 龍，崔乃剛，王小剛，白俞亮

（哈爾濱工業(yè)大學(xué) 航天工程系，哈爾濱 150001）

對(duì)于具有一定機(jī)動(dòng)能力的彈道式再入目標(biāo)跟蹤問題，穩(wěn)定性好、魯棒性強(qiáng)、收斂精度高的估計(jì)方法是保證跟蹤精度的關(guān)鍵。針對(duì)再入運(yùn)動(dòng)模型和測(cè)量體制的強(qiáng)非線性以及目標(biāo)機(jī)動(dòng)引起的濾波精度下降問題，提出一種將強(qiáng)跟蹤濾波（STF）和基于三階球面-向徑容積規(guī)則的容積卡爾曼濾波（CKF）相結(jié)合的強(qiáng)跟蹤-容積卡爾曼濾波（STCKF）。通過將強(qiáng)跟蹤算法中的自適應(yīng)漸消因子引入到濾波時(shí)間更新和測(cè)量更新方程中，在線實(shí)時(shí)調(diào)整濾波增益矩陣，能有效避免模型失準(zhǔn)造成的濾波性能下降，使該算法兼具CKF濾波精度高和STF魯棒性強(qiáng)的優(yōu)點(diǎn)。通過數(shù)學(xué)仿真表明，改進(jìn)后的STCKF可以實(shí)現(xiàn)對(duì)具有機(jī)動(dòng)的彈道式再入目標(biāo)的高精度跟蹤，相對(duì)于CKF精度提高50%，并且具有更強(qiáng)的魯棒性和自適應(yīng)能力。

彈道式再入目標(biāo)跟蹤；容積卡爾曼濾波；自適應(yīng)漸消因子；非線性系統(tǒng)

彈道式再入目標(biāo)的跟蹤是攻防對(duì)抗體系中的關(guān)鍵環(huán)節(jié)，有效的跟蹤可以延長(zhǎng)防御方的反應(yīng)時(shí)間和提高攔截能力。再入稠密大氣的彈道式目標(biāo)具有速度快、飛行時(shí)間短、運(yùn)動(dòng)環(huán)境復(fù)雜的特點(diǎn)，降低了再入目標(biāo)的跟蹤精度。同時(shí)目標(biāo)再入過程中為突防進(jìn)行的機(jī)動(dòng)未知，無法準(zhǔn)確建模，必然會(huì)造成在一段時(shí)間內(nèi)跟蹤模型失準(zhǔn)，進(jìn)一步增加跟蹤的難度。因此，開發(fā)魯棒性強(qiáng)、穩(wěn)定性好、精度高的估計(jì)算法是解決該問題的關(guān)鍵[1]。

理論上，在先驗(yàn)信息（如彈道系數(shù)、目標(biāo)機(jī)動(dòng)大小和時(shí)間）充分的前提下，可以對(duì)再入運(yùn)動(dòng)模型準(zhǔn)確建模。但通常情況下，防御方無法獲取目標(biāo)彈道系數(shù)的真值，可將彈道系數(shù)作為狀態(tài)量進(jìn)行聯(lián)合估計(jì)，彈道系數(shù)初值可借助一定的先驗(yàn)知識(shí)結(jié)合已搜集到的情報(bào)數(shù)據(jù)庫(kù)來確定[2]。但是，目標(biāo)機(jī)動(dòng)大小、時(shí)間和機(jī)動(dòng)形式不能通過先驗(yàn)信息獲取，因此無法建立準(zhǔn)確的目標(biāo)機(jī)動(dòng)模型和應(yīng)用多模型跟蹤方法[3]。

由于目標(biāo)再入運(yùn)動(dòng)方程和雷達(dá)對(duì)目標(biāo)的測(cè)量方程均是待估狀態(tài)量的非線性方程，再入跟蹤系統(tǒng)呈現(xiàn)出較強(qiáng)的非線性特性。傳統(tǒng)的解決非線性實(shí)時(shí)跟蹤濾波問題的方法是擴(kuò)展卡爾曼濾波（EKF）。該方法采用泰勒級(jí)數(shù)展開近似非線性函數(shù)，引入了線性化誤差，對(duì)于非線性強(qiáng)的系統(tǒng)精度較低[4]。不敏卡爾曼濾波（UKF）利用UT變換計(jì)算采樣點(diǎn)，直接對(duì)狀態(tài)的概率分布近似[5]，可得到比EKF高的精度。但對(duì)于高維（維數(shù)大于3）非線性系統(tǒng)，該算法在濾波過程中可能出現(xiàn)協(xié)方差非正定情況，導(dǎo)致濾波數(shù)值不穩(wěn)定甚至發(fā)散，同時(shí)易出現(xiàn)非局部效應(yīng)，嚴(yán)重影響濾波精度[6]。粒子濾波（PF）基于Monte Carlo采樣策略，通過大量的隨機(jī)粒子逼近概率分布函數(shù)，可獲得較高的濾波精度。但是由于粒子數(shù)較多，造成計(jì)算量較大，且易出現(xiàn)粒子退化問題[7]。容積卡爾曼濾波（CKF）采用三階球面-相徑容積規(guī)則來近似經(jīng)非線性函數(shù)傳遞的后驗(yàn)均值和協(xié)方差[8]。與UKF相比，CKF算法中各容積點(diǎn)的權(quán)值均為正，不會(huì)出現(xiàn)協(xié)方差非正定的情況，且數(shù)值穩(wěn)定性好，同時(shí)計(jì)算量遠(yuǎn)小于PF算法，適用于再入目標(biāo)跟蹤問題。

文獻(xiàn)[9-11]對(duì)幾種彈道式再入目標(biāo)的跟蹤濾波方法作了對(duì)比分析。文獻(xiàn)[9]在建立二維非線性目標(biāo)再入模型中，將彈道系數(shù)作為一個(gè)已知的先驗(yàn)信息來考慮，并對(duì)比了EKF、UKF、PF、CADET四種濾波方法。Ming Xin[12]針對(duì)高超聲速再入飛行器的狀態(tài)估計(jì)問題，在Bayesian濾波框架的基礎(chǔ)上，采用任意自由度容積規(guī)則計(jì)算采樣點(diǎn)積分，推導(dǎo)了五階球面-相徑容積規(guī)則的ICKF模型，并與EKF、UKF、三階CKF進(jìn)行對(duì)比，獲得了更高的估計(jì)精度，但是由于采用更高自由度的積分規(guī)則，相對(duì)于三階CKF計(jì)算量增大了幾乎n（狀態(tài)維數(shù)）倍。文獻(xiàn)[13]基于三階球面-相徑積分規(guī)則，結(jié)合強(qiáng)跟蹤濾波STF算法，推導(dǎo)出強(qiáng)跟蹤容積濾波算法，研究了初值不確定并且噪聲方差不準(zhǔn)確的GPS/INS組合導(dǎo)航問題，有效提高了跟蹤精度和系統(tǒng)的魯棒性。文獻(xiàn)[14]為了解決無源傳感器機(jī)動(dòng)目標(biāo)跟蹤系統(tǒng)非線性較強(qiáng)、傳統(tǒng)的跟蹤濾波方法不穩(wěn)定容易發(fā)散的缺陷，在Quadrature 卡爾曼濾波（QKF）基礎(chǔ)上提出了一種帶漸消因子的 QKF（ FQKF）算法。該算法通過引入時(shí)變漸消因子來實(shí)時(shí)調(diào)整誤差協(xié)方差陣，對(duì)狀態(tài)傳播積分點(diǎn)和量測(cè)傳播積分點(diǎn)進(jìn)行漸消，達(dá)到實(shí)時(shí)調(diào)整濾波器增益矩陣的目的，具有STF的優(yōu)良性能，能夠克服QKF算法的缺陷，對(duì)于無源傳感器機(jī)動(dòng)目標(biāo)跟蹤中系統(tǒng)的突變狀態(tài)具有較強(qiáng)的跟蹤能力，但是基于Gauss-Hermite積分規(guī)則對(duì)于非線性系統(tǒng)的積分點(diǎn)個(gè)數(shù)呈指數(shù)增長(zhǎng)，易造成維數(shù)災(zāi)難。

本文針對(duì)彈道系數(shù)未知、帶有一定機(jī)動(dòng)的彈道式再入目標(biāo)跟蹤問題，建立再入目標(biāo)運(yùn)動(dòng)模型和雷達(dá)測(cè)量模型，將彈道系統(tǒng)作為狀態(tài)量進(jìn)行實(shí)時(shí)估計(jì)。建立非線性系統(tǒng)的STF算法，結(jié)合三階球面-相徑積分的CKF算法，設(shè)計(jì)了帶有自適應(yīng)漸消因子的強(qiáng)跟蹤容積卡爾曼濾波算法STCKF。仿真結(jié)果表明，針對(duì)彈道式再入目標(biāo)跟蹤問題，本文提出的改進(jìn)CKF算法的濾波性能優(yōu)于EKF、CKF算法。

1 再入目標(biāo)運(yùn)動(dòng)模型和測(cè)量模型

1.1 再入目標(biāo)運(yùn)動(dòng)模型

彈道式目標(biāo)再入時(shí)，受地球引力和空氣動(dòng)力作用。考慮到彈道式目標(biāo)一般保持零度攻角再入，因此受到的空氣動(dòng)力表現(xiàn)為大氣阻力，大氣阻力加速度方向與再入速度方向相反。為便于描述再入目標(biāo)相對(duì)地面雷達(dá)站的運(yùn)動(dòng)關(guān)系，在地面雷達(dá)站坐標(biāo)系下建立再入目標(biāo)的運(yùn)動(dòng)方程。定義雷達(dá)站坐標(biāo)系o-xyz的原點(diǎn)o位于雷達(dá)站，ox軸指向北方，oy軸垂直地面指向上方，oz軸指向東方，且與ox、oy軸構(gòu)成右手坐標(biāo)系。由于再入時(shí)間較短，可忽略地球自轉(zhuǎn)角速度的影響。對(duì)再入目標(biāo)建模如圖1所示，圖中ag、ad分別是引力加速度和氣動(dòng)力加速度。

假設(shè)地球?yàn)闃?biāo)準(zhǔn)球體，目標(biāo)的位置和速度分量為[x,y,z,vx,vy,vz]T，則彈道式再入目標(biāo)的運(yùn)動(dòng)方程如下：

式中：μ = 3.986×1014m3/s2為地球重力常數(shù)，Re=為目標(biāo)的地心距，Re=6371.11 km為地球平均半徑，為目標(biāo)的再入速度，ρ為大氣密度，CD為氣動(dòng)阻力系數(shù)，A為有效面積，m為目標(biāo)質(zhì)量。定義彈道系數(shù)β，使

圖1 再入目標(biāo)相對(duì)雷達(dá)坐標(biāo)系示意圖Fig.1 Ballistic reentry target in radar frame

由于式(2)中三個(gè)參數(shù)均事先無法獲取，在濾波過程中需要對(duì)彈道系數(shù)建模。文獻(xiàn)[15]對(duì)彈道系數(shù)模型進(jìn)行了系統(tǒng)的總結(jié)，不同的建模方法對(duì)非線性次優(yōu)濾波算法的性能有直接影響。為了保證彈道系數(shù)的非負(fù)性，防止濾波器發(fā)散，本文選用指數(shù)模型，即

式中：0β為彈道系數(shù)初值，具體數(shù)值可根據(jù)經(jīng)驗(yàn)選定。將α的變化率用零均值高斯白噪聲αω表示，即

綜上，選取目標(biāo)的位置、速度和彈道系數(shù)參數(shù)α作為狀態(tài)量x=[x,y,z,vx,vy,vz,α]T，建立離散的狀態(tài)方程：

式中：ΔT為仿真步長(zhǎng)；wk為系統(tǒng)噪聲向量，滿足N(wk;0,Qk)的統(tǒng)計(jì)特性。

注意到，式(1)和(5)中均沒有考慮目標(biāo)機(jī)動(dòng)加速度aj，因此當(dāng)目標(biāo)發(fā)生機(jī)動(dòng)時(shí)，易出現(xiàn)模型失準(zhǔn)。

1.2 測(cè)量模型

采用地面雷達(dá)對(duì)再入目標(biāo)進(jìn)行跟蹤。雷達(dá)對(duì)目標(biāo)的觀測(cè)量是目標(biāo)的斜距r、高低角η和方位角ε，即z=[r,η,ε]T。假設(shè)k時(shí)刻再入目標(biāo)的位置坐標(biāo)是[xk,yk,zk]T，根據(jù)觀測(cè)量定義建立非線性測(cè)量方程：

式中：vk為雷達(dá)測(cè)量噪聲向量，滿足N(vk;0,R)的統(tǒng)計(jì)特性，且vk與wk、xk不相關(guān)。

2 STCKF算法模型

根據(jù)方程(5)和(6)建立的離散非線性系統(tǒng)有如下形式：

式中：xk∈Rn為系統(tǒng)狀態(tài)向量，zk∈Rp為測(cè)量向量，n=5、p=3分別是狀態(tài)向量和測(cè)量向量的維數(shù)，f(·)、h(·)分別是非線性函數(shù)，易看出系統(tǒng)的非線性程度較高。

由于EKF算法經(jīng)過線性化處理存在一階截?cái)嗾`差，而UKF算法在維數(shù)較高時(shí)中心采樣點(diǎn)的權(quán)值小于0，易出現(xiàn)濾波過程中協(xié)方差非正定的情況，導(dǎo)致濾波數(shù)值不穩(wěn)定，基于PF的非線性濾波算法采樣點(diǎn)多、計(jì)算量大。為了滿足工程實(shí)踐中快速、高精度跟蹤的需求，本文采用容積卡爾曼濾波算法，并針對(duì)目標(biāo)可能存在的機(jī)動(dòng)情況對(duì)算法進(jìn)行改進(jìn)，提出一種改進(jìn)的STCKF算法。

2.1 容積卡爾曼濾波CKF算法

CKF算法由學(xué)者Arasararnam和Haykin[8]提出，他們?cè)诟咚?貝葉斯濾波框架基礎(chǔ)上，根據(jù)狀態(tài)的先驗(yàn)均值和協(xié)方差，采用三階球面-相徑積分規(guī)則選取容積點(diǎn)，再將這些容積點(diǎn)經(jīng)非線性函數(shù)傳遞得到新的容積點(diǎn)，通過容積點(diǎn)的加權(quán)處理來近似狀態(tài)后驗(yàn)均值和協(xié)方差。

針對(duì)非線性系統(tǒng)(7)，假設(shè)k時(shí)刻的狀態(tài)xk的統(tǒng)計(jì)特性xk～N (xk;,Pk)，CKF具體算法如下：

1）計(jì)算容積點(diǎn)xki。

式中：m=2n；Sk滿足Pk的Cholesky分解，即表示對(duì)n維單位向量e=[1,0, … ,0]T的元素改變?cè)胤?hào)和進(jìn)行全排列所產(chǎn)生的點(diǎn)集，

[1]i表示完整全對(duì)稱點(diǎn)集的第i個(gè)點(diǎn)。

4）估計(jì)k+1時(shí)刻的狀態(tài)誤差協(xié)方差陣Pk+1/k。

9）計(jì)算k+1時(shí)刻的濾波增益矩陣Kk+1。

11）估計(jì)k+1時(shí)刻的狀態(tài)誤差協(xié)方差陣Pk+1。

2.2 非線性強(qiáng)跟蹤STF算法

強(qiáng)跟蹤濾波算法是建立在輸出殘差序列正交性原理之上的卡爾曼濾波器[16]。其基本原理是：通過對(duì)狀態(tài)預(yù)測(cè)協(xié)方差陣引入漸消因子λ，在線實(shí)時(shí)調(diào)整增益矩陣K，強(qiáng)迫輸出的殘差序列正交，這樣就能將殘差序列的有效信息完全提取出來[17]。因此，STF算法具有針對(duì)不準(zhǔn)確模型系統(tǒng)較強(qiáng)的魯棒性。

傳統(tǒng)的STF算法是基于EKF算法建立，適用于非線性較弱的系統(tǒng)，并且計(jì)算漸消因子所需的一些矩陣變量無法在CKF算法中直接得到，因此需要建立非線性系統(tǒng)下的STF算法。非線性STF算法核心結(jié)構(gòu)仍為

其漸消因子λk+1的計(jì)算方法如下：

2.3 改進(jìn)的CKF算法

CKF算法采用三階球面-相徑積分規(guī)則，對(duì)于模型精確系統(tǒng)的狀態(tài)估計(jì)精度可達(dá)到34階，但是對(duì)于系統(tǒng)模型不準(zhǔn)確或系統(tǒng)狀態(tài)存在突變的情況，與其他非線性濾波算法類似，仍會(huì)產(chǎn)生較大的估計(jì)誤差。特別是目標(biāo)再入環(huán)境極為復(fù)雜且存在機(jī)動(dòng)，系統(tǒng)模型無法做到十分精確，僅靠CKF算法不能保證滿意的跟蹤精度。為此，將CKF算法與STF算法結(jié)合，在CKF算法的框架上，將STF中的漸消因子引入到時(shí)間更新方程和測(cè)量更新方程之中，構(gòu)造改進(jìn)的強(qiáng)跟蹤-容積卡爾曼濾波算法（STCKF）。具體算法如下：

式中：上標(biāo)（l）表示未加入漸消因子的情況。

4）根據(jù)xk+1未加入漸消因子的統(tǒng)計(jì)特性計(jì)算更新后的狀態(tài)容積點(diǎn)。

7）根據(jù)式(23)式(28)計(jì)算漸消因子λk+1，并計(jì)算一步預(yù)測(cè)狀態(tài)誤差方差陣Pk+1/k。

8）根據(jù)xk+1加入漸消因子λk+1的統(tǒng)計(jì)特性計(jì)算更新后的狀態(tài)容積點(diǎn)。

11）計(jì)算k+1時(shí)刻的濾波增益矩陣Kk+1。

13）估計(jì)k+1時(shí)刻的狀態(tài)誤差協(xié)方差陣Pk+1。

3 仿真分析

在Matlab7.9(R2009b)環(huán)境下建立地面雷達(dá)站對(duì)彈道式再入目標(biāo)的跟蹤系統(tǒng)，通過蒙特卡洛打靶驗(yàn)證本文提出的改進(jìn)STCKF算法的有效性和優(yōu)越性。首先基于本文建立的再入目標(biāo)運(yùn)動(dòng)模型，在雷達(dá)站坐標(biāo)系下生成再入目標(biāo)軌跡。然后根據(jù)測(cè)量模型生成雷達(dá)測(cè)量信息用于濾波。再入目標(biāo)初始狀態(tài)為 x0= [-230.95 km, 130.55 km, -1090.48 km, -0.015km/s, 0.75 km/s, 5.75 km/s]T，彈道系數(shù)為常值β=5000 kg/m2。目標(biāo)在t=100100.5 s進(jìn)行機(jī)動(dòng)，機(jī)動(dòng)加速度大小為a0= [1,5, 0.5]Tm/s2。觀測(cè)雷達(dá)的測(cè)量數(shù)據(jù)率為10 Hz，測(cè)量噪聲標(biāo)準(zhǔn)差見表1。

設(shè)定蒙特卡洛打靶次數(shù)為200，濾波初值為X0=[-230.15 km, 131.35 km, -1091.28 km, -0.055 km/s, 0.71 km/s, 5.71 km/s, 7000 kg/m2]T?；谏厦娼o出的彈道式再入目標(biāo)運(yùn)動(dòng)模型，分別采用EKF、CKF、STCKF進(jìn)行再入跟蹤濾波，根據(jù)均方根誤差對(duì)比三種算法的性能。均方根誤差RMSE定義如下：

表1 雷達(dá)測(cè)量噪聲標(biāo)準(zhǔn)差Tab.1 Radar measurement standard deviation

圖3 x軸方向位置估計(jì)的均方根誤差Fig.3 RMSE of position estimation in x axis

圖4 y軸方向位置估計(jì)的均方根誤差Fig.4 RMSE of position estimation in y axis

圖5 z軸方向位置估計(jì)的均方根誤差Fig.5 RMSE of position estimation in z axis

圖6 目標(biāo)位置估計(jì)的均方根誤差Fig.6 RMSE of target position estimation

圖7 x軸方向速度估計(jì)的均方根誤差Fig.7 RMSE of velocity estimation in x axis

圖8 y軸方向速度估計(jì)的均方根誤差Fig.8 RMSE of velocity estimation in y axis

圖9 z軸方向速度估計(jì)的均方根誤差Fig.9 RMSE of velocity estimation in z axis

圖10 目標(biāo)速度估計(jì)的均方根誤差Fig.10 RMSE of target velocity estimation

圖2為雷達(dá)坐標(biāo)系下目標(biāo)的再入軌跡以及再入點(diǎn)和落點(diǎn)位置。圖3圖10對(duì)比了STCKF與EKF、CKF對(duì)目標(biāo)位置和速度估計(jì)的均方根誤差。由仿真結(jié)果可知，在t=100 s前，三種濾波方法對(duì)目標(biāo)狀態(tài)的估計(jì)精度相差不大。當(dāng)目標(biāo)發(fā)生機(jī)動(dòng)后，由于模型失準(zhǔn)造成濾波誤差迅速增大，而STCKF相對(duì)CKF和EKF的收斂速度更快且收斂后的誤差最小。這是因?yàn)樵偃肽Ｐ偷姆蔷€性程度較高，通過一階泰勒展開的EKF算法忽略了高階項(xiàng)的影響，且無法根據(jù)殘差的變化自適應(yīng)調(diào)整增益矩陣，因此引起較大的誤差。CKF算法采用三階球面-相徑積分規(guī)則來近似非線性函數(shù)的概率分布，適于非線性強(qiáng)的系統(tǒng)，因此造成的誤差較小。而ST-CKF算法結(jié)合了CKF算法的高精度特點(diǎn)和STF算法魯棒性強(qiáng)的特點(diǎn)，根據(jù)機(jī)動(dòng)模型失準(zhǔn)而引起的殘差計(jì)算漸消因子，并通過漸消因子在線自適應(yīng)調(diào)整增益矩陣強(qiáng)迫殘差正交，使估計(jì)狀態(tài)更符合真實(shí)狀態(tài)的變化，對(duì)目標(biāo)機(jī)動(dòng)過程具有較強(qiáng)的魯棒性和穩(wěn)定性，所以濾波精度相對(duì)CKF有所提高。圖11表明了STCKF對(duì)彈道系數(shù)的估計(jì)精度高于EKF和CKF，并且收斂速度更快。若假定彈道系數(shù)估計(jì)誤差在300 kg/m2以內(nèi)認(rèn)為其收斂，則STCKF可在70 km處收斂，CKF和EKF分別在53 km和50 km處收斂。由于彈道系數(shù)是再入目標(biāo)識(shí)別的重要參數(shù)，因此仿真結(jié)果說明STCKF可在較高高度區(qū)分再入目標(biāo)，為防御系統(tǒng)贏取寶貴時(shí)間。

圖11 目標(biāo)彈道系數(shù)估計(jì)的均方根誤差Fig.11 RMSE of trajectory coefficient estimation

表2 最終收斂精度對(duì)比表Tab.2 Standard deviation of radar measurement

表2對(duì)比了三種算法對(duì)目標(biāo)位置、速度和彈道系數(shù)的收斂精度。易知，STCKF的估計(jì)精度最高，相對(duì)于CKF提高了50%以上，更加直觀地驗(yàn)證了本文基于自適應(yīng)漸消因子的改進(jìn)CKF算法對(duì)于存在機(jī)動(dòng)的再入目標(biāo)可以實(shí)現(xiàn)更高精度的跟蹤。

表3 不同濾波方法使用點(diǎn)的數(shù)量對(duì)比表Tab.3 Number of points used in different filters

基于點(diǎn)遞推的非線性高斯濾波算法的計(jì)算復(fù)雜度是與使用點(diǎn)的數(shù)量成正比的。從表3可以看出，STCKF與CKF均使用14個(gè)點(diǎn)，因此計(jì)算復(fù)雜度基本一致。

通過上述分析可以看出，針對(duì)彈道系數(shù)未知、帶有機(jī)動(dòng)的彈道式目標(biāo)再入跟蹤系統(tǒng)，基于CKF算法提出的帶自適應(yīng)漸消因子的STCKF算法，在沒有明顯增加計(jì)算復(fù)雜度的同時(shí)可以更加精確地估計(jì)目標(biāo)狀態(tài)，并且收斂速度快、魯棒性高、穩(wěn)定性好，較CKF和EKF具有明顯的優(yōu)勢(shì)。

4 結(jié) 論

本文針對(duì)彈道系數(shù)未知且?guī)в袡C(jī)動(dòng)的再入目標(biāo)跟蹤問題，建立了將彈道系數(shù)作為待估狀態(tài)量的再入運(yùn)動(dòng)方程和雷達(dá)測(cè)量方程；針對(duì)系統(tǒng)強(qiáng)非線性特點(diǎn)，在詳細(xì)推導(dǎo)CKF算法和非線性STF算法基礎(chǔ)上，將兩者有機(jī)結(jié)合設(shè)計(jì)出一種適于系統(tǒng)模型失準(zhǔn)或狀態(tài)量突變的帶有自適應(yīng)漸消因子的STCKF算法，給出了STCKF算法的具體實(shí)現(xiàn)步驟，并應(yīng)用于再入目標(biāo)跟蹤問題，對(duì)比分析了多種非線性濾波方法。

通過本文的研究可以得到：

1）彈道式目標(biāo)再入時(shí)飛行環(huán)境復(fù)雜，在彈道系數(shù)未知的情況下，運(yùn)動(dòng)模型和測(cè)量模型具有較強(qiáng)的非線性。同時(shí)，目標(biāo)機(jī)動(dòng)模型無法準(zhǔn)確建立、系統(tǒng)模型失準(zhǔn)降低了跟蹤精度，甚至導(dǎo)致濾波發(fā)散。為了提高再入目標(biāo)的跟蹤精度，研究高精度、強(qiáng)魯棒性的非線性濾波算法具有重要意義。

2）本文提出的改進(jìn)容積卡爾曼濾波算法STCKF通過引入自適應(yīng)漸消因子，根據(jù)殘差的變化實(shí)時(shí)調(diào)整濾波器的增益矩陣。仿真結(jié)果表明STCKF遺傳了STF強(qiáng)魯棒性的特點(diǎn)，顯著提高了傳統(tǒng)CKF在狀態(tài)發(fā)生突變情況下的濾波精度，對(duì)含有機(jī)動(dòng)的再入目標(biāo)跟蹤問題具有較強(qiáng)的魯棒性和自適應(yīng)能力。算法可靠性高，穩(wěn)定性好，計(jì)算量小，適于實(shí)際工程應(yīng)用。

（References）：

[1] 劉也, 余安喜. 彈道目標(biāo)實(shí)時(shí)跟蹤中的濾波方法綜述[J]. 宇航學(xué)報(bào), 2013, 34(11): 1417-1426.Liu Ye, Yu An-xi. Survey of filter algorithms for ballistic target real-time tracking[J]. Journal of Astronautics, 2013, 34(11):1417-1426.

[2] Cardillo G P, Mrstik A V, Plambeck T. A track filter for reentry objects with uncertain drag[J]. IEEE Trans. on Aerospace and Electronic Systems, 1999, 35(2): 394-408.

[3] Tian Si-qing. A novel algorithm of maneuvering target tracking based on AIMM-CKF[C]//2011 International Conference on Electronic & Mechanical Engineering and Information Technology. 2011: 2138-2135.

[4] Forbes J R. Extended Kalman filter and sigma point filter approaches to adaptive filtering[C]//AIAA Guidance, Navigation, and Control Conference. 2010: 7748-7763.

[5] Chang Lu-bin, Hu Bai-qing, An Li, Qin Fang-jun. Transformed unscented Kalman filter[J]. IEEE Trans. on Automatic Control, 2013, 58(1): 252-257.

[6] Liu Xing, Jiang Shou-shan. Research on target tracking based on unscented Kalman filter[C]//Sensors & Transducers, 2013, 153(6): 13-21.

[7] Kim J, Tandale M. Particle filter for ballistic target tracking with glint noise[J]. Journal of Guidance, Control and Dynamics, 2010, 33(6): 1918-1921.

[8] Arasaratnam I, Haykin S. Cubature Kalman filters[J]. IEEE Transactions on Automatic Control, 2009, 54(6): 1254-1269.

[9] Farina A, Ristic B, Benvenuti D. Tracking a ballistic target: comparison of several nonlinear filters[J]. IEEE Trans. on Aerospace and Electronic Systems, 2002, 38(3): 854-867.

[10] Zhao Z L, Chen H M, Chen G S, et al. Comparison of several ballistic target tracking filters[C]//Proc. of the American Control Conference. 2006: 2197-2202.

[11] Kim J, Vaddi S S, Menon P K. Comparison between nonlinear filtering techniques for spiraling ballistic missile state estimation[J]. IEEE Trans. on Aerospace and Electronic Systems, 2012, 48(1): 313-328.

[12] Sun Tao, Xin Ming. Hypersonic entry vehicle state estimation using high degree cubature Kalman filter[C]// AIAA Atmospheric Flight Mechanics Conference, 2014: 2383-2394.

[13] Qiurong Li, Feng Sun. Strong tracking cubature Kalman filter algorithm for GPS/INS integrated navigation system [C]//Proc. of 2013 IEEE International Conference on Mechatronics and Automation. 2013, 1113-1117.

[14] 劉玉磊, 馮新喜, 鹿傳國(guó). 帶漸消因子的Quadrature卡爾曼濾波[J]. 宇航學(xué)報(bào), 2013, 34(10): 1370-1377. LIU Yu-lei，F(xiàn)ENG Xin-xi. A fading quadrature Kalman Filter for nonlinear systems[J]. Journal of Astronautics, 2013, 34(10): 1370-1377.

[15] Li X R, Jilkov V P. Survey of maneuvering target tracking (Part II): Motion Models of Ballistic and space Targets [J]. IEEE Trans. on Aerospace and Electronic Systems, 2010, 46(1): 96-119.

[16] 胡健, 馬大為, 周百令. 快速傳遞對(duì)準(zhǔn)用聯(lián)合強(qiáng)跟蹤Kalman濾波器設(shè)計(jì)與仿真[J]. 中國(guó)慣性技術(shù)學(xué)報(bào), 2010, 18(1): 48 -52. Hu Jian, Ma Da-wei, Zhou Bai-ling. Design and simulation of federated strong tracking filter for rapid transfer alignment[J]. Journal of Chinese Inertial Technology, 2010, 18(1): 48 -52.

[17] 胡高歌, 劉逸涵, 高社生, 楊一. 改進(jìn)的強(qiáng)跟蹤UKF算法及其在INS/GPS組合導(dǎo)航中的應(yīng)用[J]. 中國(guó)慣性技術(shù)學(xué)報(bào), 2014, 22(5): 634-639. HU Gao-ge, LIU Yi-han, GAO She-sheng, YANG Yi. Improved strong tracking UKF and its application in INS/ GPS integrated navigation[J]. Journal of Chinese Inertial Technology, 2014, 22(5): 634-639.

Strong tracking-cubature Kalman filter for tracking ballistic reentry target

ZHANG Long, CUI Nai-gang, WANG Xiao-gang, BAI Yu-liang
(Department of Astronautics Engineering, Harbin Institute of Technology, Harbin 150001, China)

In tracking a maneuverable ballistic reentry target, a proper estimation method with high stability, strong robustness and convergence is key to the tracking accuracy. Based on third-degree spherical-radial cubature rule and by combining strong tracking filtering(STF) and cubature Kalman filtering(CKF) , a strong tracking-cubature Kalman filtering(STCKF) was proposed for the highly nonlinear motion of reentry target and measurement system to overcome the precision decreasing caused by target maneuvering. The adaptive fading factor from STF was added to the equations of time update and measurement update, thus the filtering gain matrix could be adaptively adjusted on-line, and the performance decreasing resulted by model uncertainty could be effectively prevented. In this way, the novel filtering algorithm has such advantages as STF’s strong robustness and CKF’s high accuracy. The simulation results show that the STCKF can obtain improved performance in tracking a ballistic reentry target with maneuvering. The comparison with CKF shows that STCKF can improve the estimation precision of target state by 50% with better robustness and adaptability.

ballistic reentry target tracking; cubature Kalman filter; adaptive fading factor; nonlinear system

V557

A

1005-6734(2015)02-0211-08

10.13695/j.cnki.12-1222/o3.2015.02.014

2014-10-27；

2015-01-13

國(guó)家自然科學(xué)基金（61304236）

張龍（1987—），男，博士研究生，從事目標(biāo)跟蹤、飛行器制導(dǎo)等研究。E-mail：zhanglong_hit@163.com

聯(lián) 系 人：崔乃剛（1965—），男，教授，博士生導(dǎo)師。E-mail：cui_naigang@163.com