劉英+段容宜+謝家雨

摘 要 航天器完成預(yù)定任務(wù)后需要再入大氣層，在再入大氣層后需要對(duì)其進(jìn)行定位跟蹤。本文將UKF濾波算法應(yīng)用到對(duì)航天器的跟蹤中，首先建立再入航天器的動(dòng)力學(xué)模型，并利用單個(gè)雷達(dá)觀測(cè)站基于測(cè)角測(cè)距的原理，對(duì)再入航天器進(jìn)行無源定位跟蹤的仿真分析。仿真結(jié)果顯示，此算法有較好的定位跟蹤能力，具有較強(qiáng)的工程需求，實(shí)用性很強(qiáng)。

關(guān)鍵詞 UKF濾波；動(dòng)力學(xué)模型；無源定位跟蹤；測(cè)角測(cè)距

中圖分類號(hào)：V448 文獻(xiàn)標(biāo)識(shí)碼：A 文章編號(hào)：1671-7597（2014）07-0017-02

航天器再入大氣層后，就需要對(duì)其進(jìn)行定位跟蹤，而在正常返回情況下，常用的定位跟蹤方法是基于擴(kuò)展卡爾曼濾波的航天器定位跟蹤，而由于UKF濾波與EKF濾波的共同點(diǎn)是都可以應(yīng)用到對(duì)非線性方程濾波的處理中，所以本文利用UKF濾波來對(duì)航天器進(jìn)行無源定位跟蹤，并比較了EKF濾波與UKF濾波對(duì)目標(biāo)的定位跟蹤誤差。

1 航天器動(dòng)力學(xué)建模

在地心直角坐標(biāo)系下建立再入航天器的動(dòng)力學(xué)方程，對(duì)再入航天器起主要作用力主要有航天器的重力和空氣阻力[1]（假設(shè)為無升力的再入），x，y，z分別表示航天器在地心直角坐標(biāo)系中的位置坐標(biāo)，vx，vy，vz為航天器的速度，γ為氣動(dòng)特性參數(shù)，于是再入航天器的動(dòng)力學(xué)方程可以表示為：

（1）

其中：；；；

；，式中是大氣的相對(duì)密度函數(shù)，本論文中取的是指數(shù)大氣模型，可近似表示為，為地球半徑，是大氣密度模型常數(shù)。是彈道系數(shù)，是某飛行器彈道系數(shù)。

2 UKF濾波算法設(shè)計(jì)

當(dāng)再入航天器的狀態(tài)方程和觀測(cè)方程是非線性方程時(shí)，一般常用的目標(biāo)跟蹤方法是采用擴(kuò)展卡爾曼濾波方法來對(duì)狀態(tài)方程和觀測(cè)方程進(jìn)行線性化處理，即需要進(jìn)行泰勒級(jí)數(shù)展開，并求出雅可比矩陣。而UKF濾波是另一種非線性濾波方法，與EKF濾波不同的是，UKF濾波是以UnscentedTransform變換為基礎(chǔ)，在估計(jì)點(diǎn)附近進(jìn)行確定性采樣，用樣本點(diǎn)的高斯密度近似估計(jì)狀態(tài)的概率密度函數(shù)，UKF濾波算法不需要計(jì)算Jacobian矩陣，估計(jì)精度可以達(dá)到三階的泰勒級(jí)數(shù)展開式[2]，因此比EKF濾波能更好地逼近方程的非線性，具有更高的計(jì)算精度，UKF濾波的具體計(jì)算步驟如下。

1）初始化設(shè)計(jì)。

（2）

2）狀態(tài)估計(jì)。

計(jì)算的Sigma點(diǎn)為：

（3）

（4）

（5）

計(jì)算Sigma點(diǎn)一步預(yù)測(cè)為：

（6）

系統(tǒng)狀態(tài)的一步預(yù)測(cè)及其協(xié)方差矩陣為：

（7）

（8）

Sigma點(diǎn)的觀測(cè)預(yù)測(cè)為：

（9）

觀測(cè)預(yù)測(cè)均值及其協(xié)方差為：

（10）

（11）

增益矩陣為：

（12）

更新后系統(tǒng)狀態(tài)估計(jì)及其協(xié)方差矩陣為：

（13）

（14）

3 觀測(cè)方程設(shè)計(jì)

單站雷達(dá)測(cè)得的距離觀測(cè)量為Rr，俯仰角為Er，方位角為Ar。設(shè)雷達(dá)觀測(cè)站在地心慣性坐標(biāo)系下的位置坐標(biāo)為（），由此得到觀測(cè)方程為：

（15）

其中{nR，nE，nA}為測(cè)量誤差，均假設(shè)為零均值的白噪聲序列。

4 仿真驗(yàn)證

再入航天器狀態(tài)向量，假設(shè)取初始狀態(tài)向量為，彈道式再入航天器的軌道由離散動(dòng)力學(xué)模型生成，離散采樣周期T=0.05 s，雷達(dá)觀測(cè)站在地心直角坐標(biāo)系中的坐標(biāo)為（5000，5000，3000）。β0=0.6，H0=13.41，，系統(tǒng)的狀態(tài)噪聲標(biāo)準(zhǔn)差取1e-4，觀測(cè)量分別為距離、俯仰角和方位角。

根據(jù)再入航天器的微分方程進(jìn)行數(shù)值外推，外推時(shí)間為1050 s，外推步長(zhǎng)50 s，利用UKF濾波算法得到目標(biāo)跟蹤濾波曲線如圖1所示，圖2為曲線的放大圖。

圖1 軌道外推曲線和UKF濾波的跟蹤曲線圖

圖2 軌道外推曲線和UKF濾波跟蹤的放大圖

5 總結(jié)

通過圖1和圖2可以看出，UKF濾波算法能夠完成對(duì)再入航天器的定位跟蹤，并且具有較高的定位精度，從而證明了單個(gè)雷達(dá)測(cè)控站基于測(cè)角和測(cè)距聯(lián)合測(cè)量方法的有效性，具有一定的實(shí)際工程意義。文獻(xiàn)中單站無源定位中所利用的EKF濾波算法的位置均方根絕對(duì)誤差的定位精度在1000米范圍以內(nèi)，通過圖3的仿真數(shù)值結(jié)果可以看出：UKF濾波的位置均方根誤差收斂值為100米以內(nèi)，速度的均方根誤差的收斂值在10 m/s以內(nèi)。收斂時(shí)間大約為200 s。這說明了基于同樣的跟蹤原理，UKF濾波算法對(duì)航天器的跟蹤能夠快速到達(dá)收斂的范圍內(nèi)。

（a）位置誤差RMSE

（b）速度誤差RMSE

圖3 位置和速度均方根誤差

參考文獻(xiàn)

[1]崔乃剛，林曉輝.雷達(dá)對(duì)再入機(jī)動(dòng)目標(biāo)跟蹤算法研究[J].宇航學(xué)報(bào)，1998，19（1）：21-27.

[2]萬莉，劉焰春，皮亦鳴.EKF、UKF、PF目標(biāo)跟蹤性能的比較[J].雷達(dá)科學(xué)與技術(shù)，2007.endprint