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

    基于最優(yōu)基站選擇的超寬帶和慣導(dǎo)融合定位方法

    2021-09-04 07:44:52李傳苗趙雄偉繆存孝
    導(dǎo)航與控制 2021年3期
    關(guān)鍵詞:馬氏協(xié)方差測距

    韓 天,郝 敏,李傳苗,趙雄偉,繆存孝

    (北京科技大學(xué)機(jī)械工程學(xué)院,北京 100083)

    0 引言

    隨著通信技術(shù)的高速發(fā)展,室內(nèi)定位技術(shù)在監(jiān)控管理、無人駕駛等領(lǐng)域占據(jù)越來越重要的地位,可以為運(yùn)動(dòng)目標(biāo)提供準(zhǔn)確位置信息的室內(nèi)定位技術(shù)越來越成為人們關(guān)注的焦點(diǎn)[1-5]。慣性導(dǎo)航技術(shù)是最早被應(yīng)用到室內(nèi)定位領(lǐng)域的導(dǎo)航技術(shù),國內(nèi)外學(xué)者針對基于慣性導(dǎo)航的定位算法做了大量的研究,但是由于慣性導(dǎo)航存在累積誤差,所以并不適合長時(shí)間定位[6]。超寬帶(Ultra-wideband,UWB)是一種新型的無線通信技術(shù),相比于傳統(tǒng)的無線通信技術(shù),UWB具有功率譜低、保密性強(qiáng)、功耗低等優(yōu)點(diǎn)[7-8]。自2010年以來,已有幾種成熟的UWB無線電傳感器定位設(shè)備能夠提供厘米級的定位,例如DecaWave[9]的DWM1000和KickStarter的Pozyx。與其他室內(nèi)定位技術(shù)相比,UWB定位通過發(fā)送納秒(ns)或微秒(μs)非正弦窄脈沖可實(shí)現(xiàn)高精度解決方案,而不會產(chǎn)生誤差累積[10]。UWB信號容易被外界環(huán)境所干擾,而IMU的INS對這些干擾不敏感,在復(fù)雜環(huán)境中難以使用單一類型的傳感器滿足需求,所以為了克服多徑效應(yīng),UWB通常需要與慣導(dǎo)融合。

    M?kel?等[11]討論了傳感器融合技術(shù),用于利用室內(nèi)導(dǎo)航安裝的IMU、氣壓計(jì)和UWB,它們可以在地板上獲得準(zhǔn)確的位置,在現(xiàn)實(shí)的戰(zhàn)術(shù)測試場景中顯示。Sczyslo等使用了松散組合法,基于擴(kuò)展Kalman濾波器來跟蹤行人的運(yùn)動(dòng)[12-16]。有學(xué)者提出了一種緊密耦合的方法,該方法結(jié)合了UWB范圍和INS的測量[17-19]。文獻(xiàn)[20]設(shè)計(jì)了一種用于無人機(jī)室內(nèi)導(dǎo)航的定位方法,該方法集成了3D激光掃描儀、UWB和INS的信息,該策略可改善定位效果,與僅INS和僅UWB的方法相比,準(zhǔn)確性顯著提高。文獻(xiàn)[21]設(shè)計(jì)了一種使用松散耦合EKF算法的UWB和IMU集成系統(tǒng),在NLOS和UWB信號不足或不可用的情況下,有效地提高了定位的精度和穩(wěn)健性。北京航空航天大學(xué)的儀玉杰等[22]針對在復(fù)雜室內(nèi)環(huán)境下單純依靠UWB技術(shù)定位結(jié)果會嚴(yán)重失真甚至缺失的問題,提出了一種將UWB與行人航跡推算方法(PDR)相結(jié)合的方法,解決了在復(fù)雜室內(nèi)環(huán)境下定位解算點(diǎn)可能缺失的問題,并且較顯著地提高了在復(fù)雜環(huán)境下定位系統(tǒng)的魯棒性和定位精度。文獻(xiàn)[23]利用安裝在移動(dòng)節(jié)點(diǎn)上的UWB模塊產(chǎn)生位置的估計(jì)值,以校正慣導(dǎo)的航位推算法所得到的移動(dòng)節(jié)點(diǎn)的位置坐標(biāo)校正慣導(dǎo)中由于陀螺漂移導(dǎo)致的累積定位誤差。文獻(xiàn)[24]基于UWB結(jié)合IMU的室內(nèi)定位設(shè)計(jì)方法提出了一種定位技術(shù),可以有效抑制IMU的誤差積累,進(jìn)一步提高了定位精度。文獻(xiàn)[25]針對UWB和IMU融合車輛的定位問題,提出了一種約束魯棒迭代擴(kuò)展Kalman濾波算法,克服了針對非Gauss噪聲先天缺陷的擴(kuò)展Kalman濾波器算法的缺點(diǎn),定位精度達(dá)到0.21m。

    盡管這些方法確實(shí)可以提高定位精度,但都沒有考慮基站信號的丟失對系統(tǒng)產(chǎn)生的影響。單一的定位系統(tǒng)或精度不夠、或應(yīng)用場景受限等,無法達(dá)到實(shí)際的應(yīng)用要求。為提高室內(nèi)定位精度、克服多徑效應(yīng),本文首先開展了UWB和慣性導(dǎo)航融合定位方法研究。同時(shí),為了解決基站信號丟失對系統(tǒng)產(chǎn)生的影響,先基于改進(jìn)馬氏距離對測距異常值進(jìn)行剔除,后引入了協(xié)方差矩陣跡作為基站選擇的度量信息,利用小車進(jìn)行矩形運(yùn)動(dòng)實(shí)驗(yàn),實(shí)測數(shù)據(jù)結(jié)果表明,本文提出的最優(yōu)基站選擇算法的定位精度較輪詢算法有較大提升。

    1 基于改進(jìn)馬氏距離判定的UWB測距

    1.1 雙邊雙向測距原理

    UWB模塊進(jìn)行測距的原理為:利用飛行時(shí)間(Time of Fly,TOF)來獲得兩個(gè)模塊之間的距離。測距采用的通信方式如圖1所示,在傳統(tǒng)的雙邊雙向測距(Double-sided Two-way Ranging,DS)協(xié)議的基礎(chǔ)上增加了一個(gè)REPORT消息幀,以便將所有的距離信息匯總到標(biāo)簽中進(jìn)行下一步處理。

    圖1 UWB測距的通信過程Fig.1 Diagram of UWB ranging communication process

    UWB標(biāo)簽首先廣播一個(gè)UWB信號POLL,并記錄下發(fā)送時(shí)間Ta1,經(jīng)過時(shí)間tf后到達(dá)UWB基站;基站記錄下接收到POLL信號的時(shí)間Tb1,并對信號進(jìn)行處理,經(jīng)過時(shí)間Treply1后,在Tb2(Tb2=Tb1+Treply1)時(shí)刻基站向標(biāo)簽回應(yīng)一個(gè)ANSWER信號;標(biāo)簽在成功接收到基站的ANSWER后記錄下接收時(shí)間Ta2,并經(jīng)過時(shí)間Treply2后發(fā)送FINAL信號;基站接收到標(biāo)簽的FINAL信號后,根據(jù)各個(gè)接收時(shí)間節(jié)點(diǎn)的時(shí)間戳,估計(jì)出傳播時(shí)間

    在已知UWB信號在空氣中傳播速度的前提下,可以很容易地計(jì)算出標(biāo)簽和基站之間的距離d

    1.2 基于改進(jìn)馬氏距離判定的測距異常值檢測

    本文是在傳統(tǒng)馬氏距離異常值檢測方法的基礎(chǔ)上進(jìn)行的改進(jìn),在檢測過程中使用的均值和協(xié)方差矩陣都是在最小協(xié)方差行列式(Minimum Covariance Determinant,MCD)估計(jì)中計(jì)算出的穩(wěn)定值,這樣計(jì)算的樣本中的異常值和正常值的馬氏距離有明顯的差值,從而可以實(shí)現(xiàn)對異常值的剔除。

    傳統(tǒng)的馬氏距離可由如下計(jì)算公式得到

    改進(jìn)馬氏距離異常值檢測方法的核心思想是利用Rousseeuw提出來的快速M(fèi)CD算法(FASTMCD),再結(jié)合傳統(tǒng)馬氏距離的計(jì)算過程,得到一個(gè)穩(wěn)定的協(xié)方差矩陣和一個(gè)穩(wěn)定的均值向量,然后再根據(jù)傳統(tǒng)馬氏距離的計(jì)算公式計(jì)算出每個(gè)樣本數(shù)據(jù)的穩(wěn)定馬氏距離,再進(jìn)行異常值的剔除。

    首先從M個(gè)距離樣本中隨機(jī)選取h個(gè)距離數(shù)據(jù),h=Mα(0.5<α<1),并計(jì)算隨機(jī)選取的這h個(gè)距離數(shù)據(jù)的均值T1和協(xié)方差矩陣S1,然后計(jì)算M個(gè)距離樣本與T1的馬氏距離d。接著從M個(gè)距離樣本中選出馬氏距離最小的h個(gè)數(shù)據(jù)樣本,再根據(jù)新選取的這h個(gè)樣本數(shù)據(jù)計(jì)算出新的均值T2和協(xié)方差矩陣S2,僅當(dāng)T1=T2且detS1=detS2時(shí),S1=S2才成立。 這個(gè)過程不斷迭代, 直到Ti=Ti-1、Si=Si-1時(shí)迭代停止,這時(shí)即認(rèn)為得到的Ti和Si為穩(wěn)定的均值和協(xié)方差,最后根據(jù)Ti和Si計(jì)算距離樣本中每個(gè)數(shù)據(jù)的馬氏距離,完成對異常值的檢測。

    基于改進(jìn)馬氏距離的異常值檢測方法的流程圖如圖2所示。

    圖2 基于改進(jìn)馬氏距離的異常值檢測方法流程圖Fig.2 Flowchart of outlier detection method based on improved Mahalanobis distance

    2 UWB和慣導(dǎo)融合定位方法

    由于UWB信號具有抗干擾能力強(qiáng)、分辨率高等一系列的優(yōu)點(diǎn),使得基于UWB信號的無線定位技術(shù)在無線定位領(lǐng)域中脫穎而出。但是,由于室內(nèi)條件下環(huán)境復(fù)雜度高和障礙物多等問題,導(dǎo)致信號在傳播過程中會遇到非視距和多路徑等問題,定位精度會隨環(huán)境的復(fù)雜度提升而大幅下降,故可以采用UWB和慣導(dǎo)融合的方法來提高室內(nèi)定位精度。慣性導(dǎo)航系統(tǒng)利用IMU加速度計(jì)和陀螺對定位目標(biāo)的位姿進(jìn)行解算,UWB標(biāo)簽與基站通過圖1所示過程獲得距離,然后利用EKF將IMU與UWB信息進(jìn)行融合,最終完成對定位目標(biāo)的位置信息解算。

    2.1 IMU定位原理

    慣性導(dǎo)航系統(tǒng)是一種完全自主且不受外部環(huán)境干擾的獨(dú)立式導(dǎo)航系統(tǒng),具有隱蔽性好和獨(dú)立性高等優(yōu)勢。如圖3所示,慣性導(dǎo)航系統(tǒng)的基本工作原理是以IMU作為系統(tǒng)硬件部分的核心傳感器,以牛頓定律作為姿態(tài)解算的理論基礎(chǔ)。IMU主要包括敏感線運(yùn)動(dòng)的加速度計(jì)傳感器和敏感角運(yùn)動(dòng)的陀螺傳感器。其中,利用加速度計(jì)可以獲得載體的加速度,利用陀螺可以獲得載體的角速度。加速度對時(shí)間進(jìn)行一次積分計(jì)算后即為載體的速度,對時(shí)間進(jìn)行再次積分可以得到載體的位移,角速度對時(shí)間進(jìn)行一次積分可以得到載體的姿態(tài)信息。

    圖3 IMU定位原理Fig.3 Positioning principle of IMU

    2.2 UWB/IMU融合定位原理

    由于Kalman濾波只能用于線性系統(tǒng),故使用以Kalman濾波算法為基礎(chǔ)的EKF算法進(jìn)行融合。

    (1)狀態(tài)方程

    在定位的過程中,用轉(zhuǎn)換矩陣R表示載體坐標(biāo)系到導(dǎo)航坐標(biāo)系的變換,利用IMU和UWB對系統(tǒng)的12維狀態(tài)進(jìn)行估計(jì),系統(tǒng)狀態(tài)取為位置、速度、方向。故在EKF計(jì)算的過程中,將狀態(tài)向量ξ(k)取為

    式(4)中,X為定位目標(biāo)在導(dǎo)航坐標(biāo)系下的位置坐標(biāo),ρ=R-1˙X為定位目標(biāo)在載體系下的速度,三維矢量δ為定位目標(biāo)的姿態(tài)誤差。

    定位目標(biāo)的方向這里采用了參考姿態(tài)Rref和旋轉(zhuǎn)矢量δ來表示,δ的大小表示旋轉(zhuǎn)角,δ方向上的單位矢量表示旋轉(zhuǎn)軸,則其對應(yīng)的旋轉(zhuǎn)矩陣可表示為Dδ。

    將Dδ一階展開,有

    式(5)中,I為大小為3×3的單位矩陣。

    假設(shè)在離散時(shí)刻k到k+1的Δt內(nèi),定位目標(biāo)相對載體坐標(biāo)系的位置 變化 ΔX=[ΔxbΔybΔzb], 則

    將R表示為如下形式

    則k+1時(shí)刻定位目標(biāo)在導(dǎo)航坐標(biāo)系下的位置為

    k+1時(shí)刻定位目標(biāo)在載體坐標(biāo)系下的速度可由如下方程式得到

    d為由Rodriguez參數(shù)表示的姿態(tài)誤差,有

    式(11)中,ωx、ωy、ωz分別為陀螺在離散時(shí)間間隔內(nèi)相對載體坐標(biāo)系三個(gè)軸上的角速度,在采樣時(shí)間內(nèi)視為常數(shù)。

    δ的更新可由下式得到

    式(12)中,Dd為d對應(yīng)的旋轉(zhuǎn)矩陣。

    系統(tǒng)的狀態(tài)模型可表示為

    式(13)中,f(·)為對系統(tǒng)進(jìn)行一階Taylor展開后的線性化函數(shù)模型。

    (2)觀測方程

    在慣導(dǎo)和UWB融合定位中,由于UWB測距不存在累積誤差,且測距誤差僅在0.1m左右,屬于一種較高精度的無線測距技術(shù),所以UWB的測距值可作為EKF中的觀測值。

    假設(shè)位于已知位置的UWB基站i的坐標(biāo)為(ρi,x,ρi,y,ρi,z), 則在k時(shí)刻利用UWB標(biāo)簽解算得到的測距值為di,k。 假設(shè)此時(shí)定位目標(biāo)的實(shí)際位置坐標(biāo)為Xk=(xk,yk,zk), 則觀測方程可以建模為

    則觀測矩陣為

    圖4 UWB和IMU融合定位的整體流程圖Fig.4 Flowchart of UWB and IMU fusion positioning

    式(16)中,

    (3)EKF融合

    根據(jù)狀態(tài)方程和觀測方程,通過EKF的時(shí)間更新和狀態(tài)更新可以得到定位目標(biāo)的狀態(tài)信息。時(shí)間更新方程為

    狀態(tài)更新方程為

    綜上,基于UWB和慣性導(dǎo)航融合的定位系統(tǒng)整體流程如圖4所示。

    3 最優(yōu)基站選擇方法

    經(jīng)過UWB和慣導(dǎo)的融合定位后,對于定位區(qū)域內(nèi)的基站,傳統(tǒng)的選擇方法采用的是輪詢通信的方式,即按照固定規(guī)則的通信順序與區(qū)域內(nèi)的基站分別進(jìn)行通信。這種傳統(tǒng)的選擇方法沒有考慮到在每個(gè)時(shí)刻每個(gè)基站與定位目標(biāo)之間產(chǎn)生的測距值會對EKF解算過程中的協(xié)方差矩陣的更新產(chǎn)生的影響是不同的,這就導(dǎo)致傳統(tǒng)的基站輪詢選擇方法不能充分利用各個(gè)基站的位置信息。所以,為了進(jìn)一步提高融合定位的精度,本文提出了一種基于協(xié)方差矩陣跡的最優(yōu)基站選擇方法。

    不同于輪詢方法,本文提出的UWB基站選擇方法使定位標(biāo)簽可以自由選擇區(qū)域內(nèi)參與下一時(shí)刻EKF解算的最優(yōu)基站。

    根據(jù)定位目標(biāo)的運(yùn)動(dòng)軌跡具有連續(xù)性這一特點(diǎn),通過已知的當(dāng)前時(shí)刻定位目標(biāo)的位置坐標(biāo)預(yù)測下一時(shí)刻在當(dāng)前區(qū)域內(nèi)的所有基站所能產(chǎn)生的測距值,根據(jù)測距值進(jìn)一步計(jì)算出所能引起的協(xié)方差矩陣跡的變化,并以此作為在下一時(shí)刻進(jìn)行基站選擇的度量信息,目的是在每一時(shí)刻都以協(xié)方差矩陣跡的變化作為基準(zhǔn),選擇當(dāng)前區(qū)域內(nèi)能使系統(tǒng)狀態(tài)量的估計(jì)誤差最小的基站作為下一時(shí)刻的通信基站,即最優(yōu)基站。

    在EKF融合解算過程中的協(xié)方差矩陣可以表示為

    根據(jù)來自基站i的測距值di, 利用本文上節(jié)中的EKF觀測方程的建立過程,帶入式(16)可以得到對應(yīng)的觀測矩陣Hi, 并且可以進(jìn)一步計(jì)算出對應(yīng)的Kalman濾波增益Ki

    式(22)中,R為測距噪聲的方差陣。利用Kalman濾波增益Ki對協(xié)方差矩陣進(jìn)行更新,有

    由于觀測矩陣具有稀疏性的特點(diǎn),所以可以將式(24)簡化為

    根據(jù)式(25),可在任一時(shí)刻計(jì)算定位目標(biāo)所在區(qū)域內(nèi)所有基站能引起的協(xié)方差的變化。

    矩陣的跡定義為矩陣主對角元素之和,由協(xié)方差矩陣的特殊性質(zhì)可以知道,協(xié)方差矩陣的跡即為系統(tǒng)所有狀態(tài)量方差之和,即

    ξ為系統(tǒng)的狀態(tài)量,所以本文提出了一種利用協(xié)方差矩陣跡作為對下一時(shí)刻基站進(jìn)行選擇的度量指標(biāo),在每個(gè)時(shí)刻都選擇定位目標(biāo)所在區(qū)域內(nèi)能使協(xié)方差矩陣跡最小,即能使系統(tǒng)的狀態(tài)估計(jì)誤差最小的基站作為下一時(shí)刻的最優(yōu)通信基站。

    再次利用觀測矩陣的稀疏性質(zhì),對式(27)進(jìn)一步簡化

    在每個(gè)時(shí)刻計(jì)算定位目標(biāo)當(dāng)前所在區(qū)域內(nèi)每個(gè)基站的跡,然后選擇值最小的基站作為下一時(shí)刻參與EKF解算的最優(yōu)通信基站。

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

    4.1 實(shí)驗(yàn)環(huán)境與硬件介紹

    本文的實(shí)驗(yàn)測試環(huán)境為北京科技大學(xué)機(jī)電信息樓814實(shí)驗(yàn)室,實(shí)驗(yàn)室環(huán)境布局的平面簡圖如圖5所示。房間大小為5.0m×8.0m,在房間內(nèi)4.0m×4.2m大小的場地上方四周設(shè)有運(yùn)動(dòng)捕捉系統(tǒng)Optitrack定位攝像頭,本文的實(shí)驗(yàn)場地位于運(yùn)動(dòng)捕捉系統(tǒng)捕捉范圍內(nèi)一個(gè)2.4m×2.4m的正方形區(qū)域。實(shí)際的實(shí)驗(yàn)環(huán)境和上方的運(yùn)動(dòng)捕捉系統(tǒng)的部分定位攝像頭如圖6所示。運(yùn)動(dòng)捕捉系統(tǒng)屬于高精度的室內(nèi)定位系統(tǒng),采用紅外攝像頭覆蓋室內(nèi)的定位空間。在被定位的物體上放置反光標(biāo)記點(diǎn),通過獲取這些反光標(biāo)記點(diǎn)反射在定位攝像頭上的圖像,計(jì)算被定位物體的三維位置信息,且Optitrack定位攝像頭的定位精度能達(dá)到0.1mm。在本文的實(shí)驗(yàn)中均使用了運(yùn)動(dòng)捕捉系統(tǒng)解算的運(yùn)動(dòng)軌跡作為定位目標(biāo)的實(shí)際運(yùn)動(dòng)軌跡,與本文中所提出的定位方法形成定位精度的對比。

    圖5 實(shí)驗(yàn)室平面簡圖Fig.5 Diagram of laboratory plane

    圖6 實(shí)驗(yàn)環(huán)境Fig.6 Diagram of experiment environment

    在實(shí)驗(yàn)過程中實(shí)時(shí)采集的UWB和IMU數(shù)據(jù)通過SPI和I2C的串行通信方式與STM32F405RG處理器進(jìn)行通信,并對數(shù)據(jù)進(jìn)行解算得到定位坐標(biāo),最后將最終的定位結(jié)果、UWB測距值和IMU數(shù)據(jù)通過藍(lán)牙發(fā)送至上位機(jī)端保存成csv格式,并導(dǎo)入Matlab進(jìn)行解算和繪圖。定位標(biāo)簽和上位機(jī)端的藍(lán)牙接收裝置如圖7所示。

    圖7 定位標(biāo)簽和藍(lán)牙接收器Fig.7 Diagram of location tag and bluetooth receiver

    UWB基站在實(shí)驗(yàn)環(huán)境中的布置和本文中使用的導(dǎo)航坐標(biāo)系示意圖如圖8所示。

    圖8 UWB的基站布置和導(dǎo)航坐標(biāo)系的建立Fig.8 UWB base station layout and establishment of navigation coordinate system

    在對基站坐標(biāo)進(jìn)行測量時(shí),先將可由運(yùn)動(dòng)捕捉系統(tǒng)識別的反光標(biāo)記點(diǎn)放置在基站上,通過運(yùn)動(dòng)捕捉系統(tǒng)捕捉到的位置坐標(biāo)作為各個(gè)基站的具體位置坐標(biāo),如表1所示。

    表1 UWB基站坐標(biāo)Table 1 Coordinates of UWB base station

    4.2 測距異常值剔除實(shí)驗(yàn)

    將基于馬氏距離的異常值檢測算法程序加入到測距程序中,仍讓標(biāo)簽分別位于基站的1m和2.5m處,測距實(shí)驗(yàn)共進(jìn)行1000次,測距頻率為100Hz,實(shí)驗(yàn)結(jié)果如圖9所示。

    圖10為采用基于改進(jìn)馬氏距離的異常值檢測方法對異常值進(jìn)行剔除后的1.0m和2.5m處的測距結(jié)果。

    圖9 測距異常值檢測結(jié)果Fig.9 Diagram of ranging results using outlier detection

    圖10 測距異常值剔除后的檢測結(jié)果Fig.10 Diagram of ranging results after removing the outliers

    由圖10可知,在整個(gè)測距的過程中沒有出現(xiàn)測距異常值,且測距的精度均在0.1m左右,上述的測距實(shí)驗(yàn)表明了本文采用的基于改進(jìn)馬氏距離的異常值檢測方法的有效性,能夠在保證測距實(shí)時(shí)性的同時(shí),有效避免測距過程中異常值的出現(xiàn)。

    4.3 最優(yōu)基站選擇融合定位實(shí)驗(yàn)

    為了驗(yàn)證本文提出的UWB和IMU融合定位方法的精度,在實(shí)際場景下進(jìn)行實(shí)驗(yàn)并計(jì)算其估計(jì)軌跡誤差。如圖11所示,實(shí)驗(yàn)中將定位標(biāo)簽固定在可由運(yùn)動(dòng)捕捉系統(tǒng)反饋控制運(yùn)動(dòng)的定位小車上,定位標(biāo)簽由充電寶通過USB口進(jìn)行供電,并在定位標(biāo)簽中心位置上布設(shè)一個(gè)可由運(yùn)動(dòng)捕捉系統(tǒng)識別的反光標(biāo)記點(diǎn)。

    圖11 定位標(biāo)簽與小車Fig.11 Diagram of locating tag and trolley

    控制小車在實(shí)驗(yàn)場地中按照一個(gè)1.2m×1.2m的矩形軌跡進(jìn)行運(yùn)動(dòng),實(shí)驗(yàn)結(jié)果中以由運(yùn)動(dòng)捕捉系統(tǒng)獲得的定位標(biāo)簽中心的反光標(biāo)記點(diǎn)的軌跡作為定位標(biāo)簽的實(shí)際運(yùn)動(dòng)軌跡。

    移動(dòng)小車按照矩形軌跡運(yùn)行兩次,分別采用本文的最優(yōu)基站選擇方法和傳統(tǒng)的輪詢方法估計(jì)小車的位置軌跡。實(shí)驗(yàn)中的真實(shí)軌跡均采用的為運(yùn)動(dòng)捕捉系統(tǒng)的輸出結(jié)果,最后的真實(shí)軌跡取為兩次運(yùn)動(dòng)捕捉系統(tǒng)數(shù)據(jù)的平均值,實(shí)驗(yàn)對比結(jié)果如圖12示。

    圖12 定位結(jié)果對比Fig.12 Comparison of positioning results

    由圖12可知,在x方向和y方向上雖然某些位置處會出現(xiàn)采用傳統(tǒng)選擇方法的精度高于本文的最優(yōu)基站選擇方法的情況,但是整體軌跡中明顯能看出最優(yōu)基站選擇方法對精度的改進(jìn)。在z方向上,當(dāng)使用傳統(tǒng)的基站輪詢選擇方法進(jìn)行定位時(shí),定位結(jié)果具有較大的波動(dòng)性,而使用了最優(yōu)基站選擇的定位結(jié)果中,z方向數(shù)據(jù)的平穩(wěn)性有了很大提升。圖13給出了利用兩種不同基站選擇方法進(jìn)行定位時(shí)整體誤差的比較。

    圖13 兩種不同基站選擇方法的誤差對比Fig.13 Error comparison of two different base station selection methods

    由圖13明顯可知,最優(yōu)基站選擇方法對定位誤差波動(dòng)幅度有一定的改善,定位精度得到提升。在整個(gè)運(yùn)動(dòng)過程中,采用最優(yōu)基站選擇方法的最大定位誤差值為0.258m,絕對誤差的平均值為0.226m,均方根誤差為0.227m。采用傳統(tǒng)輪詢方法時(shí),在整個(gè)過程中的最大定位誤差值為0.342m,絕對誤差的平均值為0.267m,均方根誤差為0.269m。相比采用輪詢方法的定位結(jié)果,使用本文提出的最優(yōu)基站選擇方法時(shí),平均精度提高了15.3%,均方根誤差減小了15.6%。

    5 結(jié)論

    本文對UWB和慣性導(dǎo)航的融合定位算法進(jìn)行了研究,通過采用基于改進(jìn)馬氏距離的異常值檢測算法,有效地對測距過程中的異常值進(jìn)行了剔除。然后提出了一種基于協(xié)方差矩陣跡的最優(yōu)基站選擇算法,不同于按照給定順序進(jìn)行通信的輪詢算法,所提出的算法能夠?qū)崟r(shí)計(jì)算所在區(qū)域內(nèi)每個(gè)基站在下一時(shí)刻能對當(dāng)前時(shí)刻協(xié)方差的跡產(chǎn)生的變化量,并選擇能使當(dāng)前協(xié)方差的跡變化最大的基站作為下一時(shí)刻的通信基站。實(shí)驗(yàn)結(jié)果表明,本文提出的基站選擇算法具有計(jì)算量小、實(shí)時(shí)性高等優(yōu)點(diǎn),與傳統(tǒng)的輪詢算法相比,平均定位精度提高了15.3%,是一種高精度的實(shí)時(shí)室內(nèi)定位方法。

    猜你喜歡
    馬氏協(xié)方差測距
    一類時(shí)間變換的強(qiáng)馬氏過程
    有環(huán)的可逆馬氏鏈的統(tǒng)計(jì)確認(rèn)
    關(guān)于樹指標(biāo)非齊次馬氏鏈的廣義熵遍歷定理
    類星體的精準(zhǔn)測距
    科學(xué)(2020年3期)2020-01-06 04:02:51
    一致可數(shù)可加馬氏鏈不變測度的存在性
    淺談超聲波測距
    電子制作(2017年7期)2017-06-05 09:36:13
    不確定系統(tǒng)改進(jìn)的魯棒協(xié)方差交叉融合穩(wěn)態(tài)Kalman預(yù)報(bào)器
    一種基于廣義協(xié)方差矩陣的欠定盲辨識方法
    基于PSOC超聲測距系統(tǒng)設(shè)計(jì)
    相對差分單項(xiàng)測距△DOR
    太空探索(2014年1期)2014-07-10 13:41:50
    久久天躁狠狠躁夜夜2o2o| 亚洲18禁久久av| 亚洲av美国av| 深夜精品福利| 国产亚洲欧美在线一区二区| 一二三四社区在线视频社区8| 88av欧美| 亚洲国产精品成人综合色| 免费搜索国产男女视频| 他把我摸到了高潮在线观看| 制服丝袜大香蕉在线| 麻豆成人午夜福利视频| 久久国产精品人妻蜜桃| 亚洲 欧美 日韩 在线 免费| 少妇被粗大的猛进出69影院| 99国产精品一区二区蜜桃av| 欧美一级毛片孕妇| 特级一级黄色大片| 少妇人妻一区二区三区视频| 亚洲欧美一区二区三区黑人| www国产在线视频色| 久久 成人 亚洲| 亚洲成人免费电影在线观看| 久久久久久久久久黄片| 男女视频在线观看网站免费 | 精品不卡国产一区二区三区| 午夜免费观看网址| 久久精品国产亚洲av高清一级| 中文字幕精品亚洲无线码一区| 久久久久久久久免费视频了| 三级国产精品欧美在线观看 | 欧美黑人巨大hd| 女人被狂操c到高潮| 精品高清国产在线一区| 人人妻,人人澡人人爽秒播| 波多野结衣高清作品| 国产精品久久视频播放| 婷婷丁香在线五月| 欧美精品亚洲一区二区| 欧美av亚洲av综合av国产av| 狠狠狠狠99中文字幕| 精品无人区乱码1区二区| 亚洲精品av麻豆狂野| 亚洲国产高清在线一区二区三| 亚洲精品久久成人aⅴ小说| 国产亚洲精品久久久久5区| 99久久国产精品久久久| 亚洲av片天天在线观看| 亚洲乱码一区二区免费版| 久久久久久国产a免费观看| 成年人黄色毛片网站| 天堂影院成人在线观看| 精品国产超薄肉色丝袜足j| 日韩欧美一区二区三区在线观看| 国产成人影院久久av| 亚洲avbb在线观看| 在线观看免费视频日本深夜| 免费高清视频大片| 欧美日韩福利视频一区二区| 色综合婷婷激情| 每晚都被弄得嗷嗷叫到高潮| 亚洲国产欧美人成| 欧美色欧美亚洲另类二区| 人人妻人人看人人澡| 亚洲国产高清在线一区二区三| 欧美午夜高清在线| 国产av又大| 国产成人av激情在线播放| 在线观看66精品国产| 国产真人三级小视频在线观看| 叶爱在线成人免费视频播放| 色综合欧美亚洲国产小说| 日韩欧美在线乱码| 村上凉子中文字幕在线| 国产精品自产拍在线观看55亚洲| 性欧美人与动物交配| 欧美日本视频| 巨乳人妻的诱惑在线观看| 91av网站免费观看| 欧美中文综合在线视频| 国产精品亚洲一级av第二区| 五月玫瑰六月丁香| 国产精品美女特级片免费视频播放器 | 精品熟女少妇八av免费久了| xxx96com| 亚洲全国av大片| 国产一区二区激情短视频| 国产熟女午夜一区二区三区| 亚洲国产欧美网| 亚洲av成人不卡在线观看播放网| 国产亚洲精品久久久久5区| 国产成人欧美在线观看| 国产乱人伦免费视频| 国产不卡一卡二| 岛国在线免费视频观看| 丰满人妻熟妇乱又伦精品不卡| 国语自产精品视频在线第100页| 99re在线观看精品视频| 18美女黄网站色大片免费观看| 欧美国产日韩亚洲一区| 亚洲精品中文字幕在线视频| 久久久国产精品麻豆| 国产欧美日韩一区二区精品| 国产熟女xx| 国产野战对白在线观看| 亚洲欧美一区二区三区黑人| 久久国产精品人妻蜜桃| 一进一出抽搐gif免费好疼| 久久精品影院6| 久99久视频精品免费| 亚洲国产欧美网| 2021天堂中文幕一二区在线观| 天天添夜夜摸| 亚洲avbb在线观看| 我的老师免费观看完整版| 长腿黑丝高跟| 女警被强在线播放| 一本综合久久免费| 亚洲国产看品久久| 国产亚洲av嫩草精品影院| 国产精品 欧美亚洲| 欧美绝顶高潮抽搐喷水| 麻豆一二三区av精品| 伦理电影免费视频| 最新美女视频免费是黄的| 99国产精品99久久久久| 精品少妇一区二区三区视频日本电影| 欧美+亚洲+日韩+国产| 久久亚洲精品不卡| 国产精品爽爽va在线观看网站| 国产成人影院久久av| 老司机午夜福利在线观看视频| 免费在线观看日本一区| 国产精品99久久99久久久不卡| 亚洲美女黄片视频| 精品免费久久久久久久清纯| 天堂影院成人在线观看| 白带黄色成豆腐渣| 亚洲av美国av| 久久草成人影院| 又黄又爽又免费观看的视频| 国产免费av片在线观看野外av| 久久久久九九精品影院| 亚洲国产日韩欧美精品在线观看 | 又紧又爽又黄一区二区| 91成年电影在线观看| 久久久久久亚洲精品国产蜜桃av| 白带黄色成豆腐渣| 久久久久久国产a免费观看| 18禁黄网站禁片午夜丰满| 日韩欧美在线乱码| 久久这里只有精品中国| 桃红色精品国产亚洲av| 精品高清国产在线一区| 黄色女人牲交| 非洲黑人性xxxx精品又粗又长| 欧美高清成人免费视频www| 欧美日本亚洲视频在线播放| 这个男人来自地球电影免费观看| 男男h啪啪无遮挡| 丁香欧美五月| 亚洲成av人片免费观看| 亚洲自偷自拍图片 自拍| 婷婷六月久久综合丁香| 99热6这里只有精品| 无限看片的www在线观看| 久久精品aⅴ一区二区三区四区| 久久久久国内视频| 精品久久久久久久人妻蜜臀av| 亚洲乱码一区二区免费版| 色播亚洲综合网| 正在播放国产对白刺激| 日韩欧美国产一区二区入口| 中国美女看黄片| 伦理电影免费视频| 好男人电影高清在线观看| 久久中文字幕人妻熟女| 天堂影院成人在线观看| 国产三级在线视频| 禁无遮挡网站| 国产精品亚洲美女久久久| 男女做爰动态图高潮gif福利片| 一本一本综合久久| 欧美 亚洲 国产 日韩一| 午夜a级毛片| a级毛片在线看网站| 免费观看精品视频网站| 亚洲国产精品999在线| 母亲3免费完整高清在线观看| 亚洲在线自拍视频| 国产在线观看jvid| 久9热在线精品视频| 日韩欧美在线乱码| 久久精品国产清高在天天线| 日本撒尿小便嘘嘘汇集6| 亚洲一区中文字幕在线| 免费在线观看完整版高清| 一进一出抽搐动态| 婷婷精品国产亚洲av| 床上黄色一级片| 性欧美人与动物交配| 精品少妇一区二区三区视频日本电影| 免费看美女性在线毛片视频| 高潮久久久久久久久久久不卡| 久久欧美精品欧美久久欧美| 久久精品成人免费网站| 一本大道久久a久久精品| 国产91精品成人一区二区三区| 亚洲人成电影免费在线| 国产精品一区二区精品视频观看| 久久精品综合一区二区三区| 国产aⅴ精品一区二区三区波| 波多野结衣高清无吗| 日本免费a在线| 午夜福利成人在线免费观看| 好男人电影高清在线观看| 亚洲aⅴ乱码一区二区在线播放 | а√天堂www在线а√下载| 制服人妻中文乱码| www日本黄色视频网| 午夜福利视频1000在线观看| 色老头精品视频在线观看| АⅤ资源中文在线天堂| 午夜成年电影在线免费观看| 女人高潮潮喷娇喘18禁视频| 欧美成狂野欧美在线观看| 欧美日韩国产亚洲二区| 亚洲熟妇中文字幕五十中出| 校园春色视频在线观看| 亚洲精品一区av在线观看| 一级片免费观看大全| 国产激情欧美一区二区| 国产蜜桃级精品一区二区三区| 国产成人aa在线观看| 在线十欧美十亚洲十日本专区| 亚洲国产欧洲综合997久久,| 婷婷丁香在线五月| 午夜福利在线在线| 欧美成狂野欧美在线观看| 国产成+人综合+亚洲专区| 午夜免费观看网址| 亚洲av电影不卡..在线观看| 亚洲真实伦在线观看| 亚洲精华国产精华精| 国产99久久九九免费精品| 99re在线观看精品视频| 一进一出抽搐动态| 妹子高潮喷水视频| 99久久无色码亚洲精品果冻| 一级毛片高清免费大全| 中文字幕人妻丝袜一区二区| www.精华液| 男人舔奶头视频| 久久天躁狠狠躁夜夜2o2o| 中文字幕av在线有码专区| 黄色女人牲交| 国产视频内射| 国产精品综合久久久久久久免费| 黄片大片在线免费观看| 日韩精品中文字幕看吧| 99国产综合亚洲精品| 成人18禁高潮啪啪吃奶动态图| 欧美又色又爽又黄视频| 亚洲欧美日韩高清专用| 在线a可以看的网站| or卡值多少钱| 中文字幕久久专区| 在线永久观看黄色视频| 成人三级做爰电影| 婷婷精品国产亚洲av在线| 桃红色精品国产亚洲av| 午夜激情av网站| 午夜a级毛片| 日本免费a在线| 国产精品 国内视频| 国产视频内射| 欧美 亚洲 国产 日韩一| 国产一区二区在线观看日韩 | 成人一区二区视频在线观看| 国内少妇人妻偷人精品xxx网站 | av超薄肉色丝袜交足视频| 欧美久久黑人一区二区| 男人舔女人的私密视频| 91av网站免费观看| 国产人伦9x9x在线观看| 亚洲精品中文字幕在线视频| 日韩高清综合在线| 国产精品一区二区精品视频观看| cao死你这个sao货| 国产精品av视频在线免费观看| 操出白浆在线播放| 亚洲精品中文字幕在线视频| 毛片女人毛片| 久久精品91蜜桃| 狠狠狠狠99中文字幕| 亚洲午夜理论影院| 久久久水蜜桃国产精品网| 黄色丝袜av网址大全| 无遮挡黄片免费观看| 国产成人av教育| 亚洲国产高清在线一区二区三| 色播亚洲综合网| 无限看片的www在线观看| 琪琪午夜伦伦电影理论片6080| 国产aⅴ精品一区二区三区波| 国产精品香港三级国产av潘金莲| www国产在线视频色| 欧美又色又爽又黄视频| 精品无人区乱码1区二区| 12—13女人毛片做爰片一| a在线观看视频网站| www日本在线高清视频| 久久中文字幕人妻熟女| 日日摸夜夜添夜夜添小说| 久久婷婷人人爽人人干人人爱| 亚洲欧美精品综合久久99| 欧美日本亚洲视频在线播放| 桃色一区二区三区在线观看| 国产野战对白在线观看| 欧美3d第一页| 亚洲乱码一区二区免费版| 热99re8久久精品国产| 999精品在线视频| 午夜福利在线观看吧| 婷婷亚洲欧美| 久久亚洲真实| 久热爱精品视频在线9| 精品免费久久久久久久清纯| 女人爽到高潮嗷嗷叫在线视频| 久久香蕉国产精品| 亚洲 欧美一区二区三区| 久久中文看片网| 午夜福利成人在线免费观看| 99re在线观看精品视频| 欧美成人免费av一区二区三区| 神马国产精品三级电影在线观看 | av中文乱码字幕在线| 久久香蕉激情| 好男人电影高清在线观看| 亚洲一卡2卡3卡4卡5卡精品中文| 老司机靠b影院| 男人的好看免费观看在线视频 | 亚洲一卡2卡3卡4卡5卡精品中文| 99久久久亚洲精品蜜臀av| 一本一本综合久久| 身体一侧抽搐| 最近在线观看免费完整版| 国产亚洲精品久久久久久毛片| 中亚洲国语对白在线视频| 国产精品国产高清国产av| 我要搜黄色片| 国产精品乱码一区二三区的特点| av视频在线观看入口| 国产午夜精品论理片| 亚洲性夜色夜夜综合| 精品久久久久久久人妻蜜臀av| 久久香蕉国产精品| 日韩欧美在线乱码| 久久中文字幕一级| 国产野战对白在线观看| 欧美日韩福利视频一区二区| 18禁观看日本| 欧美色欧美亚洲另类二区| 听说在线观看完整版免费高清| 女生性感内裤真人,穿戴方法视频| 国产区一区二久久| 午夜免费成人在线视频| 欧美色欧美亚洲另类二区| 午夜免费成人在线视频| 男插女下体视频免费在线播放| av福利片在线观看| 欧美成人一区二区免费高清观看 | 欧美成人午夜精品| 久久久国产精品麻豆| 黑人欧美特级aaaaaa片| 亚洲精品色激情综合| 亚洲第一欧美日韩一区二区三区| 巨乳人妻的诱惑在线观看| 免费看十八禁软件| 国产精品一区二区精品视频观看| 最好的美女福利视频网| 在线观看免费午夜福利视频| 伊人久久大香线蕉亚洲五| 波多野结衣高清作品| 啦啦啦观看免费观看视频高清| 国产精品免费一区二区三区在线| 欧美极品一区二区三区四区| av在线播放免费不卡| 可以在线观看的亚洲视频| 少妇粗大呻吟视频| 国产熟女午夜一区二区三区| 精品福利观看| 日本 欧美在线| 国产又黄又爽又无遮挡在线| av在线播放免费不卡| 欧美日韩福利视频一区二区| 在线观看免费视频日本深夜| 亚洲成人国产一区在线观看| 色综合欧美亚洲国产小说| 色噜噜av男人的天堂激情| 久9热在线精品视频| 亚洲专区中文字幕在线| 国产成人精品久久二区二区91| 成人高潮视频无遮挡免费网站| 免费人成视频x8x8入口观看| 香蕉久久夜色| 最近最新中文字幕大全免费视频| 啦啦啦观看免费观看视频高清| 亚洲精品粉嫩美女一区| 最近在线观看免费完整版| 亚洲成av人片在线播放无| 两个人的视频大全免费| 亚洲va日本ⅴa欧美va伊人久久| 国产精品香港三级国产av潘金莲| 极品教师在线免费播放| 国产探花在线观看一区二区| 精品国产美女av久久久久小说| 麻豆国产av国片精品| 一本综合久久免费| 国产成人系列免费观看| 1024手机看黄色片| 两性午夜刺激爽爽歪歪视频在线观看 | 香蕉久久夜色| 日本五十路高清| 老鸭窝网址在线观看| 国产亚洲欧美98| 成人永久免费在线观看视频| 99热只有精品国产| 亚洲免费av在线视频| 男人舔奶头视频| 亚洲性夜色夜夜综合| 欧美大码av| 午夜福利高清视频| 日本a在线网址| 中文在线观看免费www的网站 | 国产精品久久久人人做人人爽| 黄片大片在线免费观看| 白带黄色成豆腐渣| 国产精品,欧美在线| 久久精品国产99精品国产亚洲性色| 国产私拍福利视频在线观看| 久久久国产欧美日韩av| 夜夜躁狠狠躁天天躁| 日本一二三区视频观看| 中文字幕精品亚洲无线码一区| 男女之事视频高清在线观看| 亚洲一码二码三码区别大吗| 久99久视频精品免费| 窝窝影院91人妻| 曰老女人黄片| 欧美+亚洲+日韩+国产| 99热只有精品国产| 久久性视频一级片| 婷婷丁香在线五月| 看片在线看免费视频| 人妻久久中文字幕网| 一级毛片精品| 国产精品98久久久久久宅男小说| 欧美日韩黄片免| 十八禁网站免费在线| 国产视频内射| 国产99久久九九免费精品| 欧美日韩国产亚洲二区| 不卡一级毛片| 午夜福利免费观看在线| 可以在线观看的亚洲视频| 国产av又大| 一级作爱视频免费观看| 日韩欧美在线乱码| 我的老师免费观看完整版| 88av欧美| 两性夫妻黄色片| 99久久99久久久精品蜜桃| 老熟妇仑乱视频hdxx| 亚洲精品色激情综合| 亚洲av熟女| 国产人伦9x9x在线观看| 婷婷精品国产亚洲av| 悠悠久久av| 国内毛片毛片毛片毛片毛片| 国产视频内射| 日韩欧美国产在线观看| 亚洲国产高清在线一区二区三| 在线观看一区二区三区| 国产伦人伦偷精品视频| 国产真实乱freesex| 真人做人爱边吃奶动态| 亚洲全国av大片| 国产午夜精品久久久久久| 国产成人一区二区三区免费视频网站| 国产又黄又爽又无遮挡在线| 中文亚洲av片在线观看爽| 在线视频色国产色| 国产一区二区在线av高清观看| 别揉我奶头~嗯~啊~动态视频| 久久午夜综合久久蜜桃| 久久久久久免费高清国产稀缺| 99热只有精品国产| 高清毛片免费观看视频网站| 高潮久久久久久久久久久不卡| 老熟妇仑乱视频hdxx| 欧美性猛交黑人性爽| 免费在线观看成人毛片| 欧美高清成人免费视频www| 99久久久亚洲精品蜜臀av| 久久久水蜜桃国产精品网| 亚洲av熟女| 欧美日韩一级在线毛片| 日本一本二区三区精品| 免费在线观看影片大全网站| 视频区欧美日本亚洲| 亚洲成人久久爱视频| 欧美久久黑人一区二区| 日本成人三级电影网站| 丰满人妻一区二区三区视频av | 国产精品av久久久久免费| 操出白浆在线播放| 波多野结衣巨乳人妻| 亚洲成人免费电影在线观看| 国产精品久久久av美女十八| 一个人免费在线观看的高清视频| 香蕉国产在线看| 亚洲人成网站高清观看| 999久久久精品免费观看国产| 国产av一区二区精品久久| 麻豆av在线久日| 丰满人妻熟妇乱又伦精品不卡| 精品不卡国产一区二区三区| 午夜免费观看网址| a在线观看视频网站| 亚洲精品国产一区二区精华液| 精品不卡国产一区二区三区| 色噜噜av男人的天堂激情| 国产黄色小视频在线观看| www国产在线视频色| 欧美高清成人免费视频www| 丁香欧美五月| 中文字幕熟女人妻在线| 人妻久久中文字幕网| 999久久久精品免费观看国产| 国产亚洲欧美在线一区二区| 成人av在线播放网站| 黄片大片在线免费观看| 黑人欧美特级aaaaaa片| 亚洲 欧美 日韩 在线 免费| 亚洲av美国av| 中文字幕精品亚洲无线码一区| 欧美乱色亚洲激情| 日本 av在线| 欧美人与性动交α欧美精品济南到| 757午夜福利合集在线观看| 国产av在哪里看| 亚洲国产欧美一区二区综合| 成年免费大片在线观看| 久久香蕉精品热| 亚洲成人中文字幕在线播放| АⅤ资源中文在线天堂| а√天堂www在线а√下载| 日本三级黄在线观看| 日韩欧美 国产精品| 亚洲片人在线观看| 性色av乱码一区二区三区2| 亚洲天堂国产精品一区在线| 国产午夜福利久久久久久| 亚洲国产精品sss在线观看| 国产精品日韩av在线免费观看| av片东京热男人的天堂| 成人永久免费在线观看视频| 国产真人三级小视频在线观看| 在线观看午夜福利视频| 亚洲欧美日韩高清在线视频| 成人av一区二区三区在线看| 欧美日韩亚洲综合一区二区三区_| 又爽又黄无遮挡网站| 手机成人av网站| 99精品欧美一区二区三区四区| bbb黄色大片| 亚洲国产精品合色在线| 午夜免费观看网址| 18禁黄网站禁片午夜丰满| 免费在线观看视频国产中文字幕亚洲| 他把我摸到了高潮在线观看| 欧美色视频一区免费| 婷婷亚洲欧美| 黄色女人牲交| 国产区一区二久久| 日韩中文字幕欧美一区二区| 一个人免费在线观看的高清视频| 欧美丝袜亚洲另类 | 精品一区二区三区四区五区乱码| 中文资源天堂在线| 黄色女人牲交| 欧美乱妇无乱码| 99国产精品99久久久久| 欧美日本亚洲视频在线播放| 夜夜爽天天搞| 国产精品久久电影中文字幕| 在线观看免费视频日本深夜| 露出奶头的视频| 伦理电影免费视频| 2021天堂中文幕一二区在线观| 麻豆av在线久日| 国产熟女xx| 又粗又爽又猛毛片免费看| 久久香蕉精品热| 亚洲一码二码三码区别大吗| 性欧美人与动物交配| 亚洲最大成人中文| 国产av一区二区精品久久| 丝袜人妻中文字幕| 国产av麻豆久久久久久久| 男女下面进入的视频免费午夜| 亚洲精华国产精华精| 亚洲av中文字字幕乱码综合| 老汉色av国产亚洲站长工具|