城市環(huán)境下視覺慣性里程計(jì)輔助PPP定位

張守建，李欣然，王逸石，徐 博

城市環(huán)境下視覺慣性里程計(jì)輔助PPP定位

張守建，李欣然，王逸石，徐 博

（武漢大學(xué) 測(cè)繪學(xué)院，武漢 430079）

針對(duì)復(fù)雜城市環(huán)境下，衛(wèi)星信號(hào)容易受到遮蔽，精密單點(diǎn)定位（PPP）技術(shù)無法實(shí)現(xiàn)高精度連續(xù)定位，而視覺慣性里程計(jì)（VIO）可以提供連續(xù)的相對(duì)位置和速度，但其誤差隨時(shí)間累積，無法長(zhǎng)時(shí)間獨(dú)立提供高精度導(dǎo)航等問題，提出半緊組合VIO輔助PPP（VIO-PPP）的定位方法：設(shè)計(jì)了VIO和PPP 2個(gè)濾波器；在VIO濾波器中，使用多狀態(tài)約束下的卡爾曼濾波器來處理獲取的視覺圖像和慣性測(cè)量單元（IMU）觀測(cè)數(shù)據(jù)，以預(yù)測(cè)位置和速度，并用PPP濾波器來修正預(yù)測(cè)值；同時(shí)根據(jù)定位精度因子和衛(wèi)星的數(shù)量，在不同的環(huán)境中對(duì)PPP和VIO采取不同的加權(quán)策略；然后搭建全球衛(wèi)星導(dǎo)航系統(tǒng)（GNSS）、慣性和視覺多源融合數(shù)據(jù)采集平臺(tái)，對(duì)各傳感器完成參數(shù)標(biāo)定和時(shí)間同步，形成一套完整的城市環(huán)境下的高精度定位系統(tǒng)；最后在戶外復(fù)雜環(huán)境中進(jìn)行多組實(shí)驗(yàn)，比較VIO、PPP和VIO-PPP不同定位模式的定位結(jié)果。實(shí)驗(yàn)結(jié)果表明，多源融合導(dǎo)航系統(tǒng)可以顯著提高導(dǎo)航性能，與PPP相比，VIO-PPP模型的精度能夠提高40%以上，平面精度和高程精度分別可達(dá)到0.2和0.3 m。

多源融合平臺(tái)；參數(shù)標(biāo)定；車載導(dǎo)航；半緊組合；精密單點(diǎn)定位（PPP）；視覺慣性里程計(jì)（VIO）

0 引言

當(dāng)前，高精度車道級(jí)導(dǎo)航已經(jīng)成為自動(dòng)駕駛中的關(guān)鍵技術(shù)。而在城市中，由于環(huán)境復(fù)雜，任何單一技術(shù)都無法長(zhǎng)時(shí)間提供連續(xù)可靠的導(dǎo)航定位服務(wù)，因此集成多種傳感器的多源融合導(dǎo)航成為未來導(dǎo)航領(lǐng)域的發(fā)展趨勢(shì)[1-7]。

高精度全球衛(wèi)星導(dǎo)航系統(tǒng)（global navigation satellite system，GNSS）定位模式主要有實(shí)時(shí)動(dòng)態(tài)（real-time kinematic，RTK）載波相位差分定位技術(shù)和精密單點(diǎn)定位（precise point position，PPP）技術(shù)。與需要密集的地面基站的RTK技術(shù)相比，精密單點(diǎn)定位技術(shù)僅使用單一GNSS接收機(jī)就可以提供全球高精度定位服務(wù)[8-10]，因而得到了國內(nèi)外的廣泛關(guān)注。然而，在城市地區(qū)，衛(wèi)星信號(hào)經(jīng)常被阻斷，導(dǎo)致PPP出現(xiàn)頻繁初始化的問題，其定位精度和效率受到嚴(yán)重影響。文獻(xiàn)[11]在復(fù)雜城市環(huán)境中，使用PPP-RTK技術(shù)的定位精度僅為10 m左右。同樣，文獻(xiàn)[12]在城市環(huán)境下基于單頻PPP的三維均方根（root mean square，RMS）精度為1.17 m。僅靠單一GNSS難以在城市環(huán)境中提供穩(wěn)定可靠的車道級(jí)導(dǎo)航服務(wù)。

慣性導(dǎo)航系統(tǒng)（inertial navigation system，INS）不依賴于外部信號(hào)，具備自主工作能力。然而，其定位誤差會(huì)隨著時(shí)間的推移而累積，因此在一段時(shí)間后很難提供準(zhǔn)確的位置和速度。

慣性測(cè)量單元（inertial measurement unit, IMU）通常可根據(jù)其性能分為4個(gè)級(jí)別，分別是戰(zhàn)略級(jí)、導(dǎo)航級(jí)、戰(zhàn)術(shù)級(jí)和微機(jī)械級(jí)。目前市面上的IMU設(shè)備定位精度從每小時(shí)數(shù)十公里到數(shù)米不等。性能優(yōu)異的IMU誤差發(fā)散較慢、定位精度高，但受限于高昂的價(jià)格而難以推廣。科學(xué)技術(shù)的發(fā)展催生了低成本的微機(jī)電系統(tǒng)（micro-electro-mechanical system，MEMS）IMU。目前MEMS IMU得到了廣泛的應(yīng)用。文獻(xiàn)[12-17]通過將其與GNSS、視覺等導(dǎo)航技術(shù)結(jié)合，彌補(bǔ)了單一MEMS IMU誤差飄移快、定位精度低的缺陷，為高精度的連續(xù)導(dǎo)航提供了新的方案。

為了在復(fù)雜城市環(huán)境下提供連續(xù)可靠的定位服務(wù)，搭建包含慣性、視覺和GNSS等多源傳感器的移動(dòng)觀測(cè)平臺(tái)，設(shè)計(jì)開發(fā)包括視覺慣性里程計(jì)（visual inertial odometry，VIO）濾波器和PPP濾波器在內(nèi)的多頻多系統(tǒng)PPP與VIO的半緊組合系統(tǒng)；為了保證定位結(jié)果的連續(xù)性，穩(wěn)健的定權(quán)策略至關(guān)重要，因此還提出一種根據(jù)定位精度衰減因子（position dilution of precision，PDOP）和衛(wèi)星數(shù)量的綜合加權(quán)策略；最后，利用自主搭建的多傳感器平臺(tái)在城市環(huán)境下采集多源觀測(cè)數(shù)據(jù)，對(duì)系統(tǒng)的精度進(jìn)行全面評(píng)估。

1 VIO-PPP組合模型

如圖1所示為半緊組合VIO-PPP系統(tǒng)的結(jié)構(gòu)。為了簡(jiǎn)化算法并提高系統(tǒng)的穩(wěn)健性，將系統(tǒng)分為 2個(gè)濾波器，即GNSS濾波器和VIO濾波器。VIO濾波器使用多狀態(tài)約束下的卡爾曼濾波器（multi-state constraint Kalman filter，MSCKF）處理視覺圖像和IMU觀測(cè)數(shù)據(jù)。首先通過慣性導(dǎo)航系統(tǒng)機(jī)械編排整合狀態(tài)變量，然后從視覺圖像中提取并跟蹤特征點(diǎn)，使用緊組合的方法對(duì)慣性與視覺觀測(cè)數(shù)據(jù)進(jìn)行融合。由于VIO的定位誤差會(huì)隨著時(shí)間的推移而累積，因此當(dāng)最新的狀態(tài)變量的時(shí)間戳與當(dāng)前的GNSS歷元同步時(shí)，PPP的結(jié)果可用來更新濾波器中的狀態(tài)變量以限制誤差累積。

圖1 半緊組合VIO輔助PPP系統(tǒng)設(shè)計(jì)路線

在GNSS濾波器中，本文使用多頻率和多系統(tǒng)的GNSS偽距和載波相位觀測(cè)值和精密產(chǎn)品進(jìn)行PPP解算，以獲得定位結(jié)果。在計(jì)算過程中，VIO的預(yù)測(cè)定位結(jié)果被用于輔助PPP濾波器計(jì)算衛(wèi)星到接收機(jī)的幾何距離，同時(shí)參與進(jìn)行半緊組合濾波，以提高PPP解算精度。

1.1 PPP觀測(cè)模型

將衛(wèi)星軌道、鐘差和偽距碼偏差代入到精密單點(diǎn)定位模型中，可以得到用戶端多頻多系統(tǒng)PPP的線性化觀測(cè)方程為

PPP模型的詳細(xì)公式可參考文獻(xiàn)[10]。

1.2 視覺慣性里程計(jì)組合模型

誤差狀態(tài)可以表示為

將整個(gè)狀態(tài)的協(xié)方差表示為

完整的誤差傳遞方程可以表示為

當(dāng)收到新的圖像時(shí)，應(yīng)增廣狀態(tài)協(xié)方差矩陣為

通過式（8）、式（9）和式（15），預(yù)測(cè)和更新步驟以擴(kuò)展卡爾曼濾波的形式進(jìn)行，完整公式可參見文獻(xiàn)[18]。

1.3 半緊組合VIO輔助PPP模型

PPP的解算結(jié)果包含系（地心地固坐標(biāo)系，即以地球?yàn)橹行那遗c地球固聯(lián)的坐標(biāo)系，Earth-centered Earth-fixed，ECEF）中的緯度、經(jīng)度和高程坐標(biāo)。而VIO的解算結(jié)果是載體相對(duì)于起始系（世界坐標(biāo)系，與重力方向一致的起始VIO框架）的狀態(tài)，其中有4個(gè)不可估計(jì)的狀態(tài)，即全球位置坐標(biāo)和航向。為了整合2個(gè)不同坐標(biāo)框架下的結(jié)果，以第一個(gè)歷元的坐標(biāo)為起點(diǎn)，將PPP解的結(jié)果轉(zhuǎn)換為到系（當(dāng)?shù)貙?dǎo)航坐標(biāo)系，即以載體為中心，指向東-北-天方向的坐標(biāo)系，east-north-up，ENU）下，且隨后的PPP定位結(jié)果均被轉(zhuǎn)換到第一個(gè)系下。在VIO的初始化過程中，位置積分的原點(diǎn)被設(shè)置為全局初始位置，因此系和系之間的轉(zhuǎn)換只是關(guān)于基于PPP軌跡計(jì)算的航向角的旋轉(zhuǎn)排列。通過上述初始化方法，即可以在系下融合PPP和VIO觀測(cè)值。

在短時(shí)間內(nèi)，VIO的定位精度高，因此將其作為初始值，取代PPP處理中標(biāo)準(zhǔn)單點(diǎn)定位的結(jié)果；同時(shí)，為了將VIO的預(yù)測(cè)位置融合到PPP濾波器中，我們?cè)赑PP觀測(cè)模型中加入位置約束

位置約束的協(xié)方差由文獻(xiàn)[19]中的方法確定。

2 實(shí)驗(yàn)與結(jié)果分析

車載實(shí)驗(yàn)在武漢大學(xué)校內(nèi)進(jìn)行，路線場(chǎng)景包括林蔭小道和高樓建筑等復(fù)雜環(huán)境。本文所使用的多源融合導(dǎo)航硬件平臺(tái)（如圖2所示）中搭載了北京米文動(dòng)力科技有限公司的Apex Xavier II產(chǎn)品作為控制單元，其內(nèi)部集成了英偉達(dá)智能控制平臺(tái)Jetson AGX Xavier。GNSS接收機(jī)和IMU采用的是Inertial Labs（慣性實(shí)驗(yàn)室）公司的INS-B型號(hào)GNSS/INS組合接收機(jī)，IMU的采樣頻率為100 Hz，其主要性能參數(shù)如表1所示。相機(jī)模塊采用森云智能SG-AR0143型號(hào)攝像頭，圖像數(shù)據(jù)采樣頻率為10 Hz。同時(shí)，基準(zhǔn)站設(shè)置于武漢大學(xué)測(cè)繪學(xué)院樓頂，用于實(shí)驗(yàn)后使用Inertial Explorer（慣性瀏覽器）軟件獲得RTK/INS的雙向平滑緊組合定位結(jié)果。該結(jié)果的整體定位精度為厘米級(jí)，并在接下來的評(píng)估中作為參考值使用。

圖2 GNSS/INS/視覺多源融合導(dǎo)航數(shù)據(jù)采集平臺(tái)

表1 IMU主要性能參數(shù)

本次實(shí)驗(yàn)采集道路環(huán)境如圖3所示。

圖3 車載實(shí)驗(yàn)采集環(huán)境

圖4 實(shí)驗(yàn)期間衛(wèi)星數(shù)與PDOP值

2.1 多傳感器參數(shù)標(biāo)定與時(shí)間同步

本文的多傳感器數(shù)據(jù)采集平臺(tái)安裝了包括GNSS接收機(jī)、IMU、視覺傳感器等在內(nèi)的多種傳感器，因此需要事先標(biāo)定出IMU與GNSS天線、視覺傳感器的空間幾何關(guān)系，以便后續(xù)解算，保證導(dǎo)航定位精度。關(guān)于視覺傳感器的使用，其內(nèi)外參數(shù)需要標(biāo)定。相機(jī)的內(nèi)參包括焦距、主點(diǎn)位置、成像畸變系數(shù)等。此外，由于本文使用的相機(jī)鏡頭為魚眼鏡頭，其內(nèi)參數(shù)還包括一個(gè)鏡頭彎曲系數(shù)。相機(jī)的外參是相機(jī)相對(duì)IMU的相對(duì)位姿。實(shí)驗(yàn)過程中，視覺傳感器的內(nèi)參數(shù)及其與IMU之間的外參均采用開源標(biāo)定工具包Kalibr進(jìn)行標(biāo)定[20]。

此外，多傳感器時(shí)間同步會(huì)很大程度地影響算法實(shí)現(xiàn)。GNSS絕對(duì)時(shí)間通常可達(dá)到納秒級(jí)，可靠性強(qiáng)。我們可通過硬件時(shí)間同步和軟件時(shí)間同步等將GNSS絕對(duì)時(shí)間傳遞給其他傳感器。本文設(shè)計(jì)的多源融合導(dǎo)航平臺(tái)中，IMU與GNSS已進(jìn)行時(shí)間同步，但視覺傳感器采集圖像過程相對(duì)獨(dú)立，采集到的圖像數(shù)據(jù)并無時(shí)標(biāo)信息，因此需要使用GNSS絕對(duì)時(shí)間傳遞給圖像數(shù)據(jù)并打上時(shí)間戳，以便在融合解算過程中判斷圖像數(shù)據(jù)的采集時(shí)間。本文采取的時(shí)間同步策略為，首先由GNSS接收機(jī)發(fā)送秒脈沖及美國國家海洋電子協(xié)會(huì)（National Marine Electronics Association，NMEA）協(xié)議信號(hào)給控制單元，控制單元結(jié)合內(nèi)部高穩(wěn)晶振完成外部協(xié)調(diào)世界時(shí)（coordinated universal time，UTC）授時(shí)，建立自身高精度的時(shí)間基準(zhǔn)，并通過發(fā)送脈沖信號(hào)來觸發(fā)相機(jī)采樣，同時(shí)設(shè)備會(huì)記錄該脈沖的產(chǎn)生時(shí)間。傳感器完成采樣后，設(shè)備會(huì)將記錄的時(shí)間與本次相機(jī)傳回的圖像做關(guān)聯(lián)，作為該圖像的時(shí)間戳，完成同步。

2.2 結(jié)果分析

為了驗(yàn)證半緊組合的VIO-PPP算法的有效性和可靠性，本文設(shè)計(jì)了3種不同的方案，包括VIO、PPP和VIO-PPP，來處理實(shí)驗(yàn)觀測(cè)數(shù)據(jù)。其中PPP結(jié)果為GPS+BDS+Galileo三系統(tǒng)的雙頻非組合浮點(diǎn)解，其中GPS系統(tǒng)選用的信號(hào)頻率為L(zhǎng)1和L2，BDS系統(tǒng)選用的信號(hào)頻率為B1I和B3I，GAL系統(tǒng)使用的信號(hào)頻率為E1和E5a。并且實(shí)驗(yàn)使用Inertial Explorer軟件解算得到的RTK/INS的雙向平滑緊組合定位結(jié)果作為參考值。

2.2.1 INS/視覺里程計(jì)緊組合定位性能分析

在全程一共約25 min的觀測(cè)數(shù)據(jù)中，選擇其中視覺數(shù)據(jù)紋理清晰、路上車輛和行人干擾較少的約700 s時(shí)長(zhǎng)數(shù)據(jù)進(jìn)行INS/視覺里程計(jì)緊組合解算，同時(shí)該段時(shí)間內(nèi)車輛的運(yùn)動(dòng)狀態(tài)豐富，有利于進(jìn)行實(shí)驗(yàn)驗(yàn)證。

選取GPS周內(nèi)秒25200～25900 s時(shí)間段的觀測(cè)數(shù)據(jù)，解算得到INS/視覺緊組合模式下的姿態(tài)誤差序列和定位誤差序列，如圖5所示。由圖可知，INS/視覺緊組合解算模式下，車輛俯仰角（pitch）和橫滾角（roll）在700 s內(nèi)仍能保持較好的穩(wěn)定性，而最能明顯反映城市環(huán)境下車輛行駛狀態(tài)的航向角（yaw）出現(xiàn)了明顯隨時(shí)間發(fā)散的情況，行駛700 s后航向角誤差已超過10°，同時(shí)INS/視覺里程計(jì)緊組合解算定位誤差累積在N、E 2個(gè)方向上均達(dá)到50 m以上，U方向精度略高，但也超過20 s。可見單純基于航位推算模式的INS/視覺里程計(jì)組合定位方式難以在城市環(huán)境中提供長(zhǎng)時(shí)間穩(wěn)定、可靠的導(dǎo)航服務(wù)，因此利用GNSS技術(shù)提供的絕對(duì)位置來限制INS/視覺里程計(jì)系統(tǒng)的誤差累積是很有必要的。

圖5 INS/視覺推算定姿、定位誤差

如表2所示為INS/視覺緊組合模式下的位置誤差和姿態(tài)誤差精度定量統(tǒng)計(jì)情況，分別列出了位置和姿態(tài)誤差的RMS值以及最大發(fā)散誤差。

總結(jié)上述視覺慣性里程計(jì)推算結(jié)果可知，在視覺傳感器輔助INS的情況下，定位定姿誤差會(huì)隨時(shí)間積累而逐漸增大，呈現(xiàn)出發(fā)散性，難以滿足車道級(jí)別導(dǎo)航的要求。

表2 INS/視覺定位定姿誤差統(tǒng)計(jì)

2.2.2 PPP/INS/視覺半緊組合定位性能分析

利用雙頻數(shù)據(jù)進(jìn)行GPS+BDS+Galileo三系統(tǒng)動(dòng)態(tài)PPP和PPP/INS/視覺半緊組合2種模式下的定位解算。

如圖6所示分別為單PPP和VIO-PPP組合2種模式下的定位誤差序列。由于實(shí)驗(yàn)過程的環(huán)境十分復(fù)雜，單純GNSS的定位結(jié)果較差，盡管引入了高精度的相位觀測(cè)值，但是誤差序列依然呈現(xiàn)出顯著的發(fā)散，遮擋嚴(yán)重的環(huán)境下，粗差和多路徑效應(yīng)導(dǎo)致多次出現(xiàn)收斂后再次發(fā)散的情況，PPP動(dòng)態(tài)浮點(diǎn)解的條件下，N、E、U 3個(gè)方向的位置誤差均存在1～2 m的浮動(dòng)。而在VIO-PPP半緊組合的融合定位模式下，整個(gè)時(shí)間段內(nèi)的系統(tǒng)差和定位精度得到了大幅改善，N、E、U 3個(gè)方向的位置誤差均控制在1 m以內(nèi)，且變化更為平滑，沒有大量跳躍現(xiàn)象。該組實(shí)驗(yàn)說明，在復(fù)雜環(huán)境中，慣性數(shù)據(jù)和視覺信息的引入對(duì)動(dòng)態(tài)PPP定位的精度有著顯著的提升，對(duì)單一GNSS定位方式受周圍環(huán)境影響產(chǎn)生的多路徑效應(yīng)有明顯的改善。

如表3所示為單獨(dú)PPP浮點(diǎn)解和VIO-PPP組合2種模式下的N、E、U方向定位精度統(tǒng)計(jì)情況。可以看出，VIO-PPP組合條件下在各方向上的精度均相比單純PPP模式有顯著提升。由于信號(hào)被遮擋，PPP定位的結(jié)果在N、U方向上僅能達(dá)到米級(jí)的精度，E方向上的定位精度能達(dá)到0.5 m以內(nèi)；而在利用慣性和視覺手段輔助PPP進(jìn)行粗差探測(cè)、多路徑誤差建模等預(yù)處理環(huán)節(jié)的情況下，可以顯著改進(jìn)定位精度而達(dá)到分米級(jí)。結(jié)合表2可知，借助GNSS測(cè)量信息的誤差不隨時(shí)間累積的特性，可以成功抑制VIO解算結(jié)果精度隨時(shí)間發(fā)散的情況。同圖5中的VIO解算結(jié)果相比，VIO-PPP半緊組合的位姿精度和穩(wěn)定性均有明顯提升。

3 結(jié)束語

本文搭建了多源融合數(shù)據(jù)采集平臺(tái)，對(duì)使用的傳感器進(jìn)行參數(shù)標(biāo)定與時(shí)間同步；開發(fā)了半緊組合VIO-PPP模型，包含一個(gè)PPP濾波器和一個(gè)VIO濾波器。GNSS數(shù)據(jù)和VIO數(shù)據(jù)被集成到MSCKF模型中，該模型使用VIO觀測(cè)數(shù)據(jù)預(yù)測(cè)位置和速度，并用PPP濾波器修正預(yù)測(cè)值，為PDOP和衛(wèi)星數(shù)量設(shè)定了閾值，以便對(duì)PPP和VIO采取不同的加權(quán)策略。然后在戶外復(fù)雜環(huán)境環(huán)境中采集多傳感器數(shù)據(jù)，利用半緊組合VIO-PPP組合導(dǎo)航系統(tǒng)進(jìn)行解算，驗(yàn)證其導(dǎo)航性能，并分別與VIO和PPP解算結(jié)果進(jìn)行比較。其中單一VIO模式的精度在約700 s的時(shí)間段內(nèi)航向角誤差累積超過10°，定位誤差也發(fā)散至數(shù)十米，難以滿足車輛導(dǎo)航的精度要求。而在復(fù)雜城市環(huán)境中，動(dòng)態(tài)PPP的三維定位有效值也僅有1.98 m，無法滿足車道級(jí)導(dǎo)航的要求。同時(shí)集成了VIO和GNSS的半緊組合VIO-PPP模式可以在城市環(huán)境中提供連續(xù)準(zhǔn)確的位置，東、北、天3個(gè)方向的精度分別為0.22、0.12和0.18 m，與PPP相比，分別提高了85%、76%和85%。這表明，使用多傳感器系統(tǒng)可以極大程度上彌補(bǔ)單一導(dǎo)航手段帶來的缺陷，有效限制INS/視覺傳感器的誤差累積，提升衛(wèi)星信號(hào)被嚴(yán)重遮擋情況下的定位精度與穩(wěn)定性，實(shí)現(xiàn)高精度連續(xù)定位，并且目前的精度已經(jīng)可以初步滿足車輛在復(fù)雜城市環(huán)境中的車道級(jí)導(dǎo)航，為自駕車輛等技術(shù)的發(fā)展提供參考。同時(shí)為了使系統(tǒng)更加可靠，提高定位精度，未來我們可能會(huì)考慮其他傳感器，如激光雷達(dá)（light detection and ranging，LiDAR）。此外，預(yù)計(jì)使用GNSS PPP固定解，性能將得到進(jìn)一步提高。

[1] LIAO J C, LI X X, WANG X B, et al. Enhancing navigation performance through visual-inertial odometry in GNSS-degraded environment[J]. GPS Solutions, 2021, 25(2): 1-18.

[2] LI X, LI X X, HUANG J X, et al. Improving PPP-RTK in urban environment by tightly coupled integration of gnss and ins[J]. Journal of Geodesy, 2021, 95(12):1-18.

[3] 朱鋒. GNSS/SINS/視覺多傳感器融合的精密定位定姿方法與關(guān)鍵技術(shù)[D]. 武漢大學(xué), 2019.

[4] 黃聲享, 李冠青, 張文, 等. 港珠澳大橋沉管隧道施工控制網(wǎng)布設(shè)研究[J/OL]. 武漢大學(xué)學(xué)報(bào)?信息科學(xué)版: 1-9[2022-10-28]. https://doi.org/10.13203/j.whugis20170196.

[5] REID T, HOUTS S E, CAMMARATA R, et al. Localization requirements for autonomous vehicles[J]. SAE International Journal of Connected and Automated Vehicles, 2019, 2(3): 173-190.

[6] 張樂添, 趙冬青, 賈曉雪, 等. 面向動(dòng)態(tài)環(huán)境的雙目/慣性SLAM系統(tǒng)[J/OL]. 導(dǎo)航定位學(xué)報(bào): 1-7[2022-11-03]. http://kns.cnki.net/kcms/detail/10.1096.p.20220902.1438.002.html.

[7] BOCK Y, MELGAR D. Physical applications of GPS geodesy: A review[J]. Reports on Progress in Physics, 2016, 79(10): 106801.

[8] BLEWITT G. An automatic editing algorithm for GPS data[J]. Geophysical Research Letters, 1990, 17(3): 199-202. DOI:10.1029/GL017i003p00199.

[9] KOUBA J, HéROUX P. Precise point positioning using IGS orbit and clock products[J]. GPS Solutions, 2001, 5: 12-28.

[10] 簡(jiǎn)濠駿, 王逸石, 張?jiān)? 等. 北斗衛(wèi)星廣播星歷精度評(píng)估與單點(diǎn)定位優(yōu)化模型[J]. 大地測(cè)量與地球動(dòng)力學(xué), 2022, 42(3): 291-297. DOI:10.14075/j.jgg.2022.03.014.

[11] LI X, LI X X, LI S Y, et al. Centimeter-Accurate vehicle navigation in urban environments with a tightly integrated PPP-RTK/MEMS/vision system[J]. GPS Solution, 2022, 26:124.

[12] GU S F, DAI C Q, FANG W T, et al. Multi-GNSS PPP/INS tightly coupled integration with atmospheric augmentation and its application in urban vehicle navigation[J]. Journal of Geodesy, 2021, 95(6): 1-15.

[13] RABBOU M A, EL-RABBANY A. Tightly coupled integration of GPS precise point positioning and MEMS-based inertial systems[J]. GPS Solution, 2017, 19(4): 601-609.

[14] LI M Y, MOURIKIS A I. High-Precision,consistent EKF-based visual-inertial odometry[J]. Int J Robot Res, 2013, 32: 690-711.

[15] BLOESCH M, OMARI S, HUTTER M, et al. Robust visual inertial odometry using a direct EKF-based approach[C]// IEEE/RSJ International Conference on Intelligent Robots and Systems. Hamburg, Germany, 2015. DOI: 10.1109/IROS.2015.7353389.

[16] LEUTENEGGER S, LYNEN S, BOSSE M, et al. Keyframe based visual-inertial odometry using nonlinear optimization[J]. Int J Robot Res, 2015, 34: 314-334.

[17] GAO Z Z, ZHANG H P, GE M R, et al. Tightly coupled integration of multi-GNSS PPP and MEMS inertial measurement unit data[J]. GPS Solutions, 2017, 21(2): 377-391.

[18] SUN K, MOHTA K, PFROMMER B, et al. Robust stereo visual inertial odometry for fast autonomous flight[J]. IEEE Robotics and Automation Letters, 2018, 3(2): 965-972.

[19] LI X X, WANG X B, LIAO J C, et al. Semi-Tightly coupled integration of multi-GNSS PPP and S-VINS for precise positioning in GNSS-challenged environments[J]. Satellite Navigation, 2021, 2(1): 1-14.

[20] 蘇景嵐. 車載視覺/INS/GNSS多傳感器融合定位定姿算法研究[D]. 武漢大學(xué), 2019.

Visual inertial odometry-aided PPP positioning in urban environments

ZHANG Shoujian, LI Xinran, WANG Yishi, XU Bo

（School of Geodesy and Geomatics, Wuhan University, Wuhan 430079, China）

Aiming at the problems that in the complex urban environment, precise point positioning (PPP) cannot achieve high precision continuous positioning because satellite signal is easily blocked by trees, buildings and tunnels, meanwhile visual inertial odometry (VIO) can provide continuous relative position and velocity, but its time-increasing errors make it difficult to provide highly accurate positioning results independently after a long time, the paper proposed a positioning method of semi-tightly coupled VIO aided PPP (VIO-PPP) system: two Kalman filters including VIO filter and PPP filter were designed; in the VIO filter, the multi-state constraint Kalman filter (MSCKF) model was used to process the acquired visual images and inertial measurement unit (IMU) observations to predict the position and velocity, and the predicted values were corrected with the PPP filter; then based on the position dilution of precision (PDOP) and the number of satellites, different weighting strategies for the PPP and the VIO were adopted in different environments; in addition, a multi-sensor data acquisition platform was built with global navigation satellite system (GNSS), inertial sensors and cameras, and the parameter calibration and the time synchronization were performed for each sensor, for forming a complete set of high-precision positioning system in the urban environment; finally, multiple sets of experiments were conducted in a complex outdoor environment to compare the positioning results of different positioning modes of VIO, PPP and VIO-PPP. Results showed that a multi-source fusion navigation system integrating multiple sensors could significantly improve the performance of navigation and positioning, and the VIO-PPP model would bring more than 40% accuracy improvement compared with PPP, with 0.2 m accuracy in plane and 0.3 m accuracy in elevation.

multi-source fusion platform platform; parameter calibration; in-vehicle navigation; semi-coupled integration; precise point positioning (PPP); visual inertial odometry (VIO)

張守建, 李欣然, 王逸石, 等. 城市環(huán)境下視覺慣性里程計(jì)輔助PPP定位[J]. 導(dǎo)航定位學(xué)報(bào), 2023, 11(6): 34-41.（ZHANG Shoujian, LI Xinran, WANG Yishi, et al. Visual inertial odometry-aided PPP positioning in urban environments[J]. Journal of Navigation and Positioning, 2023, 11(6): 34-41.）DOI:10.16547/j.cnki.10-1096.20230605.

P228

A

2095-4999(2023)06-0034-08

2023-11-08

國家重點(diǎn)研發(fā)計(jì)劃（2021YFB2501100）

張守建（1980—），男，山東臨沂人，博士，副教授，研究方向?yàn)槎嘣慈诤蠈?dǎo)航、低軌衛(wèi)星精密定軌等。