黃欣欣,楊東凱
(北京航空航天大學電子信息工程學院,北京100191)
羅蘭C(Loran-C)是陸基中遠程精密無線電導航系統(tǒng)。系統(tǒng)的地面發(fā)射臺通常由一個主臺和兩個以上的副臺組成,接收機通過測量主副臺脈沖到達時間差 TD(Time Difference),利用雙曲線原理進行定位。羅蘭C信號主要依靠地波傳播,信號功率大、抗電子干擾和抗天體磁暴能力強,這些優(yōu)點是衛(wèi)星信號所不具備的。增強型羅蘭C系統(tǒng)是一個完全獨立的、GNSS的最重要的互補備份系統(tǒng),是羅蘭C系統(tǒng)的發(fā)展方向[1]。
在羅蘭C系統(tǒng)中,受到雜波和環(huán)境噪聲的影響會造成較大的時差測量誤差,甚至會出現(xiàn)因周期識別模糊而造成時差出現(xiàn)幾倍10 μ s的誤差,大大降低羅蘭C接收機的定位精度。解決這個問題的一種辦法是在前端信號處理時,將噪聲和干擾處理干凈,從而避免周期識別模糊。但是僅靠前端的信號處理有時不能完全解決問題,這時就應該采取后端數(shù)據(jù)處理的方法加以消除。
卡爾曼濾波[2]是一種遞推線性無偏最小均方誤差估計算法,它能夠平滑數(shù)值的離散性。采用卡爾曼濾波對羅蘭C接收機輸出的時差數(shù)據(jù)進行處理,減小時差測量誤差,從而提高定位精度。
使用卡爾曼濾波時,首先要對應用對象進行建模,得到狀態(tài)方程與觀測方程,并且要求狀態(tài)方程與觀測方程均為線性,系統(tǒng)噪聲與觀測噪聲均為白噪聲。簡要介紹建立在羅蘭C時差處理問題的卡爾曼濾波算法中用到的消息模型與觀測模型。
消息模型用于描述目標的運動。這種模型將某一時刻的狀態(tài)變量表示為前一時刻狀態(tài)變量的函數(shù),以供濾波算法使用。主要介紹CV(Constant Velocity)模型與CA(Constant Acceleration)模型。
1)CV模型
CV模型假定目標做勻速直線運動,而將加速度看作是零均值白噪聲形式的擾動。其離散形式的狀態(tài)方程為
白噪聲uk為系統(tǒng)噪聲矢量,其協(xié)方差陣為Qk。Φk為狀態(tài)轉(zhuǎn)移矩陣,具體形式如式(2)所示,其中T為采樣間隔。
2)CA模型
CA模型假定目標做勻加速直線運動,而將加速度看作是零均值白噪聲形式的擾動。其離散形式的狀態(tài)方程為
白噪聲uk為系統(tǒng)噪聲矢量,其協(xié)方差陣為Qk。Φk為狀態(tài)轉(zhuǎn)移矩陣,具體形式如式(4)所示,其中T為采樣間隔。
其中,zk為觀測變量,即實際測量的時差值;wk為觀測噪聲,其協(xié)方差陣為Rk;Hk為觀測矩陣,CV、CA模型的Hk取值分別為
用卡爾曼濾波的方法處理狀態(tài)方程(1)或(3)、觀測方程(5),就得到如下的卡爾曼濾波公式[4]
預測
預測誤差相關(guān)陣
增益陣
濾波
濾波誤差相關(guān)陣
所采用的羅蘭C數(shù)字接收機型號為DE8100,該接收機平均每隔5 s更新一次數(shù)據(jù),RS232串口輸出數(shù)據(jù)保存為逗號分隔值文件,包括定位點經(jīng)緯度、同一個臺鏈中兩個臺對的時差(TD1和TD2)等數(shù)據(jù)。根據(jù)研究需要,只選取時差數(shù)據(jù)進行處理。首先對卡爾曼濾波器進行參數(shù)設置:
根據(jù)接收機的測量精度,設觀測噪聲協(xié)方差Rk=1;
系統(tǒng)噪聲協(xié)方差Qk=10-4;
濾波誤差相關(guān)陣初值P0=104I。
靜態(tài)測量[5],即待測點相對于其周圍固定點沒有位置變化,或在一個觀測周期內(nèi),位置變化無法察覺。第一次測量是在羅蘭C7430臺鏈信號覆蓋的區(qū)域內(nèi)選擇某一待測點(山東省煙臺市某地),進行了觀測時長約40 min的數(shù)據(jù)采集。分析該狀態(tài)下采集得到的時差數(shù)據(jù)的特征,其相應的時差一次變化率很小(最大值為0.01 μ s/s),可以將時差近似看成是無機動變化的,因此使用CV模型對其進行處理。選取狀態(tài)初值x0=[z10]T。分別對TD1、TD2進行卡爾曼濾波,濾波前后的時差值如圖1所示,時差單位為 μ s。
對濾波前后的時差值進行統(tǒng)計計算,求得的均方差如表1所示??梢钥吹浇?jīng)過卡爾曼濾波后,時差TD1和TD2的均方差都明顯地減小,這是由于所建立的卡爾曼濾波模型準確,取得了良好的跟蹤性能和濾波精度。
表1 濾波前后的時差均方差比較
第二次測量是在動態(tài)跑車的狀態(tài)下進行數(shù)據(jù)采集。平均運動速度為38 km/h。分析該狀態(tài)下采集得到的時差數(shù)據(jù)的特征,其相應的時差一次變化率(最大值為0.1 μ s/s)和二次變化率(最大值為0.02 μ s/s2)也呈現(xiàn)一定的值,但是,這些值相對有較大加速度的運動體來說也是比較小的,所以就時差本身的機動性而言,它屬于弱機動變化,因此選用CA模型對其進行處理,選取的狀態(tài)初值為x0=[z1 0 0]T。濾波前后的時差值如圖2所示。
從圖2可以看出,所采用的CA模型濾波算法能夠有效地去除動態(tài)跑車情況下的測量時差奇異值,如圖2(b)中第1380 s時刻,達到平滑數(shù)據(jù)的目的,同時也能較好地跟蹤上時差的變化。
針對靜態(tài)定位和動態(tài)跑車兩種情況下的羅蘭C實測時差信號的特征,設計卡爾曼濾波算法,對實際測量數(shù)據(jù)進行處理。結(jié)果表明,所采用的卡爾曼濾波算法能夠有效地減少時差的測量誤差。下一步工作將研究卡爾曼濾波器參數(shù)的大小對濾波性能的影響,對已有算法進行改進。
[1]Gregory W J,Peter F S,Richard J H,et al.An E-valuation of eLoran as a Backup to GPS[C]//Technologies for Homeland Security,2007 IEEE Conference,Woburn,M A,2007:95-100.
[2]李建勛,柯熙政,胡 鋼.長河增強系統(tǒng)發(fā)播信號的定時誤差及其Kalman修正[J].測試技術(shù)學報,2008,22(2):145-149.
[3]周宏仁,敬忠良,王培德.機動目標跟蹤[M].北京:國防工業(yè)出版社,1991.
[4]朱云龍,楊東凱,柳重堪.一種用于高動態(tài)GPS頻率估計的濾波算法[J].北京航空航天大學學報,2009,35(1):23-27.
[5]杜曉輝,任 章.基于卡爾曼濾波的GPS靜態(tài)定位精度分析[J].全球定位系統(tǒng),2008,34(5):47-51.