（1. 北京理工大學(xué) 機(jī)電學(xué)院，北京 100081；2. 中國科學(xué)院 空間科學(xué)與應(yīng)用研究中心，北京 100190）

（1. 北京理工大學(xué) 機(jī)電學(xué)院，北京 100081；2. 中國科學(xué)院 空間科學(xué)與應(yīng)用研究中心，北京 100190）

針對X射線脈沖星組合導(dǎo)航系統(tǒng)中測量野值導(dǎo)致的導(dǎo)航精度下降問題，利用基于殘差正交性的Unscented Kalman Filter (UKF)容錯濾波方法進(jìn)行野值修正。在深空巡航段，采用基于X射線脈沖星和太陽觀測的組合導(dǎo)航方式，用X射線探測器測量脈沖星光子到達(dá)時間，利用太陽敏感器測量太陽視線方向矢量，并利用聯(lián)邦濾波結(jié)構(gòu)進(jìn)行信息融合。仿真結(jié)果表明，基于 UKF的容錯濾波算法在脈沖星組合導(dǎo)航系統(tǒng)的應(yīng)用中，能夠?qū)σ爸颠M(jìn)行實時修正，避免了導(dǎo)航精度下降，提高了系統(tǒng)的魯棒性和工程實用價值。

脈沖星；太陽敏感器；UKF濾波；野值檢測；容錯濾波

在深空探測活動中，往往存在時間延遲和精度不高的問題，而且地面測控資源有限，因此深空探測需要自主導(dǎo)航技術(shù)的支撐。X射線脈沖星自主導(dǎo)航技術(shù)具有高精度、高自主性的特點，是一種很有應(yīng)用前景的航天器自主導(dǎo)航技術(shù)。該技術(shù)也將在美國宇航局NICER任務(wù)[1]中得到驗證，我國也在積極開展相關(guān)的研制工作[2]。

然而，在長時間的深空飛行中，由于空間中太陽活動、宇宙射線、星際塵埃、元件故障等多種未知因素的影響，導(dǎo)航敏感器得到的探測信息中很容易存在野值，導(dǎo)致濾波結(jié)果變差，甚至發(fā)散，嚴(yán)重影響航天器在深空中的自主飛行安全。因此，需要研究基于野值檢測和信息修正的容錯濾波方法在X射線脈沖星自主導(dǎo)航中的應(yīng)用。

目前對X射線脈沖星自主導(dǎo)航容錯濾波方法的研究仍相對較少。文獻(xiàn)[3]利用魯棒濾波修正星表誤差，但沒有考慮野值因素的影響。文獻(xiàn)[4] 利用脈沖星和捷聯(lián)慣導(dǎo)組成組合導(dǎo)航系統(tǒng)，考慮了天體遮擋因素，利用聯(lián)邦EKF濾波進(jìn)行導(dǎo)航，但捷聯(lián)慣導(dǎo)誤差隨時間漂移，有應(yīng)用的局限性。本文采用X射線脈沖星和太陽敏感器組成組合導(dǎo)航系統(tǒng)，其誤差不隨時間漂移，利用基于殘差正交性的 UKF濾波方法(residual orthogonal unscented Kalman filter，ROUKF）進(jìn)行野值檢測。仿真結(jié)果表明，該方法在X射線脈沖星組合導(dǎo)航系統(tǒng)容錯濾波中，能有效進(jìn)行野值診斷和修正，為未來的工程化應(yīng)用提供了借鑒。

1 數(shù)學(xué)模型

1.1 巡航段軌道動力學(xué)模型

在執(zhí)行深空任務(wù)時，由于航天器在星際巡航段的飛行時間最長，遇到的復(fù)雜情況相對較多，因此選取深空巡航段的導(dǎo)航任務(wù)作為研究對象。

在深空巡航段，常將坐標(biāo)系建立在太陽質(zhì)心J2000慣性坐標(biāo)系中，除太陽中心引力外，還要考慮大行星的攝動引力和太陽光壓作用。其軌道動力學(xué)方程為[5]：

式中：r和v分別為航天器在太陽質(zhì)心J2000慣性坐標(biāo)系中的位置及速度；μs為太陽引力常數(shù)；np為攝動引力的數(shù)目，考慮了太陽系內(nèi)所有大行星的引力； μi為行星的引力常數(shù)； rri為第i顆行星相對于航天器的位置； rpi為第i顆行星在太陽質(zhì)心慣性坐標(biāo)系中的位置；A為航天器受到太陽輻射壓的面積；G為太陽光壓系數(shù)；m為航天器質(zhì)量；a為未建模的其他攝動力。

導(dǎo)航系統(tǒng)中的狀態(tài)變量取為航天器在太陽質(zhì)心J2000慣性坐標(biāo)系中的位置矢量和速度矢量，即

1.2 X射線脈沖星觀測模型

X射線脈沖星高穩(wěn)定的輻射周期和累積脈沖輪廓是高精度自主導(dǎo)航的基礎(chǔ)。X射線光子到達(dá)時間可以被記錄下來，通過時間轉(zhuǎn)換將該時間轉(zhuǎn)化為光子到達(dá)太陽系質(zhì)心的時間，通過歷元折疊可以得到某一歷元的累積脈沖輪廓。時間轉(zhuǎn)換方程為[6]：

式中，tSSB為經(jīng)轉(zhuǎn)換后到達(dá)太陽系質(zhì)心的時間，tSC為光子到達(dá)X射線探測器的時間，n為太陽系質(zhì)心J2000坐標(biāo)系中脈沖星的方向矢量，α和λ為脈沖星的赤經(jīng)和赤緯， rsun為太陽在太陽系質(zhì)心坐標(biāo)系中的位置，c為光速， D0為太陽系質(zhì)心到脈沖星的距離，b為太陽系質(zhì)心在太陽質(zhì)心J2000慣性坐標(biāo)系中的位置。

通過脈沖星數(shù)據(jù)庫，可以預(yù)測獲得同一歷元在太陽系質(zhì)心處的累積脈沖輪廓，通過長期觀測，可以得到X射線脈沖星的相位模型：

經(jīng)輪廓互相關(guān)處理可以得到一個時間延遲量，該時間延遲量即為X射線脈沖星導(dǎo)航的基本觀測量 Δt。

X射線脈沖星導(dǎo)航的測量方程為：

式中，ni=[nixniyniz]T為第i顆X射線脈沖星在太陽系質(zhì)心J2000坐標(biāo)系中的方向矢量，i為導(dǎo)航所使用的脈沖星個數(shù)，w1(k)為測量噪聲。

1.3 太陽敏感器觀測模型

由于在巡航段中，幾乎不存在天體遮擋因素，航天器能夠始終獲得太陽光線信息，因此在姿態(tài)已知的情況下，用太陽敏感器能夠獲得太陽相對于航天器的方向矢量，其測量模型為[7]：

式中， ls為太陽敏感器的基本觀測量——太陽質(zhì)心相對于航天器的方向矢量，r為航天器在太陽質(zhì)心慣性坐標(biāo)系中的位置。

則太陽敏感器的測量方程為：

式中， w2(k)為測量噪聲。

2 組合導(dǎo)航系統(tǒng)設(shè)計

無跡卡爾曼濾波(Unscented Kalman Filter，UKF)在解決非線性問題時，不需要進(jìn)行狀態(tài)方程和測量方程的線性化，因此具有更高的精度。

設(shè)系統(tǒng)的狀態(tài)方程和測量方程如下：

則標(biāo)準(zhǔn)的UKF算法如下[8]：

在UKF濾波器中，該故障檢測函數(shù)為[10]：

則式(18)可以修正為：

式中， f(r)為加權(quán)因子。當(dāng) γk≤ ε時， f(r)=1；當(dāng)γk＞ ε時， f(r) = 1/γk。在統(tǒng)計學(xué)上γk服從自由度為觀測維數(shù)的 χ2分布，ε為在顯著性水平 0.01的情況下 χ2分布的臨界值。

組合導(dǎo)航系統(tǒng)分為X射線脈沖星導(dǎo)航子系統(tǒng)和太陽敏感器導(dǎo)航子系統(tǒng)，每個子濾波器均采用容錯UKF算法進(jìn)行野值檢測和濾波估計，兩個子濾波器的濾波結(jié)果最終利用聯(lián)邦濾波方法進(jìn)行信息融合。關(guān)于聯(lián)邦濾波器的實現(xiàn)可參見相關(guān)資料。

3 數(shù)學(xué)仿真

3.1 仿真條件

1）以美國“深空一號”任務(wù)巡航段的軌道驗證本文算法。航天器在太陽質(zhì)心慣性坐標(biāo)系中的位置初值為(126 966 202.276 870, 71 240 023.368 644, 308 951 743.957 506) km ，速度初值為(-17.012 246 566 619, 25.573 125 836 158, 11.411 474 895 983) km/s 。初始時刻在各方向上的位置誤差為500 km，各方向上的速度誤差為1.5 m/s；

3）導(dǎo)航用的脈沖星為B0531+21、B1937+ 21、B1957+20、B1821-24，探測器面積為1 m2，脈沖信號累積時間為500 s，測量更新時間為500 s，總仿真時間為30 d。

4）為檢驗該組合導(dǎo)航系統(tǒng)的容錯性能，不但對離散野值進(jìn)行了考察，而且對連續(xù)野值進(jìn)行了仿真。在離散野值仿真中，分別在4×105s、8×105s、1.2×106s、1.6×106s處的脈沖星導(dǎo)航測量值中加入 1000 km野值，在5×105s、1×106s、1.5×106s、2×106s處的太陽敏感器測量值中加入0.5 rad野值。在連續(xù)野值仿真中，分別在400 500~410 000 s、1 000 500~1 010 000 s、 2 000 500~2 010 000 s處的脈沖星導(dǎo)航測量值中連續(xù)加入1000 km野值，在500 500~507 500 s、1 500 500~1 507 500 s處的太陽敏感器測量值中連續(xù)加入0.5 rad野值。

3.2 仿真結(jié)果

圖1給出了無野值情況下，UKF濾波和基于殘差正交性容錯UKF濾波的組合導(dǎo)航位置誤差，兩種濾波均能有效收斂。UKF濾波位置精度為0.184 321 km，速度精度為2.569 87×10-6km/s；容錯UKF濾波方法的位置精度為0.184 475 km，速度精度為2.570 16×10-6km/s。說明在無野值情況下，容錯UKF濾波器與UKF濾波器估計結(jié)果相當(dāng)，都具有較高的導(dǎo)航精度。

圖 1 UKF濾波和容錯UKF濾波對比（無野值）Fig.1 UKF and ROUKF results without outliers

圖2和圖3分別給出了在離散野值和連續(xù)野值條件下，UKF濾波和容錯UKF濾波的組合導(dǎo)航位置誤差。由圖2、圖3可知，在較大野值存在時，UKF濾波的估計效果較差，并且在連續(xù)野值情況下位置誤差更大，在仿真條件下達(dá)到上千千米的位置誤差，而容錯UKF濾波能夠有效檢測野值，并進(jìn)行修正，使濾波結(jié)果始終保持較高的導(dǎo)航精度，具有較強(qiáng)的容錯性能。

圖 2 UKF濾波和容錯UKF濾波對比（離散野值）Fig.2 UKF and ROUKF results with discrete outliers

圖3 UKF濾波和容錯UKF濾波對比（連續(xù)野值）Fig.3 UKF and ROUKF results with consecutive outliers

4 結(jié) 論

本文針對X射線脈沖星組合導(dǎo)航中出現(xiàn)的野值問題，利用基于殘差正交性的UKF容錯算法，進(jìn)行野值檢測和修正，并通過仿真實驗進(jìn)行了驗證。結(jié)果表明，在X射線脈沖星組合導(dǎo)航系統(tǒng)中應(yīng)用ROUKF算法，能夠有效識別野值，始終保持較高的定位精度，避免了野值存在時的導(dǎo)航誤差過大問題。

（References）：

[1] Keith C G, Zaven A, Takashi O, et al. The Neutron star Interior Composition ExploreR (NICER): an Explorer mission of opportunity for soft x-ray timing spectroscopy [C]//SPIE Proceedings, Bellingham: SPIE, 2012: 13-20.

[2] Fuchang Zuo, Jianwu Chen, Liansheng Li, et al. Analysis and design of grazing incidence x-ray optics for pulsar navigation[C]//SPIE Proceedings, Bellingham, 2013: 23-30.

[3] 熊凱，魏春嶺，劉良棟. 魯棒濾波技術(shù)在脈沖星導(dǎo)航中的應(yīng)用[J]. 空間控制技術(shù)與應(yīng)用，2008，34(6)：8-12.

XIONG Kai, WEI Chun-ling, LIU Liang-dong. Application of robust filtering in pulsars based navigation[J]. Aerospace Control and Application, 2008, 34(6): 8-12.

[4] 蘇哲，許錄平，張華，等. 基于XPNAV和SINS的容錯組合導(dǎo)航系統(tǒng)[J]. 華中科技大學(xué)學(xué)報（自然科學(xué)版），2011，39(6)：24-28.

SU Zhe, XU Lu-ping, ZHANG hua, et al. Fault-tolerant integrated navigation system based on XPNAV and SINS[J]. Journal of Huazhong University of Science and Technology(Nature Science), 2011, 39(6): 24-28.

[5] 楊成偉，鄭建華. 基于脈沖星和小行星的組合導(dǎo)航在深空巡航段的應(yīng)用[J]. 中國慣性技術(shù)學(xué)報，2012，20(5)：583-586.

YANG Cheng-wei, ZHENG Jian-hua. Integrated navigation based on X-ray pulsars and asteroids during interplanetary cruise[J]. Journal of Chinese Inertial Technology, 2012, 20(5): 583-586.

[6] Li Jianxun, Ke Xizheng. Study on autonomous navigation based on pulsar timing model[J]. Science in China Series G: Physics, Mechanics, Astronomy, 2009, 52(2): 303-309.

[7] Ke Han, Hao Wang, Binjie Tu, et al. Pico-satellite autonomous navigation with magnetometer and sun sensor data [J]. Chinese Journal of Aeronautics, 2011, 24(1): 46-54.

[8] Jwo DahJing, Yang Chifan, Chuang Chihhsun, et al. Performance enhancement for ultra-tight GPS/INS integration using a fuzzy adaptive strong tracking unscented Kalman filter[J]. Nonlinear Dynamics, 2013, 73(1): 377-395.

[9] 榮思遠(yuǎn)，常亞武，崔乃剛. UKF容錯濾波方法在自主導(dǎo)航中的應(yīng)用研究[J]. 宇航學(xué)報，2006，27(4)：605-608.

RONG Si-yuan, CHANG Ya-wu, CUI Nai-gang. Research on the fault tolerant UKF applied on autonomous navigation[J]. Journal of Astronautics, 2006, 27(4): 605-608.

UKF容錯濾波在脈沖星組合導(dǎo)航中的應(yīng)用

楊成偉1，鄭建華2，高 東2

Fault tolerant UKF application in pulsar-based integrated navigation

YANG Cheng-wei1, ZHENG Jian-hua2, GAO Dong2
(1. School of Mechatronical Engineering, Beijing Institute of Technology, Beijing 100081, China; 2. Center for Space Science and Applied Research, Chinese Academy of Sciences, Beijing 100190, China)

In view of the low navigation accuracy caused by the outliers in the pulsar-based integrated navigation system, a residual orthogonal unscented Kalman filter (ROUKF) was employed to correct the outliers. During interplanetary cruise, an integrated navigation was applied which included X-ray pulsar navigation system and sun observation navigation system. The X-ray detector was used to record the arrival times of pulsar photons. The sun sensor was used to measure the sun line-of-sight vector. The information fusion was conducted by the federated filter. Simulation results demonstrate that the ROUKF in the pulsar-based integrated navigation system can effectively correct the outliers. The proposed method improves the robust capability and the application value of the pulsar-based integrated navigation system.

pulsar; sun sensor; unscented Kalman filter; outlier detection; fault tolerant filter

1005-6734(2014)06-0759-04

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

V448.224

A

2014-06-08；

2014-10-27

空間科學(xué)預(yù)先研究項目（XDA04074300）

楊成偉（1986—），男，博士后，從事自主導(dǎo)航研究。E-mail：yangchengwei2009@126.com