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

    基于多傳感器的室內(nèi)三維定位算法研究*

    2019-07-08 10:07:26陳友榮鐘陳健劉半藤任條娟周駿華
    傳感技術(shù)學(xué)報(bào) 2019年6期
    關(guān)鍵詞:海拔高度步數(shù)樓梯

    陳友榮,陳 浩,鐘陳健,劉半藤,任條娟,周駿華

    (1.浙江樹人大學(xué)信息科技學(xué)院,杭州 310015;2.常州大學(xué)信息科學(xué)與工程學(xué)院,江蘇 常州 213164; 3.中移(杭州)信息技術(shù)有限公司,杭州 311100)

    近年來,城市的建筑結(jié)構(gòu)日益復(fù)雜,這給消防員的偵察、滅火和搜救等工作帶來極大的挑戰(zhàn)。在復(fù)雜的建筑結(jié)構(gòu)下開展救援行動(dòng),需要獲知消防員的實(shí)時(shí)位置信息,從而保障消防員的自身安全和協(xié)調(diào)整體救援行動(dòng)。但是目前在日常救援過程中,消防員和指揮員只采用對講機(jī)進(jìn)行人工對話,簡單收集消防員的位置和所在位置的火情信息,沒有考慮消防員的精準(zhǔn)定位問題,指揮員和消防員難以準(zhǔn)確獲知各自的位置坐標(biāo)[1]。因此需要一種現(xiàn)場救援環(huán)境下的消防員實(shí)時(shí)定位技術(shù)。

    目前實(shí)時(shí)定位主要分為室內(nèi)定位和室外定位。全球衛(wèi)星定位系統(tǒng)已經(jīng)廣泛應(yīng)用到室外目標(biāo)的定位和跟蹤。但是由于衛(wèi)星信號(hào)在室內(nèi)嚴(yán)重衰減,衛(wèi)星定位系統(tǒng)不能應(yīng)用到室內(nèi)環(huán)境,而且較多購物中心、大型超市、地下車庫等建筑物內(nèi)部結(jié)構(gòu)復(fù)雜,室內(nèi)人員容易迷路,因此對室內(nèi)精準(zhǔn)定位的需求較大,且受到學(xué)術(shù)界和產(chǎn)業(yè)界的高度關(guān)注。目前較多學(xué)者側(cè)重于利用WIFI信號(hào)、攝像頭信號(hào)、無線信號(hào)、慣性導(dǎo)航等信號(hào),研究室內(nèi)二維定位算法[2-3],如文獻(xiàn)[4]提出了基于零速度更新的腳踏式慣性導(dǎo)航算法FINS(Foot-mounted INS algorithm),實(shí)現(xiàn)自身的二維定位。文獻(xiàn)[5]提出基于鞋上慣性傳感器的室內(nèi)步行導(dǎo)航算法IPN_S(Indoor Pedestrian Navigation algorithm with shoe-mounted inertial sensors),采用零速度更新和9維擴(kuò)展卡爾曼濾波器估計(jì)自身二維定位。一部分學(xué)者側(cè)重于利用單個(gè)或多個(gè)信號(hào)研究室內(nèi)三維定位算法,如利用現(xiàn)場部署攝像頭的圖像數(shù)據(jù)[6],激光信號(hào)[7],聲音信號(hào)[8],LED燈光信號(hào)[9]和超寬帶信號(hào)[10]等單一信號(hào)實(shí)現(xiàn)室內(nèi)三維定位。文獻(xiàn)[11]利用地磁信號(hào)、轉(zhuǎn)向角傳感器和氣壓傳感器等傳感器融合計(jì)算三維定位。文獻(xiàn)[12]提出一種三維室內(nèi)定位算法IPA_3D(3D Indoor Positioning Algorithm),即利用加速度計(jì)、陀螺儀和氣壓計(jì)等低成本傳感器,采用15維擴(kuò)展卡爾曼濾波器融合計(jì)算室內(nèi)人員的相對三維位置。

    目前關(guān)于消防員的室內(nèi)定位算法的研究結(jié)果非常少,主要集中在RFID、慣性導(dǎo)航方面的定位算法研究。如文獻(xiàn)[13-14]采集所有消防員的信息,采用集中式方法計(jì)算消防員的位置。集中式方法需要收集所有傳感節(jié)點(diǎn)信息。文獻(xiàn)[15-16]利用RFID[15]、聲音[16]等信號(hào)對室內(nèi)人員進(jìn)行定位。文獻(xiàn)[17]考慮野外火災(zāi)救援場景,考慮部署在貨車上的基站設(shè)備和消防員身上的beacon節(jié)點(diǎn),根據(jù)基站設(shè)備信號(hào)計(jì)算自身位置坐標(biāo)。

    由表1可知,上述算法存在一定缺點(diǎn),不能有效解決缺電、出現(xiàn)大量濃煙、烈火等火災(zāi)現(xiàn)場下的室內(nèi)定位問題。因此在上述文獻(xiàn)的基礎(chǔ)上,結(jié)合三軸加速度計(jì)、三軸陀螺儀、三軸磁力計(jì)、氣壓計(jì)等多個(gè)傳感器,提出一種基于多傳感器的室內(nèi)三維定位算法ITPA(Indoor Three-dimensional Positioning Algorithm based on multi-sensor)。即當(dāng)消防員進(jìn)入室內(nèi)進(jìn)行救援行動(dòng)時(shí),通過氣壓計(jì)輸出數(shù)據(jù)和Kalman濾波,計(jì)算消防員所在的高度和樓層,判斷平地行走、上下樓梯、上下電梯等行為。通過三軸加速度計(jì)、三軸陀螺儀和三軸磁力計(jì)的數(shù)據(jù),采用過零檢測識(shí)別消防員靜止和運(yùn)動(dòng)情況,并通過捷聯(lián)慣導(dǎo)處理和航向角計(jì)算移動(dòng)偏移的坐標(biāo)。最終選擇第一層的樓梯位置作為原點(diǎn),以樓梯為參照點(diǎn),采用Kalman融合算法計(jì)算消防員的三維位置坐標(biāo)??傊?當(dāng)消防員處于復(fù)雜室內(nèi)環(huán)境下運(yùn)動(dòng)時(shí),本算法不僅能夠?qū)崟r(shí)判別其行為情況,還能計(jì)算3維位置,可降低定位誤差,同時(shí)解決火災(zāi)復(fù)雜環(huán)境下室內(nèi)消防員的定位問題,為其他算法提供位置信息。

    表1 室內(nèi)定位算法分析

    1 定位算法原理

    基于多傳感器的室內(nèi)三維定位算法的原理如圖1所示。首先將加速度計(jì)等傳感器綁在腳上獲取消防員行走的各個(gè)數(shù)據(jù)。其次通過氣壓計(jì)的值,采用Kalman濾波算法對當(dāng)前的高度數(shù)據(jù)進(jìn)行濾波,并通過行為閾值判斷方法判斷平地行走、上下樓梯、上下電梯等行為。由于三軸加速度計(jì)、三軸陀螺儀和三軸磁力計(jì)的輸出數(shù)據(jù)存在漂移誤差,即當(dāng)消防員在靜止的狀態(tài)下仍輸出明顯波動(dòng)的數(shù)據(jù),因此采用過零檢測判斷消防員是否處于靜止?fàn)顟B(tài),如果處于靜止?fàn)顟B(tài),則將該三個(gè)傳感器的輸出值歸零。如果不為零,則把加速度計(jì),陀螺儀和磁力計(jì)數(shù)據(jù)經(jīng)過捷聯(lián)慣導(dǎo)計(jì)算處理,同時(shí)結(jié)合航向角數(shù)據(jù),計(jì)算平面二維位置信息。最后采用Kalman融合估計(jì)消防員的三維定位坐標(biāo),從而提高定位的準(zhǔn)確度。但是ITPA算法仍需要解決以下3個(gè)問題:①如何通過氣壓計(jì)判斷當(dāng)前的高度、移動(dòng)行為和當(dāng)前樓層;②如何根據(jù)三軸加速度計(jì)、三軸陀螺儀和三軸磁力計(jì),計(jì)算當(dāng)前平面的二維坐標(biāo);③如何采用Kalman融合算法融合估計(jì)當(dāng)前信息,獲取消防員的室內(nèi)三維坐標(biāo),這三個(gè)問題的具體解決如下。

    圖1 室內(nèi)三維定位算法原理

    1.1 傳感器數(shù)據(jù)輸出

    1.2 過零檢測

    在消防員行走過程中,每個(gè)跨步中腳都要經(jīng)歷平穩(wěn)、邁步、再次平穩(wěn)的周期性變化過程。但是當(dāng)消防員的腳處于平穩(wěn)狀態(tài)時(shí),傳感器采集到的數(shù)據(jù)仍會(huì)出現(xiàn)一定的漂移,會(huì)影響后續(xù)的定位效果,提高了定位誤差。因此考慮根據(jù)加速度計(jì)和陀螺儀輸出的信息,考慮加速度的幅值均方根、加速度的幅值方差和角速度的幅值均方根的情況,實(shí)現(xiàn)過零監(jiān)測,判斷消防員是否靜止在地面上,從而控制和消除數(shù)據(jù)漂移誤差。具體條件如下:

    t時(shí)刻的合加速度值為

    (1)

    其中,at表示t時(shí)刻的三個(gè)方向的合加速度大小。

    (2)

    (3)

    其中,C1表示加速度幅值均方根條件的判斷指示符,thmin和thmax表示根據(jù)實(shí)際情況設(shè)置的幅值均方根條件最小和最大閾值。

    令平均加速度為

    (4)

    (5)

    加速度的幅值方差條件為

    (6)

    其中,C2表示加速度幅值方差條件的判斷指示符,thσ-min表示根據(jù)實(shí)際情況設(shè)置的幅值方差閾值。

    令角速度的幅值均方根為

    (7)

    (8)

    其中,C3表示角速度的幅值均方根條件的判斷指示符號(hào),thw-max表示根據(jù)實(shí)際情況設(shè)置的角速度閾值。

    上述3個(gè)條件中,C1表示加速度是在一定的范圍內(nèi),接近重力值。C2表示加速度的波動(dòng)不能太大,保持穩(wěn)定。C3表明角速度小于閾值,沒有發(fā)生轉(zhuǎn)動(dòng)。只有當(dāng)C1,C2和C3同時(shí)為1時(shí),才判定消防員的腳落在地面上,沒有移動(dòng),此時(shí)腳處于平穩(wěn)態(tài)。

    1.3 高度和移動(dòng)行為判斷

    高度和移動(dòng)行為判斷包括高度獲取,卡爾曼濾波和異常數(shù)據(jù)處理、移動(dòng)行為判斷和修正3個(gè)方面。

    1.3.1 高度獲取

    采用氣壓計(jì)獲取消防員位置的高度信息,并結(jié)合該高度信息判斷移動(dòng)行為和所在樓層。即根據(jù)大氣壓力,計(jì)算海拔高度。

    (9)

    其中,ρt表示t時(shí)刻消防員所處位置的大氣壓力值,ρ0表示標(biāo)準(zhǔn)大氣壓力值1.013 25×105Pa,Ht表示t時(shí)刻消防員所處的海拔高度,單位m。

    由于三維定位所需的是相對海拔高度值,因此采用以下公式計(jì)算Δht。

    Δht=Ht-h0

    (10)

    其中,Δht表示t時(shí)刻消防員所處的相對海拔高度,h0表示起始位置的海拔高度。

    1.3.2 卡爾曼濾波和異常數(shù)據(jù)處理

    由于相對海拔高度值Δht中具有一定噪聲,因此需要對Δht進(jìn)行卡爾曼濾波處理,其所對應(yīng)的空間模型為:

    (11)

    建立觀測方程為:

    (12)

    (13)

    結(jié)合時(shí)間更新方程和測量更新方程進(jìn)行迭代計(jì)算,獲得濾波后的相對海拔高度值。

    通過過零檢測可將每一腳步劃分為邁步期與平穩(wěn)期兩種狀態(tài)。由于氣壓計(jì)存在一定的不穩(wěn)定性,且考慮腳步邁步期的高度變化較大,因此根據(jù)過零檢測的結(jié)果,分析當(dāng)前時(shí)刻是否處于平穩(wěn)期。如果處于平穩(wěn)期且該步平穩(wěn)期內(nèi)Kalman濾波器輸出的相對海拔高度數(shù)據(jù)個(gè)數(shù)大于或等于100個(gè),選擇100個(gè)相對海拔高度值,否則如果該步平穩(wěn)期較短且開始進(jìn)入邁步期,即相對海拔高度數(shù)據(jù)個(gè)數(shù)小于100個(gè)時(shí),選擇該步平穩(wěn)期內(nèi)的所有相對海拔高度數(shù)據(jù)。采用箱型圖方法對所選擇的相對海拔高度數(shù)據(jù)進(jìn)行異常點(diǎn)檢測。令H表示所選擇的相對海拔高度數(shù)據(jù)集合。對集合H內(nèi)所有元素進(jìn)行排序,選擇排序第25%的相對海拔高度值作為上四分位值U,選擇排序第75%的相對海拔高度值作為下四分位值L,即集合H內(nèi)只有1/4個(gè)數(shù)大于U,只有1/4個(gè)數(shù)小于L。則定義上界高度和下界高度為

    hupper=U+1.5(U-L)

    (14)

    hlower=U-1.5(U-L)

    (15)

    其中,hupper表示上界高度數(shù)值,hlower表示下界高度數(shù)值。

    (16)

    (17)

    1.3.3 移動(dòng)行為判斷和修正

    根據(jù)經(jīng)過濾波和異常點(diǎn)處理后的高度數(shù)據(jù),判斷消防員的移動(dòng)行為。為區(qū)分平地行動(dòng)、上下樓梯和上下電梯的行為,引入λh和μh兩個(gè)正閾值。如果前后兩個(gè)時(shí)刻的平均高度變化的差值不大于λh,則表示消防員在平面上行動(dòng)。差值大于λh,則表示消防員在走樓梯或乘坐電梯。而μh區(qū)分消防員是在走樓梯還是乘坐電梯。具體算法偽代碼如下:

    1. if |h′t-h′t-1|≤λhthen在平面上行動(dòng)

    2. else if (h′t-h′t-1)≥μhthen乘坐電梯且上行

    3. else if (h′t-h′t-1)≤-μhthen乘坐電梯且下行

    4. else if (h′t-h′t-1)>λhthen向上走樓梯

    5. else向下走樓梯

    6. end if

    在實(shí)際的判斷過程中,由于沒有考慮以下情況,會(huì)出現(xiàn)錯(cuò)誤判斷,需要加入一定的結(jié)果修正,從而保證判斷的準(zhǔn)確度。

    情況1電梯啟動(dòng)是一個(gè)慢慢加速過程。在電梯啟動(dòng)和停止部分會(huì)出現(xiàn)上下樓梯的錯(cuò)誤判斷。修正辦法:在判斷行為為乘坐電梯后,則計(jì)算開始乘樓梯行動(dòng)的判斷部分的時(shí)間長度。若時(shí)間長度大于η1,則判斷消防員的行為為乘坐電梯,將在開始,中間和結(jié)束階段中走樓梯的判斷結(jié)果直接修正為乘坐電梯。如果在結(jié)束部分出現(xiàn)在平面上行動(dòng)的判斷結(jié)果,則結(jié)束修正。

    情況2移動(dòng)行為判斷為上下樓梯,但在中間部分可能會(huì)出現(xiàn)乘坐電梯的誤判斷。修正辦法:在判斷行為為上下樓梯后,則計(jì)算上下樓梯行動(dòng)的判斷部分的時(shí)間長度。若時(shí)間長度大于η2,則判斷消防員的行為為上下樓梯,將在開始,中間和結(jié)束階段中乘坐電梯的判斷結(jié)果直接修正為上下樓梯。如果在結(jié)束部分出現(xiàn)在平面上行動(dòng)的判斷結(jié)果,則結(jié)束修正。

    情況3移動(dòng)行為判斷為上下樓梯,中間部分會(huì)出現(xiàn)在平面上行動(dòng)的判斷,無法區(qū)分是在樓梯上停留還是錯(cuò)誤判斷。修正辦法:計(jì)算平面上行動(dòng)的判斷部分的時(shí)間長度。若時(shí)間長度大于η3,則保留判斷結(jié)果,否則修正為上下樓梯行為。

    情況4移動(dòng)行為判斷為平面上行動(dòng),中間部分會(huì)出現(xiàn)部分判定為上下樓梯或乘坐電梯的錯(cuò)誤判斷。修正辦法:如果移動(dòng)行為判斷為平面上行動(dòng)且中間部分出現(xiàn)上下樓梯或乘坐電梯,則計(jì)算上下樓梯或乘坐電梯判斷部分的時(shí)間長度。若時(shí)間長度小于η4,則修正為平面上行動(dòng)。

    1.4 二維坐標(biāo)計(jì)算

    二維坐標(biāo)計(jì)算包括移動(dòng)距離計(jì)算和位置獲取兩個(gè)方面。

    1.4.1 移動(dòng)距離計(jì)算

    考慮到定位對象是消防員,結(jié)合其日常工作環(huán)境分析發(fā)現(xiàn):消防員在救災(zāi)現(xiàn)場不可能像普通行人那樣走路,他們的動(dòng)作更復(fù)雜,跑步、不平坦的地勢和擺動(dòng)幅度大的行走是消防員不可避免的。因此提出一種新的移動(dòng)距離計(jì)算方法,它除了能計(jì)算普通行人的移動(dòng)距離外,更適用于像消防員這類人的移動(dòng)距離計(jì)算。下面就是這種算法的步驟:

    (18)

    (19)

    其中,q0、q1、q0、q0表示四元數(shù)。通過加速度計(jì)和陀螺儀兩個(gè)傳感器,采用畢卡逼近法更新四元數(shù),可獲得當(dāng)前時(shí)刻的旋轉(zhuǎn)矩陣。

    (20)

    其中,T是采樣周期。

    步驟3修正速度。根據(jù)過零檢測的結(jié)果,分析當(dāng)前時(shí)刻是否處于平穩(wěn)期。如果處于平穩(wěn)期且該步平穩(wěn)期內(nèi)的速度數(shù)據(jù)個(gè)數(shù)大于或等于100個(gè),選擇100個(gè)速度數(shù)據(jù),否則如果該步平穩(wěn)期較短且開始進(jìn)入邁步期,即速度數(shù)據(jù)個(gè)數(shù)小于100個(gè),選擇該步平穩(wěn)期內(nèi)的所有相對速度數(shù)據(jù)。令Vpi表示所選擇平穩(wěn)期的速度數(shù)據(jù)集合,計(jì)算Vpi的速度平均值,即

    (21)

    根據(jù)平均速度βt,通過式(22)修正邁步期的速度。

    (22)

    根據(jù)平均速度βt,修正平穩(wěn)期的速度為:

    (23)

    步驟4計(jì)算位移增量ΔPt:

    (24)

    步驟5計(jì)算平面上移動(dòng)距離:

    (25)

    其中,SLt表示第t時(shí)刻的移動(dòng)距離。

    循環(huán)執(zhí)行步驟1~步驟5,則可以獲得在二維平面上移動(dòng)的距離。

    1.4.2 位置獲取

    假定載體坐標(biāo)系的X軸與腳相一致后,根據(jù)陀螺儀和磁力計(jì)兩個(gè)傳感器輸出的值,采用互補(bǔ)濾波修正航向角,并通過移動(dòng)距離計(jì)算自身二維位置。即:

    (26)

    (27)

    (28)

    其中,θs=arctan(|T22/T12|)。

    1.5 Kalman融合估計(jì)

    在獲得高度值和二維坐標(biāo)的信息后,采用Kalman融合算法將信息進(jìn)行融合處理。令Xt表示t時(shí)刻Kalman融合算法的狀態(tài)向量估計(jì)值,由位置、速度、姿態(tài)角、加速度和角速度構(gòu)成,即Xt=[rt,ct,φt,bt,ηt]T,其中rt表示3維位置估計(jì)值,ct表示3維速度估計(jì)值,φt表示3維姿態(tài)角估計(jì)值,bt表示3維加速度計(jì)零偏誤差值,ηt表示3維陀螺儀零偏值。其所對應(yīng)的空間模型為:

    Xt=FtXt-1+Γt-1Wt-1

    (29)

    其中,Xt表示t時(shí)刻融合濾波狀態(tài)向量的估計(jì)值,Ft表示狀態(tài)轉(zhuǎn)移矩陣,Wt-1表示t-1時(shí)刻的過程噪聲,Γt-1表示系統(tǒng)噪聲增益矩陣。Ft可表示為:

    (30)

    其中,ξ表示t時(shí)刻的旋轉(zhuǎn)矩陣,ψ表示加速度an的反對稱矩陣,Δt表示采樣間隔,I3×3表示3×3單位矩陣,O3×3表示全為0的3×3矩陣。ψ可表示為:

    (31)

    系統(tǒng)噪聲增益矩陣Γt-1為

    (32)

    建立觀測方程為:

    Zt=HtXt+nt

    (33)

    其中,Zt表示t時(shí)刻融合濾波的測量值,nt表示t時(shí)刻的測量噪聲,Ht表示濾波算法的測量矩陣。Ht可表示為:

    Ht=[I3×3ΔtI3×3O3×3O3×3O3×3O3×3]

    (34)

    2 算法實(shí)現(xiàn)

    本算法可直接應(yīng)用到消防員上的嵌入式設(shè)備中,實(shí)現(xiàn)消防員的實(shí)時(shí)三維定位。如圖2所示,其三維定位算法的具體實(shí)現(xiàn)步驟如下:

    步驟1初始化各個(gè)參數(shù),包括起始位置的海拔高度、橫軸、縱軸和豎軸的方向、二維平面坐標(biāo)和航向角等信息。

    步驟2實(shí)時(shí)采集三軸加速度計(jì)、三軸陀螺儀、三軸磁力計(jì)的姿態(tài)傳感器和氣壓計(jì)數(shù)值,并存儲(chǔ)到存儲(chǔ)器中。

    步驟3根據(jù)加速度計(jì)和陀螺儀輸出的信息,計(jì)算當(dāng)前時(shí)刻的加速度幅值均方根條件C1、加速度幅值方差條件C2和角速度幅值均方根條件C3。如果C1,C2和C3的值都為1時(shí),判斷當(dāng)前時(shí)刻處于平穩(wěn)期,否則處于邁步期。

    步驟4根據(jù)當(dāng)前的氣壓計(jì)值,參考起始位置的海拔高度,計(jì)算相對海拔高度值。采用卡爾曼濾波算法對高度數(shù)據(jù)進(jìn)行濾波,消除噪聲。

    步驟5根據(jù)過零檢測的結(jié)果,分析當(dāng)前時(shí)刻是否處于平穩(wěn)期。如果處于平穩(wěn)期且該平穩(wěn)期內(nèi)卡爾曼濾波后輸出的相對海拔高度數(shù)據(jù)個(gè)數(shù)大于或等于100個(gè),則選擇該100個(gè)相對海拔高度數(shù)據(jù),否則如果處于平穩(wěn)期且該平穩(wěn)期內(nèi)卡爾曼濾波后輸出的相對海拔高度數(shù)據(jù)個(gè)數(shù)小于100個(gè),則直接選擇該平穩(wěn)期內(nèi)所有相對海拔高度數(shù)據(jù),否則直接跳到步驟2。采用箱型圖方法對所選擇的相對海拔高度數(shù)據(jù)進(jìn)行異常點(diǎn)檢測和修正,將這些相對海拔數(shù)據(jù)的平均值作為當(dāng)前時(shí)刻的消防員的高度值,跳到步驟6;

    步驟6根據(jù)前后高度值,識(shí)別平面行動(dòng)、上下樓梯和上下電梯等消防員的行為,并對識(shí)別結(jié)果進(jìn)行修正,從而保證判斷的準(zhǔn)確度。

    步驟7根據(jù)加速度計(jì)和陀螺儀的值,計(jì)算和修正當(dāng)前二維的移動(dòng)距離。根據(jù)陀螺儀和磁力計(jì)的值,采用互補(bǔ)濾波修正航向角,并通過移動(dòng)距離計(jì)算自身的二維位置坐標(biāo)。

    步驟8采用Kalman融合方法對信息進(jìn)行融合處理,計(jì)算和輸出消防員的室內(nèi)三維坐標(biāo)。

    圖2 工作流程圖

    步驟9如果消防員手動(dòng)結(jié)束室內(nèi)三維定位功能,則退出,否則跳到步驟2。

    循環(huán)執(zhí)行步驟2~步驟9,實(shí)現(xiàn)消防員室內(nèi)實(shí)時(shí)三維定位。

    3 算法實(shí)驗(yàn)

    3.1 實(shí)驗(yàn)參數(shù)

    在實(shí)驗(yàn)過程中,選擇MPU9025姿態(tài)傳感器和MS5611氣壓計(jì)。將上述兩個(gè)模塊固定在實(shí)驗(yàn)人員的腳部,并通過藍(lán)牙模塊、STM32開發(fā)板和上位機(jī)軟件,實(shí)現(xiàn)實(shí)驗(yàn)人員的運(yùn)動(dòng)數(shù)據(jù)采集,且每次測試時(shí)記錄下經(jīng)過測量點(diǎn)的真實(shí)步數(shù),位置和移動(dòng)距離等信息,方便后續(xù)誤差分析。MPU9250姿態(tài)傳感器由3軸加速度、3軸陀螺儀和3軸磁力計(jì)組成。其中3軸陀螺儀輸出具有三個(gè)可選擇量程(±250 °/s,±500 °/s,±1 000 °/s)的16 位三軸角速度數(shù)據(jù);3軸加速度輸出具有三個(gè)可選擇量程(±2gn,±4gn,±8gn,±16gn)的16位三軸加速度數(shù)據(jù);3軸磁力計(jì)輸出具有14位和16位分辨率的磁力計(jì)數(shù)據(jù),同時(shí)最大測量范圍在±4 800 μT。MS5611氣壓計(jì)內(nèi)置24位模數(shù)轉(zhuǎn)換器,支持IIC和SPI通訊協(xié)議,測量/工作輸出范圍:1 000 mPa~1 200 mPa,分辨率10 cm。根據(jù)實(shí)驗(yàn)人員的實(shí)測運(yùn)動(dòng)數(shù)據(jù),選擇以下參數(shù),通過MATLAB軟件計(jì)算消防員室內(nèi)三維位置、步數(shù)誤差、距離誤差和漂移誤差:thmin為0,thmax為1,thσ-min為1,thw-max為1,λh為0.14,μh為0.6,nt、wt-1、qt和wt-1為隨機(jī)高斯噪聲的協(xié)方差,采樣周期T為0.01 s。

    其中,定義步數(shù)誤差errorzupt為計(jì)算所得的當(dāng)前步數(shù)和真實(shí)步數(shù)差值的絕對值與真實(shí)步數(shù)的比值,可表示為:

    errorzupt=(|steptrue-stepcal|)/steptrue

    (35)

    其中,steptrue表示測量過程中的真實(shí)步數(shù)。stepcal表示算法計(jì)算所得的步數(shù)。定義移動(dòng)距離誤差errordis為計(jì)算所得的移動(dòng)距離和真實(shí)距離差值的絕對值與真實(shí)距離的比值,可表示為:

    errordis=(|distrue-discal|)/distrue

    (36)

    其中,distrue表示測量過程中的真實(shí)移動(dòng)距離。discal表示算法計(jì)算所得的移動(dòng)路程。定義漂移誤差 errordrift為計(jì)算所得的三維坐標(biāo)和真實(shí)三維位置坐標(biāo)差值的模值與真實(shí)距離的比值,可表示為:

    (37)

    其中,(xtrue,ytrue,ztrue)表示測量過程中的真實(shí)坐標(biāo)。(xcal,ycal,zcal)表示算法計(jì)算所得的坐標(biāo)。

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

    選擇3.1節(jié)中參數(shù),比較FINS[4],IPN_S[5],IPA_3D[12]和ITPA算法的消防員室內(nèi)三維位置、步數(shù)誤差、距離誤差和漂移誤差。其中FINS和IPN_S算法是二維定位算法,在算法比較中直接選擇ITPA算法的高度計(jì)算方法計(jì)算其高度值,從而獲得三維位置坐標(biāo)。

    3.2.1 直線行走

    如圖3所示,起始點(diǎn)矩形經(jīng)過11個(gè)中間測量點(diǎn)(菱形),到達(dá)終點(diǎn)測量點(diǎn)圓形。真實(shí)軌跡是朝一個(gè)方向直線行走30 m。從圖中可以發(fā)現(xiàn)軌跡在x軸方向上穩(wěn)定增加,而在y軸方向上幾乎沒有出現(xiàn)明顯的波動(dòng),較接近真實(shí)路線。

    圖3 直線行走的定位坐標(biāo)圖

    如圖4所示,ITPA算法的直線行走步數(shù)誤差在8%以下,遠(yuǎn)低于FINS,IPN_S和IPA_3D的直線行走步數(shù)誤差。這是因?yàn)?FINS,IPN_S和IPA_3D算法采用單個(gè)條件或結(jié)合瞬時(shí)時(shí)刻的數(shù)據(jù)分析行人行走的邁步態(tài)和平穩(wěn)態(tài),從而判斷其行走步數(shù),而ITPA算法選取加速度的幅值均方根、加速度的幅值方差和角速度的幅值均方根的情況,實(shí)現(xiàn)過零監(jiān)測,降低了步數(shù)判斷的誤差。

    圖4 直線行走的步數(shù)誤差

    如圖5所示,ITPA算法的直線行走距離誤差低于FINS,IPN_S和IPA_3D的直線行走距離誤差,但是當(dāng)移動(dòng)距離較大時(shí),ITPA算法和FINS算法的距離誤差相差不大。這是因?yàn)?在直線行走時(shí),ITPA算法和FINS算法基本上采用相同的方法,但是由于ITPA算法根據(jù)平穩(wěn)期的平均速度修正邁步期和平穩(wěn)期的速度,從而獲得較接近實(shí)際的速度,降低了距離誤差,因此其距離誤差略低于FINS算法的距離誤差。IPN_S 和IPA_3D采用靜止時(shí)的速度作為觀測量修正位置,其距離誤差略高。

    圖5 直線行走的距離誤差

    如圖6所示,ITPA算法的直線行走漂移誤差低于FINS,IPN_S,IPA_3D的直線行走漂移誤差。這是因?yàn)?ITPA算法的步數(shù)判斷較準(zhǔn)確,高度且2維坐標(biāo)獲取的誤差較小,同時(shí)采用Kalman融合算法對由位置、速度、姿態(tài)角、加速度和角速度構(gòu)成的狀態(tài)向量進(jìn)行融合估計(jì),降低了系統(tǒng)噪聲,并有效防止誤差的累計(jì)。

    圖6 直線行走的漂移誤差

    3.2.2 樓梯行走

    如圖7所示,起始點(diǎn)(矩形),先向上經(jīng)過一段樓梯和中間平臺(tái),再換一個(gè)方向向上經(jīng)過另一段樓梯,最終行走到上一層樓,即經(jīng)過11個(gè)中間測量點(diǎn)(菱形),到達(dá)終點(diǎn)測量點(diǎn)(圓形)。從圖中可以發(fā)現(xiàn)軌跡在z軸上穩(wěn)定增加,而在x軸和y軸上有規(guī)律的變化,其行走的路線較接近真實(shí)路線。

    圖7 樓梯行走的定位坐標(biāo)圖

    如圖8所示,ITPA算法的樓梯行走步數(shù)誤差遠(yuǎn)低于FINS,IPN_S和IPA_3D的樓梯行走步數(shù)誤差。這是因?yàn)?ITPA算法選取加速度的幅值均方根、加速度的幅值方差和角速度的幅值均方根作為消防員邁出一步的判斷標(biāo)準(zhǔn),不受高度對步數(shù)判斷的影響,其步數(shù)誤差與直線行走的步數(shù)誤差相差不大。而FINS,IPN_S和IPA_3D只是考慮部分條件,走樓梯的行為對其步數(shù)判斷影響較大,其步數(shù)誤差明顯高于直線行走的步數(shù)誤差。

    圖8 樓梯行走的步數(shù)誤差

    如圖9所示,ITPA算法通過分析人行走時(shí)的狀態(tài),及時(shí)對不同階段的速度進(jìn)行修正,同時(shí)根據(jù)高度值判斷行人所在樓層高度,并及時(shí)修正樓層高度,并根據(jù)移動(dòng)行為對三維坐標(biāo)觀測值進(jìn)行修正,有效降低了累計(jì)誤差,同時(shí)結(jié)合樓層高度和移動(dòng)行為進(jìn)行數(shù)據(jù)融合,降低了數(shù)據(jù)的漂移對算法影響,因此ITPA算法的樓梯行走距離誤差低于FINS,IPN_S和IPA_3D的樓梯行走距離誤差,且與其直線行走距離誤差相差不大。但是FINS,IPN_S和IPA_3D的樓梯行走距離誤差比其直線行走距離誤差提高較多。

    圖9 樓梯行走的距離誤差

    如圖10所示,FINS和IPN_S算法是二維定位,其高度計(jì)算方法采用ITPA算法的高度計(jì)算方法,對氣壓計(jì)的輸出值進(jìn)行Kalman濾波和異常數(shù)據(jù)處理等,提高了高度精度,因此其漂移誤差遠(yuǎn)低于IPA_3D算法。由于樓梯上行走x和y軸的變化相對不大,主要是在z軸上逐漸增加,因此FINS,IPN_S和ITPA算法的漂移誤差相差不大,且與其各自直線行走的漂移誤差提高不多。由于ITPA算法采用了Kalman融合估計(jì),并根據(jù)移動(dòng)行為對觀測值進(jìn)行修正,從而降低了算法的漂移誤差,因此ITPA算法略低于FINS和IPN_S算法。

    圖10 樓梯行走的漂移誤差

    3.3.3 綜合行走

    如圖11所示,起始點(diǎn)(矩形),先沿樓梯行走至第二層,再在該層樓行走一個(gè)矩形后,經(jīng)過樓梯返回至第一層,即經(jīng)過11個(gè)中間測量點(diǎn)(菱形)到達(dá)終點(diǎn)測量點(diǎn)(圓形)。從圖11可以發(fā)現(xiàn)軌跡在樓梯行走的時(shí)候z軸上穩(wěn)定增加,而x軸和y軸上有規(guī)律的變化,在平面行走時(shí),z軸基本無變化,且其計(jì)算路徑較接近真實(shí)路線。

    圖11 綜合行走的定位圖

    圖12 綜合行走的步數(shù)誤差

    如圖12所示,ITPA算法不受行走路徑的影響,其綜合行走的步數(shù)誤差低于FINS,IPN_S和IPA_3D的綜合行走步數(shù)誤差,且比樓梯行走和直線行走的步數(shù)誤差略高。IPN_S和IPA_3D受高度變化的影響較大,其綜合行走步數(shù)誤差遠(yuǎn)大于樓梯行走和直線行走的步數(shù)誤差。其原因與樓梯行走的類似,請參考3.2.2節(jié)。

    如圖13所示,ITPA算法不受行走路徑的影響,其綜合行走距離誤差遠(yuǎn)低于FINS,IPN_S和IPA_3D的綜合行走距離誤差,且與其樓梯行走和直線行走的距離誤差相差不大。FINS,IPN_S和IPA_3D的綜合行走距離誤差比其樓梯行走和直線行走的距離誤差提高較多,其中IPN_S達(dá)到200%以上,距離誤差較大。其原因與樓梯行走的類似,請參考3.2.2節(jié)。

    圖13 綜合行走的距離誤差

    如圖14所示,IPA_3D算法的漂移誤差較大,遠(yuǎn)大于其樓梯行走和直線行走的漂移誤差。FINS,IPN_S和ITPA算法選用相同的高度計(jì)算方法,其綜合行走漂移誤差相對較小,其中ITPA算法的綜合行走漂移誤差最小,且與其樓梯行走和直線行走的漂移誤差相差不大。其原因與樓梯行走的類似,請參考3.2.2節(jié)。

    圖14 綜合行走的漂移誤差

    4 總結(jié)

    利用氣壓計(jì)和包含三軸加速度計(jì)、三軸陀螺儀和三軸磁力計(jì)的姿態(tài)傳感器數(shù)據(jù),提出一種基于多傳感器的室內(nèi)三維定位算法。首先,提出了傳感器數(shù)據(jù)輸出和過零檢測方法,其次,根據(jù)氣壓計(jì)數(shù)據(jù),獲得海拔值,并采用卡爾曼濾波和異常數(shù)據(jù)處理等方法,獲得消防員的當(dāng)前高度,并提出消防員移動(dòng)行為判斷和修正方法。接著,通過移動(dòng)距離計(jì)算和位置獲取,計(jì)算二維坐標(biāo),并采用Kalman融合估計(jì)方法,利用移動(dòng)行為修正觀測值,降低定位誤差。最后給出算法的仿真參數(shù),比較直行行走、樓梯行走和綜合行走的FINS,IPN_S,IPA_3D和ITPA算法的性能。

    總之,在直行行走、樓梯行走和綜合行走下,ITPA算法都能獲得較接近真實(shí)路線的移動(dòng)軌跡和消防員室內(nèi)三維位置,降低了算法的步數(shù)誤差、距離誤差和漂移誤差。但是算法目前根據(jù)真實(shí)實(shí)驗(yàn)數(shù)據(jù)進(jìn)行仿真分析和比較,因此下一階段目標(biāo)是將在嵌入式設(shè)備上實(shí)現(xiàn)ITPA算法,實(shí)現(xiàn)算法的應(yīng)用。

    猜你喜歡
    海拔高度步數(shù)樓梯
    速度和步數(shù),哪個(gè)更重要
    楚國的探索之旅
    奇妙博物館(2021年4期)2021-05-04 08:59:48
    故障狀態(tài)下純電動(dòng)汽車環(huán)境壓力及海拔高度估算方法
    北京汽車(2021年1期)2021-03-04 13:05:46
    微信運(yùn)動(dòng)步數(shù)識(shí)人指南
    小演奏家(2018年9期)2018-12-06 08:42:02
    逃跑的樓梯
    掃樓梯
    小布老虎(2017年3期)2017-08-10 08:22:35
    上下樓梯時(shí)要注意什么 ?
    原來樓梯還可以是這樣的
    不同海拔高度人群胃蛋白酶原血清水平差異性分析
    手机成人av网站| 久久久久久久久免费视频了| 国产精品久久久久久人妻精品电影| 日韩欧美一区二区三区在线观看 | 色婷婷久久久亚洲欧美| 免费av中文字幕在线| 大香蕉久久成人网| 国产免费现黄频在线看| 精品少妇一区二区三区视频日本电影| 久久久久精品国产欧美久久久| 久久久国产成人免费| 他把我摸到了高潮在线观看| 午夜福利视频在线观看免费| 97人妻天天添夜夜摸| 欧洲精品卡2卡3卡4卡5卡区| 一区在线观看完整版| 亚洲中文av在线| avwww免费| 18禁观看日本| 一二三四在线观看免费中文在| 国产精品一区二区在线不卡| 久久性视频一级片| 啦啦啦免费观看视频1| 亚洲免费av在线视频| 丝袜在线中文字幕| 欧美乱妇无乱码| 一进一出抽搐gif免费好疼 | a级毛片黄视频| 99国产精品一区二区蜜桃av | 热99久久久久精品小说推荐| 精品久久久久久久久久免费视频 | 亚洲欧美激情在线| 一本综合久久免费| 欧洲精品卡2卡3卡4卡5卡区| 国产色视频综合| 狠狠狠狠99中文字幕| 日韩欧美一区二区三区在线观看 | 欧美黑人精品巨大| www日本在线高清视频| 91精品国产国语对白视频| 成熟少妇高潮喷水视频| aaaaa片日本免费| 亚洲人成伊人成综合网2020| 麻豆av在线久日| 一级,二级,三级黄色视频| 欧美精品人与动牲交sv欧美| 天堂中文最新版在线下载| 欧美日韩中文字幕国产精品一区二区三区 | 建设人人有责人人尽责人人享有的| 欧美日韩av久久| 久久精品亚洲熟妇少妇任你| 免费一级毛片在线播放高清视频 | 人妻 亚洲 视频| 国产高清激情床上av| 无遮挡黄片免费观看| 精品久久久久久,| 成人国产一区最新在线观看| 动漫黄色视频在线观看| 中文亚洲av片在线观看爽 | 性色av乱码一区二区三区2| 国产免费现黄频在线看| 午夜福利在线免费观看网站| 亚洲精品粉嫩美女一区| 高清视频免费观看一区二区| 深夜精品福利| 亚洲成人国产一区在线观看| 国产精品免费一区二区三区在线 | 国产单亲对白刺激| 亚洲免费av在线视频| 国产成人av教育| 亚洲一卡2卡3卡4卡5卡精品中文| 国产精品久久视频播放| 男女下面插进去视频免费观看| 叶爱在线成人免费视频播放| 国产男女超爽视频在线观看| 91精品三级在线观看| 黄色女人牲交| 国产不卡一卡二| tube8黄色片| 嫩草影视91久久| 亚洲精品国产区一区二| 黄网站色视频无遮挡免费观看| 亚洲自偷自拍图片 自拍| 欧美日韩亚洲高清精品| 身体一侧抽搐| av免费在线观看网站| 超碰成人久久| 国产精品影院久久| 视频区欧美日本亚洲| 黄色视频,在线免费观看| 99久久国产精品久久久| 黄片播放在线免费| 又黄又爽又免费观看的视频| av中文乱码字幕在线| 国产一区二区三区综合在线观看| 满18在线观看网站| 69精品国产乱码久久久| 精品第一国产精品| 国产精品国产高清国产av | 欧美精品一区二区免费开放| 夫妻午夜视频| 亚洲国产中文字幕在线视频| 亚洲午夜理论影院| 亚洲精品国产区一区二| 国产在线观看jvid| 国产欧美亚洲国产| 天天操日日干夜夜撸| 日本一区二区免费在线视频| 熟女少妇亚洲综合色aaa.| 亚洲情色 制服丝袜| 欧美乱色亚洲激情| 亚洲一区中文字幕在线| 日韩中文字幕欧美一区二区| 国产欧美日韩一区二区三区在线| 久久国产精品人妻蜜桃| x7x7x7水蜜桃| 久久中文字幕一级| 精品国产一区二区三区久久久樱花| 亚洲久久久国产精品| 午夜福利乱码中文字幕| 免费在线观看完整版高清| 亚洲国产看品久久| 在线观看一区二区三区激情| 在线观看免费高清a一片| 亚洲专区字幕在线| 午夜福利影视在线免费观看| 亚洲国产欧美网| 久久国产精品影院| 欧美精品亚洲一区二区| 777久久人妻少妇嫩草av网站| 国产亚洲av高清不卡| 国产精品免费视频内射| 九色亚洲精品在线播放| 一二三四在线观看免费中文在| 少妇 在线观看| 久热爱精品视频在线9| 美女国产高潮福利片在线看| 无限看片的www在线观看| 一本综合久久免费| 国产精品久久久久成人av| av不卡在线播放| 欧美乱色亚洲激情| 老司机深夜福利视频在线观看| 99久久99久久久精品蜜桃| 美女福利国产在线| 色老头精品视频在线观看| 欧美日韩av久久| 麻豆乱淫一区二区| 一边摸一边做爽爽视频免费| 激情在线观看视频在线高清 | 两个人免费观看高清视频| 成年动漫av网址| 丰满的人妻完整版| 亚洲视频免费观看视频| 一二三四社区在线视频社区8| 女性生殖器流出的白浆| 国产亚洲欧美在线一区二区| 欧美黑人欧美精品刺激| 日韩熟女老妇一区二区性免费视频| 美女高潮到喷水免费观看| 丝袜美腿诱惑在线| 母亲3免费完整高清在线观看| 欧美日韩视频精品一区| 久99久视频精品免费| 久久精品国产99精品国产亚洲性色 | 亚洲欧美精品综合一区二区三区| 国产精品99久久99久久久不卡| av免费在线观看网站| 黄网站色视频无遮挡免费观看| 欧美 日韩 精品 国产| 国产日韩欧美亚洲二区| 18禁国产床啪视频网站| 深夜精品福利| 国产免费现黄频在线看| 91av网站免费观看| 老鸭窝网址在线观看| 国产熟女午夜一区二区三区| 狂野欧美激情性xxxx| 在线播放国产精品三级| 一级毛片高清免费大全| 757午夜福利合集在线观看| 一级黄色大片毛片| 嫩草影视91久久| 日韩制服丝袜自拍偷拍| 精品亚洲成a人片在线观看| 日韩精品免费视频一区二区三区| 欧美激情极品国产一区二区三区| 啦啦啦 在线观看视频| 少妇裸体淫交视频免费看高清 | 国产精品久久视频播放| 免费不卡黄色视频| 淫妇啪啪啪对白视频| 日日爽夜夜爽网站| 中文字幕精品免费在线观看视频| 天堂俺去俺来也www色官网| 国产精品久久久久成人av| 国产精品一区二区精品视频观看| 一二三四在线观看免费中文在| 国产亚洲精品久久久久久毛片 | 亚洲av欧美aⅴ国产| 这个男人来自地球电影免费观看| 免费看十八禁软件| 久9热在线精品视频| 女警被强在线播放| 日韩一卡2卡3卡4卡2021年| 欧美一级毛片孕妇| 丰满人妻熟妇乱又伦精品不卡| 精品一区二区三区av网在线观看| 一级毛片女人18水好多| 王馨瑶露胸无遮挡在线观看| 不卡av一区二区三区| 又紧又爽又黄一区二区| 老司机靠b影院| videos熟女内射| 80岁老熟妇乱子伦牲交| 精品人妻熟女毛片av久久网站| 国产亚洲精品久久久久5区| 久久精品91无色码中文字幕| 一级作爱视频免费观看| 性少妇av在线| 国产激情久久老熟女| xxx96com| 热re99久久国产66热| 岛国在线观看网站| 亚洲三区欧美一区| 国产精品影院久久| 久久亚洲精品不卡| 男女免费视频国产| 一本一本久久a久久精品综合妖精| 日韩熟女老妇一区二区性免费视频| 国产伦人伦偷精品视频| 欧美日韩成人在线一区二区| 很黄的视频免费| 色尼玛亚洲综合影院| 最新在线观看一区二区三区| 伦理电影免费视频| 一级毛片精品| 欧美日韩av久久| 午夜精品国产一区二区电影| 亚洲美女黄片视频| 人人妻人人爽人人添夜夜欢视频| 国产有黄有色有爽视频| 欧美日韩成人在线一区二区| 极品人妻少妇av视频| 欧美中文综合在线视频| 国产成人免费无遮挡视频| 亚洲va日本ⅴa欧美va伊人久久| 国产99白浆流出| 免费黄频网站在线观看国产| 热99久久久久精品小说推荐| 精品久久久久久久毛片微露脸| 色精品久久人妻99蜜桃| bbb黄色大片| 多毛熟女@视频| 一级毛片精品| 国产精品免费视频内射| 亚洲伊人色综图| 精品乱码久久久久久99久播| 俄罗斯特黄特色一大片| 又大又爽又粗| 看免费av毛片| 又黄又爽又免费观看的视频| 老司机靠b影院| 国产一卡二卡三卡精品| 亚洲精品自拍成人| 操美女的视频在线观看| 国产精品一区二区免费欧美| 韩国av一区二区三区四区| 女性被躁到高潮视频| 无遮挡黄片免费观看| 黄频高清免费视频| 国产97色在线日韩免费| 一级a爱视频在线免费观看| 一二三四社区在线视频社区8| 别揉我奶头~嗯~啊~动态视频| 丰满迷人的少妇在线观看| av不卡在线播放| 国产日韩欧美亚洲二区| 免费高清在线观看日韩| 国产精品美女特级片免费视频播放器 | 国产一区二区三区在线臀色熟女 | tocl精华| 精品一区二区三区av网在线观看| 一边摸一边做爽爽视频免费| 久热这里只有精品99| 在线观看午夜福利视频| 久久久久精品国产欧美久久久| www日本在线高清视频| 亚洲专区中文字幕在线| 国产一区二区三区综合在线观看| 天天操日日干夜夜撸| 成年女人毛片免费观看观看9 | 下体分泌物呈黄色| 婷婷成人精品国产| 国产精品久久久人人做人人爽| 夜夜爽天天搞| 99久久精品国产亚洲精品| 国产精品电影一区二区三区 | 亚洲一码二码三码区别大吗| 国产精品偷伦视频观看了| www.精华液| 久久精品亚洲精品国产色婷小说| 国产精品久久久久久精品古装| 精品视频人人做人人爽| 午夜福利在线免费观看网站| 国产欧美日韩一区二区精品| 国产亚洲欧美精品永久| 在线观看舔阴道视频| 免费在线观看影片大全网站| 久久精品国产亚洲av香蕉五月 | 亚洲 欧美一区二区三区| 久久香蕉精品热| 国产不卡一卡二| 国产男女超爽视频在线观看| 波多野结衣一区麻豆| 成人18禁在线播放| 岛国在线观看网站| 精品亚洲成国产av| 国产精品九九99| 国产av又大| 人妻丰满熟妇av一区二区三区 | 国产成人系列免费观看| 亚洲精品粉嫩美女一区| 桃红色精品国产亚洲av| 亚洲欧洲精品一区二区精品久久久| 岛国在线观看网站| 日本欧美视频一区| 久久中文字幕一级| 极品人妻少妇av视频| 国精品久久久久久国模美| 建设人人有责人人尽责人人享有的| 久久精品国产亚洲av香蕉五月 | 色播在线永久视频| 老熟妇仑乱视频hdxx| 老汉色av国产亚洲站长工具| a在线观看视频网站| 国产精品一区二区在线不卡| 欧美成人午夜精品| 深夜精品福利| 99精品久久久久人妻精品| 人妻丰满熟妇av一区二区三区 | 国产男靠女视频免费网站| 亚洲av成人av| 欧美色视频一区免费| 精品国产乱子伦一区二区三区| 身体一侧抽搐| 90打野战视频偷拍视频| 极品人妻少妇av视频| 在线观看免费高清a一片| 免费在线观看影片大全网站| 日本黄色日本黄色录像| 免费在线观看黄色视频的| 久久 成人 亚洲| 国产精品影院久久| 男女下面插进去视频免费观看| 极品人妻少妇av视频| 一区二区三区国产精品乱码| av天堂在线播放| 一夜夜www| www.精华液| 国产无遮挡羞羞视频在线观看| 成人亚洲精品一区在线观看| 日本wwww免费看| 一级毛片高清免费大全| 国产xxxxx性猛交| 交换朋友夫妻互换小说| 国产成人欧美在线观看 | 午夜福利,免费看| 青草久久国产| 久久热在线av| 亚洲成人免费电影在线观看| 欧美黄色片欧美黄色片| 国产成人av教育| 美女福利国产在线| 女人高潮潮喷娇喘18禁视频| 天堂中文最新版在线下载| 国内毛片毛片毛片毛片毛片| 中文字幕人妻熟女乱码| 亚洲国产欧美网| 日韩 欧美 亚洲 中文字幕| 国产精品成人在线| 真人做人爱边吃奶动态| 91成人精品电影| 最近最新中文字幕大全免费视频| 久久久国产成人精品二区 | 国内久久婷婷六月综合欲色啪| 亚洲成人免费电影在线观看| 亚洲精品美女久久av网站| 自拍欧美九色日韩亚洲蝌蚪91| 一级黄色大片毛片| 国产精品二区激情视频| 国产色视频综合| 50天的宝宝边吃奶边哭怎么回事| 中文字幕制服av| 久久中文字幕人妻熟女| 亚洲一区高清亚洲精品| 97人妻天天添夜夜摸| 在线免费观看的www视频| 香蕉国产在线看| 色婷婷久久久亚洲欧美| 99精品欧美一区二区三区四区| 亚洲人成电影免费在线| 中文字幕精品免费在线观看视频| av在线播放免费不卡| 高清毛片免费观看视频网站 | 午夜福利在线观看吧| 国产精品欧美亚洲77777| 妹子高潮喷水视频| 亚洲精品国产精品久久久不卡| 99热网站在线观看| 国产精品国产高清国产av | 久久精品国产99精品国产亚洲性色 | 免费观看精品视频网站| 成人国产一区最新在线观看| 欧美日韩乱码在线| √禁漫天堂资源中文www| 精品国产超薄肉色丝袜足j| 国产精品九九99| 久久久久视频综合| 亚洲专区国产一区二区| 亚洲熟妇中文字幕五十中出 | 久久久国产成人免费| 午夜日韩欧美国产| 巨乳人妻的诱惑在线观看| 国产成人影院久久av| 中文字幕精品免费在线观看视频| 亚洲av美国av| 18禁裸乳无遮挡动漫免费视频| 国产精品免费视频内射| 五月开心婷婷网| 精品久久蜜臀av无| 亚洲国产欧美网| 亚洲伊人色综图| 亚洲黑人精品在线| 久久久久视频综合| 国产日韩一区二区三区精品不卡| 国产深夜福利视频在线观看| 最近最新中文字幕大全免费视频| 男女高潮啪啪啪动态图| 久久精品国产a三级三级三级| 这个男人来自地球电影免费观看| 亚洲精品国产色婷婷电影| 亚洲全国av大片| 午夜亚洲福利在线播放| 国产日韩一区二区三区精品不卡| 最近最新中文字幕大全免费视频| 黄频高清免费视频| 美女扒开内裤让男人捅视频| 91字幕亚洲| 亚洲一区二区三区欧美精品| 精品久久久精品久久久| 人妻一区二区av| 高清av免费在线| 成人av一区二区三区在线看| 欧美在线一区亚洲| 王馨瑶露胸无遮挡在线观看| 久久精品aⅴ一区二区三区四区| 国产精品久久视频播放| 正在播放国产对白刺激| 黄网站色视频无遮挡免费观看| 亚洲男人天堂网一区| 波多野结衣一区麻豆| 色婷婷久久久亚洲欧美| www.999成人在线观看| 精品国产一区二区久久| 美女国产高潮福利片在线看| 日本精品一区二区三区蜜桃| 中文字幕色久视频| 日本黄色视频三级网站网址 | 99久久综合精品五月天人人| 少妇粗大呻吟视频| 69av精品久久久久久| 人人妻人人添人人爽欧美一区卜| 亚洲国产看品久久| 亚洲五月婷婷丁香| 中文字幕高清在线视频| 欧美黑人精品巨大| 日韩一卡2卡3卡4卡2021年| 国产精品亚洲一级av第二区| 久久精品人人爽人人爽视色| 国产精品久久电影中文字幕 | 精品乱码久久久久久99久播| 精品一区二区三区四区五区乱码| 9热在线视频观看99| 女人久久www免费人成看片| 老司机午夜福利在线观看视频| 欧美亚洲日本最大视频资源| 精品国产乱码久久久久久男人| svipshipincom国产片| 嫩草影视91久久| a在线观看视频网站| 50天的宝宝边吃奶边哭怎么回事| 一二三四在线观看免费中文在| 叶爱在线成人免费视频播放| 最新美女视频免费是黄的| 亚洲少妇的诱惑av| 如日韩欧美国产精品一区二区三区| 午夜福利影视在线免费观看| 日本精品一区二区三区蜜桃| 亚洲一区高清亚洲精品| 成人av一区二区三区在线看| 亚洲黑人精品在线| 久久国产亚洲av麻豆专区| 日韩欧美一区二区三区在线观看 | 国产精品一区二区免费欧美| 一级a爱片免费观看的视频| 制服诱惑二区| 亚洲精品一卡2卡三卡4卡5卡| 国产av精品麻豆| 精品高清国产在线一区| avwww免费| 亚洲国产中文字幕在线视频| 老熟女久久久| 香蕉国产在线看| 久热爱精品视频在线9| 久久人妻熟女aⅴ| 亚洲色图综合在线观看| 亚洲视频免费观看视频| 在线av久久热| 99久久人妻综合| 69精品国产乱码久久久| 国产精品久久久久久精品古装| 成年人黄色毛片网站| 亚洲精品国产区一区二| 亚洲av欧美aⅴ国产| 亚洲一区二区三区不卡视频| 亚洲精品美女久久久久99蜜臀| 国产片内射在线| 在线观看一区二区三区激情| 国产麻豆69| 亚洲精品在线美女| 母亲3免费完整高清在线观看| 亚洲国产欧美网| 亚洲男人天堂网一区| 法律面前人人平等表现在哪些方面| 精品人妻1区二区| 欧美日韩福利视频一区二区| 国产精品免费视频内射| 一夜夜www| 精品高清国产在线一区| 国产欧美日韩精品亚洲av| 亚洲国产中文字幕在线视频| 天天躁狠狠躁夜夜躁狠狠躁| 国产欧美日韩综合在线一区二区| 久久香蕉精品热| 亚洲黑人精品在线| 不卡av一区二区三区| 亚洲av日韩精品久久久久久密| xxx96com| 两个人免费观看高清视频| 亚洲第一欧美日韩一区二区三区| 18禁观看日本| 大香蕉久久成人网| 久久国产精品影院| 69av精品久久久久久| 两性午夜刺激爽爽歪歪视频在线观看 | 狠狠狠狠99中文字幕| 亚洲专区字幕在线| 老司机影院毛片| 国精品久久久久久国模美| 黄片小视频在线播放| 国产精品永久免费网站| 国产淫语在线视频| 人妻久久中文字幕网| 亚洲国产毛片av蜜桃av| 久久这里只有精品19| 成人av一区二区三区在线看| 在线观看免费日韩欧美大片| 亚洲五月色婷婷综合| 亚洲精华国产精华精| 亚洲五月色婷婷综合| 母亲3免费完整高清在线观看| 不卡av一区二区三区| 亚洲av日韩精品久久久久久密| svipshipincom国产片| 久久狼人影院| 亚洲精品乱久久久久久| videos熟女内射| 精品久久久久久电影网| 日韩欧美国产一区二区入口| 精品熟女少妇八av免费久了| 999精品在线视频| 在线观看免费日韩欧美大片| 国产亚洲精品久久久久久毛片 | 久久精品亚洲精品国产色婷小说| 免费高清在线观看日韩| 男男h啪啪无遮挡| 大陆偷拍与自拍| 亚洲国产欧美网| 午夜福利在线免费观看网站| 精品国内亚洲2022精品成人 | 性色av乱码一区二区三区2| 欧美人与性动交α欧美软件| 叶爱在线成人免费视频播放| 老司机深夜福利视频在线观看| 欧美激情高清一区二区三区| 国产成+人综合+亚洲专区| 国产亚洲精品久久久久5区| 欧美日韩国产mv在线观看视频| 极品教师在线免费播放| 一本综合久久免费| 日韩欧美免费精品| 亚洲va日本ⅴa欧美va伊人久久| 少妇裸体淫交视频免费看高清 | tube8黄色片| 久久精品国产99精品国产亚洲性色 | ponron亚洲| 欧美日韩福利视频一区二区| 成人国产一区最新在线观看| 三级毛片av免费| 久久久国产欧美日韩av| 老司机午夜福利在线观看视频| 国产淫语在线视频| 法律面前人人平等表现在哪些方面| 久久精品国产亚洲av香蕉五月 |