甘 雨，隋立芬，張清華，肖國銳

(信息工程大學(xué)地理空間信息學(xué)院，河南 鄭州450000)

一、引 言

緊組合模式直接依賴于GNSS原始觀測值，相比松組合，緊組合系統(tǒng)可以在衛(wèi)星少于4顆時工作，而且運(yùn)算精度較高，速度較快［1］。傳統(tǒng)的GNSS/INS組合系統(tǒng)一般利用偽距作為觀測值，導(dǎo)航性能依賴于偽距精度。載波相位觀測值精度遠(yuǎn)高于偽距，但組合導(dǎo)航中整周模糊度的實(shí)時解算還很困難，時間差分載波相位(time-differenced carrier phase，TDCP)則可以避免整周模糊度問題。通常，時間差分載波相位可用于導(dǎo)出平均多普勒［2］，作為偽距率觀測信息引入到緊組合觀測系統(tǒng)中［3-4］，實(shí)際上，它可以作為原始觀測值直接應(yīng)用到緊組合觀測系統(tǒng)中［5-6］。

時間差分載波觀測方程中，前后歷元狀態(tài)參數(shù)相關(guān)，不符合標(biāo)準(zhǔn)Kalman濾波的要求［7-9］。Wendel和Han均推導(dǎo)了嚴(yán)密的時間差分載波觀測方程［10-11］，該方程以速度誤差參數(shù)為媒介將狀態(tài)向量融合進(jìn)來，但是這種較為嚴(yán)密的公式計算過于復(fù)雜，影響濾波效率。Soon等認(rèn)為可以直接將前一歷元的信息作為已知值，采用簡化方程，取得了較好的結(jié)果［12］，但是該方法沒有考慮前一歷元信息對隨機(jī)模型的影響及差分載波引起的位置誤差積累問題。

本文采用簡化時間差分載波觀測模型，分析了此模型的誤差影響，說明了短期內(nèi)時間差分載波觀測更新精度較高但存在誤差積累問題的特點(diǎn)，重點(diǎn)推導(dǎo)了雙周期組合情況下的時間差分載波觀測值的實(shí)用隨機(jī)模型確定公式，該隨機(jī)模型同時顧及了長周期偽距更新的誤差影響和短周期時間差分相位更新的誤差疊加效應(yīng)。將采用時間差分載波的組合方案與傳統(tǒng)偽距組合方案進(jìn)行比較，結(jié)果表明，時間差分載波觀測值精度高，在觀測隨機(jī)模型可靠的情況下優(yōu)于傳統(tǒng)的偽距緊組合導(dǎo)航。

二、傳統(tǒng)偽距緊組合觀測模型

1．偽距差觀測模型

GNSS的偽距觀測方程為

式中，ρG為偽距觀測值;ρSR為星地距離;δtR為接收機(jī)鐘差;δtS為衛(wèi)星鐘差;ΔIg和ΔT為大氣折射延遲。為簡潔起見，后面推導(dǎo)省略衛(wèi)星鐘差和大氣折射延遲有關(guān)項(xiàng)。

將ρSR在INS坐標(biāo)處展開，則有

式中，ρI為由INS坐標(biāo)計算的偽距;δx、δy和δz為位置誤差參數(shù)δR的三分量;lj為方向余弦反號。

移項(xiàng)整理得

ρI－ρG即為組合導(dǎo)航系統(tǒng)的偽距差觀測值。

2．基于多普勒觀測值的偽距率差觀測模型

GNSS的偽距率通常由多普勒觀測值求出，低成本接收機(jī)中也可由偽距和載波時間差分導(dǎo)出。偽距率觀測方程為

將INS速度值代入并整理可得偽距率差觀測方程為

偽距率差反映了載體的速度信息，有利于提高姿態(tài)和速度精度。因此，為更好地比較分析偽距觀測值和時間差分載波相位觀測值對系統(tǒng)定位精度的不同影響，應(yīng)用多普勒觀測值作為速度約束方程，即多普勒觀測值分別與偽距和時間差分載波相結(jié)合。

三、時間差分載波(TDCP)觀測模型

非差載波相位觀測方程為

如果沒有找到幾個關(guān)鍵詞的基本特征，很容易造成選取關(guān)鍵詞后各自為營，獨(dú)立成段，不能形成有機(jī)關(guān)聯(lián)。如上文的云浮高二期末考試作文，容易寫成一段寫“拼搏成就成功人生”，一段寫“貢獻(xiàn)成就成功人生”，而兩段之間缺少兩個關(guān)鍵詞統(tǒng)一于一身的聯(lián)系點(diǎn)，這樣就難以完成“形成有機(jī)關(guān)聯(lián)”這一任務(wù)，作文往往也難以取得高分。

對tk和tk－1時刻的載波相位觀測值做差，可消去模糊度參數(shù)。歷元間作差得到時間差分載波相位(TDCP)觀測方程為

式差中之差，TD Δ CδPtR觀=δ測tR，值tkλ δt ΦR，tΔk－t1=。－;接收機(jī)鐘對于接收機(jī)鐘差之差ΔδtR，可以在衛(wèi)星間第二次作差來消去。周跳對TDCP的影響遠(yuǎn)遠(yuǎn)小于對非差觀測值的影響，它只影響本歷元的TCDP觀測值，因此，在TDCP的組合導(dǎo)航系統(tǒng)中，周跳的影響可以忽略［11］。

式(7)所示的TDCP觀測方程中同時含有前后兩個歷元的導(dǎo)航參數(shù)，無法直接應(yīng)用Kalman濾波公式，使用狀態(tài)延遲Kalman濾波［9］可以解決這個問題，但是這種濾波器將前后歷元的參數(shù)整合成一個整體參數(shù)，極大地增加了濾波器的負(fù)擔(dān)。Wendel和Han以速度誤差參數(shù)為媒介將狀態(tài)向量融合進(jìn)來，得到一個極為復(fù)雜的嚴(yán)密公式，且此嚴(yán)密公式實(shí)際上是速度約束方程。同為速度約束方程，多普勒觀測值的精度穩(wěn)定性高于TDCP，在使用多普勒的情況下，不需要再使用此TDCP嚴(yán)密公式。

TDCP觀測值主要描述用戶位置的相對變化，因此，可以從應(yīng)用效率的角度出發(fā)，直接將前一時刻組合導(dǎo)航系統(tǒng)的狀態(tài)值作為已知值代入式(7)中，可得

式(8)在INS位置處展開，有

式中，δΦ即為GNSS/INS組合導(dǎo)航中的TDCP觀測值。如果采用星間再作二次差，則接收機(jī)鐘差相關(guān)的參數(shù)可進(jìn)一步消去。

若要應(yīng)用式(9)，關(guān)鍵問題是確定δΦ的隨機(jī)模型，這里不僅要考慮eΦΔt的影響，還需要考慮前一時刻參數(shù)的統(tǒng)計信息的影響，其中，eΦΔt的影響相對較小且比較穩(wěn)定。

四、利用TDCP的組合導(dǎo)航系統(tǒng)濾波結(jié)構(gòu)

TDCP觀測值精度高，相對于偽距觀測值能夠維持組合導(dǎo)航系統(tǒng)短期內(nèi)較高的精度。但是，前一時刻導(dǎo)航信息的誤差必然會不斷積累，影響系統(tǒng)的長期精度。這里，先分析僅用TDCP觀測值時的導(dǎo)航性能，再給出雙周期更新的濾波結(jié)構(gòu)，重點(diǎn)推導(dǎo)了此濾波結(jié)構(gòu)下的隨機(jī)模型。

1．僅用TDCP觀測值的組合導(dǎo)航精度

圖1 緯度誤差

傳統(tǒng)偽距輔助的組合導(dǎo)航精度主要受偽距測距精度影響，由于非差偽距測量受大氣折射延遲誤差、衛(wèi)星鐘差等影響較大，組合后經(jīng)緯度精度基本穩(wěn)定在1．0e－5角秒量級，高程精度基本維持在4．0 m量級，此位置精度和單獨(dú)使用GNSS偽距進(jìn)行導(dǎo)航的精度相當(dāng)。

圖2 經(jīng)度誤差

圖3 高程誤差

使用TDCP觀測值的組合系統(tǒng)短時間內(nèi)定位精度明顯高于偽距組合結(jié)果。TDCP觀測值的觀測誤差eΦΔt經(jīng)過時間差分后僅含少量殘余誤差成分的影響，對INS的位置約束能力更強(qiáng)。但是隨著時間變化，前一時刻導(dǎo)航參數(shù)ρSR，tk－1等所含誤差使得定位誤差不斷積累。如果僅僅使用TDCP觀測值的話，導(dǎo)航結(jié)果在一段時間之后會發(fā)散。因此，在組合導(dǎo)航中對于TDCP觀測值的應(yīng)用關(guān)鍵是要在利用其短期高精度的同時抑制其誤差積累。

2．雙周期更新及濾波隨機(jī)模型確定方法

本文的組合更新結(jié)構(gòu)是將用TDCP在各GNSS采樣時刻上與INS組合的同時，利用偽距在更長的周期上進(jìn)行組合，以抑制TDCP觀測值的誤差積累?？梢詮念l域角度理解該組合導(dǎo)航系統(tǒng)，INS優(yōu)勢在高頻部分，偽距優(yōu)勢在低頻部分，而TDCP便是介于兩者之間的頻帶。

記TDCP更新周期為T，偽距更新周期為nT，對于一段歷元nT，(n+1)T，(n+2)T，…，2nT，其中nT和2nT時刻使用偽距觀測模型組合INS;(n+1)T，(n+2)T，…，(2n－1)T時刻使用TDCP觀測模型組合。對于任一時刻的TDCP觀測值δΦ，其誤差影響包含兩個部分

式中，σ2ρ－1代表前一時刻狀態(tài)參數(shù)估計誤差所引起的等效距離誤差;σ2ΦΔt為誤差項(xiàng)eΦΔt的方差。

對于(n+1)T時刻，σ2ρ－1為nT時刻偽距更新結(jié)果的等效距離誤差，即

則有

對于(n+2)T時刻，σ2ρ－1即為(n+1)T時刻的誤差，即

顯然，(n+i)T時刻的誤差為

式(14)即為濾波更新過程中TDCP觀測方程的隨機(jī)模型確定公式。值得指出的是，σ2^ρ雖為偽距觀測值更新時刻計算所得的導(dǎo)航參數(shù)等效距離誤差，但不同于傳統(tǒng)單純使用偽距組合導(dǎo)航時的距離誤差，因?yàn)榻M合導(dǎo)航濾波實(shí)際上是一個兩種導(dǎo)航系統(tǒng)不斷互補(bǔ)的結(jié)果，是前面所有歷史信息的總和，偽距更新周期內(nèi)的TDCP更新貢獻(xiàn)很大。

五、計算與分析

采用一組戰(zhàn)術(shù)級GPS/INS試驗(yàn)數(shù)據(jù)，IMU采樣頻率為100 Hz，GPS采樣頻率為1 Hz，對GPS/INS數(shù)據(jù)進(jìn)行緊組合解算。以載波相位差分獲得的位置作為參考解。分別采用如下兩種方案進(jìn)行緊組合導(dǎo)航解算:

方案1:使用傳統(tǒng)偽距觀測值更新的緊組合算法。

方案2:使用TDCP短周期結(jié)合偽距長周期更新的緊組合算法。

在方案2中，TDCP觀測值的更新周期為1 s，偽距觀測值的更新周期為30 s，采用第4章第2節(jié)的方法確定觀測值隨機(jī)模型。兩種方案的三方向誤差結(jié)果(絕對值)分別如圖4—6所示，RMS比較見表1。

圖4 兩種方案的緯度誤差

圖5 兩種方案的經(jīng)度誤差

通過上述計算結(jié)果，可以得出結(jié)論:

1)本文利用TDCP的組合導(dǎo)航方案優(yōu)于傳統(tǒng)利用偽距的組合導(dǎo)航方案。TDCP觀測值削弱了多種誤差成分，在每一段短時間的更新周期內(nèi)能更好地維持組合系統(tǒng)的精度。因?yàn)楸苊饬四：冉馑銌栴}，其效率與傳統(tǒng)偽距方法相當(dāng)。

2)使用TDCP和偽距雙周期更新的緊組合系統(tǒng)相比傳統(tǒng)偽距組合在各方向上精度分別提高41%、18%和47%，其中誤差最大的高程方向改善最為明顯，時間差分對誤差的削弱效果明顯。

六、結(jié)束語

時間差分載波相位避免了整周模糊度解算問題，并減小了周跳的影響范圍，其對衛(wèi)星鐘差和大氣折射延遲等誤差的削弱作用明顯，具有短期精度高的特點(diǎn)。

時間差分載波本質(zhì)上屬于相對測距，其誤差隨時間積累，利用偽距在更大的周期上組合能同時發(fā)揮時間差分載波和偽距在不同頻帶上的優(yōu)勢，提高導(dǎo)航精度。在簡化的時間差分載波相位觀測模型基礎(chǔ)上，本文推導(dǎo)了雙周期更新濾波結(jié)構(gòu)下的隨機(jī)模型，并應(yīng)用于組合導(dǎo)航實(shí)際數(shù)據(jù)處理中。相對于傳統(tǒng)偽距組合，利用載波相位時間差分的雙周期更新濾波在經(jīng)度和緯度方向的精度分別提高41%和18%，而在誤差最大的高程方向，則高達(dá)47%。

［1］ 柴艷菊．挖掘信息提高GPS/INS導(dǎo)航精度的理論與方法研究所［D］．武漢:中國科學(xué)院測量與地球物理研究所，2008．

［2］ 何海波，楊元喜，孫中苗．幾種GPS測速方法的比較分析［J］．測繪學(xué)報，2002，31(3):217-221．

［3］ 吳富梅，秦顯平，唐穎哲．低成本車載GPS/INS組合導(dǎo)航速度更新算法［J］．測繪科學(xué)技術(shù)學(xué)報，2010，27(4):243-246．

［4］ MOAFIPOOR S，GREJNER-BRZEZINSKA D A，TOTH C K．Tightly Coupled GPS/INS Integration Based on GPSCarrier Phase Velocity Update［C］∥ION NTM 2004．San Diego CA:［s．n．］，2004:1094-1102．

［5］ 湯勇剛，練軍想，吳文啟，等．北斗載波相位時間差分/SINS緊組合技術(shù)與實(shí)驗(yàn)研究［J］．國防科技大學(xué)學(xué)報，2007，29(2):19-23．

［6］ 溫永智，吳杰．高軌飛行器精確導(dǎo)航的載波相位時間差分/捷聯(lián)慣導(dǎo)緊組合算法［J］．武漢大學(xué)學(xué)報:信息科學(xué)版，2011，36(10):1195-1199．

［7］ FARRELL J L．GPS/INS-streamlined［J］．Navigation，2002，49(4):171-182．

［8］ VAN GRASS F，F(xiàn)ARRELL J L．GPS/INS-a Very Different Way［C］∥ION 57th Annual Meeting/CIGTF 20th Biennial Guidance Test Symposium．Albuquerque NM:［s．n．］，2001:715-721．

［9］ FORD T J，HAMILTON J．A New Positioning Filter:Phase Smoothing in the Position Domain［J］．Navigation，2003，50(2):65-78．

［10］ WENDEL J，TROMMER G F．Tightly Coupled GPS/INSIntegration for Missile Applications［J］．Aerospace Science and Technology，2004，8(7):627-634．

［11］ HAN S L，WANG J L．Integrated GPS/INS Navigation System with Dual-Rate Kalman Filter［J］．GPS Solution，2012，16(3):389-404．

［12］ SOON B K H，SCHEDING S，LEE H K，et al．Performance Analysis of an Integrated Navigation System In Urban Canyon Environment［C］∥IGNSS Symposium 2007．Sydney，Australia:［s．n．］，2007．