陶毅峰，江金光，方 偉

(武漢大學(xué) 衛(wèi)星導(dǎo)航定位技術(shù)研究中心，湖北 武漢 430079)

0 引 言

基于捷聯(lián)慣性導(dǎo)航系統(tǒng)和GPS(global positioning system)技術(shù)，在GPS信號(hào)良好的情況下可以有效地進(jìn)行導(dǎo)航[1]?？柭鼮V波(Kalman filtering)技術(shù)由于其高精度，設(shè)計(jì)簡(jiǎn)單等優(yōu)點(diǎn)成為了最廣泛使用的技術(shù)。因?yàn)楦呔葢T性測(cè)量單元(inertial measurement unit，IMU)成本昂貴，大部分情況下IMU只是MEMS(microelectro mechanical systems)級(jí)別的，這種級(jí)別的INS(inertial navigation system)/GPS組合導(dǎo)航系統(tǒng)的定位精度極大地依賴于GPS信號(hào)[2]，而GPS信號(hào)極易受到高樓、樹蔭等遮擋而失鎖[3-5]；此時(shí)INS/GPS組合導(dǎo)航系統(tǒng)僅能依靠純慣導(dǎo)進(jìn)行機(jī)械編排，定位結(jié)果會(huì)隨著時(shí)間的積累發(fā)散[6]，導(dǎo)致解算精度迅速下降。而神經(jīng)網(wǎng)絡(luò)作為近幾年火熱的技術(shù)，已有許多結(jié)合神經(jīng)網(wǎng)絡(luò)與INS/GPS的研究[7,8]。如利用BP(back propagation)神經(jīng)網(wǎng)絡(luò)[9]、多層感知器(multi-layer perceptron，MLP)[10]來輔助組合導(dǎo)航系統(tǒng)。這些模型將各時(shí)刻的輸入與輸出視為獨(dú)立的元素，但是實(shí)際的組合導(dǎo)航系統(tǒng)顯然是一個(gè)連續(xù)的、各時(shí)刻位置相關(guān)的系統(tǒng)。循環(huán)神經(jīng)網(wǎng)絡(luò)(recurrent neural network，RNN)可以將過去時(shí)刻的位置信息與當(dāng)前時(shí)刻的輸出聯(lián)系起來，恰好與上述問題契合。因此本文使用循環(huán)神經(jīng)網(wǎng)絡(luò)中的一種變體結(jié)構(gòu)GRU(gated recurrent unit)算法輔助組合導(dǎo)航系統(tǒng)，以解決GPS失鎖時(shí)定位精度迅速發(fā)散的問題。

1 組合導(dǎo)航卡爾曼濾波模型

INS/GPS組合導(dǎo)航系統(tǒng)的組合方式有：松組合、緊組合、深組合等。其中松組合是基于GPS導(dǎo)航結(jié)果的數(shù)據(jù)組合，即Kalman的觀測(cè)向量為GPS和INS的速度、位置的數(shù)據(jù)組合。松組合結(jié)構(gòu)簡(jiǎn)單，計(jì)算負(fù)擔(dān)低，易實(shí)現(xiàn)，可靠性很高，但所需衛(wèi)星數(shù)最少為4顆，粗差探測(cè)能力弱。緊組合是基于GPS觀測(cè)量的數(shù)據(jù)組合，即Kalman的觀測(cè)向量為GPS的偽距、偽距率的數(shù)據(jù)組合。緊組合結(jié)構(gòu)復(fù)雜，計(jì)算負(fù)擔(dān)較高，可靠性也不如松組合，但是其粗差探測(cè)能力強(qiáng)，可觀測(cè)衛(wèi)星數(shù)少于4顆時(shí)也可以正常工作。深組合是基于GPS信號(hào)的組合，采用了矢量環(huán)路的方法，通道間互相輔助，提高了信號(hào)跟蹤環(huán)路性能和系統(tǒng)，降低了載體動(dòng)態(tài)變化的影響[11]，但該技術(shù)還不成熟，實(shí)現(xiàn)難度高。

由于本文側(cè)重點(diǎn)為解決GPS失鎖時(shí)的精度問題，故本文選取了結(jié)構(gòu)較為簡(jiǎn)單，計(jì)算量小的松組合作為組合方式。INS/GPS松組合的結(jié)構(gòu)如圖1所示，其中INS輸出慣導(dǎo)推算得到的信息PINS(位置)、VINS(速度)、AINS(姿態(tài)角)；GPS提供位置信息，與INS的位置信息相減作為觀測(cè)向量ZK[12]輸入到卡爾曼濾波模塊；卡爾曼濾波模塊輸出改正信息δp，δv，δA對(duì)INS的輸出值進(jìn)行修正，得到最終的組合結(jié)果。

圖1 INS/GPS松組合結(jié)構(gòu)框架

本文松組合采用15維卡爾曼濾波，坐標(biāo)系采用北東地地理坐標(biāo)系，狀態(tài)變量為

(1)

觀測(cè)向量為

Z=[PINS-GPS]

(2)

觀測(cè)值的量測(cè)矩陣為

(3)

狀態(tài)轉(zhuǎn)移矩陣為

(4)

卡爾曼濾波預(yù)測(cè)部分

(5)

更新部分

(6)

其中，φk,k-1為離散化后的狀態(tài)轉(zhuǎn)移矩陣，Qk-1為離散化后的系統(tǒng)狀態(tài)噪聲方差陣，Pk,k-1為一步預(yù)測(cè)狀態(tài)協(xié)方差矩陣，Kk為卡爾曼濾波增益，Pk為估計(jì)狀態(tài)協(xié)方差矩陣[13]。GPS信號(hào)正常時(shí)，每一秒內(nèi)的純慣導(dǎo)推算帶來的誤差會(huì)被卡爾曼濾波后的δp，δv，δA所補(bǔ)償?shù)?。但是一旦GPS失鎖，卡爾曼濾波就失去了觀測(cè)向量，無法繼續(xù)進(jìn)行組合，也就無法產(chǎn)生δp，δv，δA對(duì)INS結(jié)果進(jìn)行反饋。這部分的誤差一直累計(jì)，會(huì)隨時(shí)間產(chǎn)生二次發(fā)散。因此GPS失鎖時(shí)松組合退化為純慣導(dǎo)推算無法滿足正常的導(dǎo)航需求，需要其它觀測(cè)或算法輔助，本文的輔助導(dǎo)航方法在第3章中繼續(xù)詳細(xì)闡述。

2 GRU循環(huán)神經(jīng)網(wǎng)絡(luò)模型

2.1 循環(huán)神經(jīng)網(wǎng)絡(luò)結(jié)構(gòu)

傳統(tǒng)的神經(jīng)網(wǎng)絡(luò)為前饋神經(jīng)網(wǎng)絡(luò)(feed-forward neural network，F(xiàn)NN)，通常包含輸入層、隱藏層和輸出層。各層之間互相連接，訓(xùn)練時(shí)每一層的權(quán)值更新就是通過這些連接進(jìn)行傳遞；但是每一層內(nèi)的神經(jīng)元互相獨(dú)立，不存在環(huán)路，因此FNN僅適用于觀測(cè)數(shù)據(jù)互相獨(dú)立的情況，而對(duì)于上下文有聯(lián)系的時(shí)間序列數(shù)據(jù)就效果欠佳。

為了彌補(bǔ)這一不足，RNN在隱藏層加入了回路連接，前一時(shí)刻的網(wǎng)絡(luò)狀態(tài)會(huì)傳遞到下一時(shí)刻，因此當(dāng)前時(shí)刻的輸出不僅受到當(dāng)前時(shí)刻的輸入影響，還與之前時(shí)刻的數(shù)據(jù)輸入產(chǎn)生了聯(lián)系。而對(duì)于權(quán)值參數(shù)的問題，RNN借鑒了隱馬爾可夫模型(hidden Markov model，HMM)參數(shù)共享的概念。HMM廣泛應(yīng)用于語音處理、文字處理等領(lǐng)域，對(duì)于序列數(shù)據(jù)建模取得很好的效果。這二者利用內(nèi)部狀態(tài)來衡量數(shù)據(jù)間的依賴關(guān)系，參數(shù)共享減少了訓(xùn)練的參數(shù)，提高了效率。RNN的參數(shù)更新和傳統(tǒng)的神經(jīng)網(wǎng)絡(luò)類似，使用了反向傳播算法(backpropagation algorithm)，其前向傳播如圖2所示，由于每個(gè)時(shí)刻的隱藏狀態(tài)都與前一時(shí)刻的產(chǎn)生聯(lián)系，因此進(jìn)一步產(chǎn)生了長(zhǎng)距離的依賴。

圖2 RNN前向傳播結(jié)構(gòu)

2.2 GRU算法

RNN適用于處理時(shí)間序列數(shù)據(jù)，可以將當(dāng)前時(shí)刻的輸出和狀態(tài)當(dāng)作輸入傳遞到下一時(shí)刻，因此這種串型結(jié)構(gòu)可以保持各時(shí)刻間的數(shù)據(jù)關(guān)系。但是RNN很難保持長(zhǎng)期的依賴性，且存在梯度消失、梯度爆炸的問題[14]，因此在RNN基礎(chǔ)上進(jìn)一步產(chǎn)生了許多優(yōu)秀的演化模型，如長(zhǎng)短期記憶網(wǎng)絡(luò)(long short-term memory，LSTM)和GRU。這些模型通過加入記憶單元來解決長(zhǎng)期依賴的問題，通過門控單元來避免梯度爆炸。而GRU相較于LSTM參數(shù)更少，訓(xùn)練更快，因此人工智能(artificial intelligence，AI)模塊選擇GRU算法。

GRU單元結(jié)構(gòu)如圖3所示，ht-1是前一時(shí)刻的隱藏狀態(tài)，ht為當(dāng)前時(shí)刻的隱藏狀態(tài)輸出，xt是當(dāng)前時(shí)刻的數(shù)據(jù)輸入。該單元結(jié)構(gòu)有2個(gè)門，更新門和重置門，更新門用于控制前一時(shí)刻的狀態(tài)信息對(duì)當(dāng)前時(shí)刻的影響程度，輸出為rt，更新門的值越大，狀態(tài)信息保留越多；重置門用于忽略前一時(shí)刻的部分狀態(tài)信息，輸出為zt，重置門的值越小，狀態(tài)信息忽略越多。

圖3 GRU單元結(jié)構(gòu)

具體前向傳播公式如下

(7)

其中，Wxr為輸入層到更新門的權(quán)重矩陣，Whr為隱藏狀態(tài)到更新門的權(quán)重矩陣，Wxz為輸入層到重置門的權(quán)重矩陣，Whz為隱藏狀態(tài)到重置門的權(quán)重矩陣，Wxh為輸入層到隱藏狀態(tài)的權(quán)重矩陣，Whh為隱藏狀態(tài)之間的連接權(quán)重矩陣；br，bz，bh分別為更新門、重置門、隱藏單元的偏置向量。

循環(huán)神經(jīng)網(wǎng)絡(luò)相較于普通神經(jīng)網(wǎng)絡(luò)最大的區(qū)別就是存在time step(時(shí)間步長(zhǎng))參數(shù)，GRU也同樣存在這個(gè)參數(shù)。這個(gè)參數(shù)的選擇決定了訓(xùn)練時(shí)利用多少步長(zhǎng)內(nèi)的時(shí)序關(guān)系，即輸出與前多少個(gè)陸續(xù)的數(shù)據(jù)輸入有關(guān)系。具體GRU和循環(huán)神經(jīng)網(wǎng)絡(luò)的結(jié)構(gòu)與推導(dǎo)公式見文獻(xiàn)[14]。

3 GRU循環(huán)神經(jīng)網(wǎng)絡(luò)輔助INS/GPS組合導(dǎo)航

目前關(guān)于GPS失鎖時(shí)使用AI技術(shù)進(jìn)行輔助的模型主要有3種，分別是OINS-δPINS模型、OINS-Xk模型和OINS-ΔPGPS模型，都有著不錯(cuò)的效果[15]。OINS-δPINS模型輸入為INS信息，輸出為GPS和INS的誤差；OINS-Xk模型輸入為INS信息，輸出為Kalman濾波后的狀態(tài)向量；OINS-ΔPGPS模型輸入為INS信息，輸出為GPS增量信息。前兩種模型的預(yù)測(cè)值既包含INS信息，也包含GPS信息，而第三種模型的預(yù)測(cè)值僅與GPS信息相關(guān)，因此前兩種模型相較于第三種模型會(huì)引入額外的混合誤差，所以本文采用OINS-ΔPGPS模型。ΔPGPS的具體推導(dǎo)公式如下

(8)

(9)

具體工作流程如圖4所示，在GPS信號(hào)鎖定時(shí)，使用GRU循環(huán)神經(jīng)網(wǎng)絡(luò)進(jìn)行實(shí)時(shí)訓(xùn)練，輸入為IMU提供的三軸加速度計(jì)數(shù)據(jù)fb、三軸陀螺儀數(shù)據(jù)ωb、INS輸出的速度信息VINS和航向角ψINS。因此在GPS信號(hào)良好時(shí)GRU模塊可以找到IMU、INS信息與GPS增量信息之間的映射關(guān)系。

圖4 GRU輔助INS/GPS組合導(dǎo)航訓(xùn)練過程

當(dāng)GPS失鎖后，GPS模塊不再提供位置信息，IMU和INS模塊繼續(xù)向GRU模塊輸入傳感器數(shù)據(jù)，慣導(dǎo)推算結(jié)果等相關(guān)信息，由已訓(xùn)練好的GRU循環(huán)神經(jīng)網(wǎng)絡(luò)根據(jù)輸入來預(yù)測(cè)ΔPGPS。將上述GPS增量信息進(jìn)行積分，就可以得到一個(gè)模擬的GPS位置信息[16]，也叫作偽GPS位置信息，效果等同于GPS信號(hào)鎖定時(shí)的GPS定位結(jié)果。將該結(jié)果與PINS作差后送入KF模塊即可繼續(xù)進(jìn)行卡爾曼濾波，用來對(duì)位置、速度、姿態(tài)進(jìn)行修正，如圖5所示。此時(shí)原本只能通過慣導(dǎo)進(jìn)行推算的純慣導(dǎo)模塊，有了偽GPS信息對(duì)其進(jìn)行修正，抑制了MEMS級(jí)慣導(dǎo)的誤差發(fā)散速度。

圖5 GRU輔助INS/GPS組合導(dǎo)航預(yù)測(cè)過程

4 算法驗(yàn)證

為驗(yàn)證算法，使用邁普時(shí)空的M39設(shè)備所采的數(shù)據(jù)進(jìn)行仿真，采樣輸出頻率為200 HZ，利用SPAN-CPT設(shè)備作為參考系統(tǒng)，二者的IMU性能參數(shù)見表1。數(shù)據(jù)采集地點(diǎn)為武漢市佛祖嶺附近，所采數(shù)據(jù)共4500 s，選取中段的4000 s數(shù)據(jù)來進(jìn)行仿真，前3000 s用于訓(xùn)練，3000 s-3200 s用于驗(yàn)證，3200 s-4000 s用于測(cè)試。

表1 仿真設(shè)備與參考設(shè)備的IMU性能參數(shù)

GRU模型的輸入為IMU的三軸陀螺儀數(shù)據(jù)、三軸加速度計(jì)數(shù)據(jù)、速度矢量、航向角共10個(gè)特征維度，輸出為GPS增量信息。訓(xùn)練時(shí)由于輸入層的IMU傳感器數(shù)據(jù)、速度、航向角等INS信息為1 s 200次，而GPS增量信息1 s僅有1次，所以訓(xùn)練時(shí)需要將1 s內(nèi)的所有信息一起作為輸入層的輸入。進(jìn)一步地，由于GRU模型存在time step參數(shù)，即存在時(shí)間上的維度，結(jié)合上述的10個(gè)特征和信息頻率以及訓(xùn)練時(shí)長(zhǎng)為3000 s，因此輸入層的數(shù)據(jù)為大小為(3000,time step,2000)；而輸出層的數(shù)據(jù)顯然為GPS增量信息，大小為(3000,3)。此數(shù)據(jù)量非常龐大，隱藏層的神經(jīng)元個(gè)數(shù)，time step的參數(shù)選擇都會(huì)影響到訓(xùn)練的效率和最終精度，因此本文先對(duì)輸入層和輸出層數(shù)據(jù)進(jìn)行了歸一化處理，預(yù)測(cè)模型預(yù)測(cè)時(shí)再反歸一化，以加快訓(xùn)練時(shí)的收斂速度。并且對(duì)于相關(guān)參數(shù)的調(diào)節(jié)也進(jìn)行了實(shí)驗(yàn)，見表2。

表2 不同time step和隱藏層單元數(shù)的性能對(duì)比

表2中為不同time step和隱藏層單元數(shù)的調(diào)節(jié)情況。考慮到效率和精度，最終本文中GRU模塊優(yōu)化器選擇為adam算法，隱藏層神經(jīng)元個(gè)數(shù)設(shè)置為128個(gè)，time step參數(shù)選擇為4，其它參數(shù)變量的值見表3。

表3 GRU模塊參數(shù)設(shè)置

由于本文采用的實(shí)驗(yàn)環(huán)境為車載環(huán)境，高程在精度上的變化與影響較小，因此下述實(shí)驗(yàn)僅考慮和分析水平誤差。圖6、圖7分別為測(cè)試集GRU預(yù)測(cè)的緯度、經(jīng)度增量和真實(shí)的緯度、經(jīng)度增量的比較，可以看出二者趨勢(shì)基本一致。具體的平均絕對(duì)誤差(mean absolute error，MAE)和均方誤差(mean square error，MSE)統(tǒng)計(jì)見表4。

圖6 GRU預(yù)測(cè)緯度增量與真值的對(duì)比

圖7 GRU預(yù)測(cè)經(jīng)度增量與真值的對(duì)比

表4 GRU預(yù)測(cè)的經(jīng)緯度增量誤差統(tǒng)計(jì)

圖8是將800 s預(yù)測(cè)的ΔPGPS累加畫出的水平軌跡圖與真實(shí)軌跡的比較。起點(diǎn)處二者重合，誤差逐漸增大，最大誤差不超過50 m。從圖8中也可以看出，雖然全程誤差都在發(fā)散，軌跡逐漸分離，但是誤差陡增的幾處基本為拐彎處，直線行駛時(shí)誤差增加很小。這是因?yàn)檐囕d環(huán)境下直線行駛的情況較多，相應(yīng)地，訓(xùn)練集中直線行駛的數(shù)據(jù)就更豐富，GRU模型更容易找到直線行駛時(shí)INS、IMU信息和GPS增量的關(guān)系。同時(shí)，相較于拐彎，直線行駛時(shí)的IMU測(cè)得的數(shù)據(jù)更準(zhǔn)，慣導(dǎo)推算結(jié)果也更精確，這也導(dǎo)致了上述結(jié)果。

圖8 GRU預(yù)測(cè)的軌跡與實(shí)際軌跡對(duì)比

上述仿真是采用了組合導(dǎo)航的結(jié)果進(jìn)行預(yù)測(cè)，目的是為了驗(yàn)證GRU模型應(yīng)用于GPS增量預(yù)測(cè)時(shí)的可行性，并調(diào)節(jié)GRU網(wǎng)絡(luò)的參數(shù)，使得該預(yù)測(cè)模型達(dá)到最優(yōu)；實(shí)際使用本模型時(shí)，由于一次次的預(yù)測(cè)會(huì)導(dǎo)致速度、航向、位置等信息的誤差累積，因此選取其中200 s(202100 周秒-202300 周秒)的時(shí)間完整模擬本模型方法。為了進(jìn)一步說明GRU循環(huán)神經(jīng)網(wǎng)絡(luò)相較于普通神經(jīng)網(wǎng)絡(luò)的優(yōu)越性，下述圖中還加入了MLP的預(yù)測(cè)情況。圖9(a)、圖9(b)分別為GPS失鎖200 s時(shí)GRU循環(huán)神經(jīng)網(wǎng)絡(luò)模型輔助的組合導(dǎo)航與GPS失鎖時(shí)純機(jī)械編排的北向/東向速度漂移對(duì)比。GRU、MLP算法輔助的北向、東向速度漂移要優(yōu)于純慣導(dǎo)、其中GRU效果更好。純慣導(dǎo)推算北向、東向最大速度漂移分別為4.61 m/s，3.37 m/s；MLP輔助的北向、東向最大漂移分別為4.55 m/s、2.83 m/s，與純慣導(dǎo)推算相當(dāng)，略小于純慣導(dǎo)結(jié)果，但是整體要優(yōu)于純慣導(dǎo)；GRU輔助的北向，東向最大速度漂移為1.55 m/s，1.17 m/s。GRU輔助相較于純慣導(dǎo)推算，北向和東向最大速度漂移分別降低66.4%和65.3%。GRU輔助相較于MLP輔助，北向和東向最大速度漂移分別降低65.9%和56.7%。

圖9 不同算法輔助的速度漂移

圖10、圖11、圖12分別為GPS失鎖200 s時(shí)GRU循環(huán)神經(jīng)網(wǎng)絡(luò)模型輔助的組合導(dǎo)航與GPS失鎖時(shí)純機(jī)械編排的緯度、經(jīng)度、水平位置漂移對(duì)比。純慣導(dǎo)緯度、經(jīng)度、水平最大漂移分別為394.51 m、294.66 m、492.40 m；MLP輔助的緯度、經(jīng)度、水平最大漂移分別為370.23 m、166.78 m、406.06 m；GRU輔助的緯度、經(jīng)度、水平最大漂移分別為86.88 m、69.07 m、87.14 m。GRU輔助相較于純慣導(dǎo)推算、緯度、經(jīng)度和水平方向最大位置漂移分別降低78.0%、76.6%和82.3%；GRU輔助相較于MLP輔助、緯度、經(jīng)度和水平方向最大位置漂移分別降低76.5%、58.6%和78.5%。上述所有統(tǒng)計(jì)結(jié)果總結(jié)見表5。

圖10 不同算法輔助的緯度位置漂移

圖11 不同算法輔助的經(jīng)度位置漂移

圖12 不同算法輔助的水平位置漂移

表5 GPS失鎖200 s的3種方法最大誤差統(tǒng)計(jì)結(jié)果

圖13為這200 s仿真結(jié)果在Google Earth上的軌跡。黑色的兩條線分別為真實(shí)軌跡和GRU輔助軌跡，其中真實(shí)軌跡的圖標(biāo)為黑色實(shí)心圓，GRU輔助軌跡的圖標(biāo)為黑色正方形；白色的兩條線為MLP輔助軌跡和純慣導(dǎo)軌跡，其中MLP輔助軌跡的圖標(biāo)為白色空心三角形，純慣導(dǎo)軌跡的圖標(biāo)為白色空心圓。可以看出經(jīng)過一個(gè)彎道后，3種方法與真實(shí)軌跡的誤差已經(jīng)有了明顯的差距，GRU輔助的最為接近，MLP輔助的次之，純慣導(dǎo)推算最差；經(jīng)過2個(gè)彎道后只有GRU輔助的軌跡仍與真實(shí)軌跡趨勢(shì)接近，其它軌跡都發(fā)散嚴(yán)重。

圖13 不同算法輔助的地圖軌跡

表6為GPS失鎖200 s的3種方法RMS統(tǒng)計(jì)結(jié)果，可以看出使用MLP、GRU輔助的結(jié)果各方面都要優(yōu)于純慣導(dǎo)推算，其中GRU輔助最優(yōu)，水平誤差54.20 m相較于純慣導(dǎo)的204.80 m和MLP輔助的153.40 m有巨大提升。

表6 GPS失鎖200 s的3種方法RMS統(tǒng)計(jì)結(jié)果

5 結(jié)束語

本文為了解決GPS失鎖時(shí)純慣導(dǎo)推算發(fā)散嚴(yán)重的問題，采用了GRU輔助INS/GPS的方法。在GPS鎖定時(shí)使用INS速度、姿態(tài)角信息、IMU加速度計(jì)、陀螺儀數(shù)據(jù)和GPS增量進(jìn)行訓(xùn)練，找到相應(yīng)的映射關(guān)系；GPS失鎖后，向訓(xùn)練好的GRU模型繼續(xù)輸入INS和IMU信息，該模型就可以提供預(yù)測(cè)的GPS增量信息，將之積分得到偽GPS位置。此時(shí)就可以進(jìn)行卡爾曼濾波，以抑制原本純MEMS級(jí)慣導(dǎo)推算時(shí)的誤差快速發(fā)散。并且本文與MLP輔助INS/GPS的方法進(jìn)行了比較，驗(yàn)證了GRU循環(huán)神經(jīng)網(wǎng)絡(luò)對(duì)于連續(xù)時(shí)間軌跡推算的優(yōu)越性。由于GPS失鎖時(shí)，里程計(jì)在車載導(dǎo)航中對(duì)精度有著極為明顯的提升，且技術(shù)較為成熟，因此，下一步工作將結(jié)合里程計(jì)與本方法進(jìn)行進(jìn)一步實(shí)驗(yàn)。