• <tr id="yyy80"></tr>
  • <sup id="yyy80"></sup>
  • <tfoot id="yyy80"><noscript id="yyy80"></noscript></tfoot>
  • 99热精品在线国产_美女午夜性视频免费_国产精品国产高清国产av_av欧美777_自拍偷自拍亚洲精品老妇_亚洲熟女精品中文字幕_www日本黄色视频网_国产精品野战在线观看 ?

    步幅和建筑方向輔助的行人導(dǎo)航算法

    2016-04-26 06:08:58于飛白紅美高偉趙博葉攀

    于飛, 白紅美, 高偉, 趙博, 葉攀

    (哈爾濱工程大學(xué) 自動(dòng)化學(xué)院, 黑龍江 哈爾濱 150001)

    ?

    步幅和建筑方向輔助的行人導(dǎo)航算法

    于飛, 白紅美, 高偉, 趙博, 葉攀

    (哈爾濱工程大學(xué) 自動(dòng)化學(xué)院, 黑龍江 哈爾濱 150001)

    摘要:針對(duì)零速校正過(guò)程中航向誤差觀測(cè)性差引起的定位精度低的問(wèn)題,在零速校正的基礎(chǔ)上,采用行人步幅和建筑方向輔助的航向誤差校正算法,對(duì)系統(tǒng)原有觀測(cè)量擴(kuò)維。根據(jù)行人運(yùn)動(dòng)狀態(tài)得到步幅航向和建筑方向,建立基于速度誤差和航向誤差的量測(cè)模型,利用卡爾曼濾波器實(shí)現(xiàn)濾波更新。并且研究了RTS平滑算法,對(duì)軌跡進(jìn)行平滑以解決軌跡突變問(wèn)題。采用荷蘭Xsens公司的MTi-G型IMU進(jìn)行場(chǎng)地試驗(yàn),通過(guò)對(duì)比不同算法的定位誤差驗(yàn)證算法的有效性。結(jié)果表明,當(dāng)行人運(yùn)動(dòng)距離為70 m時(shí),其最大定位誤差不超過(guò)3.4 m。

    關(guān)鍵詞:IMU;零速校正;行人步幅;建筑方向;RTS平滑;定位誤差

    行人導(dǎo)航系統(tǒng)主要用于行人在已知或未知環(huán)境下的自主導(dǎo)航和實(shí)時(shí)定位。當(dāng)GPS信號(hào)丟失或強(qiáng)度較弱無(wú)法完成導(dǎo)航任務(wù)時(shí),基于微機(jī)電系統(tǒng)(micro electro mechanical systems,MEMS)慣性器件的IMU可以為行人完成自主式導(dǎo)航的功能[1]。然而長(zhǎng)時(shí)間導(dǎo)航時(shí),IMU的誤差隨時(shí)間積累,導(dǎo)致導(dǎo)航精度降低[2]。為減小IMU引起的誤差,Christoph等采用視覺陀螺輔助的IMU系統(tǒng)[3],Leppakoski等對(duì)Wi-Fi與IMU的組合系統(tǒng)進(jìn)行了研究[4]。Delikostidis等分析了路標(biāo)輔助的算法[5]。這些方法雖能提高導(dǎo)航精度,但均需提供外界信息,而且增加了系統(tǒng)成本。因此,研究在無(wú)外界信號(hào)情況下提高導(dǎo)航定位精度的算法顯得尤為重要。故提出基于行人步幅和建筑方向的輔助算法,并利用RTS平滑算法對(duì)軌跡進(jìn)行平滑處理,解決軌跡突變問(wèn)題。

    1零速校正

    當(dāng)IMU固定于行人腳部時(shí)[6],利用檢測(cè)到的零速能有效修正系統(tǒng)的導(dǎo)航參數(shù)誤差[7]。以速度誤差為觀測(cè)量時(shí),航向誤差是通過(guò)北向與東向加速度和速度誤差相關(guān)聯(lián),而北向和東向加速度理論值應(yīng)為零,這使得航向誤差的可觀測(cè)性非常差[8]。高階IMU能夠提高系統(tǒng)性能,但會(huì)增加系統(tǒng)成本和尺寸,且誤差依然會(huì)累積。磁力計(jì)對(duì)應(yīng)用環(huán)境有一定的要求。因此提出基于行人步幅和建筑方向的航向誤差校正算法,以減小行人導(dǎo)航的定位誤差。系統(tǒng)總體算法流程如圖1。

    圖1 系統(tǒng)總體算法流程圖Fig. 1 The overall algorithm flowchart of system

    首先利用IMU的輸出進(jìn)行導(dǎo)航解算和零速檢測(cè),當(dāng)行人步態(tài)處于零速狀態(tài)時(shí),應(yīng)用零速校正和航向誤差校正算法,通過(guò)卡爾曼濾波器估計(jì)狀態(tài)向量,得到修正后的導(dǎo)航參數(shù),同時(shí)保存濾波參數(shù),利用RTS平滑算法得到平滑后的運(yùn)動(dòng)軌跡。

    2航向誤差校正算法

    航向誤差校正算法建立在行人步幅和建筑方向的基礎(chǔ)上。首先需要利用行人的運(yùn)動(dòng)狀態(tài)獲得步幅航向和建筑方向,然后對(duì)原有觀測(cè)量進(jìn)行擴(kuò)維,以速度誤差和航向誤差為觀測(cè)量推導(dǎo)系統(tǒng)模型,最后采用卡爾曼濾波器對(duì)導(dǎo)航參數(shù)進(jìn)行估計(jì),并利用估計(jì)結(jié)果修正導(dǎo)航參數(shù)。

    2.1行人步幅和建筑方向分析

    在行人運(yùn)動(dòng)過(guò)程中,每運(yùn)動(dòng)一步均會(huì)產(chǎn)生步幅航向和步長(zhǎng)。步長(zhǎng)定義為一步的距離,步幅航向定義為兩個(gè)連續(xù)步之間的角度[9],如下

    (1)

    圖2 步幅航向示意圖Fig. 2 Schematic diagram of stride heading

    在引入步幅航向之前,需要判斷行人是否已經(jīng)走出一步。只有當(dāng)行人已經(jīng)邁出一步,才可以根據(jù)式(1)得到步幅航向。由于行人運(yùn)動(dòng)的靈活性較大,本文利用廣泛似然比檢測(cè)算法判斷行人的步態(tài)[10],相對(duì)于傳統(tǒng)的閾值檢測(cè)算法,此方法充分利用了傳感器信息,并將零速檢測(cè)問(wèn)題模型化為假設(shè)檢驗(yàn)問(wèn)題,可對(duì)快走、跑步等運(yùn)動(dòng)狀態(tài)進(jìn)行準(zhǔn)確檢測(cè)。表1給出了行人在正常、快走和跑步運(yùn)動(dòng)狀態(tài)的步態(tài)檢測(cè)結(jié)果,默認(rèn)一步運(yùn)動(dòng)中只有一個(gè)零速區(qū)間,實(shí)驗(yàn)共有34個(gè)真實(shí)零速區(qū)間。

    表1 步態(tài)檢測(cè)結(jié)果

    由表1可知,傳統(tǒng)算法只適用于正常步速情況,無(wú)法準(zhǔn)確檢測(cè)快走和跑步時(shí)的零速情況。GLRT檢測(cè)算法則可對(duì)正常步速、快走和跑步等運(yùn)動(dòng)狀態(tài)進(jìn)行準(zhǔn)確的檢測(cè),能夠檢測(cè)到較為完整的零速區(qū)間。

    在零速檢測(cè)的基礎(chǔ)上,根據(jù)兩個(gè)相鄰的零速點(diǎn)即可計(jì)算行人步幅航向,計(jì)算得到的步幅航向?qū)⒃谙乱徊街杏玫絒11]。零速檢測(cè)結(jié)果可用二進(jìn)制表示,如圖3所示,“0”為非零速狀態(tài),“1”為零速狀態(tài)[12],圖中黑點(diǎn)表示每個(gè)零速區(qū)間的第一個(gè)零速點(diǎn),即用于計(jì)算步幅航向的時(shí)刻點(diǎn)。

    圖3 零速檢測(cè)結(jié)果Fig. 3 Result of zero velocity detection

    建筑方向通過(guò)2D地圖獲取,利用MATLAB對(duì)圖像進(jìn)行處理,根據(jù)追蹤到的像素點(diǎn)即可計(jì)算建筑方向的值[13]。

    建筑方向的獲取方法為:首先利用Canny檢測(cè)算子檢測(cè)圖像上的邊緣;在邊緣檢測(cè)的基礎(chǔ)上,采用Hough變換檢測(cè)圖像上的直線;根據(jù)直線起始點(diǎn)和結(jié)束點(diǎn)的像素值,即可獲得建筑方向:

    (2)

    式中:φbm為獲得的建筑方向,δx、δy分別為起始點(diǎn)和結(jié)束點(diǎn)在x和y方向上的像素差。圖4給出了圖像處理得到的建筑方向。

    圖4 建筑方向Fig. 4 Building heading

    圖4中,黑色直線為檢測(cè)到的一條直線,直線的起始點(diǎn)和結(jié)束點(diǎn)分別已在圖中標(biāo)注,將兩點(diǎn)的像素值代入式(2),可得到該建筑方向?yàn)?.589 rad。

    為得到更加準(zhǔn)確的建筑方向φb,利用零速檢測(cè)點(diǎn)處的導(dǎo)航參數(shù)對(duì)其修正,零速點(diǎn)如圖4中的黑點(diǎn)所示,分析相鄰3個(gè)零速點(diǎn)的航向變化值:

    (3)

    式中:θk為采樣時(shí)刻k時(shí)的航向值,km-1為前一個(gè)零速點(diǎn)的采樣時(shí)刻,km-2為第1個(gè)零速點(diǎn)的采樣時(shí)刻,α和β分別為前2個(gè)采樣時(shí)刻對(duì)應(yīng)航向的修正權(quán)值。當(dāng)km-1和km-2時(shí)刻的濾波精度相同時(shí),權(quán)值α和β相等。由式(3)可知,此時(shí)應(yīng)取兩時(shí)刻航向的平均值與k時(shí)刻的航向值進(jìn)行比較,即滿足α=β=1,故權(quán)值α和β應(yīng)滿足:

    (4)

    當(dāng)兩時(shí)刻的濾波精度不同時(shí),其具體數(shù)值可根據(jù)對(duì)應(yīng)時(shí)刻的濾波效果決定,即由km-1和km-2采樣時(shí)刻的濾波協(xié)方差矩陣Pkm-1和Pkm-2決定。若km-2時(shí)刻的航向?yàn)V波精度高,則對(duì)應(yīng)權(quán)值大;若濾波精度低,則其權(quán)值小。km-1時(shí)刻亦然。所以權(quán)值和對(duì)應(yīng)時(shí)刻的航向?yàn)V波精度值成反比:

    (5)

    (6)

    由式(3)可得到相鄰3個(gè)零速點(diǎn)的航向變化值,利用此航向變化值可對(duì)建筑航向進(jìn)行修正,得到修正后的建筑方向:

    (7)

    式中:φbm為由地圖得到的建筑方向,δθ為航向變化值,φb為修正后的建筑方向。

    2.2系統(tǒng)模型

    在分析步幅航向和建筑方向后,即可推導(dǎo)系統(tǒng)模型。首先分析系統(tǒng)的狀態(tài)空間模型,選取狀態(tài)向量x為

    (8)

    式中:p3×1為位置向量,v3×1為速度向量,a3×1為姿態(tài)向量,δw3×1為陀螺零偏向量,δf3×1為加速度計(jì)零偏向量。狀態(tài)轉(zhuǎn)移矩陣F(t)如下

    (9)

    (10)

    式中:W(t)為系統(tǒng)白噪聲。

    由融合零速校正和航向誤差校正算法[12],得到系統(tǒng)的觀測(cè)模型:

    (11)

    (12)

    由此得到量測(cè)矩陣H4×15:

    (13)

    式中:xk-1(9)為濾波更新得到的上一時(shí)刻的縱搖角,Vk為量測(cè)噪聲。各協(xié)方差矩陣如下所示:

    濾波協(xié)方差陣:

    (14)

    系統(tǒng)噪聲協(xié)方差矩陣:

    (15)

    量測(cè)噪聲協(xié)方差矩陣:

    (16)

    其中

    3RTS平滑算法

    零速校正算法和航向誤差校正算法均以零速檢測(cè)為基礎(chǔ),在修正區(qū)間能有效限制誤差增長(zhǎng),在非零速區(qū)間,誤差依然持續(xù)增長(zhǎng),故會(huì)產(chǎn)生軌跡突變現(xiàn)象。為避免急劇修正現(xiàn)象的產(chǎn)生,本文在行人每個(gè)單步運(yùn)動(dòng)中利用RTS平滑算法對(duì)軌跡進(jìn)行平滑,以得到平滑的運(yùn)動(dòng)軌跡。

    RTS平滑算法包括前向?yàn)V波和后向平滑兩部分。本文中前向?yàn)V波采用卡爾曼濾波,在濾波過(guò)程中,保存每個(gè)時(shí)刻的狀態(tài)向量Xk、估計(jì)均方誤差陣Pk、一步預(yù)測(cè)均方誤差Pk,k-1以及狀態(tài)轉(zhuǎn)移矩陣Φk,k-1,保存值將在后向平滑過(guò)程中用到[14]。

    前向?yàn)V波的卡爾曼濾波算法為

    后向平滑過(guò)程按k=N,N-1,…1逆時(shí)針方向遞推解算得到平滑估計(jì)結(jié)果。后向平滑算法為

    4試驗(yàn)驗(yàn)證

    為驗(yàn)證算法的有效性,利用荷蘭Xsens公司的MTi-G型IMU進(jìn)行場(chǎng)地試驗(yàn)。實(shí)物如圖5所示,其內(nèi)部集成了三軸MEMS加速度計(jì)、陀螺和磁力計(jì)。其中,加速度計(jì)量程為±5.23rad/s,陀螺量程為±50m/s2,滿足試驗(yàn)要求。

    圖5 IMU實(shí)物圖Fig. 5 Figure of the IMU

    將IMU固定于鞋上,盡量與水平地面保持平行。利用自帶數(shù)據(jù)采集軟件XSENSMTManager對(duì)傳感器數(shù)據(jù)進(jìn)行實(shí)時(shí)采集和存儲(chǔ),并可根據(jù)需要導(dǎo)出十進(jìn)制或二進(jìn)制的MEMS傳感器數(shù)據(jù)。系統(tǒng)啟動(dòng)時(shí),需對(duì)系統(tǒng)的采樣頻率、輸出數(shù)據(jù)格式等參數(shù)進(jìn)行設(shè)置。

    試驗(yàn)時(shí)波特率設(shè)置為115 200,數(shù)據(jù)采樣頻率為100Hz,傳感器輸出為標(biāo)定后的數(shù)據(jù),可直接用于導(dǎo)航解算。步行試驗(yàn)持續(xù)8min左右,全程大約70m,試驗(yàn)開始和結(jié)束的地點(diǎn)在同一位置,以確保得到返回時(shí)的位置誤差。場(chǎng)地試驗(yàn)在哈爾濱工程大學(xué)軍工操場(chǎng)內(nèi)進(jìn)行,如圖6所示,其中箭頭代表開始點(diǎn),圓點(diǎn)繪制的線路為試驗(yàn)時(shí)行人的運(yùn)動(dòng)軌跡。

    圖6 試驗(yàn)場(chǎng)地圖Fig. 6 Map of the test field

    數(shù)據(jù)采集完成后,進(jìn)行離線分析。單獨(dú)采用INS算法得到的航向如圖7所示。由圖7可知,單獨(dú)采用INS算法得到的航向波動(dòng)較大,且呈發(fā)散趨勢(shì),需進(jìn)行進(jìn)一步修正。采用ZUPT+航向誤差校正算法與單獨(dú)采用ZUPT的航向?qū)Ρ葓D如圖8所示。

    圖7 INS航向Fig. 7 The heading of INS algorithm

    圖8 航向?qū)Ρ葓DFig. 8 The comparison chart of heading

    由圖8可以看出,采用航向誤差校正算法能夠有效減小航向誤差。在前200s內(nèi),零速校正算法能使航向保持在一定精度范圍內(nèi)。但在200s之后,隨著時(shí)間的推移,航向誤差逐漸增大。表2給出了航向誤差的具體數(shù)值,表中數(shù)據(jù)為各時(shí)間段內(nèi)的最大航向誤差值。

    表2 200 s后的航向誤差對(duì)比結(jié)果

    由表2可以看出,單獨(dú)采用零速校正算法時(shí)的航向誤差最大可達(dá)到0.262 rad,而且在各時(shí)間段內(nèi)的誤差均超過(guò)0.174 rad;采用航向誤差校正算法后的最大誤差減小為0.163 rad,各時(shí)間段內(nèi)的誤差最小為0.060 rad。由此可見,航向誤差校正算法能有效提高航向的精度。

    采用零速校正和航向誤差校正算法得到的行人運(yùn)動(dòng)軌跡如圖9所示。

    圖9 行人運(yùn)動(dòng)軌跡Fig. 9 The trajectory for pedestrian

    由圖9和圖6對(duì)比可以看出,此算法解算得到的行人運(yùn)動(dòng)軌跡與真實(shí)運(yùn)動(dòng)軌跡一致,故此算法能完成對(duì)行人的自主導(dǎo)航和定位功能。為更好的分析定位結(jié)果,以IMU/GPS組合系統(tǒng)得到定位結(jié)果為參考,進(jìn)一步量化分析行人的定位誤差,行人運(yùn)動(dòng)過(guò)程中的定位誤差如圖10所示,誤差的具體數(shù)值見表3。

    圖10 行人定位誤差Fig. 10 The positioning error for pedestrian

    誤差類型誤差/m占總距離百分比/%最大誤差3.384.82平均誤差1.211.72返回誤差1.051.51

    由圖10和表3可以看出,在300~400 s,行人的位置誤差達(dá)到最大值,為3.38 m。在整個(gè)運(yùn)動(dòng)過(guò)程中,其位置誤差不超過(guò)運(yùn)動(dòng)總距離的5%,并且其位置誤差不隨時(shí)間累積,能夠限制在一定范圍內(nèi)。由此可見,采用航向誤差校正算法能有效減小行人的定位誤差。利用RTS平滑算法后的行人運(yùn)動(dòng)軌跡對(duì)比圖如圖11所示。

    圖11 平滑運(yùn)動(dòng)軌跡對(duì)比圖Fig. 11 The comparison chart of smoothed trajectory

    由圖11可以看出,和平滑前的軌跡相比,平滑后的軌跡較為平滑,不存在軌跡突變現(xiàn)象。在保證定位精度的同時(shí),采用RTS平滑算法能有效解決軌跡突變問(wèn)題。

    5結(jié)論

    本文在零速校正的基礎(chǔ)上,對(duì)步幅和建筑方向輔助的航向誤差校正算法進(jìn)行了研究,通過(guò)數(shù)據(jù)的離線分析可得到以下結(jié)論:

    1)利用修正建筑方向和步幅航向之差作為觀測(cè)量對(duì)導(dǎo)航參數(shù)實(shí)現(xiàn)濾波更新,由航向誤差和定位誤差的結(jié)果對(duì)比可以看出,該方法的定位精度較傳統(tǒng)的零速校正算法有所提高;

    2)在航向誤差校正算法的基礎(chǔ)上,采用RTS平滑算法對(duì)定位軌跡進(jìn)行后向平滑,在保證了定位精度的同時(shí),解決了只在零速區(qū)間內(nèi)進(jìn)行校正導(dǎo)致的軌跡突變問(wèn)題;

    3)此算法不需額外的信號(hào)源,這意味著不論試驗(yàn)場(chǎng)地大小,系統(tǒng)的成本不會(huì)增加,但其不足在于校正算法依賴于零速點(diǎn)的準(zhǔn)確檢測(cè),當(dāng)行人處于非靜止?fàn)顟B(tài)時(shí),誤差仍然是累積的,未來(lái)的工作主要在于解決運(yùn)動(dòng)狀態(tài)下誤差累積的問(wèn)題。

    參考文獻(xiàn):

    [1]周啟帆, 張海, 常艷紅, 等. 基于MIMU的行人導(dǎo)航算法研究[J]. 系統(tǒng)仿真技術(shù), 2010, 6(4): 281-286.

    ZHOU Qifan, ZHANG Hai, CHANG Yanhong, et al. Research of pedestrian navigation algorithm based on MIMU[J]. System simulation technology, 2010, 6(4): 281-286.

    [2]陳述奇, 劉青峰, 冉龍明, 等. 低成本MIMU/編碼器組合的高精度航姿系統(tǒng)[J]. 壓電與聲光, 2012, 34(3): 368-371.

    CHEN Shuqi, LIU Qingfeng, RAN Longming, et al. Design and test of low-cost MIMU/encoder integrated precision attitude heading reference system[J]. Piezoelectrics & acoustooptics, 2012, 34(3): 368-371.

    [3]KESSLER C, ASCHER C, FRIETSCH N, et al. Vision-based attitude estimation for indoor navigation using vanishing points and lines[C]//Position Location and Navigation Symposium (PLANS). Indian Wells, USA, 2010: 310-318.

    [5]DELIKOSTIDIS I, ENGEL J, RETSIOS B, et al. Increasing the usability of pedestrian navigation interfaces by means of landmark visibility analysis[J]. Journal of navigation, 2013, 66(4): 523-537.

    [6]張金亮, 秦永元, 梅春波. 基于MEMS慣性技術(shù)的鞋式個(gè)人導(dǎo)航系統(tǒng)[J]. 中國(guó)慣性技術(shù)學(xué)報(bào), 2011, 19(3): 253-256.

    ZHAGN Jinliang, QIN Yongyuan, MEI Chunbo. Shoe-mounted personal navigation system based on MEMS inertial technology[J]. Journal of Chinese inertial technology, 2011, 19(3): 253-256.

    [7]PARK S K, SUH Y S. A zero velocity detection algorithm using inertial sensors for pedestrian navigation systems[J]. Sensors, 2010, 10(10): 9163-9178.

    [8]GODHA S, LACHAPELLE G. Foot mounted inertial system for pedestrian navigation[J]. Measurement science and technology, 2008, 19(7): 075202.

    [9]FENG Wenquan, ZHAO Hongbo, ZHAO Qi, et al. Integration of GPS and low cost INS for pedestrian navigation aided by building layout[J]. Chinese journal of aeronautics, 2013, 26(5): 1283-1289.

    [10]SKOG I, HANDEL P, NILSSON J O, et al. Zero-velocity detection-An algorithm evaluation[J]. IEEE Transactions on biomedical engineering, 2010, 57(11): 2657-2666.

    [11]JIMéNEZ A R, SECO F, ZAMPELLA F, et al. Improved heuristic drift elimination with magnetically-aided dominant directions (MiHDE) for pedestrian navigation in complex buildings[J]. Journal of location based services, 2012, 6(3): 186-210.

    [12]JIMENEZ A R, SECO F, PRIETO J C, et al. Indoor pedestrian navigation using an INS/EKF framework for yaw drift reduction and a foot-mounted IMU[C]//Proceedings of the 7th Workshop on Positioning Navigation and Communication. Dresden, Germany, 2010: 135-143.

    [13]ABDULRAHIM K, HIDE C, MOORE T, et al. Aiding MEMS IMU with building heading for indoor pedestrian navigation[C]//Proceedings of Ubiquitous Positioning Indoor Navigation and Location Based Service(UPINLBS). Kirkkonummi, Finland, 2010: 1-6.

    [14]宮曉琳, 張蓉, 房建成. 固定區(qū)間平滑算法及其在組合導(dǎo)航系統(tǒng)中的應(yīng)用[J]. 中國(guó)慣性技術(shù)學(xué)報(bào), 2012, 20(6): 687-693.

    GONG Xiaolin, ZHANG Rong, FANG Jiancheng. Fixed-interval smoother and its applications in integrated navigation system[J]. Journal of Chinese inertial technology, 2012, 20(6): 687-693.

    Stride and building heading aided algorithm for pedestrian navigation

    YU Fei, BAI Hongmei, GAO Wei, ZHAO Bo, YE Pan

    (College of Automation, Harbin Engineering University, Harbin 150001, China)

    Abstract:In view of the low positioning accuracy achieved owing to poor observability of the cause of heading error during zero velocity updating (ZUPT), on the basis of ZUPT, we propose a heading aided algorithm based on pedestrian stride and the building direction to expand the dimensions of the observation. From the movement of a pedestrian, we obtained the stride direction and building heading. Then, we established a measurement model based on the velocity and heading errors, using a Kalman filter for the update. Furthermore, we investigated the Rauch Rung Streibel (RTS) smoothing algorithm, and smoothed the trajectory using the RTS smoother to solve the mutation problem. Finally, we conducted experiments to prove the algorithm's validity by using the MTi-G inertial measurement unit (IMU) of Xsens in the Netherlands, and verified the effectiveness of the algorithm by comparing its positioning error with those of different algorithms. The results show that the maximum positioning error does not exceed 3.4 m when the walking distance is 70 m.

    Keywords:inertial measurement unit (IMU); zero velocity updating (ZUPT); pedestrian stride; building direction; RTS smoothing; positioning error

    中圖分類號(hào):V241.5

    文獻(xiàn)標(biāo)志碼:A

    文章編號(hào):1006-7043(2016)03-408-06

    doi:10.11990/jheu.201412076

    作者簡(jiǎn)介:于飛(1974-), 男, 教授,博士生導(dǎo)師;通信作者:白紅美, E-mail:baihongmei_kit@163.com.

    基金項(xiàng)目:國(guó)家自然科學(xué)基金資助項(xiàng)目(51379047).

    收稿日期:2014-12-29.

    網(wǎng)絡(luò)出版地址:http://www.cnki.net/kcms/detail/23.1390.u.20151218.1049.002.html

    網(wǎng)絡(luò)出版日期:2015-12-18.

    白紅美(1989-), 女, 碩士研究生.

    啦啦啦韩国在线观看视频| 精品久久久久久久久久久久久| 观看免费一级毛片| 亚洲av电影不卡..在线观看| 免费在线观看日本一区| 久久久久久久久久成人| 欧美乱色亚洲激情| 婷婷亚洲欧美| 久久久久久久久久成人| 午夜日韩欧美国产| a级一级毛片免费在线观看| 亚洲国产精品久久男人天堂| 美女高潮的动态| 91麻豆av在线| 麻豆国产av国片精品| 欧美日韩乱码在线| 久久久精品欧美日韩精品| 国产成年人精品一区二区| 亚洲av.av天堂| 精品久久久久久久久av| 午夜精品在线福利| 男女那种视频在线观看| 动漫黄色视频在线观看| 亚洲熟妇熟女久久| 午夜激情欧美在线| 亚洲中文日韩欧美视频| 好男人电影高清在线观看| 免费高清视频大片| 三级毛片av免费| 看免费av毛片| 中文字幕av成人在线电影| 精品久久久久久久久av| 97超级碰碰碰精品色视频在线观看| 中文字幕高清在线视频| 亚洲精品一区av在线观看| 综合色av麻豆| 免费在线观看成人毛片| 亚洲成av人片在线播放无| 91字幕亚洲| 有码 亚洲区| 成人av在线播放网站| 精品久久久久久久久久久久久| 精品福利观看| 亚洲精品色激情综合| 十八禁人妻一区二区| 精品久久久久久久久久久久久| 免费无遮挡裸体视频| 午夜福利欧美成人| 中国美女看黄片| 免费黄网站久久成人精品 | 午夜亚洲福利在线播放| 欧美成人免费av一区二区三区| 内射极品少妇av片p| 久久国产乱子伦精品免费另类| 美女xxoo啪啪120秒动态图 | 久久中文看片网| 国产成人影院久久av| 久久久久精品国产欧美久久久| 久久国产精品影院| 久久人人爽人人爽人人片va | 国产黄片美女视频| 99国产极品粉嫩在线观看| 午夜福利18| 日本精品一区二区三区蜜桃| 三级毛片av免费| 亚洲午夜理论影院| 色噜噜av男人的天堂激情| 女人十人毛片免费观看3o分钟| 色av中文字幕| 99久久九九国产精品国产免费| 精品久久久久久久久亚洲 | 亚洲av不卡在线观看| 欧美精品啪啪一区二区三区| 国产欧美日韩一区二区三| 俺也久久电影网| 男女那种视频在线观看| 神马国产精品三级电影在线观看| 两个人视频免费观看高清| 老司机福利观看| 久久久久国产精品人妻aⅴ院| 男人舔女人下体高潮全视频| 国产黄a三级三级三级人| 岛国在线免费视频观看| 欧美成人一区二区免费高清观看| 日韩 亚洲 欧美在线| av黄色大香蕉| 小蜜桃在线观看免费完整版高清| 黄色配什么色好看| 91久久精品电影网| www.色视频.com| 久久久久久国产a免费观看| 熟女人妻精品中文字幕| 天天一区二区日本电影三级| 老司机午夜十八禁免费视频| 婷婷亚洲欧美| 两个人的视频大全免费| 悠悠久久av| 精品久久久久久久久亚洲 | 久99久视频精品免费| 亚洲中文日韩欧美视频| eeuss影院久久| 亚洲五月天丁香| 国产高清三级在线| 欧美日本亚洲视频在线播放| 亚洲黑人精品在线| 天堂网av新在线| 老熟妇仑乱视频hdxx| 亚洲av日韩精品久久久久久密| 免费在线观看成人毛片| 久久国产精品影院| 琪琪午夜伦伦电影理论片6080| aaaaa片日本免费| 国产精品亚洲美女久久久| 婷婷色综合大香蕉| 一区二区三区免费毛片| 脱女人内裤的视频| 亚洲成人中文字幕在线播放| 一本久久中文字幕| 看免费av毛片| 五月伊人婷婷丁香| 欧美乱妇无乱码| 国产av麻豆久久久久久久| 亚洲精品在线观看二区| 久久亚洲真实| 国内精品久久久久精免费| 老熟妇仑乱视频hdxx| 欧美性猛交╳xxx乱大交人| 久久草成人影院| 久久国产精品影院| 欧美性猛交黑人性爽| 性欧美人与动物交配| 欧美不卡视频在线免费观看| 国产一区二区亚洲精品在线观看| 欧美极品一区二区三区四区| 欧美日韩黄片免| 九九热线精品视视频播放| 男人狂女人下面高潮的视频| 午夜福利在线观看免费完整高清在 | 日本一二三区视频观看| 少妇的逼水好多| 婷婷色综合大香蕉| 亚洲国产色片| 欧美不卡视频在线免费观看| 琪琪午夜伦伦电影理论片6080| 欧美中文日本在线观看视频| 国产极品精品免费视频能看的| www.999成人在线观看| 精品无人区乱码1区二区| 亚洲国产精品合色在线| 国产成人福利小说| 欧洲精品卡2卡3卡4卡5卡区| 亚洲精品亚洲一区二区| 亚洲精华国产精华精| 国产精品电影一区二区三区| 精品国产三级普通话版| 热99re8久久精品国产| 国产探花极品一区二区| 变态另类丝袜制服| 中文字幕免费在线视频6| 国产亚洲精品久久久久久毛片| 99在线人妻在线中文字幕| 99热这里只有是精品在线观看 | 最近在线观看免费完整版| 亚洲国产日韩欧美精品在线观看| 我的女老师完整版在线观看| 国产69精品久久久久777片| 国产黄片美女视频| 噜噜噜噜噜久久久久久91| 亚洲男人的天堂狠狠| 免费在线观看影片大全网站| 丝袜美腿在线中文| 成人精品一区二区免费| 色吧在线观看| 欧美黄色淫秽网站| 夜夜看夜夜爽夜夜摸| 淫秽高清视频在线观看| 最近最新中文字幕大全电影3| 91字幕亚洲| 夜夜爽天天搞| 真人做人爱边吃奶动态| 亚洲激情在线av| 麻豆国产av国片精品| 一个人看视频在线观看www免费| 亚洲综合色惰| 午夜激情福利司机影院| 熟女电影av网| 舔av片在线| 直男gayav资源| 亚洲专区中文字幕在线| 性色avwww在线观看| 国产亚洲精品综合一区在线观看| 在线免费观看的www视频| 97超级碰碰碰精品色视频在线观看| 免费av不卡在线播放| 欧美一区二区国产精品久久精品| 老师上课跳d突然被开到最大视频 久久午夜综合久久蜜桃 | 男人和女人高潮做爰伦理| 韩国av一区二区三区四区| www.色视频.com| 亚洲欧美激情综合另类| 亚洲中文字幕一区二区三区有码在线看| 免费看美女性在线毛片视频| 成人一区二区视频在线观看| 国产精品久久久久久精品电影| 国产人妻一区二区三区在| 少妇熟女aⅴ在线视频| 亚洲精品色激情综合| 国产成人欧美在线观看| 亚洲专区中文字幕在线| 国产亚洲精品久久久com| 亚洲一区二区三区不卡视频| 精品久久久久久久久av| 九色国产91popny在线| 亚洲乱码一区二区免费版| 精品久久久久久久末码| 日韩国内少妇激情av| 亚洲国产欧洲综合997久久,| 欧美国产日韩亚洲一区| 成人三级黄色视频| 熟女人妻精品中文字幕| 免费av不卡在线播放| 露出奶头的视频| 尤物成人国产欧美一区二区三区| 婷婷精品国产亚洲av在线| 日韩欧美精品免费久久 | 国产精品久久视频播放| 亚洲无线观看免费| 亚洲国产精品sss在线观看| 极品教师在线免费播放| 精品无人区乱码1区二区| 看免费av毛片| 欧美在线黄色| 国产亚洲欧美98| 精品一区二区三区视频在线观看免费| 老鸭窝网址在线观看| 免费av观看视频| 国产精品,欧美在线| 最新在线观看一区二区三区| ponron亚洲| 久久亚洲真实| 少妇熟女aⅴ在线视频| 国产一区二区在线av高清观看| 国产精品久久电影中文字幕| 亚洲18禁久久av| 性欧美人与动物交配| 国产免费一级a男人的天堂| 99国产精品一区二区蜜桃av| 91狼人影院| 波多野结衣高清作品| 国产v大片淫在线免费观看| 老熟妇仑乱视频hdxx| 精品久久久久久久末码| 国产精品国产高清国产av| a级毛片免费高清观看在线播放| 久久伊人香网站| av天堂在线播放| 欧美乱妇无乱码| 欧美不卡视频在线免费观看| 嫩草影院新地址| 波多野结衣巨乳人妻| 久久这里只有精品中国| 91麻豆av在线| 人人妻,人人澡人人爽秒播| 禁无遮挡网站| 中文亚洲av片在线观看爽| 一夜夜www| 看片在线看免费视频| 久久中文看片网| 91麻豆av在线| 亚洲国产精品sss在线观看| 成人性生交大片免费视频hd| 国产精品亚洲一级av第二区| 精品久久久久久久末码| 日韩国内少妇激情av| 亚洲av日韩精品久久久久久密| 最近最新中文字幕大全电影3| 3wmmmm亚洲av在线观看| 久久久国产成人精品二区| 国产高潮美女av| 亚洲av一区综合| 国产精品久久电影中文字幕| 伦理电影大哥的女人| 精品国产三级普通话版| 欧美在线一区亚洲| 国产大屁股一区二区在线视频| 免费在线观看影片大全网站| 国产黄色小视频在线观看| www.熟女人妻精品国产| 波野结衣二区三区在线| 成人三级黄色视频| 日韩欧美免费精品| 亚洲av电影不卡..在线观看| 亚洲,欧美,日韩| 亚洲精品日韩av片在线观看| 国产一区二区三区在线臀色熟女| 99热这里只有是精品在线观看 | 国产黄a三级三级三级人| 久久午夜亚洲精品久久| 国产 一区 欧美 日韩| 一级黄色大片毛片| 美女黄网站色视频| 在线免费观看不下载黄p国产 | 长腿黑丝高跟| 久久久久久久亚洲中文字幕 | 可以在线观看毛片的网站| 国产91精品成人一区二区三区| 如何舔出高潮| 一级a爱片免费观看的视频| 免费在线观看成人毛片| 97碰自拍视频| 狂野欧美白嫩少妇大欣赏| 人妻夜夜爽99麻豆av| 18禁裸乳无遮挡免费网站照片| 国产精品国产高清国产av| 欧美日韩乱码在线| 国产精品亚洲美女久久久| 国产精品爽爽va在线观看网站| 人妻丰满熟妇av一区二区三区| 亚洲av.av天堂| 亚洲美女搞黄在线观看 | 小说图片视频综合网站| 有码 亚洲区| 色尼玛亚洲综合影院| 欧美+亚洲+日韩+国产| 精品久久久久久久末码| 久久久久久久久久成人| 国产伦人伦偷精品视频| 国产伦在线观看视频一区| or卡值多少钱| 91在线观看av| 超碰av人人做人人爽久久| 91在线观看av| 一级毛片久久久久久久久女| 国产免费男女视频| 两个人视频免费观看高清| 久久久久久久久久成人| 嫩草影院新地址| 国产精品99久久久久久久久| а√天堂www在线а√下载| 欧美日韩国产亚洲二区| 欧美日韩乱码在线| 欧美精品啪啪一区二区三区| 日韩av在线大香蕉| 国语自产精品视频在线第100页| 成人午夜高清在线视频| 亚洲国产精品合色在线| 国产精品久久久久久人妻精品电影| 成人高潮视频无遮挡免费网站| 观看美女的网站| 国产伦一二天堂av在线观看| 国产黄色小视频在线观看| 欧美+日韩+精品| 18禁在线播放成人免费| 伊人久久精品亚洲午夜| 亚洲国产精品成人综合色| 成人高潮视频无遮挡免费网站| 国产黄色小视频在线观看| 久久久久久久久久成人| 两个人视频免费观看高清| 99国产精品一区二区三区| 偷拍熟女少妇极品色| 亚洲午夜理论影院| 免费观看人在逋| 国产成+人综合+亚洲专区| 欧美性感艳星| 怎么达到女性高潮| 亚洲美女视频黄频| 国产精品亚洲av一区麻豆| 一进一出抽搐gif免费好疼| 色精品久久人妻99蜜桃| 久久久久免费精品人妻一区二区| 成年女人永久免费观看视频| 免费av观看视频| 黄色视频,在线免费观看| 91在线观看av| а√天堂www在线а√下载| 在线十欧美十亚洲十日本专区| 观看美女的网站| 亚洲va日本ⅴa欧美va伊人久久| 国产精品女同一区二区软件 | 亚洲精品日韩av片在线观看| 亚洲人成网站在线播| av欧美777| 亚洲国产精品久久男人天堂| 丰满人妻一区二区三区视频av| 老女人水多毛片| 91麻豆精品激情在线观看国产| 亚洲一区高清亚洲精品| 身体一侧抽搐| 男插女下体视频免费在线播放| 亚洲 欧美 日韩 在线 免费| 久久久精品大字幕| 少妇的逼好多水| 麻豆一二三区av精品| or卡值多少钱| 少妇熟女aⅴ在线视频| 欧美一区二区亚洲| 日本一本二区三区精品| 91av网一区二区| 久久午夜亚洲精品久久| 在线十欧美十亚洲十日本专区| 亚洲国产欧美人成| 在线国产一区二区在线| 51午夜福利影视在线观看| 又黄又爽又免费观看的视频| 亚洲精品久久国产高清桃花| 熟女电影av网| 国产人妻一区二区三区在| 又粗又爽又猛毛片免费看| 免费在线观看成人毛片| www日本黄色视频网| 日韩欧美在线二视频| 宅男免费午夜| 国产av麻豆久久久久久久| 90打野战视频偷拍视频| 日本熟妇午夜| 亚洲五月天丁香| 亚洲精品久久国产高清桃花| 1000部很黄的大片| 97超级碰碰碰精品色视频在线观看| 精品人妻视频免费看| 色av中文字幕| 97超视频在线观看视频| 日日摸夜夜添夜夜添小说| 国产精品爽爽va在线观看网站| 国产成+人综合+亚洲专区| 99国产精品一区二区蜜桃av| 夜夜看夜夜爽夜夜摸| 国产真实乱freesex| 婷婷精品国产亚洲av在线| 久久草成人影院| 国产高清激情床上av| 九色国产91popny在线| 变态另类丝袜制服| 国产午夜精品论理片| av视频在线观看入口| 欧美最新免费一区二区三区 | 757午夜福利合集在线观看| 天天躁日日操中文字幕| 亚洲第一区二区三区不卡| 国产成人aa在线观看| 日本与韩国留学比较| 校园春色视频在线观看| 国产精品免费一区二区三区在线| av专区在线播放| 国产精品精品国产色婷婷| 伊人久久精品亚洲午夜| 性色avwww在线观看| 每晚都被弄得嗷嗷叫到高潮| 亚洲成a人片在线一区二区| 色噜噜av男人的天堂激情| 中文在线观看免费www的网站| 哪里可以看免费的av片| 国产成+人综合+亚洲专区| 欧美黑人巨大hd| 不卡一级毛片| 日本黄色片子视频| 精品一区二区免费观看| 日日摸夜夜添夜夜添小说| 超碰av人人做人人爽久久| 国产白丝娇喘喷水9色精品| 禁无遮挡网站| av中文乱码字幕在线| av天堂中文字幕网| 欧美成狂野欧美在线观看| 国产三级中文精品| 精品午夜福利视频在线观看一区| 黄片小视频在线播放| 国产伦精品一区二区三区四那| 少妇裸体淫交视频免费看高清| 国产乱人伦免费视频| 男人和女人高潮做爰伦理| 人人妻,人人澡人人爽秒播| 一卡2卡三卡四卡精品乱码亚洲| 在线免费观看的www视频| 赤兔流量卡办理| 日日干狠狠操夜夜爽| 免费av不卡在线播放| 99在线视频只有这里精品首页| 免费看a级黄色片| 亚洲av电影不卡..在线观看| 天堂动漫精品| 欧美乱色亚洲激情| 男人的好看免费观看在线视频| 嫩草影视91久久| 色av中文字幕| 长腿黑丝高跟| 亚洲欧美日韩东京热| 最后的刺客免费高清国语| 一进一出抽搐gif免费好疼| 欧美中文日本在线观看视频| 国产精品,欧美在线| 看黄色毛片网站| 亚洲黑人精品在线| 成人毛片a级毛片在线播放| 亚洲精品456在线播放app | 亚洲最大成人手机在线| 人人妻人人澡欧美一区二区| 精品人妻一区二区三区麻豆 | 成年女人看的毛片在线观看| 亚洲欧美清纯卡通| 99精品在免费线老司机午夜| 我的老师免费观看完整版| 精品欧美国产一区二区三| 欧美日韩综合久久久久久 | 国产精品免费一区二区三区在线| 亚洲美女搞黄在线观看 | 伦理电影大哥的女人| 18美女黄网站色大片免费观看| 欧美最新免费一区二区三区 | 精品国内亚洲2022精品成人| 精品久久久久久久久av| 美女被艹到高潮喷水动态| 丰满乱子伦码专区| 色综合婷婷激情| 欧美性感艳星| 757午夜福利合集在线观看| 女人十人毛片免费观看3o分钟| 又黄又爽又免费观看的视频| 色播亚洲综合网| 三级男女做爰猛烈吃奶摸视频| 禁无遮挡网站| 一区二区三区高清视频在线| 国产成人av教育| 国产三级在线视频| 又爽又黄无遮挡网站| 少妇被粗大猛烈的视频| 国产精品永久免费网站| 精品一区二区免费观看| 老师上课跳d突然被开到最大视频 久久午夜综合久久蜜桃 | 久久亚洲真实| 欧美区成人在线视频| 嫁个100分男人电影在线观看| 亚洲中文字幕一区二区三区有码在线看| 精品欧美国产一区二区三| 国内少妇人妻偷人精品xxx网站| 少妇人妻精品综合一区二区 | www日本黄色视频网| 久久精品国产亚洲av天美| 婷婷六月久久综合丁香| 国产在视频线在精品| 亚洲精品色激情综合| 免费在线观看日本一区| 久久久久久大精品| 在线观看舔阴道视频| 精品免费久久久久久久清纯| 人妻制服诱惑在线中文字幕| 欧美成人性av电影在线观看| 成年版毛片免费区| 十八禁人妻一区二区| 身体一侧抽搐| 国产成人av教育| 无遮挡黄片免费观看| 精品久久久久久成人av| 国产高清激情床上av| 国产又黄又爽又无遮挡在线| 亚洲精品色激情综合| 欧美最黄视频在线播放免费| 国产精品日韩av在线免费观看| 欧美高清成人免费视频www| 免费观看人在逋| 99久久九九国产精品国产免费| 国模一区二区三区四区视频| 国产一级毛片七仙女欲春2| 能在线免费观看的黄片| av在线观看视频网站免费| 午夜福利成人在线免费观看| 男女下面进入的视频免费午夜| 国产综合懂色| 一二三四社区在线视频社区8| 人妻丰满熟妇av一区二区三区| 亚洲无线在线观看| 亚洲va日本ⅴa欧美va伊人久久| 毛片一级片免费看久久久久 | 国产午夜精品论理片| 国产精品自产拍在线观看55亚洲| 搡老熟女国产l中国老女人| 欧美在线一区亚洲| 亚洲电影在线观看av| 精品熟女少妇八av免费久了| 亚洲乱码一区二区免费版| 婷婷丁香在线五月| 香蕉av资源在线| 国产欧美日韩精品一区二区| 深爱激情五月婷婷| 国语自产精品视频在线第100页| 给我免费播放毛片高清在线观看| 国产乱人视频| 欧美中文日本在线观看视频| 久久久成人免费电影| 美女被艹到高潮喷水动态| 少妇裸体淫交视频免费看高清| 国产精品1区2区在线观看.| 午夜精品在线福利| 自拍偷自拍亚洲精品老妇| 国产成人啪精品午夜网站| 国产私拍福利视频在线观看| 国产精品野战在线观看| 国产黄色小视频在线观看| 国产精品亚洲一级av第二区| 日韩 亚洲 欧美在线| av国产免费在线观看| 又黄又爽又刺激的免费视频.| 成人特级av手机在线观看| 国产精品嫩草影院av在线观看 | 一级黄色大片毛片| 久99久视频精品免费| 搡老岳熟女国产| 久久人妻av系列| 噜噜噜噜噜久久久久久91| 老熟妇乱子伦视频在线观看| 一本一本综合久久| 色在线成人网| 精品人妻一区二区三区麻豆 | 国产伦精品一区二区三区四那|