楊　濤，趙子陽，李醒飛，張家川

（1.天津大學(xué)精密儀器與光電子工程學(xué)院，天津　300072；2.天津航海儀器研究所，天津　300131）

?

基于χ2檢驗的慣性/衛(wèi)星緊耦合系統(tǒng)故障檢測與隔離方法*

楊濤1，2，趙子陽2，李醒飛1，張家川2

（1.天津大學(xué)精密儀器與光電子工程學(xué)院，天津300072；2.天津航海儀器研究所，天津300131）

摘要：研究了一種基于χ2檢驗的慣性/衛(wèi)星緊耦合系統(tǒng)故障檢測與隔離方法，該方法可利用故障檢測函數(shù)自動識別單個衛(wèi)導(dǎo)故障，并實時剔除故障星重構(gòu)觀測信息序列，從而避免了對緊耦合系統(tǒng)的影響。構(gòu)建數(shù)字化仿真環(huán)境對所研究的故障檢測與隔離方法進行了仿真，仿真結(jié)果表明，該方法可在衛(wèi)星發(fā)生故障時及時檢測并隔離故障星，并自動實現(xiàn)觀測信息重構(gòu)，保證了緊耦合系統(tǒng)的精度和完好性。

關(guān)鍵詞：殘差χ2檢驗，慣性/衛(wèi)星，緊耦合，故障檢測與隔離

0　引言

慣性/衛(wèi)星緊耦合系統(tǒng)直接利用衛(wèi)星偽距、偽距率等原始觀測量信息估計慣導(dǎo)誤差和接收機鐘差，大大提高了組合系統(tǒng)的精度和連續(xù)性［1 -4］。然而，在工程實際中發(fā)現(xiàn)，在未進行完好性監(jiān)測時，緊耦合濾波器的穩(wěn)定性易受錯誤的星歷參數(shù)、接收機原始觀測量跳數(shù)等因素的影響。衛(wèi)星導(dǎo)航系統(tǒng)曾多次出現(xiàn)過星歷參數(shù)故障，其中最近一次發(fā)生在2014年4月2日，由于地面控制站注入了錯誤的星歷參數(shù)，GLONASS在軌衛(wèi)星星歷參數(shù)誤差驟然增大，導(dǎo)致定位誤差一度達數(shù)十千米［5］。此外，當(dāng)衛(wèi)導(dǎo)接收機發(fā)生故障時，也會導(dǎo)致其輸出的偽距和偽距率等測量參數(shù)出現(xiàn)野值，這些都會嚴(yán)重干擾緊耦合系統(tǒng)的正常運行。為此，開發(fā)一種可實時運行的系統(tǒng)級故障檢測與隔離方法顯得十分必要。

國內(nèi)外已有許多學(xué)者開展了接收機自主完好性監(jiān)測（RAIM）方法及慣導(dǎo)輔助的完好性監(jiān)測方法研究［6 -9］，傳統(tǒng)的RAIM方法對星座分布等外部條件的要求較嚴(yán)格，使用受到一定限制，且絕大部分慣導(dǎo)輔助的衛(wèi)導(dǎo)完好性監(jiān)測研究成果都側(cè)重于理論建模與仿真，未考慮故障檢測與隔離方法的實時運行。本文擬首先建立慣性/衛(wèi)星緊耦合系統(tǒng)的數(shù)學(xué)模型，之后研究兩種基于χ2檢驗的故障檢測與隔離方法，利用模擬的慣性和衛(wèi)星系統(tǒng)開展數(shù)字仿真，對所研究的故障檢測與隔離方法進行驗證，最后得出結(jié)論。

1　慣性/衛(wèi)星緊耦合系統(tǒng)數(shù)學(xué)模型

1.1系統(tǒng)狀態(tài)方程

對于艦船等載體，可選取慣導(dǎo)及衛(wèi)導(dǎo)接收機誤差參數(shù)等作為誤差狀態(tài)［10］：

XI=［△Ve，△Vn，△準(zhǔn)，△λ，△φx，△φy，△φz，△εx，△εy，εφz，△ax，△ay，△tu，△tur］

其中：△Ve，△Vn分別為慣導(dǎo)東向速度誤差、北向速度誤差；△準(zhǔn)，△λ分別為慣導(dǎo)緯度誤差、經(jīng)度誤差；△φx，△φy，△φz分別為慣導(dǎo)在載體坐標(biāo)系x、y、z方向的姿態(tài)角誤差；△εx，△εy，εφz分別為慣導(dǎo)載體坐標(biāo)系x、y、z方向陀螺漂移誤差；△ax，△ay分別為慣導(dǎo)載體坐標(biāo)系x、y方向加速度計零位誤差；△tu，△tur分別為衛(wèi)導(dǎo)接收機鐘差及鐘差變化率。

系統(tǒng)狀態(tài)方程為，

X=FX+GW（1）

式中，X為狀態(tài)變量，F(xiàn)為狀態(tài)轉(zhuǎn)移矩陣，G為噪聲驅(qū)動陣，W為系統(tǒng)噪聲。

1.2系統(tǒng)量測方程

采用偽距量測時，慣性/衛(wèi)星緊耦合系統(tǒng)的量測信息為接收機輸出的多星座測量偽距與預(yù)測偽距之間的差值，預(yù)測偽距一般利用慣導(dǎo)位置信息及衛(wèi)星星歷計算得到。系統(tǒng)量測方程為：

Z=HX+V（2）

式中，Z為系統(tǒng)觀測量，H為量測矩陣，V為量測噪聲。

2　基于χ2檢驗的緊耦合系統(tǒng)故障檢測與隔離方法

2.1總體思路

慣性/衛(wèi)星緊耦合系統(tǒng)故障檢測與隔離方法的總體思路是：利用慣導(dǎo)設(shè)備提供的短時間精密導(dǎo)航信息，為衛(wèi)導(dǎo)系統(tǒng)提供序貫新息，利用慣導(dǎo)輸出的用戶位置及衛(wèi)星星歷計算預(yù)測偽距，通過各顆可見星測量偽距與預(yù)測偽距的一致性校驗來判斷GNSS故障。即使在可見星數(shù)少于5顆的條件下，也可利用該方法對緊耦合系統(tǒng)進行完好性監(jiān)測，并對故障星進行檢測與隔離。

在緊組合卡爾曼濾波器中，完好性監(jiān)測在濾波器的時間更新和量測更新之間進行，步驟如下：

①對濾波器的被估計狀態(tài)（包括慣導(dǎo)誤差和衛(wèi)導(dǎo)鐘差等狀態(tài)）進行時間更新，計算狀態(tài)估計預(yù)測值和均方誤差估計預(yù)測值；

②利用預(yù)測的誤差狀態(tài)信息計算量測預(yù)報值及預(yù)報偽距差，進而計算殘差rk和殘差方差A(yù)k，并進行衛(wèi)導(dǎo)故障檢測；

③當(dāng)故障檢測函數(shù)超過告警門限時，利用m-1法進行m次故障檢測排除故障星，最后利用無故障的可見星信息重組觀測量Zk進行量測更新，完成一個濾波循環(huán)。

整個故障檢測與隔離的流程圖如圖1所示。

圖1慣性/衛(wèi)星緊耦合系統(tǒng)故障檢測與隔離流程圖

2.2殘差χ2檢測與隔離方法

卡爾曼濾波器中，殘差可記為：

在慣導(dǎo)輔助衛(wèi)導(dǎo)接收機完好性監(jiān)測時，Hkk/k-1=為一步狀態(tài)估計量測預(yù)報值，是由k時刻慣導(dǎo)誤差傳播方程狀態(tài)更新推出的誤差狀態(tài)估計值乘以量測陣Hk得到的量測預(yù)報值，即偽距差的預(yù)報值。由于卡爾曼濾波屬于線性最小方差估計，因此，殘差rk是白噪聲序列，其方差為

定義檢測函數(shù)為：

顯然λk符合χ2分布。由于贊k/ k-1由{Zk-1，Zk-2，…，Z1}計算得到，可以得到rk各元素不相關(guān)，因此，λk的自由度等于rk的維數(shù)m（即緊耦合系統(tǒng)可見衛(wèi)星數(shù)），此時λk~χ2（m）。確定故障判定準(zhǔn)則為：

式中，故障判定門限TD可由可見衛(wèi)星數(shù)m和虛警率確定，當(dāng)故障檢測周期為1 s，虛警率為0.002/h時，判定門限與可見衛(wèi)星數(shù)關(guān)系如表1所示。

表1檢測門限與可見星數(shù)的關(guān)系

當(dāng)檢測函數(shù)超過門限時，可以判斷存在故障，然后利用m-1組合法進行m次殘差檢驗，即一次排除一顆可見星，利用余下的m-1顆可見星重組偽距差量測量，并進行殘差檢測，以識別故障星。

2.3狀態(tài)χ2檢測與隔離方法

由于卡爾曼濾波采用遞推方式實現(xiàn)狀態(tài)估計，當(dāng)量測量Zk存在慢變故障時（如衛(wèi)導(dǎo)時鐘漂移故障），濾波器將有可能將定位結(jié)果的偏差視為用戶狀態(tài)的正常變化而修正Pk，導(dǎo)致濾波器不再正確跟蹤用戶真正狀態(tài)，即出現(xiàn)“故障跟蹤”現(xiàn)象。此時，在同樣故障偏差條件下，慢變故障對應(yīng)的檢測函數(shù)小于快變故障對應(yīng)的λk，使得殘差檢驗法不易檢測出故障，采用狀態(tài)外推檢驗法可以解決這一問題。

無關(guān)，僅僅是通過慣導(dǎo)誤差傳播方程外推出的偽距差量測預(yù)報值。因此，Z贊sk不會受s時刻到k時刻區(qū)間內(nèi)帶故障的量測更新影響，所以不會出現(xiàn)殘差χ2檢測與隔離方法的“故障跟蹤”現(xiàn)象。

遞推周期m=k-s應(yīng)根據(jù)衛(wèi)導(dǎo)慢變故障檢測的設(shè)計要求進行選擇。遞推周期太短，故障偏差導(dǎo)致的濾波器量測量殘差在短的時間內(nèi)無法發(fā)展到可以被檢測出的程度，因而易產(chǎn)生漏檢；遞推周期太長，一方面會導(dǎo)致狀態(tài)外推的精度降低，使得濾波狀態(tài)在遞推中會越來越偏離真實值，造成無故障時殘差超差，另一方面，遞推周期過長也嚴(yán)重影響了故障檢測的反應(yīng)速度。重新定義殘差與檢測函數(shù)為：

3　仿真驗證與分析

仿真系統(tǒng)主要包括用戶真實軌跡模擬、慣導(dǎo)模擬、衛(wèi)導(dǎo)模擬和故障模擬4個模塊，仿真系統(tǒng)的流程圖如圖2所示。

圖2故障檢測與隔離算法仿真流程圖

仿真參數(shù)的設(shè)置如下：仿真總時間3 600 s；初始位置為東經(jīng)117.143 23°，北緯39.182 33°，海拔0 m；衛(wèi)導(dǎo)的輸出頻率為1 Hz，遮蔽角為5°；慣導(dǎo)的輸出頻率為100 Hz；采用全部可見星濾波，濾波器周期為1 Hz；在第1 100 s~1 500 s模擬2號星突變故障，故障大小為100 m。

仿真的主要步驟如下：

①進行用戶真實軌跡模擬，并在真實軌跡中加入慣導(dǎo)器件誤差模擬慣導(dǎo)輸出，結(jié)合衛(wèi)導(dǎo)星座模擬模塊生成的衛(wèi)星位置模擬測量偽距和預(yù)測偽距。

②在選定的故障衛(wèi)星量測偽距上疊加一個故障值，然后將其送入慣性/衛(wèi)星緊耦合濾波器進行濾波，同時在濾波器中加入上述故障檢測與隔離算法，以檢測和隔離故障星。

③利用濾波器誤差狀態(tài)的估計值來校正慣導(dǎo)輸出，將全部仿真時間內(nèi)校正后的慣導(dǎo)輸出和相應(yīng)的用戶真實位置的數(shù)據(jù)一一記錄并進行比較，繪制誤差曲線圖；記錄每一次濾波的故障檢測函數(shù)值，與相應(yīng)時刻的檢測門限值做比較，并繪制故障檢測函數(shù)曲線圖。

圖3未進行故障檢測與隔離前的經(jīng)度誤差

圖4未進行故障檢測與隔離時的緯度誤差

圖3和圖4給出了衛(wèi)導(dǎo)故障時，未進行故障檢測與隔離前的組合導(dǎo)航定位結(jié)果，圖5給出了對應(yīng)的檢測函數(shù)及門限曲線圖。

圖5未進行故障檢測與隔離前的檢測函數(shù)及門限值

圖6進行故障檢測與隔離后的經(jīng)度誤差

圖6和圖7給出了衛(wèi)導(dǎo)故障時，進行故障檢測與隔離后的組合導(dǎo)航定位結(jié)果，圖8給出了對應(yīng)的檢測函數(shù)及門限曲線圖。

圖7進行故障檢測與隔離后的緯度誤差

圖8進行故障檢測與隔離后的檢測函數(shù)及門限值

從仿真結(jié)果可看出，未進行故障檢測與隔離前，當(dāng)可見星出現(xiàn)故障時會造成緊耦合系統(tǒng)定位精度嚴(yán)重下降，最大位置誤差可達70 m，此時，故障函數(shù)遠(yuǎn)遠(yuǎn)超出門限值；加入故障檢測與隔離模塊后，當(dāng)可見星發(fā)生故障時，殘差χ2檢測與隔離方法能及時檢測并隔離故障星，進行系統(tǒng)重構(gòu)后，故障函數(shù)值遠(yuǎn)遠(yuǎn)低于門限值，系統(tǒng)定位精度也未受到影響。

4　結(jié)論

針對傳統(tǒng)基于衛(wèi)導(dǎo)自身信息的RAIM方法只有在可見衛(wèi)星數(shù)大于或等于5顆時可用的問題，提出一種基于χ2檢驗的慣性/衛(wèi)星緊耦合系統(tǒng)故障檢測與隔離方法，該方法取消了對可見衛(wèi)星數(shù)的限制，當(dāng)導(dǎo)航衛(wèi)星發(fā)生故障時可實時檢測并隔離障星，并利用剩余無故障可見星重構(gòu)量測值序列，從而保證了組合導(dǎo)航系統(tǒng)的定位信息的精度完好性。

參考文獻：

［1］XU X S，ZHANG G L. Implementation of tightly coupled GPS/INS navigation algorithm on DSP［C］//Computer Design and Applications，2010.

［2］WANG X L，LI Y F. An innovative scheme for SINS/GPS ultra-tight integration system with low-grade IMU［J］. Aerospace Science and Technology，2012，23（1）：452-460.

［3］鄭辛，付夢印.SINS/GPS緊耦合組合導(dǎo)航［J］.中國慣性技術(shù)學(xué)報，2011，19（1）：33-37.

［4］閆捷，徐曉蘇，張濤，等.艦載小型化SINS/GNSS緊組合導(dǎo)航系統(tǒng)設(shè)計［J］.中國慣性技術(shù)學(xué)報，2013，21（6）：775-780.

［5］Bhatti U I，Ochieng W Y. Performance of rate detector algorithms for an integrated GPS/INS systems in the presence of slowly growing error［J］. GPS Solutions，2012，16（3）：293-301.

［6］劉海穎，岳亞洲，楊毅鈞.基于多解分離的GNSS/Inertial組合系統(tǒng)完好性監(jiān)測［J］.中國慣性技術(shù)學(xué)報，2012，20 （1）：63-68.

［7］劉海穎，馮成濤，王惠南.一種慣性輔助衛(wèi)星導(dǎo)航系統(tǒng)及其完好性檢測方法［J］.宇航學(xué)報，2011，32（4）：775-780.

［8］鐘麗娜，劉建業(yè)，李榮冰，等.基于LSSVM的慣性/衛(wèi)星緊組合導(dǎo)航系統(tǒng)緩變故障檢測方法［J］.中國慣性技術(shù)學(xué)報，2012，20（6）：754-758.

［9］陳坡，孫付平，景曉鵬，等.基于慣導(dǎo)輔助的GNSS完好性檢測方法研究［J］.大地測量與地球動力學(xué)，2013，33（2）：101-104.

［10］王惠南. GPS導(dǎo)航原理與應(yīng)用［M］.北京：科學(xué)出版社，2003.

聲明

近期有不法機構(gòu)冒用《火力與指揮控制》編輯部名義，以非法手段騙取作者的稿件及財物，因此，我刊鄭重聲明：

從2005年至今，我刊一直使用以下兩種投稿方式：

①電子投稿。投稿郵箱為：HLYZ@chinajoumal.net.cn；hlyz207@126.com，在線投稿尚未啟用，啟用后予以告知。

②信函投稿。郵寄地址為：山西省太原市193信箱《火力與指揮控制》編輯部。郵編：030006。

除此之外無其他任何方式向作者索稿。投稿時可電話咨詢：0351-8725026或0351-8725316。

特此聲明!

《火力與指揮控制》編輯部

2016年2月25日

Approach for Fault Detection and Isolation in INS/GNSS Tightly- coupled System Based on Chi- square Test

YANG Tao1，2，ZHAO Zi-yang2，LI Xing-fei1，ZHANG Jia-chuan2
（1. Tianjin University School of Precision Instrument and Opto-electronics Engineering，Tianjin 300072，China；2. Tianjin Navigation Instruments Research Institute，Tianjin 300131，China）

Abstract：An approach for fault detection and isolation of INS/GPS tightly-coupled system was studied，which could recognize single navigation satellite error automatically by the utilization of fault detection function，could eliminate the fault satellite and reconstruct measurements array，and could avoid the influence of the fault on system. The digital simulation environment was constructed，then simulations of method for fault detection and isolation were conducted，results of which indicated that the proposed method could detect and isolate the fault satellite in time，and could reconstruct measurements information，which ensured the accuracy and integrity of tightly-coupled system.

Key words：chi-square test of filter residual，INS/GNSS，tightly-coupled，fault detection and isolation

作者簡介：楊濤（1979-），男，河北南宮人，博士后，高級工程師。研究方向：慣性/衛(wèi)星組合導(dǎo)航技術(shù)。

*基金項目：海軍重點預(yù)研項目（401010301）；天津市企業(yè)博士后創(chuàng)新基金資助項目（2014-010）

收稿日期：2014-12-20修回日期：2015-02-14

文章編號：1002-0640（2016）02-0169-04

中圖分類號：V249.32

文獻標(biāo)識碼：A