姚慧，茅旭初，王俊璞

（上海交通大學(xué) 電子信息與電氣工程學(xué)院，上海 200240）

基于非線性濾波的GLONASS/GPS融合定位方法

姚慧，茅旭初，王俊璞

（上海交通大學(xué) 電子信息與電氣工程學(xué)院，上海 200240）

為了避免對(duì)單一衛(wèi)星導(dǎo)航系統(tǒng)的過分依賴，并且針對(duì)在觀測(cè)條件較差，單一系統(tǒng)無法定位或者定位精度急速下降的情況，提出了一種基于非線性濾波的GLONASS/GPS雙系統(tǒng)融合定位的方法。采用擴(kuò)展卡爾曼濾波（EKF）和平淡卡爾曼濾波（UKF）算法，并引入偽距判別選星策略，削弱觀測(cè)衛(wèi)星數(shù)量跳變對(duì)定位精度的影響，進(jìn)行雙系統(tǒng)融合定位，并針對(duì)惡劣環(huán)境，選取仰角最高的五顆衛(wèi)星進(jìn)行雙系統(tǒng)定位。實(shí)驗(yàn)結(jié)果表明，算法有較高的定位精度和穩(wěn)定性，尤其在惡劣情況下，單系統(tǒng)衛(wèi)星數(shù)不足時(shí)，雙系統(tǒng)融合定位更顯示其優(yōu)勢(shì)。

衛(wèi)星導(dǎo)航；GLONASS/GPS雙系統(tǒng)定位；卡爾曼濾波

目前，全球定位系統(tǒng)GPS的精密單點(diǎn)定位技術(shù)已很成熟，能夠?yàn)槿蛴脩籼峁└呔鹊膶?dǎo)航定位服務(wù)，但衛(wèi)星可見性受應(yīng)用環(huán)境的影響很大，在觀測(cè)條件很差時(shí)，其可見衛(wèi)星數(shù)、定位精度和可用性都會(huì)大幅下降，無法保障定位可靠性，甚至無法進(jìn)行定位解算[1-5]。GLONASS是第二個(gè)可實(shí)現(xiàn)全球定位的衛(wèi)星導(dǎo)航系統(tǒng)。近幾年，隨著俄羅斯的星座能力恢復(fù)計(jì)劃、GLONASS-K/KM/NG新衛(wèi)星系統(tǒng)研制等策略的推出，GLONASS系統(tǒng)得到了長(zhǎng)足的發(fā)展[6-8]。GPS與GLONASS融合定位，可大大提高衛(wèi)星可用數(shù)量，改善衛(wèi)星幾何分布，提高定位的可靠性、精確性及系統(tǒng)的自主完備性，在衛(wèi)星可視條件不好的情況下，彌補(bǔ)單一系統(tǒng)無法定位的缺陷[9-10]。因此，GPS與GLONASS融合定位具有重要的應(yīng)用前景。文中提出了一種保障衛(wèi)星定位可靠性的GPS/GLONASS雙系統(tǒng)融合偽距定位模型，并增加根據(jù)跳變衛(wèi)星偽距來刪選衛(wèi)星的策略，采用非線性卡爾曼濾波算法進(jìn)行定位估計(jì)，實(shí)現(xiàn)了高精度、高可靠的單機(jī)定位。

1 GPS/GLONASS融合定位原理

GPS和 GLONASS都是利用衛(wèi)星與接收設(shè)備之間信號(hào)傳輸時(shí)間測(cè)距原理來確定地面用戶所在的位置[11]，有偽距方程：

式（1）表示接收機(jī)計(jì)算得到的實(shí)際偽距ρi與真實(shí)幾何距離Ri的關(guān)系。式中：Xu、Yu、Zu為接收機(jī)方位坐標(biāo)；Xi、Yi、Zi為不同衛(wèi)星系統(tǒng)的第顆衛(wèi)星的方位坐標(biāo)；δt是接收機(jī)相對(duì)于定位系統(tǒng)的用戶時(shí)鐘偏差；c為真空中光速；vi是第i號(hào)衛(wèi)星的其余未建模的測(cè)量誤差的總和，在解算過程中一般設(shè)為白噪聲。對(duì)于GPS和GLONASS雙系統(tǒng)定位，有如下偽距方程[12-13]：

cδtg和δtl分別是接收機(jī)相對(duì)于GPS和GLONASS系統(tǒng)的用戶時(shí)鐘偏差，GPS和GLONASS系統(tǒng)間鐘差記為δtsyst=δtl-δtg。從以上方程可以看出，雙系統(tǒng)解算用戶位置需要求解5個(gè)未知量：Xu、Yu、Zu、δtg和δtb，比單系統(tǒng)多一個(gè)系統(tǒng)時(shí)間差的未知數(shù)。所以必須至少需要5顆衛(wèi)星才能進(jìn)行雙系統(tǒng)定位解算。

2 GPS/GLONASS融合定位解算方法

2.1 新增衛(wèi)星的刪選策略

由偽距定位原理可知，偽距的觀測(cè)值對(duì)于定位結(jié)果有著直接的影響，通過觀察發(fā)現(xiàn)偽距觀測(cè)值有時(shí)會(huì)有較大的偏差，尤其是在某一時(shí)刻某顆衛(wèi)星剛進(jìn)入到可觀測(cè)范圍時(shí)，新增衛(wèi)星偽距的偏差會(huì)造成定位結(jié)果出現(xiàn)誤差。文中針對(duì)新增衛(wèi)星，根據(jù)其偽距是否準(zhǔn)確來決定此顆衛(wèi)星是否為有效的定位衛(wèi)星。

圖1 判別偽距刪選衛(wèi)星流程圖

針對(duì)新增衛(wèi)星，如圖1所示，通過其它衛(wèi)星解算用戶位置，再反推出新增衛(wèi)星的正確偽距，與接收機(jī)采集的偽距比較，如果差值大于規(guī)定閾值，則認(rèn)為此時(shí)新增衛(wèi)星偽距有較大偏差，該衛(wèi)星無效。否則，該衛(wèi)星有效。其中閾值是通過文中定位實(shí)驗(yàn)所有有效衛(wèi)星反算得出的偽距與接收機(jī)采集偽距之差來確定的。選擇有效衛(wèi)星最大偽距差值作為該閾值。

2.2 基于非線性濾波的雙系統(tǒng)定位模型

目前衛(wèi)星定位通常采用的線性模型是最小二乘迭代算法ILS。最小二乘法把偽距的測(cè)量誤差當(dāng)作白噪聲，定位解算快速簡(jiǎn)單，但精度不高，穩(wěn)定性不強(qiáng)，在惡劣的定位環(huán)境下，魯棒性也很弱[14]。通過改進(jìn)噪聲模型，引入非線性濾波，可提高定位精度和穩(wěn)定性。在非線性濾波中，考慮系統(tǒng)模型，即狀態(tài)模型與測(cè)量模型。

2.2.1 狀態(tài)模型

其中：wci為接收機(jī)第i通道的驅(qū)動(dòng)噪聲，假設(shè)這些噪聲為零均值、非相關(guān)的隨機(jī)白噪聲，參數(shù)φ和φ可由下式得出[11]：

2.2.2 測(cè)量模型

由于接收機(jī)的位置和速度受多普勒頻移影響，所以將多普勒方程加到測(cè)量模型中：

系統(tǒng)的測(cè)量方程還包括非線性的偽距測(cè)量方程，如下：

式中：Xit、Yit、Zit為 t時(shí)刻第 i顆衛(wèi)星的位置坐標(biāo)；δRt為由時(shí)鐘偏移引起的距離差，ρit為在時(shí)刻第顆衛(wèi)星的偽距；eit為接收機(jī)通道i的非白噪聲誤差；vit為通道i的測(cè)量噪聲。故當(dāng)觀測(cè)到n顆GLONASS衛(wèi)星和m顆GPS衛(wèi)星時(shí)，系統(tǒng)的測(cè)量方程如下：

2.3 非線性卡爾曼濾波

卡爾曼濾波最早出現(xiàn)在上世紀(jì)60年代，是一種高效的最優(yōu)化自回歸數(shù)據(jù)處理算法，能夠從一系列含噪聲的測(cè)量中估計(jì)系統(tǒng)的狀態(tài)，已在工程中得到了廣泛的應(yīng)用。UKF和EKF是非線性卡爾曼濾波中應(yīng)用廣泛的兩種方法。EKF通過對(duì)非線性函數(shù)的泰勒展開式進(jìn)行一階線性化截?cái)?，從而將非線性問題轉(zhuǎn)化為線性問題，在解決非線性問題中得到了廣泛的應(yīng)用。但EKF也存在不足，如在線性化過程中只保留一階結(jié)果，會(huì)產(chǎn)生不可忽視的線性化誤差；EKF需要進(jìn)行雅可比估計(jì)和求偏微分，在實(shí)際應(yīng)用中有過多的局限性等[15]。UKF是一種用采樣策略逼近非線性分布的方法。UKF以UT變換為基礎(chǔ)，采用卡爾曼線性濾波框架，采樣形式為確定性采樣，而非粒子濾波PF的隨機(jī)采樣。UKF采樣的粒子點(diǎn)（一般稱為Sigma點(diǎn)）的個(gè)數(shù)很少，具體個(gè)數(shù)根據(jù)所選擇的采樣策略而定。最常用的是（2n+1）個(gè)Sigma點(diǎn)對(duì)稱采樣。UKF的計(jì)算量基本與EKF算法相當(dāng)，但性能優(yōu)于EKF，并且采用的是確定性采樣，從而避免了PF的粒子點(diǎn)退化問題[16]。此外，UKF還有無需對(duì)方程求偏微分、無需進(jìn)行雅可比矩陣的估計(jì)等優(yōu)勢(shì)。相對(duì)于EKF，UKF有著很大的優(yōu)勢(shì)。

3 定位實(shí)驗(yàn)及結(jié)果分析

為了驗(yàn)證文中提出的定位方法的有效性，使用NovAtel公司OEM-628多系統(tǒng)接收機(jī)獲取衛(wèi)星原始數(shù)據(jù)進(jìn)行實(shí)驗(yàn)。采樣地點(diǎn)為上海交通大學(xué)電院群樓樓頂，天線無遮擋，采樣頻率1Hz，采樣時(shí)長(zhǎng)2500s。定位實(shí)驗(yàn)以O(shè)EM-628在同一位置連續(xù)24小時(shí)定位的平均值為基準(zhǔn)。

3.1 非線性濾波定位實(shí)驗(yàn)

實(shí)驗(yàn)中，GLONASS和GPS接收到的衛(wèi)星數(shù)變化情況如圖2所示。GLONASS在454秒和555秒處有新增衛(wèi)星；1 617~2 362 s期間GPS的衛(wèi)星數(shù)在9和10之間跳動(dòng)。首先采用最小二乘法進(jìn)行兩次定位解算：得到不使用偽距判別刪選衛(wèi)星策略的ILS1和用策略的ILS2，結(jié)果分別如圖3（a）、（b）所示。結(jié)果表明，若不采用刪選衛(wèi)星策略，定位結(jié)果會(huì)因在454~ 491 s內(nèi)、在555~582 s內(nèi)、1 617~1 652 s內(nèi)新增衛(wèi)星有偽距偏差而相應(yīng)的出現(xiàn)定位誤差。采用刪選衛(wèi)星策略后，則可削弱甚至消除衛(wèi)星數(shù)量跳變對(duì)定位結(jié)果的影響。

圖2 可見衛(wèi)星數(shù)

然后分別對(duì)GLONASS、GPS以及GLONASS/GSP雙系統(tǒng)使用EKF、UKF進(jìn)行定位解算，如圖4所示。由圖可知，EKF、UKF幾乎全部情況下比最小二乘定位結(jié)果更接近基準(zhǔn)值，很多情況下比接收機(jī)定位結(jié)果更準(zhǔn)確，且當(dāng)定位結(jié)果出現(xiàn)跳動(dòng)時(shí)，EKF和UKF可有效地進(jìn)行一定的平滑，使之更趨近于基準(zhǔn)值。

為進(jìn)一步分析非線性濾波融合定位算法的精度，計(jì)算了圖4中各定位結(jié)果在X、Y、Z方向及3D方向的均方根誤差RMSE，如表1所示。分析表1可知：對(duì)于相同的定位系統(tǒng) （單系統(tǒng)或雙系統(tǒng)），EKF和UKF的定位精度都比最小二乘法高，大部分方向甚至比接收機(jī)輸出的定位精度要高?？傮w看來，UKF能得到最高的定位精度，EKF次之，ILS最低。對(duì)于相同的定位方法（ILS、EKF或UKF），雙系統(tǒng)的定位精度基本介于兩種單系統(tǒng)的定位精度之間。當(dāng)某單一定位系統(tǒng)所處環(huán)境較差、定位精度較低時(shí)，通過與另一定位系統(tǒng)進(jìn)行融合，能得到次優(yōu)的結(jié)果，這犧牲了一些精度，但大大增加了定位的穩(wěn)定性。

圖3 刪選衛(wèi)星策略實(shí)驗(yàn)結(jié)果

圖4 非線性濾波定位實(shí)驗(yàn)結(jié)果

3.2 惡劣環(huán)境中的定位仿真驗(yàn)證

3.1節(jié)驗(yàn)證了文中所提出的非線性定位模型和濾波算法的有效性，為進(jìn)一步驗(yàn)證該模型的可靠性，進(jìn)行惡劣環(huán)境下的定位實(shí)驗(yàn)。實(shí)驗(yàn)?zāi)M峽谷、高樓林立等極端惡劣的情況：選擇仰角最大的3顆GPS衛(wèi)星和2顆GLONASS衛(wèi)星，僅能觀測(cè)到頭頂附近衛(wèi)星，且數(shù)量剛滿足定位需求。此時(shí)單系統(tǒng)無法定位，而雙系統(tǒng)仍可很好地應(yīng)對(duì)這種惡劣情況（結(jié)果見圖5）。

表1 定位誤差比較

圖5 惡劣情況下定位結(jié)果

與圖4相比，惡劣環(huán)境下衛(wèi)星數(shù)量減少，ILS算法的精度急速下降，而對(duì)于EKF和UKF，衛(wèi)星數(shù)量的減少并沒有對(duì)定位產(chǎn)生巨大影響，定位曲線平滑穩(wěn)定。UKF的定位曲線相對(duì)EKF更為平滑，幾乎沒有衛(wèi)星數(shù)量變化引起的波動(dòng)。表2列出了惡劣環(huán)境實(shí)驗(yàn)中各方法的RMES。雙系統(tǒng)UKF所得到的定位精度最高，EKF略低于UKF，但遠(yuǎn)高于雙系統(tǒng)ILS的精度。

表2 惡劣環(huán)境下定位誤差比較

4 結(jié)束語

文中介紹了采用偽距判別刪選衛(wèi)星策略的基于EKF和UKF進(jìn)行雙系統(tǒng)定位的方法。通過非線性濾波定位實(shí)驗(yàn)，得出文中提出的雙系統(tǒng)融合定位算法相對(duì)于傳統(tǒng)定位方法有更高的精度和穩(wěn)定性。通過模擬惡劣環(huán)境，展示了文中提出的定位方法在單系統(tǒng)衛(wèi)星數(shù)量不足時(shí)的絕對(duì)優(yōu)勢(shì)，即只需GLONASS和GPS衛(wèi)星數(shù)之和不少于5顆，文中的算法仍能實(shí)現(xiàn)穩(wěn)定可靠的高精度定位。為進(jìn)一步提高雙系統(tǒng)定位精度，文中提出的偽距判別衛(wèi)星刪選策略中的閾值選擇可以做進(jìn)一步研究，也可以深入研究其他衛(wèi)星選擇策略，為后續(xù)的研究打下基礎(chǔ)。

[1]蔡昌盛，朱建軍.GPS/GLONASS組合精密單點(diǎn)定位模型及結(jié)果分析 [J].武漢大學(xué)學(xué)報(bào)，2011，36（12）:1474-1477.

[2]羅曉敏，蔡昌盛.顧及PDOP的GPS/GLONASS組合單點(diǎn)定位的觀測(cè)值定權(quán)[J].導(dǎo)航定位學(xué)報(bào)，2013，1（1）:56-60.

[3]段舉舉．GPS/GLONASS組合靜態(tài)相位相對(duì)定位算法[J].測(cè)繪學(xué)報(bào)，2012，41（6）:825-830.

[4]Pirti A.Accuracy analysis of GPS positioning near the forest environment[J].Croatian Journal of Forest Engineering，2008（29）:189-199.

[5]Antonio A，Salvatore G，Ciro G.Performance assessment of aided Global Navigation Satellite System for land navigation [J].Iet Rader，Sonar and Navigation，2013，7（6）:671-680.

[6]成躍進(jìn).衛(wèi)星導(dǎo)航定位系統(tǒng)及其導(dǎo)航戰(zhàn)技術(shù)情報(bào)研究[R].五院情報(bào)報(bào)告，2013．

[7]紀(jì)龍蟄，單慶曉.GLONASS全球衛(wèi)星導(dǎo)航系統(tǒng)發(fā)展概況及最新進(jìn)展[J].全球定位系統(tǒng)，2012，37（5）：56-61．

[8]成躍進(jìn).現(xiàn)代衛(wèi)星導(dǎo)航定位系統(tǒng)發(fā)展介紹[J].空間電子技術(shù)，2015（1）:17-25.

[9]Zhang Xiao-hong.Study on precise point positioning based on combined GPS and GLONASS[J]. Geomatics and Information Science ofWuhan University，2011，35（1）:9-12.

[10]王正軍.GPS/GLONASS組合精密單點(diǎn)定位性能分析[J].大地測(cè)量與地球動(dòng)力學(xué)，2012，32（2）:105-109.

[11]張思靜.GPS/GLONASS雙系統(tǒng)兼容定位算法研究與實(shí)現(xiàn)[D].北京：北京郵電大學(xué)，2011.

[12]Junping Chen.A comparative study for accuracy assessmentofPPP techniqueusingGPS and GLONASS in urban areas[J].Advances in Space Research，2015，55:125-134.

[13]Reha Metin Alkan，et al.A simplified and unified model of multi-GNSS precise point positioning[J]. Measurement，2015（69）:1-8.

[14]X Mao.NonlinearGPS ModelsforPosition Estimate Using Low-cost Receiver[C].The IEEE 6th IntelligentTransporta-tion System Conference，Shanghai，China，2003:637-642.

[15]朱萍.軟件GPS接收機(jī)定位算法研究[D].上海：上海交通大學(xué)，2009.

GLONASS/GPS dual system positioning based on nonlinear filter

YAO Hui，MAO Xu-chu，WANG Jun-pu
（School of Electronic Information and Electrical Engineering，Shanghai Jiao Tong University，Shanghai 200240，China）

In order to avoid excessive dependence on one single satellite navigation system，and solve the problem that one single system cannot position in a high accuracy way under poor observation conditions，this paper proposes a method for GLONASS/GPS dual system positioning based on nonlinear filtering.This method adopts Extended Kalman filter （EKF）and unscented Kalman filter（UKF）algorithm，designs a satellite selection strategy based on analyzing pseudorange，and also apply this method to the poor environments for dual system positioning.The experiments results show that the proposed GLONASS/GPS dual system positioning method performs high accuracy and stability，especially in the poor conditions where the number of single system satellites is insufficient.

satellite navigation；GLONASS/GPS dual system positioning；Kalman filter

TN967

：A

：1674－6236（2017）01-0101-05

2015-11-30稿件編號(hào)：201511294

姚 慧（1990—），女，河北秦皇島人，碩士研究生。研究方向：全球衛(wèi)星導(dǎo)航系統(tǒng)定位。