劉崇錦,高周正,涂銳,4,張睿,韓軍強(qiáng),盧曉春,4

(1.中國(guó)科學(xué)院國(guó)家授時(shí)中心,陜西 西安 710600;2.中國(guó)科學(xué)院大學(xué) 電子電氣與通信工程學(xué)院,北京 100049;3.中國(guó)地質(zhì)大學(xué)(北京)土地科學(xué)技術(shù)學(xué)院,北京 100084;4.中國(guó)科學(xué)院精密導(dǎo)航定位與定時(shí)技術(shù)重點(diǎn)實(shí)驗(yàn)室,陜西 西安710600)

0 引 言

全球?qū)Ш叫l(wèi)星導(dǎo)航系統(tǒng)(GNSS)利用衛(wèi)星無(wú)線電信號(hào)進(jìn)行導(dǎo)航、定位、授時(shí),主要由美國(guó)GPS、俄羅斯GLONASS、中國(guó)北斗衛(wèi)星導(dǎo)航系統(tǒng)(BDS)、歐盟Galileo四大全球系統(tǒng)和日本QZSS、印度IRNSS兩大區(qū)域系統(tǒng)組成.BDS是中國(guó)自主研發(fā)、擁有完全知識(shí)產(chǎn)權(quán)、自主可控的衛(wèi)星導(dǎo)航系統(tǒng),相較于其他GNSS,采用了地球靜止同步衛(wèi)星(GEO),地球傾斜軌道同步衛(wèi)星(IGSO)和中地軌衛(wèi)星(MEO)的混合星座,并擁有短報(bào)文通信能力,其在國(guó)民經(jīng)濟(jì)和國(guó)防建設(shè)中扮演著重要角色.近年來(lái),BDS發(fā)展迅速,并將于2020年前后實(shí)現(xiàn)全球服務(wù)[1].BDS定位精度高,精度均勻穩(wěn)定,是當(dāng)前主要的位置服務(wù)手段之一.實(shí)時(shí)動(dòng)態(tài)載波相位差分定位(RTK)技術(shù)通過(guò)進(jìn)行雙差模式的基線解算,消除或減弱了鐘差和大氣誤差的影響,可以極大提高BDS的定位精度.但BDS與其他衛(wèi)星導(dǎo)航系統(tǒng)一樣,有著動(dòng)態(tài)性能差、數(shù)據(jù)頻率低、導(dǎo)航信息少、抗干擾能力差的缺點(diǎn).慣性導(dǎo)航系統(tǒng)(INS)技術(shù)不需要外部信息,抗干擾能力強(qiáng),能提供高頻、豐富、穩(wěn)定的導(dǎo)航信息[2],但傳統(tǒng)INS體積大,價(jià)格昂貴,難以大規(guī)模使用.自21世紀(jì)以來(lái)微機(jī)電系統(tǒng)(MEMS)高速發(fā)展,低成本INS的性能不斷提升,使BDS+低成本INS的組合擁有了較高的實(shí)用性[3-4].兩系統(tǒng)優(yōu)劣互補(bǔ),進(jìn)行組合能在移動(dòng)測(cè)繪、車輛導(dǎo)航、航空航天等領(lǐng)域發(fā)揮重要作用[5].因此,國(guó)內(nèi)外對(duì)BDS RTK+低成本INS的組合進(jìn)行了相關(guān)研究.其中,韓厚增[6]對(duì)慣導(dǎo)輔助下的BDS/GPS精密定位模型進(jìn)行了研究;Li Wei[7]研究了車載條件下BDS RTK的模糊度固定及與INS緊組合算法;Li Tuan[4]研究分析了單頻RTK與低成本INS進(jìn)行緊組合的算法與性能.這些研究結(jié)果表明BDS RTK精度與GPS RTK接近,而低成本INS在BDS RTK不可用時(shí)能提供較可信的結(jié)果[6].但這些研究多集中在BDS不可用時(shí)組合導(dǎo)航系統(tǒng)的性能,而較少對(duì)BDS可用時(shí)細(xì)致的性能分析.此外,除了定位精度外,運(yùn)載體的導(dǎo)航對(duì)速度和姿態(tài)精度也有著實(shí)際的需求[8].

因此,本文首先推導(dǎo)了BDS RTK與INS緊組合的量測(cè)模型與狀態(tài)模型,在此基礎(chǔ)上進(jìn)行BDS+低成本INS實(shí)地跑車測(cè)試.通過(guò)對(duì)實(shí)測(cè)數(shù)據(jù)進(jìn)行不同的組合模式解算,對(duì)不同組合方案的定位、測(cè)速、定姿精度進(jìn)行了評(píng)價(jià)分析,并對(duì)比了各組合方案的性能.

1 BDS RTK/INS緊組合模型

BDS RTK/INS緊組合模型主要由BDS模塊、INS模塊、卡爾曼濾波器組成.該模型首先進(jìn)行BDS、INS模塊解算,再將兩模塊的結(jié)果輸入卡爾曼濾波器進(jìn)行組合,輸出載體的姿態(tài)、速度、位置信息并進(jìn)行反饋,完成閉環(huán)組合導(dǎo)航流程.其中INS模塊根據(jù)慣性傳感器輸出的觀測(cè)量δv、δθ進(jìn)行INS機(jī)械編排,完成姿態(tài)、速度、位置的更新計(jì)算;BDS模塊使用基站、流動(dòng)站數(shù)據(jù)計(jì)算雙差偽距和雙差載波相位觀測(cè)值,與INS推算的虛擬觀測(cè)值求差,作為量測(cè)更新的新息;卡爾曼濾波模塊對(duì)當(dāng)前狀態(tài)進(jìn)行最優(yōu)估計(jì),輸出改正后的姿態(tài)、速度、位置等導(dǎo)航參數(shù)并對(duì)慣性傳感器進(jìn)行反饋修正,完成閉環(huán)[9].其全過(guò)程如圖1所示.

圖1 BDS RTK/INS 緊組合模型

1.1 狀態(tài)方程

本文采用當(dāng)?shù)刂苯亲鴺?biāo)系(n系)作為參考坐標(biāo)系,原點(diǎn)為載體中心,x軸指向地理北向,z軸向下指向參考橢球面,y軸垂直于x軸、z軸形成的平面并取右手坐標(biāo)系,即北東地(N-E-D)坐標(biāo)系.載體坐標(biāo)系采用前右下(F-W-D)坐標(biāo)系,x軸指向載體運(yùn)動(dòng)方向,y軸指向載體右方,z軸指向載體下方.本文是基于低精度MEMS的研究,其陀螺精度較低,無(wú)法敏感到地球自轉(zhuǎn)信息,故φ角誤差模型可以進(jìn)行相應(yīng)簡(jiǎn)化[10]:

(1)

慣性傳感器誤差包括陀螺、加速度計(jì)的零偏誤差和比例因子誤差.對(duì)于低精度MEMS級(jí)別的傳感器,通常采用一階高斯-馬爾科夫過(guò)程進(jìn)行建模,相比與隨機(jī)常值模型,可提升組合系統(tǒng)的抗干擾能力[8].故本文傳感器誤差使用如下一階高斯-馬爾科夫過(guò)程描述[11]:

(2)

式中:δb、δs為零偏誤差和比例因子誤差;τb、τs為零偏誤差和比例因子誤差的一階高斯-馬爾科夫過(guò)程相關(guān)時(shí)間;wb、ws為相應(yīng)的驅(qū)動(dòng)白噪聲.本文所使用的陀螺和加速度計(jì)均為三軸,因此傳感器誤差共有12維.姿態(tài)、速度、位置誤差和傳感器誤差構(gòu)成了21維的誤差狀態(tài)方程:

(3)

式中:F為狀態(tài)轉(zhuǎn)移矩陣,其形式參考文獻(xiàn)[12];xINS為誤差狀態(tài)向量,其具體形式為

xINS=[δpcδvcδφδbgδbaδsgδsa]T，

(4)

G為噪聲驅(qū)動(dòng)矩陣;w為驅(qū)動(dòng)白噪聲.

在BDS RTK/INS組合中,將雙差模糊度作為增廣狀態(tài)量,完整的狀態(tài)向量為

(5)

式中:xINS為誤差狀態(tài)向量;ΔN為雙差模糊度.

1.2 量測(cè)方程

BDS RTK/INS緊組合的觀測(cè)信息由實(shí)際觀測(cè)的BDS雙差觀測(cè)值與INS預(yù)測(cè)BDS雙差觀測(cè)值之差構(gòu)成.首先使用基站和流動(dòng)站的觀測(cè)數(shù)據(jù)求差,計(jì)算雙差偽距、雙差偽距率、雙差載波相位,再與慣導(dǎo)推算的虛擬觀測(cè)值求差,作為量測(cè)更新的觀測(cè)量[13]:

(6)

在短基線定位中,通過(guò)差分可以較好地消除對(duì)流層和電離層的影響[12],其載波相位觀測(cè)方程為

(7)

INS計(jì)算的虛擬觀測(cè)距離可表示為

(8)

式中:ek、ej為流動(dòng)站對(duì)衛(wèi)星的視線向量;δre為地心地固坐標(biāo)系下的位置誤差向量.將式(7)和(8)相減,可得量測(cè)更新中的載波相位觀測(cè)量δzφ為

(9)

同理,偽距觀測(cè)量δzp為

δzP=(ek-ej)·δre.

(10)

在接收機(jī)能接收多普勒觀測(cè)值的情況下,可利用多普勒觀測(cè)值構(gòu)成偽距率觀測(cè)量,通過(guò)與INS計(jì)算的虛擬偽距率求差,作為量測(cè)新息進(jìn)行計(jì)算[14].雙差偽距率量測(cè)方程為

(11)

式中,δve為地心地固坐標(biāo)系下的速度誤差向量.

該類偉晶巖主要分布在靠近花崗巖體的變質(zhì)巖中，其規(guī)模不大，多呈透鏡狀，其交代作用較弱，礦化較差，還可見(jiàn)黑云母、白云母，局部發(fā)育有絹云母化。

綜合三種觀測(cè)量, BDS RTK/INS緊組合的觀測(cè)方程可表示為

Z=HX+V，

(12)

H=

其中：D為位置誤差向量的設(shè)計(jì)矩陣;E為速度誤差向量的設(shè)計(jì)矩陣;C1為地心地固坐標(biāo)系到NED坐標(biāo)系的誤差轉(zhuǎn)換矩陣;C2為IMU質(zhì)心到BDS天線相位中心的桿臂補(bǔ)償項(xiàng);n為雙差個(gè)數(shù).各項(xiàng)詳細(xì)推導(dǎo)計(jì)算可參考文獻(xiàn)[13-14].

2 BDS RTK/INS組合導(dǎo)航系統(tǒng)性能分析

為評(píng)估低成本慣性器件在BDS RTK/INS組合系統(tǒng)中的表現(xiàn),于2019年6月9日在武漢市郊進(jìn)行了約40 min的跑車測(cè)試,其軌跡如圖2所示.慣性器件使用某款典型的低成本MEMS-IMU,采樣率為200 Hz,其主要性能如表1所示.基準(zhǔn)站使用雙頻Novatel接收機(jī),采樣率為1 Hz,基線長(zhǎng)度約為10 km.數(shù)據(jù)處理時(shí),設(shè)置衛(wèi)星高度角截止角為15°.

圖2 測(cè)試軌跡圖

表1 MEMS-IMU主要參數(shù)

部件參數(shù)量值單位IMU陀螺儀尺寸零偏3×3×0.7550mm (°)/h隨機(jī)游走0.24(°)/h加速度計(jì)零偏250mGal隨機(jī)游走0.24m/s/h

圖3和4表示本次實(shí)驗(yàn)過(guò)程中BDS可用衛(wèi)星數(shù)和對(duì)應(yīng)的PDOP值情況.所有歷元衛(wèi)星數(shù)均在4顆以上,有83.5%的歷元衛(wèi)星數(shù)大于8顆;99.2%的歷元PDOP值小于4.說(shuō)明本試驗(yàn)觀測(cè)條件整體較好.在1587～1876 s的289個(gè)歷元內(nèi),可見(jiàn)衛(wèi)星數(shù)減少為6顆,PDOP值也大幅上升.由于該時(shí)段路徑兩旁有建筑物,可能形成遮擋造成可見(jiàn)星數(shù)下降并影響星座幾何構(gòu)型.

圖3 觀測(cè)時(shí)段衛(wèi)星數(shù)

2.1 數(shù)據(jù)處理策略

本文主要測(cè)試分析正常工作情況下,低成本慣性器件(IMU)對(duì)組合導(dǎo)航系統(tǒng)的影響,故未進(jìn)行信號(hào)中斷測(cè)試.由于IMU精度較低,理論上在RTK級(jí)別的高精度定位中貢獻(xiàn)較小,故主要從測(cè)速、測(cè)姿角度進(jìn)行分析.本文采用的數(shù)據(jù)處理策略如下:

1)使用雙頻雙模GNSS數(shù)據(jù)與INS數(shù)據(jù)進(jìn)行雙向平滑緊組合解算,作為試驗(yàn)的參考真值,以此為基準(zhǔn)對(duì)組合導(dǎo)航系統(tǒng)性能進(jìn)行評(píng)估.

2)分別使用BDS單頻、雙頻數(shù)據(jù),與INS數(shù)據(jù)進(jìn)行松、緊組合解算,共有BDS單頻,BDS單頻松組合、BDS單頻緊組合、BDS雙頻、BDS雙頻松組合、BDS雙頻緊組合六種組合方案,分別計(jì)算各組合導(dǎo)航模式的位置、速度、姿態(tài),作為實(shí)際應(yīng)用條件下BDS RTK+低成本INS組合的表現(xiàn)并進(jìn)行后續(xù)分析.

3)將BDS單頻、雙頻不同組合方式的實(shí)測(cè)結(jié)果與參考真值的速度、位置、姿態(tài)求差,分析不同組合方式的性能.

2.2 BDS RTK/INS定位精度分析

本試驗(yàn)分別使用BDS 單頻、雙頻數(shù)據(jù),與INS數(shù)據(jù)進(jìn)行松、緊組合解算,獲得相應(yīng)組合方案的定位結(jié)果,再與參考值求差,評(píng)價(jià)相應(yīng)組合方案的定位精度.圖5、6示出了BDS單頻RTK+INS的定位結(jié)果,圖7、8示出了BDS雙頻RTK+INS的定位結(jié)果.在1587～1876 s,BDS單頻RTK及BDS單頻RTK松組合出現(xiàn)了一段時(shí)間的跳變,與衛(wèi)星數(shù)及PDOP值惡化的時(shí)間段一致,故這一時(shí)段可能由于衛(wèi)星數(shù)不足,衛(wèi)星幾何構(gòu)型變差,造成定位精度下降.

圖5 單頻BDS和INS融合定位東向誤差

圖6 單頻BDS和INS融合定位北向誤差

圖7 雙頻BDS和INS融合定位東向誤差

圖8 雙頻BDS和INS融合定位北向誤差

表2示出了各組合方式相對(duì)于參考值的定位誤差.可以看出,當(dāng)采用同一頻率設(shè)置的衛(wèi)星數(shù)據(jù)時(shí),各慣導(dǎo)組合方式間定位精度基本相近,同一頻率設(shè)置間各組合方式定位誤差在mm量級(jí),這在低成本車載導(dǎo)航中是可以忽略的.此外雙頻定位結(jié)果優(yōu)于單頻定位結(jié)果,在RTK、松組合、緊組合三種方案中,定位誤差RMS分別在東向改善了45.9%、38.7%、42.1%;在北向改善了17.9%、10%、24.4%.此外,當(dāng)出現(xiàn)跳變時(shí),緊組合方式能較好地減小誤差,穩(wěn)定性較好,這與理論是相一致的.試驗(yàn)結(jié)果表明,在松、緊組合方式下,低成本IMU的引入對(duì)定位精度影響較小.

表2 不同組合方式定位精度

2.3 BDS RTK/INS測(cè)速精度分析

本試驗(yàn)分別使用BDS單頻、雙頻數(shù)據(jù),與INS數(shù)據(jù)進(jìn)行松、緊組合解算,獲取相應(yīng)組合方式的速度,再與參考值求差,以此評(píng)價(jià)相應(yīng)組合方案的測(cè)速精度.圖9～11示出了BDS單頻數(shù)據(jù)與INS進(jìn)行組合的速度誤差.在松組合模式下,相對(duì)于BDS測(cè)速,加入低成本IMU使組合系統(tǒng)在北、東、地方向RMS分別改善了65.9%、5.7%、57.1%.而在緊組合模式下速度精度提高更為明顯,在北、東、地方向RMS分別改善了75.8%、79.5%、66.7%.圖12～14示出了BDS雙頻數(shù)據(jù)與INS進(jìn)行組合的速度誤差,各組合方式的表現(xiàn)基本與單頻一致.表3示出了BDS單雙頻數(shù)據(jù)與INS組合相對(duì)參考值的速度誤差,可以看出即便是低精度MEMS-IMU,在與BDS組合后也能對(duì)測(cè)速精度有較大的改善.此外,單頻數(shù)據(jù)+低成本INS的兩種組合方式均有較好的性能,且相對(duì)雙頻數(shù)據(jù)差距較小,可構(gòu)成單頻BDS+低成本INS的低成本組合導(dǎo)航系統(tǒng),有較高的實(shí)用價(jià)值.

圖9 單頻BDS和INS融合測(cè)速N向誤差

圖10 單頻BDS和INS融合測(cè)速E向誤差

圖11 單頻BDS和INS融合測(cè)速D向誤差

圖12 雙頻BDS和INS融合測(cè)速N向誤差

圖13 雙頻BDS和INS融合測(cè)速E向誤差

圖14 雙頻BDS和INS融合測(cè)速D向誤差

表3 不同組合方式測(cè)速精度

方案東向測(cè)速RMS/(m·s-1)北向測(cè)速RMS/(m·s-1)地向測(cè)速RMS/(m·s-1)BDS單頻0.0880.0910.063 BDS單頻松組合0.0730.0310.027 BDS單頻緊組合0.0180.0220.021 BDS雙頻0.0880.0910.063 BDS雙頻松組合0.0730.0320.026 BDS雙頻緊組合0.0120.0180.014

在上述實(shí)驗(yàn)中,BDS RTK/INS緊組合模式表現(xiàn)出了最好的性能.為驗(yàn)證在此種高性能條件下BDS使用頻率的影響,本試驗(yàn)采用BDS單頻、雙頻數(shù)據(jù),與INS數(shù)據(jù)進(jìn)行緊導(dǎo)航解算,獲取相應(yīng)組合方式的速度,再與參考值求差,并進(jìn)行對(duì)比.通過(guò)對(duì)試驗(yàn)結(jié)果進(jìn)行分析,評(píng)價(jià)雙頻數(shù)據(jù)在低成本、緊組合組合導(dǎo)航中的實(shí)用性.圖15～17示出了BDS雙頻數(shù)據(jù)與INS進(jìn)行緊組合后的速度誤差.從圖上可以看出,在BDS/INS緊組合中使用雙頻BDS數(shù)據(jù)有效改善了測(cè)速精度,N、E、D向RMS分別改善了18.2%、33.3%、33.3%.這說(shuō)明在進(jìn)行BDS RTK/INS緊組合導(dǎo)航解算時(shí),雙頻數(shù)據(jù)的引入對(duì)BDS RTK/INS緊組合導(dǎo)航測(cè)速精度能帶來(lái)較大改善.隨著電子技術(shù)的不斷發(fā)展,雙頻芯片的成本也在不斷降低,這對(duì)實(shí)現(xiàn)高精度低成本的組合導(dǎo)航系統(tǒng)有一定幫助.

圖15 單雙頻BDS和INS緊組合測(cè)速北向誤差

圖16 單雙頻BDS和INS緊組合測(cè)速東向誤差

圖17 單雙頻BDS和INS緊組合測(cè)速地向誤差

圖18示出了各測(cè)速方案的統(tǒng)計(jì)圖.從圖上可以看出,不論何種組合方式,低成本慣性器件的引入均能有效改善BDS的測(cè)速精度,而緊組合的改善程度較松組合更為明顯.當(dāng)雙頻數(shù)據(jù)可用時(shí),使用雙頻數(shù)據(jù)能有效改善緊組合中的測(cè)速精度.

圖18 不同測(cè)速方案誤差統(tǒng)計(jì)

2.4 BDS RTK/INS定姿精度分析

本實(shí)驗(yàn)分別采用單頻、雙頻BDS數(shù)據(jù)與INS數(shù)據(jù)組合解算,獲取相應(yīng)組合方式的姿態(tài),并與參考值進(jìn)行比較.圖19～21分別示出了單、雙頻BDS緊組合的橫滾角(roll)、俯仰角(pitch)、航向角(heading)誤差.從圖上可以看出,使用雙頻BDS數(shù)據(jù)與進(jìn)行INS緊組合解算能有效減少姿態(tài)收斂時(shí)間.表4示出了兩種組合方式的姿態(tài)誤差RMS,使用雙頻數(shù)據(jù)使橫滾角(roll)、俯仰角(pitch)、航向角(heading)誤差RMS分別改善了41.1%、26.7%、59.0%.

圖19 單雙頻BDS和INS緊組合橫滾角誤差

圖20 單雙頻BDS和INS緊組合俯仰角誤差

圖21 單雙頻BDS和INS緊組合航向角誤差

表4 緊組合姿態(tài)誤差

方案橫滾角RMS/(°)俯仰角RMS/(°)航向角RMS/(°) BDS單頻緊組合0.0730.0300.337 BDS雙頻緊組合0.0400.0220.138

此外,不論何種組合方式,航向角RMS明顯差于其他兩個(gè)方向,這可能是由于航向方向的可用性較差[9].

3 結(jié)束語(yǔ)

本文推導(dǎo)了BDS RTK/INS緊組合系統(tǒng)的狀態(tài)模型、量測(cè)模型,并基于車載實(shí)驗(yàn)數(shù)據(jù)對(duì)BDS RTK/低成本INS緊組合導(dǎo)航系統(tǒng)性能進(jìn)行驗(yàn)證和分析.實(shí)驗(yàn)結(jié)果表明,低成本IMU能在基本不影響組合導(dǎo)航系統(tǒng)定位精度的同時(shí),較大改善系統(tǒng)測(cè)速精度.松組合模式下, N、E、D方向速度RMS分別改善了65.9%、5.7%、57.1%;而緊組合模式下速度RMS分別改善了79.5%、75.8%、66.7%.使用雙頻數(shù)據(jù)時(shí),緊組合可以進(jìn)一步改善系統(tǒng)測(cè)速精度,其N、E、D向速度RMS相對(duì)單頻BDS RTK/INS緊組合分別改善了18.2%、33.3%、33.3%.而在定姿時(shí),使用雙頻數(shù)據(jù)可有效減小收斂時(shí)間,改善定姿精度,使橫滾角、俯仰角、航向角誤差RMS分別改善了41.1%、26.7%、59.0%.

致謝:感謝武漢大學(xué)章紅平教授團(tuán)隊(duì)提供的試驗(yàn)數(shù)據(jù).