欧美成人午夜精品久久久,国产?V天堂一区二区三区,欧美精品va在线观看,亚洲一区二区三区免费在线观看,av无码精品一区二区久久,欧美性爱视频不卡一区三区,欧美乱人伦视频在线观看,国产一级牲交高潮

ARTICLE DETAIL

資訊詳情

深耕商務(wù)建站與企業(yè)官網(wǎng)運(yùn)營(yíng)的一線實(shí)戰(zhàn)洞察。

基于DW1000芯片的雙邊測(cè)距(TW-TOF)原理與工程實(shí)踐詳解

基于DW1000芯片的雙邊測(cè)距(TW-TOF)原理與工程實(shí)踐詳解 1. 項(xiàng)目概述從芯片到厘米級(jí)精度的距離測(cè)量在物聯(lián)網(wǎng)、機(jī)器人定位和工業(yè)自動(dòng)化領(lǐng)域精確的距離測(cè)量一直是個(gè)核心需求。傳統(tǒng)的方案如GPS在室內(nèi)會(huì)失效Wi-Fi或藍(lán)牙的RSSI接收信號(hào)強(qiáng)度指示精度又太差通常在米級(jí)甚至十米級(jí)。這時(shí)基于超寬帶UWB技術(shù)的Decawave DW1000芯片就成了一張王牌。我接觸這個(gè)芯片有好幾年了從最早的評(píng)估板到后來(lái)的量產(chǎn)項(xiàng)目踩過(guò)不少坑也積累了一些心得。今天要聊的“雙邊測(cè)距”就是利用DW1000實(shí)現(xiàn)兩個(gè)設(shè)備間高精度距離測(cè)量的核心方法它本質(zhì)上是一種雙向飛行時(shí)間Two-Way Time-of-Flight, TW-TOF測(cè)距。簡(jiǎn)單來(lái)說(shuō)雙邊測(cè)距就是讓兩個(gè)設(shè)備我們稱為設(shè)備A和設(shè)備B像對(duì)話一樣通過(guò)精確測(cè)量無(wú)線電信號(hào)在它們之間“跑一個(gè)來(lái)回”所花的時(shí)間來(lái)計(jì)算出兩者間的直線距離。這個(gè)方法最大的好處是它不需要兩個(gè)設(shè)備擁有高度同步的時(shí)鐘對(duì)時(shí)鐘精度的要求大大降低非常適合低成本、分布式的節(jié)點(diǎn)部署。想象一下你要在一個(gè)倉(cāng)庫(kù)里部署幾十個(gè)定位標(biāo)簽和基站如果每個(gè)都要配一個(gè)原子鐘來(lái)保持時(shí)間同步那成本和復(fù)雜度就上天了。雙邊測(cè)距巧妙地避開了這個(gè)問(wèn)題。DW1000芯片是實(shí)現(xiàn)這一技術(shù)的硬件基石。它工作在3.5GHz到6.5GHz的UWB頻段發(fā)射的信號(hào)脈沖極窄約2納秒這帶來(lái)了兩大優(yōu)勢(shì)極高的時(shí)間分辨率和強(qiáng)大的抗多徑干擾能力。高時(shí)間分辨率意味著它能非常精確地“掐表”計(jì)算信號(hào)傳播時(shí)間抗多徑能力強(qiáng)則保證了在復(fù)雜的室內(nèi)環(huán)境中比如滿是金屬貨架的工廠測(cè)量結(jié)果依然穩(wěn)定可靠。最終實(shí)現(xiàn)的測(cè)距精度在理想條件下可以達(dá)到10厘米以內(nèi)這在很多應(yīng)用場(chǎng)景中已經(jīng)足夠用了。這篇文章我會(huì)帶你深入Decawave官方雙邊測(cè)距的原理并基于官方的驅(qū)動(dòng)和示例代碼手把手拆解其實(shí)現(xiàn)過(guò)程。無(wú)論你是正在評(píng)估UWB技術(shù)方案的工程師還是已經(jīng)上手但被一些細(xì)節(jié)困擾的開發(fā)者希望這些從實(shí)際項(xiàng)目中總結(jié)出來(lái)的內(nèi)容能幫到你。2. 雙邊測(cè)距TW-TOF核心原理深度拆解要理解代碼必須先吃透原理。雙邊測(cè)距之所以能放松對(duì)時(shí)鐘同步的要求其核心思想在于“對(duì)稱性”和“自抵消”。我們拋開復(fù)雜的數(shù)學(xué)公式用一次“對(duì)話”來(lái)模擬整個(gè)過(guò)程。2.1 一次完整的測(cè)距“對(duì)話”流程假設(shè)設(shè)備A是發(fā)起者Initiator設(shè)備B是響應(yīng)者Responder。一次標(biāo)準(zhǔn)的雙邊測(cè)距包含兩次信號(hào)傳輸和兩次響應(yīng)總共四個(gè)時(shí)間戳這就是常說(shuō)的“單次雙邊測(cè)距”Single-Sided Two-Way Ranging, SS-TWR。其步驟如下Poll詢問(wèn)設(shè)備A在本地時(shí)間T1發(fā)送一個(gè)Poll消息給設(shè)備B。這個(gè)消息就像A在問(wèn)“B你在嗎我們量一下距離吧?!盧esponse響應(yīng)設(shè)備B在本地時(shí)間T2收到了這個(gè)Poll消息。注意T2是B的本地時(shí)鐘記錄的收到時(shí)間。B處理一下然后在本地時(shí)間T3發(fā)送一個(gè)Response消息回復(fù)給A。這個(gè)消息相當(dāng)于B回答“A我在我收到你的消息了?!盕inal最終設(shè)備A在本地時(shí)間T4收到了B發(fā)來(lái)的Response消息。至此設(shè)備A掌握了四個(gè)關(guān)鍵時(shí)間點(diǎn)T1自己發(fā)、T4自己收設(shè)備B掌握了兩個(gè)T2自己收、T3自己發(fā)。注意T1和T4是在A的時(shí)鐘體系下T2和T3是在B的時(shí)鐘體系下。兩個(gè)時(shí)鐘可能存在偏差它們的頻率可能略有不同這就是時(shí)鐘漂移Clock Drift。2.2 關(guān)鍵公式推導(dǎo)與時(shí)鐘漂移的消除距離等于速度乘以時(shí)間。無(wú)線電波在空氣中的傳播速度c近似為光速~3e8 m/s。所以關(guān)鍵就是求出信號(hào)在空中的真實(shí)傳播時(shí)間Tprop。我們定義幾個(gè)時(shí)間間隔TreplyA不存在因?yàn)锳沒有“回復(fù)”動(dòng)作。TreplyB T3 - T2。這是設(shè)備B從收到消息到發(fā)出回復(fù)的“處理時(shí)間”。這個(gè)時(shí)間B自己是知道的并且需要在Response消息中攜帶給A。RTT(Round-Trip Time) 在A看來(lái)是TroundA T4 - T1。這是從A發(fā)出Poll到收到Response的總時(shí)間。那么信號(hào)從A到B的飛行時(shí)間Tprop加上B的處理時(shí)間TreplyB再加上信號(hào)從B回到A的飛行時(shí)間Tprop應(yīng)該等于A測(cè)到的總時(shí)間TroundA。即TroundA Tprop TreplyB Tprop 2 * Tprop TreplyB因此傳播時(shí)間Tprop (TroundA - TreplyB) / 2。這個(gè)公式的美妙之處在于它完全由設(shè)備A本地測(cè)量的TroundA和設(shè)備B告知的TreplyB計(jì)算得出。TroundA和TreplyB分別是在A和B各自時(shí)鐘下測(cè)量的時(shí)間間隔。只要A和B的時(shí)鐘在短時(shí)間內(nèi)是穩(wěn)定的即時(shí)鐘頻率穩(wěn)定即使有固定偏差那么計(jì)算出的Tprop就是準(zhǔn)確的與兩個(gè)時(shí)鐘之間的絕對(duì)偏差無(wú)關(guān)。時(shí)鐘偏差在作差(TroundA - TreplyB)的過(guò)程中被抵消了。注意這里說(shuō)的“穩(wěn)定”是指在一次測(cè)距對(duì)話的毫秒級(jí)時(shí)間內(nèi)時(shí)鐘的晶振頻率沒有劇烈變化。如果B的時(shí)鐘跑得比A快那么B測(cè)量的TreplyB實(shí)際物理時(shí)間會(huì)偏短但B告訴A的數(shù)值是基于B自己的時(shí)鐘這個(gè)“偏短”的數(shù)值被代入公式后會(huì)與A測(cè)量的“偏長(zhǎng)”的TroundA相互補(bǔ)償最終結(jié)果仍然正確。這就是“自抵消”效應(yīng)。最終距離Distance c * Tprop。2.3 官方方案的演進(jìn)從SS-TWR到DS-TWR上面介紹的SS-TWR有一個(gè)潛在問(wèn)題它假設(shè)A和B的時(shí)鐘頻率在測(cè)距期間完全一致。雖然短時(shí)間內(nèi)可以近似但如果兩個(gè)設(shè)備的晶振精度差異較大比如一個(gè)是±20ppm另一個(gè)是±40ppm或者在溫度變化下頻率漂移不同就會(huì)引入誤差。TreplyB越長(zhǎng)這個(gè)誤差被放大的就越多。為了進(jìn)一步抑制時(shí)鐘漂移帶來(lái)的誤差Decawave官方驅(qū)動(dòng)庫(kù)中更常用的是雙邊雙邊測(cè)距Double-Sided Two-Way Ranging, DS-TWR。DS-TWR在SS-TWR的基礎(chǔ)上增加了一次“對(duì)話”形成了對(duì)稱結(jié)構(gòu)。流程簡(jiǎn)述如下A發(fā)Poll (T1) B收 (T2)。B發(fā)Response (T3) A收 (T4)。至此與SS-TWR相同A再發(fā)一個(gè)Final (T5) B收 (T6)。這樣A掌握了T1, T4, T5B掌握了T2, T3, T6。通過(guò)一個(gè)更復(fù)雜的公式通常基于三個(gè)時(shí)間間隔TroundA T4-T1,TreplayB T3-T2,TroundB T6-T3,TreplayA T5-T4可以構(gòu)建一個(gè)方程組最終求解出的Tprop對(duì)時(shí)鐘漂移的敏感度比SS-TWR低一個(gè)數(shù)量級(jí)。官方示例代碼examples\twr_ss和examples\twr_ds就分別實(shí)現(xiàn)了這兩種方法。對(duì)于高精度要求場(chǎng)景強(qiáng)烈建議使用DS-TWR。3. 基于DW1000的代碼實(shí)現(xiàn)框架解析理解了原理我們來(lái)看代碼怎么把它變成現(xiàn)實(shí)。Decawave提供了基于STM32的官方驅(qū)動(dòng)庫(kù)decadriver和一系列示例工程。這些代碼結(jié)構(gòu)清晰但初看可能有些龐雜。我們以最核心的DS-TWR為例拆解其實(shí)現(xiàn)框架。3.1 硬件與軟件基礎(chǔ)準(zhǔn)備硬件上你需要至少兩塊搭載DW1000芯片的開發(fā)板比如基于STM32的官方EVB1000或更常見的開源模塊如DWM1000。確保天線連接良好供電穩(wěn)定。軟件上你需要獲取Decawave的官方軟件包里面包含decadriver/底層硬件抽象層HAL和DW1000寄存器操作驅(qū)動(dòng)。examples/各種示例工程包括twr_ss,twr_ds,ss_twr_initiator,ss_twr_responder等。platform/針對(duì)特定MCU如STM32的移植層代碼。我通常的做法是直接使用examples\twr_ds作為起點(diǎn)。這個(gè)工程已經(jīng)配置好了兩個(gè)角色I(xiàn)nitiator和Responder的代碼通過(guò)編譯宏來(lái)切換。你需要為兩塊板子分別編譯不同角色的固件。3.2 程序狀態(tài)機(jī)與主循環(huán)設(shè)計(jì)UWB通信是事件驅(qū)動(dòng)的不能簡(jiǎn)單用輪詢。官方示例采用了一個(gè)經(jīng)典的狀態(tài)機(jī)State Machine模型來(lái)控制測(cè)距流程。以Initiator為例其主循環(huán)和狀態(tài)遷移大致如下// 偽代碼示意流程 int main(void) { dwt_initialise(); // 初始化DW1000 dwt_configure(); // 配置信道、速率、脈沖重復(fù)頻率等 while(1) { switch(current_state) { case STATE_IDLE: // 等待用戶觸發(fā)或定時(shí)觸發(fā) if (start_ranging_requested) { prepare_poll_message(); // 組裝Poll消息 dwt_writetxdata(); // 寫入發(fā)送緩沖區(qū) dwt_writetxfctrl(); // 設(shè)置發(fā)送幀控制 dwt_starttx(DWT_START_TX_IMMEDIATE); // 立即發(fā)送記錄T1 current_state STATE_WAIT_FOR_RESPONSE; } break; case STATE_WAIT_FOR_RESPONSE: // 等待接收Response if (rx_event_detected) { dwt_readrxdata(); // 讀取數(shù)據(jù) if (is_valid_response_message()) { record_T4(); // 從RX時(shí)間戳記錄T4 prepare_final_message(); // 組裝Final消息 // ... 發(fā)送Final記錄T5 current_state STATE_WAIT_FOR_REPORT; } } if (timeout) { current_state STATE_IDLE; // 超時(shí)復(fù)位 } break; case STATE_WAIT_FOR_REPORT: // DS-TWR中Initiator計(jì)算距離 // 實(shí)際上在發(fā)送Final后本次測(cè)距的主要任務(wù)已完成。 // 這里可以計(jì)算距離或者等待一個(gè)延遲后進(jìn)入下一次測(cè)距。 calculate_distance(); // 使用T1, T4, T5以及從Response中解析出的T2, T3 current_state STATE_IDLE; break; } // 處理DW1000中斷標(biāo)志位 process_dw1000_irq(); } }Responder的代碼是對(duì)稱的狀態(tài)包括STATE_WAIT_FOR_POLL,STATE_SEND_RESPONSE,STATE_WAIT_FOR_FINAL等。這里的關(guān)鍵點(diǎn)在于時(shí)間戳的獲取。DW1000在發(fā)送或接收完一幀數(shù)據(jù)的物理層前導(dǎo)碼Preamble結(jié)束時(shí)會(huì)自動(dòng)將一個(gè)64位的高精度時(shí)間戳約15.65ps分辨率寫入寄存器。代碼中通過(guò)dwt_readtxtimestamp()和dwt_readrxtimestamp()來(lái)讀取T1/T5和T4對(duì)于Initiator。T2/T6和T3則由Responder讀取并通過(guò)消息內(nèi)容傳遞給Initiator。3.3 消息幀格式設(shè)計(jì)與關(guān)鍵信息傳遞設(shè)備間需要交換哪些信息才能完成計(jì)算這需要定義一個(gè)簡(jiǎn)單的應(yīng)用層幀格式。官方示例中使用了一個(gè)簡(jiǎn)單的結(jié)構(gòu)typedef struct { uint8_t frameCtrl[2]; // 幀控制 uint8_t seqNum; // 序列號(hào)用于匹配一次對(duì)話 uint8_t pollMsg[4]; // 或 respMsg/finalMsg用于標(biāo)識(shí)消息類型 uint8_t sourceAddr[2]; // 源地址 uint8_t destAddr[2]; // 目標(biāo)地址 uint8_t payload[0]; // 可變長(zhǎng)負(fù)載 } msg_frame_t;對(duì)于雙邊測(cè)距負(fù)載Payload里必須攜帶關(guān)鍵的時(shí)間信息Poll消息通常只需標(biāo)識(shí)自己是Poll。Response消息這是最關(guān)鍵的一環(huán)。它必須包含Responder測(cè)得的T2收到Poll的時(shí)間和T3發(fā)送Response的時(shí)間。這樣Initiator收到后才能獲得T2和T3。Final消息在DS-TWR中Final消息需要包含Initiator測(cè)得的T4收到Response的時(shí)間和T5發(fā)送Final的時(shí)間。這樣Responder在收到Final后也能獨(dú)立計(jì)算一次距離如果需要。時(shí)間戳是64位的整數(shù)傳輸時(shí)需要妥善處理字節(jié)序。通常將它們拆分為兩個(gè)32位整數(shù)進(jìn)行發(fā)送和接收。3.4 時(shí)鐘校正與時(shí)間戳處理直接從DW1000讀出的時(shí)間戳是基于其內(nèi)部系統(tǒng)時(shí)間的還需要兩步處理才能用于計(jì)算天線延遲補(bǔ)償Antenna Delay信號(hào)在芯片內(nèi)部到達(dá)天線端口以及從天線端口進(jìn)入芯片接收通路都存在固定的硬件延遲。這個(gè)延遲需要預(yù)先校準(zhǔn)并寫入DW1000的TX_ANTD和RX_ANTD寄存器。DW1000會(huì)在生成時(shí)間戳?xí)r自動(dòng)加上對(duì)于TX或減去對(duì)于RX這個(gè)延遲值。如果這個(gè)值設(shè)置不準(zhǔn)會(huì)帶來(lái)固定的距離偏差。官方提供校準(zhǔn)程序務(wù)必為每塊板子單獨(dú)校準(zhǔn)并寫入這個(gè)值。時(shí)間戳單位轉(zhuǎn)換DW1000的時(shí)間戳單位是“設(shè)備時(shí)間單位”約等于~15.65ps。計(jì)算時(shí)需要將其轉(zhuǎn)換為標(biāo)準(zhǔn)秒。time_s timestamp * TIME_RES * 1e-12其中TIME_RES是時(shí)間分辨率常量如DWT_TIME_UNITS定義為1.0/499.2e6/128.0秒約15.65ps。在代碼中計(jì)算時(shí)間間隔時(shí)還需要注意64位整數(shù)的溢出處理。DW1000的時(shí)鐘約每17秒溢出一次做減法時(shí)需要判斷。4. 核心代碼模塊逐行解讀與實(shí)操讓我們深入到幾個(gè)最核心的函數(shù)看看具體是如何實(shí)現(xiàn)的。我將基于twr_ds示例中的Initiator角色代碼進(jìn)行講解。4.1 DW1000初始化與信道配置這是所有操作的基礎(chǔ)配置錯(cuò)誤會(huì)導(dǎo)致無(wú)法通信或精度極差。void dwt_configure(int config) { // 1. 軟復(fù)位DW1000 dwt_softreset(); // 2. 等待芯片喚醒并加載OTP內(nèi)存 sleep(2); // 3. 讀取設(shè)備ID確認(rèn)通信正常 dwt_readdevid(); // 4. 配置初始化參數(shù)結(jié)構(gòu)體 dwt_config_t config { .chan 5, // 信道5 (中心頻率6489.6 MHz) .txPreambLength DWT_PLEN_128, // 前導(dǎo)碼長(zhǎng)度越長(zhǎng)測(cè)距能力越強(qiáng)但耗時(shí)增加 .rxPAC DWT_PAC8, // 前導(dǎo)碼采集塊大小與長(zhǎng)度匹配 .txCode 9, // 前導(dǎo)碼發(fā)送碼 .rxCode 9, // 前導(dǎo)碼接收碼 .nsSFD 0, // 使用標(biāo)準(zhǔn)SFD .dataRate DWT_BR_6M8, // 數(shù)據(jù)速率 6.8 Mbps .sfdType 0, // 標(biāo)準(zhǔn)SFD .stsLength DWT_STS_LEN_64, // STS安全時(shí)間戳長(zhǎng)度用于增強(qiáng)安全性 .stsMode DWT_STS_MODE_OFF, // 本例先關(guān)閉STS .pdoaMode 0 // 關(guān)閉到達(dá)相位差用于角度測(cè)量 }; // 5. 應(yīng)用配置 if (dwt_configure(config)) { printf(Config success.\n); } // 6. 配置天線延遲必須校準(zhǔn) dwt_setrxantennadelay(RX_ANT_DLY); dwt_settxantennadelay(TX_ANT_DLY); // 7. 配置發(fā)送幀過(guò)濾例如開啟源地址過(guò)濾 dwt_enableframefilter(DWT_FF_RSVD_EN | DWT_FF_COORD_EN); }實(shí)操心得txPreambLength和rxPAC的搭配非常重要。官方有推薦組合表如PLEN_128對(duì)應(yīng)PAC8PLEN_256對(duì)應(yīng)PAC16。PAC設(shè)置過(guò)小可能導(dǎo)致接收靈敏度不足無(wú)法完成長(zhǎng)距離測(cè)距PAC設(shè)置過(guò)大會(huì)增加功耗和接收時(shí)間。在項(xiàng)目初期建議使用較長(zhǎng)的前導(dǎo)碼如PLEN_1024以確保通信穩(wěn)定優(yōu)化階段再根據(jù)實(shí)際距離調(diào)整。4.2 發(fā)送Poll消息與記錄T1這是測(cè)距對(duì)話的起點(diǎn)關(guān)鍵在于精確記錄發(fā)送瞬間的時(shí)間戳。void send_poll(void) { // 1. 組裝Poll消息幀 msg_poll.poll_msg[0] P; msg_poll.poll_msg[1] O; msg_poll.poll_msg[2] L; msg_poll.poll_msg[3] L; msg_poll.seq_num current_seq_num; // 序列號(hào)遞增 // 2. 將消息寫入DW1000發(fā)送緩沖區(qū) dwt_writetxdata(sizeof(msg_poll), (uint8_t *)msg_poll, 0); // 參數(shù)數(shù)據(jù)長(zhǎng)度數(shù)據(jù)指針緩沖區(qū)偏移量0表示從頭開始 // 3. 配置發(fā)送幀控制數(shù)據(jù)長(zhǎng)度、偏移量等 dwt_writetxfctrl(sizeof(msg_poll), 0, 0); // 4. 啟動(dòng)發(fā)送并立即返回。DWT_START_TX_IMMEDIATE表示無(wú)延遲發(fā)送。 // 發(fā)送完成后DW1000會(huì)自動(dòng)將高精度TX時(shí)間戳寫入寄存器。 dwt_starttx(DWT_START_TX_IMMEDIATE); // 5. 輪詢或等待中斷確認(rèn)發(fā)送完成 while (!(dwt_read32bitreg(SYS_STATUS_ID) SYS_STATUS_TXFRS)) { // 等待發(fā)送完成標(biāo)志位 }; // 6. 清除發(fā)送完成狀態(tài)位 dwt_write32bitreg(SYS_STATUS_ID, SYS_STATUS_TXFRS); // 7. 關(guān)鍵步驟讀取發(fā)送時(shí)間戳T1 uint64_t tx_timestamp; dwt_readtxtimestamp(tx_timestamp); // 讀取64位時(shí)間戳 poll_tx_ts tx_timestamp; // 保存到全局變量用于后續(xù)計(jì)算 printf(Poll sent. T1 %llu\n, poll_tx_ts); }注意事項(xiàng)dwt_starttx(DWT_START_TX_IMMEDIATE)和dwt_starttx(DWT_START_TX_DELAYED)的區(qū)別很大。IMMEDIATE會(huì)在命令下達(dá)后盡可能快地發(fā)送微秒級(jí)適合實(shí)時(shí)交互。DELAYED則可以指定一個(gè)未來(lái)的系統(tǒng)時(shí)間點(diǎn)發(fā)送用于實(shí)現(xiàn)精確的時(shí)分多址TDMA調(diào)度。在簡(jiǎn)單的點(diǎn)對(duì)點(diǎn)測(cè)距中使用IMMEDIATE即可。4.3 接收Response與解析關(guān)鍵數(shù)據(jù)這是Initiator側(cè)最復(fù)雜的一步需要處理接收中斷、校驗(yàn)數(shù)據(jù)并提取出B發(fā)來(lái)的時(shí)間戳T2和T3。// 在接收中斷服務(wù)程序或主循環(huán)輪詢中 if (dwt_read32bitreg(SYS_STATUS_ID) SYS_STATUS_RXFCG) { // 1. 清除接收成功狀態(tài)位 dwt_write32bitreg(SYS_STATUS_ID, SYS_STATUS_RXFCG); // 2. 讀取接收數(shù)據(jù)長(zhǎng)度 frame_len dwt_read32bitreg(RX_FINFO_ID) RX_FINFO_RXFL_MASK; // 3. 從RX緩沖區(qū)讀取數(shù)據(jù)到本地結(jié)構(gòu)體 dwt_readrxdata(rx_buffer, frame_len, 0); // 4. 解析幀類型 msg_header_t *header (msg_header_t *)rx_buffer; if (header-message_type RESPONSE_MSG) { // 5. 關(guān)鍵步驟讀取接收時(shí)間戳T4 uint64_t rx_timestamp; dwt_readrxtimestamp(rx_timestamp); response_rx_ts rx_timestamp; // 保存T4 // 6. 解析Response消息負(fù)載獲取B發(fā)來(lái)的T2和T3 msg_response_t *resp (msg_response_t *)(rx_buffer sizeof(msg_header_t)); uint64_t poll_rx_ts_remote resp-poll_rx_ts; // 這是B測(cè)得的T2 uint64_t resp_tx_ts_remote resp-resp_tx_ts; // 這是B測(cè)得的T3 // 7. 驗(yàn)證序列號(hào)是否匹配本次對(duì)話 if (resp-seq_num current_seq_num) { // 8. 計(jì)算B的處理時(shí)間 TreplyB T3 - T2 (注意是B的時(shí)鐘體系) // 這里需要處理64位減法可能的借位問(wèn)題 treplyB resp_tx_ts_remote - poll_rx_ts_remote; // 9. 準(zhǔn)備進(jìn)入下一階段發(fā)送Final消息 prepare_and_send_final(poll_rx_ts_remote, resp_tx_ts_remote); } } // 重新使能接收準(zhǔn)備接收下一次消息 dwt_rxenable(DWT_START_RX_IMMEDIATE); }避坑技巧時(shí)間戳的字節(jié)序Endianness是個(gè)大坑。DW1000寄存器中的時(shí)間戳是小端格式Least Significant Byte first。而你在消息中傳輸這些64位整數(shù)時(shí)需要定義好網(wǎng)絡(luò)字節(jié)序通常是大端。在發(fā)送端將64位整數(shù)拆成兩個(gè)32位整數(shù)htole32()轉(zhuǎn)換后發(fā)送在接收端接收后再用le32toh()轉(zhuǎn)換回來(lái)。如果不一致得到的時(shí)間戳將是完全錯(cuò)誤的數(shù)字。4.4 距離計(jì)算與誤差處理收集齊所有時(shí)間戳后就可以進(jìn)行距離計(jì)算了。我們以DS-TWR的計(jì)算公式為例這是官方驅(qū)動(dòng)庫(kù)decadriver中推薦的方法能更好地抵消時(shí)鐘漂移。double calculate_distance_ds_twr(uint64_t T1, uint64_t T4, uint64_t T5, uint64_t T2, uint64_t T3, uint64_t T6) { // 將64位時(shí)間戳轉(zhuǎn)換為double類型的秒數(shù) double t1 T1 * DWT_TIME_UNITS; double t2 T2 * DWT_TIME_UNITS; double t3 T3 * DWT_TIME_UNITS; double t4 T4 * DWT_TIME_UNITS; double t5 T5 * DWT_TIME_UNITS; double t6 T6 * DWT_TIME_UNITS; // 計(jì)算四個(gè)時(shí)間間隔 double Tround1 t4 - t1; // A的第一次往返時(shí)間 double Treply1 t3 - t2; // B的回復(fù)時(shí)間 double Tround2 t6 - t3; // B的第二次往返時(shí)間 double Treply2 t5 - t4; // A的回復(fù)時(shí)間 // DS-TWR經(jīng)典計(jì)算公式 // 這個(gè)公式由 (Tround1 * Tround2 - Treply1 * Treply2) / (Tround1 Tround2 Treply1 Treply2) 推導(dǎo)而來(lái) // 能有效抵消時(shí)鐘頻率偏差Clock Drift的一階影響 double numerator Tround1 * Tround2 - Treply1 * Treply2; double denominator Tround1 Tround2 Treply1 Treply2; double Tprop numerator / denominator; // 計(jì)算距離 double distance Tprop * SPEED_OF_LIGHT; return distance; // 單位米 }重要提示在實(shí)際代碼中T6是Responder在收到Final后記錄的時(shí)間戳Responder需要將它通過(guò)另一條消息比如一個(gè)Report發(fā)回給Initiator或者Responder自己計(jì)算距離。在官方的twr_ds示例中為了簡(jiǎn)化有時(shí)會(huì)讓Initiator在發(fā)送Final后直接使用SS-TWR公式即(Tround1 - Treply1)/2計(jì)算一個(gè)粗略距離而DS-TWR的完整計(jì)算則由Responder完成并輸出。你需要根據(jù)你的應(yīng)用決定由誰(shuí)、在何時(shí)計(jì)算最終結(jié)果。誤差來(lái)源與處理天線延遲未校準(zhǔn)表現(xiàn)為固定的距離偏差如恒定的0.5米。必須通過(guò)校準(zhǔn)程序獲取精確值。時(shí)鐘漂移DS-TWR公式已大幅抑制但晶振的短期不穩(wěn)定性仍會(huì)引入噪聲。選擇精度更高的外部晶振如±10ppm可以改善。多徑效應(yīng)在金屬環(huán)境反射信號(hào)可能干擾主信號(hào)導(dǎo)致時(shí)間戳提取錯(cuò)誤。DW1000的前導(dǎo)碼和信道設(shè)計(jì)已優(yōu)化抗多徑但在極端環(huán)境下仍需測(cè)試。首次路徑First Path與最強(qiáng)路徑在復(fù)雜多徑下接收機(jī)可能鎖定在反射信號(hào)最強(qiáng)路徑而非直射信號(hào)首次路徑。DW1000的智能算法可以估計(jì)首次路徑功率配置相關(guān)寄存器如RX_TUNE可以優(yōu)化性能。環(huán)境因素溫度變化影響晶振頻率和天線特性。對(duì)于高精度應(yīng)用可能需要溫度補(bǔ)償算法。5. 調(diào)試技巧、常見問(wèn)題與性能優(yōu)化在實(shí)際部署中你會(huì)遇到各種各樣的問(wèn)題。下面是我從項(xiàng)目中總結(jié)的一些典型問(wèn)題和解決方法。5.1 通信鏈路建立失敗現(xiàn)象設(shè)備收不到任何消息或者只能單向通信。排查步驟檢查基礎(chǔ)配置確認(rèn)兩塊板的信道Channel、數(shù)據(jù)速率Data Rate、前導(dǎo)碼長(zhǎng)度Preamble Length和碼Code完全一致。這是最常見的錯(cuò)誤。檢查天線和電源確保天線連接牢固使用萬(wàn)用表測(cè)量DW1000的供電電壓是否穩(wěn)定典型值3.3V。電源紋波過(guò)大會(huì)導(dǎo)致芯片工作異常。降低速率和增加前導(dǎo)碼將數(shù)據(jù)速率從6.8Mbps降到110kbps前導(dǎo)碼長(zhǎng)度從128增加到1024。如果此時(shí)能通信說(shuō)明鏈路質(zhì)量不佳需要優(yōu)化天線布局或減小距離。使用示波器或邏輯分析儀探測(cè)DW1000的SPI總線確認(rèn)MCU是否正確讀寫寄存器。檢查中斷引腳是否有跳變。打印調(diào)試信息在初始化后讀取DW1000的設(shè)備IDdwt_readdevid()和系統(tǒng)狀態(tài)寄存器確認(rèn)芯片已正確喚醒并初始化。5.2 測(cè)距結(jié)果跳動(dòng)大或不準(zhǔn)確現(xiàn)象距離值穩(wěn)定但有固定偏差或者距離值無(wú)規(guī)律跳動(dòng)。排查與優(yōu)化校準(zhǔn)天線延遲這是解決固定偏差的第一步也是最重要的一步。使用官方examples\ant_delay校準(zhǔn)程序或者將兩塊板子的天線端口用已知長(zhǎng)度的同軸電纜直連測(cè)量一個(gè)固定距離下的誤差反推出天線延遲值。優(yōu)化接收配置調(diào)整dwt_configure中的rxPAC前導(dǎo)碼采集塊大小。對(duì)于長(zhǎng)前導(dǎo)碼需要更大的PAC值。調(diào)整dwt_configure中的nsSFD非標(biāo)準(zhǔn)SFD。某些環(huán)境下標(biāo)準(zhǔn)SFD可能容易誤觸發(fā)可以嘗試開啟非標(biāo)準(zhǔn)SFD并設(shè)置sfdType。調(diào)整dwt_setrxaftertxdelay()。在發(fā)送后立即切換到接收模式時(shí)需要留出一個(gè)短暫的延遲讓射頻電路穩(wěn)定。這個(gè)值需要根據(jù)硬件實(shí)測(cè)調(diào)整。啟用首次路徑檢測(cè)配置dwt_configuresleepcnt()和dwt_configuresleep()可能不直接相關(guān)重點(diǎn)是配置dwt_configuresleepcnt不應(yīng)該是dwt_configuremode。實(shí)際上對(duì)抗多徑需要配置dwt_configurepathpower()相關(guān)的寄存器但這部分較復(fù)雜。更簡(jiǎn)單的方法是使用官方examples\simple_rx或examples\simple_tx測(cè)試接收質(zhì)量觀察接收到的幀的“首次路徑功率”和“接收功率”報(bào)告值。在decadriver中可以通過(guò)dwt_readaccdata()函數(shù)讀取相關(guān)的診斷信息。多次測(cè)量取平均在軟件層面連續(xù)進(jìn)行多次DS-TWR測(cè)距如10次然后去掉最大最小值取中間值的平均可以顯著平滑結(jié)果抑制隨機(jī)誤差。檢查物理環(huán)境避免將設(shè)備放在大型金屬表面附近或強(qiáng)射頻干擾源旁。人體也會(huì)對(duì)UWB信號(hào)造成衰減和反射測(cè)試時(shí)盡量固定設(shè)備位置。5.3 增加通信魯棒性超時(shí)與重傳機(jī)制在實(shí)際應(yīng)用中無(wú)線通信可能失敗。代碼必須包含超時(shí)和重傳邏輯。// 在狀態(tài) STATE_WAIT_FOR_RESPONSE 中 uint32_t wait_start_time get_system_tick(); while(current_state STATE_WAIT_FOR_RESPONSE) { // ... 檢查接收事件 ... if (rx_event_detected) { // ... 處理接收 ... break; } // 檢查超時(shí) if ((get_system_tick() - wait_start_time) RESPONSE_TIMEOUT_MS) { printf(等待Response超時(shí)\n); current_seq_num; // 可選遞增序列號(hào)避免舊消息混淆 current_state STATE_IDLE; // 可以在這里觸發(fā)重傳Poll break; } }重傳策略簡(jiǎn)單的策略是失敗后立即重傳但這可能在信道持續(xù)阻塞時(shí)導(dǎo)致雪崩。更好的策略是指數(shù)退避Exponential Backoff即每次重傳前等待的時(shí)間加倍如100ms, 200ms, 400ms...達(dá)到最大重試次數(shù)后宣告失敗。5.4 從一對(duì)一到一對(duì)多網(wǎng)絡(luò)化擴(kuò)展思路單個(gè)Initiator對(duì)一個(gè)Responder只是基礎(chǔ)。實(shí)際定位系統(tǒng)往往需要一個(gè)基站Anchor與多個(gè)標(biāo)簽Tag通信。輪詢Polling最簡(jiǎn)單的方式?;疽来闻c每個(gè)標(biāo)簽進(jìn)行雙邊測(cè)距。缺點(diǎn)是延遲隨標(biāo)簽數(shù)量線性增加。時(shí)分多址TDMA為每個(gè)標(biāo)簽分配固定的時(shí)間片?;緩V播一個(gè)同步信標(biāo)標(biāo)簽在各自分配的時(shí)間片內(nèi)發(fā)起測(cè)距。這需要精確的時(shí)間同步可以利用DW1000的延遲發(fā)送DWT_START_TX_DELAYED功能實(shí)現(xiàn)。對(duì)稱雙邊測(cè)距Symmetric Double-Sided TWR這是DS-TWR的擴(kuò)展通過(guò)精心設(shè)計(jì)的消息序列讓一個(gè)基站能并行與多個(gè)標(biāo)簽測(cè)距效率更高。Decawave的定位系統(tǒng)DW3000及更高系列對(duì)此有更好支持。在代碼實(shí)現(xiàn)上網(wǎng)絡(luò)化需要引入設(shè)備地址過(guò)濾Frame Filtering、消息隊(duì)列、調(diào)度器以及更復(fù)雜的狀態(tài)機(jī)來(lái)管理多個(gè)并行的測(cè)距會(huì)話。最后我想分享一個(gè)最深的體會(huì)UWB雙邊測(cè)距的代碼實(shí)現(xiàn)三分在編程七分在調(diào)試和對(duì)射頻的理解。寄存器配置的一個(gè)微小差異天線擺放的一點(diǎn)變化都可能對(duì)結(jié)果產(chǎn)生巨大影響。最好的學(xué)習(xí)方式就是動(dòng)手用兩塊板子先讓最簡(jiǎn)單的Poll-Response通起來(lái)然后一步步加入時(shí)間戳傳遞、計(jì)算、誤差處理。遇到問(wèn)題時(shí)善用DW1000提供的豐富診斷寄存器如RX_FQUAL,RX_TIME等它們能告訴你信號(hào)質(zhì)量、首次路徑位置等關(guān)鍵信息。把這個(gè)過(guò)程走通你對(duì)無(wú)線測(cè)距的理解會(huì)上一個(gè)大臺(tái)階。
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
婷婷五月天无码熟女| 九九AV在线| 成人片在线免费看| 91丨九色丨白浆| 亚洲在线综合| 99这里只有免费的精品| 久久婷婷五月综合色丁香| 伊人综合婷婷| 狠狠草网| 激情丁香婷婷五月天| 五月婷婷成人w| 开心五月天激情网站| 另类视在线| 婷婷九月丁香| 婷婷五月色播天| 久久丁香九| 超碰色女人| 五月激情婷婷综合| 热久久视频99| 99热免费精品| www九九免费视频| 日韩黄色电影| 五月激情日本在线| 激情五月六月婷婷| 五月丁香六月婷婷网| 国产69久久久欧美黑人A片| 91av视频| 亚洲激情综合色站| 五月婷婷在线免费观看| 97碰在线视频| 狠狠情色| 呦呦v线| 丁香五月中文字幕久色| 亚洲操B| 91干婷婷| 中字幕视频在线永久在线观看免费| 国产干逼片| 五月天天堂久久| 久久黄色免费视频| 在线观看亚洲AV| 色五月综合| 99在线爽| 五月天激情网页| 五月天婷综合| 91干网站| 天天色爽| 大香蕉520| 婷婷色色亚洲| 亚洲五月天色| 五月婷婷导航| 91五月花丁香| 99超在线| 99热在这里只有精品| 猫咪伊人AV| 中文精品在| 五月婷婷激清网| 久草A片| 玖玖99婷婷| 婷婷色播婷婷| www99在线观看视频| 中文字幕日产A片在线看| 五月婷婷色播| 亚州色色色| 国产激情视频在线观看| 99九九中文字幕视频| 高清无码 一区 二区 三区| 色偷偷五月天| 日本在线观看aaa 99| 激情久久四色| 激情五月天综合| 久久久久激情| 欧美婷婷丁香五月| 99er久久| 综合欧美五月婷婷| 伊人超碰| 色婷五月| 久久综合五月天| 激情开心五月天婷婷基地丁香社区| a在线观看| 六月丁香中文字幕| 99色在线| 青青色com久久| 日本美女天天日天天爽| 国产这里只有精品| 丁香色五月婷婷17C| 婷婷瑟瑟五月天| 天天爽天天爽| 秋霞学生妹一二级| 超碰在线看| 久久婷婷色综合| 狠狠草狠狠草| 色婷婷av综合网| 亚洲激情无码久久| 五月天开心网| 激情丁香婷婷五月天| AV色婷婷| 九九精品综合| 九九激情综合| 青草青草久热这里只有精品| 亚洲成人免费在线| 香蕉综合在线| 激情五月图| www.五月婷婷.com| 日韩黄色网络| www.99婷婷| 狠狠九九婷婷韩| 人人摸人人射| 婷婷五月在线影院| www.激情五月天| 九九热在线视频| 五月丁香六月婷婷综合在线| 久久99热这里只有精品| 天天综合网、天天综合色| 久久激情五月婷婷| 五月天激情四射| 91大神操美女| 亚洲综合在线伊人婷| 激情婷婷丁香五月天| 中文网婷婷字幕婷| 成人综合AV| 五月丁香婷婷激情四射迷人| 91狠狠色丁香| 在线成人网址| 婷婷五月天影院| 九九热色视频| 国产亚洲精品久久久久久牛牛| 国产精品久久99| 色色色色色色色色网站| 91丨熟女丨首页| 97人人干人人操| 这里只有精品在线视频精品| 激情五月天网站| 丁香5月激情网| 丁香九月婷婷综合| 少妇人妻偷人精品无码视频新浪| 激情小说五月天中文字幕| 欧美成人精品A片免费一区99| 五月天婷亚洲综合在线嫩草网| 亚洲九区| 天天爽综合网| 9999三级片| 91精品久久久久久77777| 五月天激情四射网站| 日本婷婷在线| 99亚洲综合| 中文字幕丰满孑伦无码专区| WWW.色婷婷.COM| 丁香婷婷五月天成人| 五月天激情无码| 婷色视频| 亚洲久久激情| 五月天基地| 久久久久久久久久婷婷| 亚洲色啪| 久久在线人妻| 久久婷婷丁香| 色五月婷婷网| 婷婷丁香18| 五月婷婷熟女| 四川BBB搡BBB爽爽视频| 五月婷婷亚洲色视频| 日韩黄色电影| 丁香五月色情| 婷婷综合成人五月天| 人五月天婷婷喷水| AAA久久久| 五月丁香婷婷无码中文| 五月色亭丁香| 67194国产| 国产日批视频免费播放| 被强行糟蹋的女人A片| 99亚洲色| 久久婷婷热| 亚洲欧美在线观看| 婷婷激情五月| 丁香五月婷婷成人综合| 亚洲免费av在线| 播播网色播播| 1010日日无码| 大香蕉伊人99| 琪琪布丁香社区激情五月天| 婷婷五月天激情电影| 亚洲va日| 欧美性爱日韩性爱| 俺去也五月| 99视频这里有精品免费观看| 操操自拍| 一本色道久久综合狠狠躁一二三| 99热国产精品| 天天日日夜夜爽。| 五月丁香久久综合| 色一情一乱一乱一区9| 成年人丁香五月| 日本韩国视频在线观看社区免费的9| 99爱视频在线观看| 开心五月丁香综合久久| 91婷婷色| 玖玖婷婷五月天毛片| 色婷婷丁香| www激情网| 91精品91久久久中77777久久玖玖九九| 91中文在线| 婷婷va| 亚色网站小视频| 大香蕉人人网| 天堂久久丁香| 激情五月天综合网| 亚洲性爱电影| 婷婷五月天在线综合| 九九热99视频| 伊人久久中文网| 九九热在线视频| 五月丁香六月玩女人| 婷婷丁香五月天欧美| 色色九九五月天 | 色99视频| 精品人妻伦一二三区久| 人人操人av| 色色婷婷五月天| 7777久久亚洲中文字幕| 国产欧美熟妇另类久久久 | 色色色99韩| 久久天堂加勒比| 色伦专区97中文字幕| 另类天堂| 在线超碰91| 五月天色小说| 欧美精品999| 国产激情在线| 五月天天爽| 天天在线天天综合网色| 这里只有精品免费在线视频| 丁香婷婷九月| 亚洲AV免费国产电影| 亚洲网综合在线| 老司机伊人| 欧美性色视频| 日本五月视频| 丁香婷婷五色月| 婷婷五月天成人五月天| 色婷婷电影网| 九月影院義母在线播放| 久久伦乱| 9999三级片| 日日夜夜亚洲一区| 一级黄色片看看| 久久精品99国产精品日本| 五月丁香综合激情| 天天激情站| 日本色色网站| 五月丁香啪啪综合| 激情开心五月天婷婷基地丁香社区| 99热国产这里只有| 5月丁香婷婷| 色综合色色| 无码yw| 六月丁香啪| 五月婷精品| 狠色狠色狠色狠色狠色网| 亚洲色五月天是什么| 天天日天天色| 婷婷六月丁| 99精品在线下载| 七七九九色色| 色五月成人| 热久久999| AV伊人青草丁香六月| 日日干日日| 爱穴久久| 99热这里只有精品13| 久久久激情视频| 精品九九婷婷| va亚洲中文在线| 99热这里只有精品55| 久久激情五月网| 26uuu欧美宗合| 97精品人人A片免费看| 六月婷婷激情图片| 成人在线综合| 婷婷玖玖五月天| 天天日天天干天天插天天射| 大香蕉久久视频久久视频| 欧美va精品va老师va| 亚洲成人av在线| 99在线视频喷水| 色五月婷婷激情五月| 国产在这里只有精品| 99re久热只有精品6在线直播.com| 3p日韩网站视频| 日本三级中国三级99人妇网站| 婷婷无码视频| 99热这里只有精品国产免费| 五月丁香五月综合欧美| 婷婷丁香五月天哟啪| 97操碰视频| 婷婷六月综合基地| 亚洲99在线| 无码一级片| 久久色五月天激情小说| 日本A片一区| 丁香五月婷婷成人网| 日韩少妇内射免费播放| 久久99色色| 国产乱子轮XXX农村| 欧美综合婷婷欧美综| 色五月成人| 婷婷五月成人色综合| 99视频在线精品| 激情婷婷| 九九热最新| 丁香五月激情婷婷视频| AV九九| 人妻久久做| 久久人人看| 激情深爱综合| 99在线精品免费视频| 91免费在线视频6| 中文字幕永久在线| 欧美成人网婷婷综合在线| 最近中文字幕大全免费版在线 | 亚洲99在线视频| 色婷婷伊人激情在线观看| 久久96热| 一级七香蕉| 丁香五月激情网| 午夜成人综合| 久久六月综合| 狠狠操天天操综合| 97色精品视频 | 万月丁香狠狠爱| 99色一| 色欲AVV| 婷婷日日夜夜| 五月天综合激情网| 99久久网站| 97色色色视屏| 丁香五月玖玖| 色色色色色色色色色色色色色97| 99碰碰| 亚洲视频二区| 亚洲九九免费| 亚洲综合色激情色五月| 五月激情小说| 综合亚洲六月婷婷在线| 久久久国产精品黄毛片| 五月丁香免费看| 日韩AV在线免费观看| 久久99网站| 激情综合网络插| 亚洲色无码A片一区二区麻豆| 天天夜天天色天天| 伊人玖玖网| 五月丁香婷婷在线| 婷婷伊人激情婷婷| 丁香六月av| 中文资源在线a| 九九视频网| 51精品国自产在线| 日本色综合| 五月激情婷婷综合| 国产精品久久久久久久久久免费| 色99网站| 青青草原中文字幕| 日韩野外 无套| 在线观看亚洲AV| 九九AV| 99热在线观看| 人人摸人人干| 五月丁香婷婷激情在线视频| 九九久久污| 国产91视频| 狠狠操天天操天天操| 久久五月热| 久操大| 99久久a线观| 99热99日天天干| 99色干| 激情网 五月天| 9色免费网| 欧美久久婷婷| 婷婷亚洲五月色综合| 欧美日韩成人在线网站| 亚洲视频在线观看| 第四色五月婷婷| 99精品色色| AV网在线| 色五月婷婷大香蕉| 丁香综合伊人AV| 影音先锋 一区| 天天插天天干| 五月综合视频| a v色婷婷| 五月婷婷亚洲色图| 欧美日韩欧美| 99热免费精品| 操熟女成人网| 亚洲色9| 丁香六月天婷婷| 五月丁香啪啪| 丁香五月成人社区| www.狠狠操.con| 久久在线大香蕉| 99∨VTV| 狠狠色综合久久| 伊人婷婷青青cao| 丁香五月狠狠在线观看| 色婷婷久久| 婷婷五月深爱五月| 久热这里只有精品在线观看| 日韩久综合| 农村熟妇高潮精品A片| 五月丁香五月婷婷| 五月婷婷之激情五月| 激情婷婷久久| 色色综合网。| 综合网亚洲| 人妻久久久久久久 | 婷婷五月丁香色色| 26uuu国产| 天天色99| 毛片色五月| 99热这里只有在线播放| 成人一级片| ZpRSw| 久操热| 九九热啪啪| 国产婷婷五月天| 五月天婷基地| 97干视频| 日韩欧美成人片| 97超级碰| 超碰v| 97人人草| 大香蕉婷婷久久| 丁香婷婷色情社区成人小说| WWW.桔色成人.COM入口| 婷婷综合另类小说| 996热re视频精品视频| 97操女视频| 国产精产国品一二三在观看| 激情五月五月婷婷| 97婷婷狠狠| 色五月在线播放| 丁香五月天啪啪激情综合网| 五月丁香成人| 免费精品66| 五月天激情四射| sewuyuetingtingiii| 狠狠干.com| 五月丁香综合激情| 99热只有| 丁香五月五月婷婷| 六月丁香久久| 久热91精品| 婷婷综合激情| 丁香五月激情啪啪| www.成人婷婷综合| 色婷婷久久综合丁香五月| 啪啪干伊人婷婷| 五月激情丁香六月狠狠干| 激情九月婷婷| 久久综合爱| 五月婷婷综合久久| 久久92| www综合久久| 亚洲成人在线观看网址| av一区二区电影免费在线观看| 成人做爰黄A片免费看直播室男男 久草热8精品视频在线观看 | 久久资源综合| 99re在线免费视频| 久久婷婷五月综合色天| YW无码| 色九九九综合| 97se在线视频| 久久婷婷六月综合综合| 99性视频| 91久热| 五月天综合久久| 丁香婷婷色| 97超碰在线免费观看| 夜夜撸日日操| 丁香五月婷婷av| 99毛片| 色丁香五月| 日本一级一片免费视频 | 五月丁香婷婷中文网| 色香五月天| 五月丁香亭亭成人电影| 五月天开心色情网| 天天橾日日橾夜夜橾17| 久热播这里只有精品| 99热12| A网在线欧洲| 中文字幕婷婷五月天在线观看| 人人人操97| 欧美成人精品一区二区| 五月天综合激情网| 五月婷婷新网站| 五月丁欧美| 婷婷五月天中文字幕.| 99色精品视频| 亚洲看av的网站| 亚洲激情区| 色婷婷丁香五月综合| 婷婷丁香五月亚洲| 欧美色五月| 激情综合一| 激情综合色图| 色五月激情五月开心五月| 五月天综合在线| 少妇被躁爽到高潮无码文| 无码少妇高潮喷水A片免费| 婷婷色色网站| 色五月,婷婷大香蕉| 一本色道久久88加勒比—| 99狠狠色| 九九99视频精品| 欧美综合丁香网| 色婷婷激情五月天在线观看| 开心五月深爱五月| 五月婷婷AV| 青柠影视免费高清电视剧| 五月桃花网综合| 久草婷婷视频| 丁香六月婷婷综合| 激情纯色婷婷五月天在线不卡视频| 伊人9999| 激情五月婷| 这里有精品| 国产真人做爰视频免费| 久久色吧| 色五月综合| 婷婷丁香五月天综合AV| 五月婷婷免费视频| 99在线精品视频| 亚洲激情网| 天天做天天爽| 人人97操| se99高清无码| 五月丁香婷爱在线| 91爱啪啪| 色婷婷伊人激情在线观看| 视频在线免费观看欧洲乱码| 色色综合色视频| 五月色天五月色| 丁香久月| 欧美性生交XXXXX无码小说| 69久久久| site:901-07.com| 欧美婷婷五月| 超碰人人操人人干| 黄色视频网站在线播放| 婷婷九月亚洲| 五月天激情中文字幕| 天天操综合网| 极品少妇XXXX精品少妇偷拍| 久久精品五月| 做爱夜夜干天天操| 直接看的av| 26uuu国产| 91a片爽| 婷香五月| 久久视频这里99| 亚洲AV免费在线| 5月丁香综合图区| 一起草无码| 综合五月亭亭9| 五月天激情小说| 婷婷97狠狠成人网站| 超碰中文字幕在线| 五月天激情网图片 - 百度| 天天色亚洲| 香蕉久久国产AV一区二区| 久热伊人在91| 激情五月综合六月丁香婷婷狠狠干| 97色色色| 中国无码av| 7777激情基地| 激情丁香五月天图片| 大香蕉伊人久久| 大香蕉狠狠爱主页| 先锋资源 996| 午夜免费试看| 牛牛色av| 六月丁香综合999| 黄色成人网站在线播放| 激情内射人妻1区2区3区| 99操无码视频观看| 亚洲夜夜操| 热九九精品| 97色操| 国产裸舞福利资源在线视频| 狠狠色五月| 2050人人操免费工开爱| 丁香五月天偷拍| 婷婷 伊人 久久| 婷婷视频在线碰| 开心久久xxx色| 色五月激情网| 久久密臀婷婷| 激情综合网,五月| 伊人久久99| 日韩精品一区二区刘| 26uuu激情五月天| 色色激情五月天| 国内久久久精品99| 丁香成人色情五月天| 极品少妇高潮啪啪AV无码| 丁香五月91| 直接看的AV| 亚洲AV影片在线观看| 久久这里都是精品免费| 精品久久久999| 色吊丝中文字幕| www.minyis.com【JT】国内CDN落地页保证转化QQ2101460746 | AAA级久久久精品| 性爱先锋AV| 人人操插| 波多野结衣AV无码Porn| 日韩爱操视频| 五月天丁香久久综合| 久久久久亚洲A∨成人乱码电影| 99干日本| 综合激情肏逼网| 五月丁香婷婷成人综合网| 777米奇影视第四色| 亚洲色综合| 九九干视频| 综合超碰熟| 欧美97p| 亚洲爆乳无码精品AAA片蜜桃| 天天激情5月天亚洲| 欧日韩成人| 丁香玖玖| 激情五月婷黄版| 久超免费视频| 天天爽日日爽夜夜爽| 日本不卡高字幕在线2019| 少妇日麻屄| 欧美日韩99| 99re最新地址视频| 激情五月婷婷丁香| 亲子乱AV一区二区三区下载| 久久婷婷综合基地| 久久婷婷91| 97性视频| 99久久久久久| 亚洲综合色色| 大香蕉久久久久| 久久婷婷啪啪视频| 国产精典视频在线观看| 亚洲综合久| 五月丁香婷婷色色色| 4399亚洲视频| 色婷婷操逼| 日本在线视频www色| 亚洲综合婷婷五月| 99色色网| 91人妻色色网| 日本99热| 日在线V视频在线播放| 99热热热99精品丁香| 狠狠操狠狠狠| 操逼电影免费看| 欧美丁香五月| 人妻六月天| 色香欲综合| 色yeye欧美| 俺去也五月天| 久久婷婷国产| 久久精品性爱| 久久视频婷婷视频| 久久黄色片| 五月丁香狠狠| 六月激情网| 色玖玖综合| 婷婷在线综合| 婷婷成人五月天| 五月天另类综合网| 色五月天婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷 | 翔田千里 50岁 无码| 99精品久久| 天堂AV三级| 少妇性BBB搡BBB爽爽爽电影| 伍月婷婷六月丁香| 天堂久久大香蕉| 五月天丁香成人| 大香蕉九九| 综合久久99| 这里只有免费的精品| 婷婷六月成人| 大香蕉久久婷婷精品综合| 国产操碰| 青柠影视免费高清电视剧| 丁香五月天啪啪激情综合网| 69久热| 九九色综合网| 思思热思在线精品视频| 无码碰碰| 九九色大香蕉| 亚洲 日韩色色| 伊人九热| 欧美色色色色色色色色色色| 久久永久网址| 婷婷色五月91啪啪| 日日操夜夜爽| 久久精品色| 日韩一级一片内射视频4K| 亚洲免费婷婷| 超碰在线91| 91av传媒高清在线视频网| 综合五月网| 久9精品视频| 亚洲成人综合在线| 色婷婷色婷婷五月| 99久热在线精品| .精品久久久麻豆国产精品| 色色色色色色色色色色色色色色,网站| 综合九九中文字幕| 色综合伊人网| 欧美日韩AAA| 男人的天堂五月丁香| 综合久| 色婷视频| 久久er视频6| 丁香六月婷婷操逼网| 超碰日日操| 亚洲综合网激情小说| 婷婷中文字暮| 天天色天天| 精品草原久久视频| 五月丁香六月婷| 先锋影音av色五月天资源站| 97五月久久丁香婷婷| 蜜臀av无码久久久久久久久| 激情五月天色色色| 色情五月综合婷婷| 色五月婷婷很很操| 激情五月天噢美| 色婷婷第四色| 丁香五月婷婷基地| 国产色色视频| 深夜婷婷五月丁香| 色色九九五月天| 九九热精品视频在线观看| 五月天国产| 亚洲avjiujiur91| 天色综合网| 在线日韩视频| 99这里只有精品| 丁香五月骚喷水视频| 婷婷成人AV| 国产成人AV不卡| 五月丁香好婷婷A片网| 啪啪激情网站| 中文字幕丰满孑伦无码专区| 日韩人妻无码精品| 丁香婷婷伊人| 午夜丁香丁香婷婷| www.99久久久久99| 久久在线视频免费观看| 色婷婷欧美| Www.激情| 婷婷丁香成人在线视频| 九九综合色综合| 久久九九思思| 91操人| 伊人久久大香蕉网| 夜夜骑天天玩天天日| 青草网在线观看| 婷婷色偷拍| 成人国产欧美大片一区| 超碰人人超碰| 亚洲欧美一区二区三区爱爱动图| 国产夫妻操逼内射视频| 五月丁香婷婷综合视频| 日韩在线视频9色| 五月天激情国产综合婷婷婷| 伊人婷婷色| 婷婷伊人久久综合| 97五月天婷婷午夜| 九九综合伊人| 色五月大香蕉婷婷| 久久综合五月天激情小说网站| 国产亚洲99久久精品| 五月天亚洲综合网| 婷婷丁香激情| 色五月婷婷成人视频| 超碰在线人人| 成人在线网站| 日韩三级视频一区二区| 亚洲V国产V欧美V久久久久久| 久碰视频| 强伦轩人妻一区二区电影| 婷婷五月天激情网站| 丁香五月狠狠综合欧美| 国产VA播放| 五月丁香婷婷综合久久| 五月丁香六月婷婷的女人| 婷婷丁香综合网| 六月丁香网| 婷婷五月色天| 九九综合九九| WWW.桔色成人.COM| 无码人妻一区二区三区免费九色| 99这里只有免费的精品| 久久婷婷五月综合伊人| 欧美成人日韩| 婷婷日本色| 国产亚洲AV人片在线| 99热只有| 五月婷婷六月丁香| 五月激情婷婷丁香| 级情九色| 色色丁香婷婷| 日韩在线视频中文字幕| 久久99精品久久久久久三级| 婷婷五月色天| 色婷婷成人五月| 婷婷五月天天aV| 丁香五月亚洲综合| 久久伊人日日夜夜| 亚洲天堂AV免费片| 99热无码精品| 成人操呦av| 九九热视频精品2| 丁香色色网| 久久九九爽| 五月丁香久久网| 久婷婷五月天影院| 一级二级色大片| 亚洲99在线| 一起草aV| 97碰碰视频| 九九 激情 网| 五月天基地| 大香人妻| 日韩美女羞羞网站在线观看| 色综合久久综合| 四射综合网| 婷婷终合色图| 六月丁香六月婷婷欧美| 天天综合 99久久婷婷| 色老久久| 九九九九综合| 丁香五月亚洲激情婷婷射| 久久狠狠欧美| 3pAV| 婷婷五月天亚洲色| 99热这里只有精品50| 亚州AV超碰人人操| 婷婷六月激情综合| 色婷婷亚洲六月婷婷中文字幕| 九九热在线视频观看| 这里有精品2| 99热首页| 黄色成人网站在线播放| 九月婷婷久久| 激情小说五月天| 婷婷伊人五月天| 久久9热综合| 97热精品| 丁香五月天色| 天天影视色综合网| 狠狠操狠狠操| 国产操碰| 97精品综合久久| 欧洲电影在线观看免费版英语版| 曰韩五月丁香色婷婷无码| 色婷婷丁香AV综合| 99热碰碰| 亚洲1区| 亚州激情在线视频| site:feetmall.com| 色五月天成人| 99九九99九九九视频精彩| 99热综合网| 一本色综合色| 欧美 日韩 成人| 久久香蕉网| 五月天综合区| 九九在线精品| 婷婷伊人五月天| 97caop| 任你日热视频| 伊人春天av| 米奇影视五月天| 国产97色在线 | 日韩| 五月激情在线| 欧美三级视频| 激情五月综合网最新| 狠狠操天天操综合| 色婷婷狠狠| 亚洲色五月天| 亚洲日本三级片| 嫩模aV在线| 亚洲色情激情丁香五月| 亚洲色频| 99热精品在线| 久久五月婷综合网| 五月色综合| 久久久精品人妻录| 在线99热| 人人肏逼视频在线一区二区| 人伦30P| 丁香五月网| 69色婷婷| 欧美人与性动交CCOO| 中文字幕亚洲-区久久99婷婷| 这里有精品99| 99热99热在线| 五月天综合色| 久久六月综合| A一级操| 天天干,夜夜爽| 99在线精品免费视频| 成人免费高清在线播放| 精品国产va久久久久久久| 婷婷五月在线观看| 亚洲乱码日产精品BD| 欧美激情中文字幕| 婷婷五月天色网久| 日良久久| 婷婷五月天av小说| 色噜噜狠狠色综合AV兰草影视| 亚洲亚洲永久无码777777| 五月丁香综合在线| 丁香六月成人网| 色色色色色色色综合| 日本天天操| 亚洲精品第一色色色色色色| 欧美久久婷婷| 亚洲天码视频www蛋播视频| 亚洲激情另类| 激情五月份婷婷| 婷婷五月天亚洲激情戏精品| 欧美熟女99| 婷婷综合久久综合| 天天搞夜夜六| 免费看欧美成人A片无码| 亚洲乱码日产精品BD| 一逼色综合| 欧美色色网| 少妇人妻丰满做爰XXX| 久久激情五月婷婷| 婷婷丁香五月亚洲| 久久小说| 丁香色婷婷| 99久在线精品99re8热| 五月婷婷影院| 另类激情综合| 永久精品| 丁香五月之久操视频| 丁香色五月婷婷17C| 国产精品美女| 午夜成人av在线| 天天爽夜夜爽夜夜爽精| 久久在这里99| 国产亚洲成AV人片在线| 狠狠色狠狠色综合日日91| www婷婷| 猫咪伊人久久| 天天干天干| 激情5月婷婷| 亚洲激情 久久| 色五月综合激情| 久热久操久热久草国产91| 日日做夜夜爱| 国产精品久久久久久久久久| 天天狠狠婷婷在线| 激情综合在线观看| 天天艹| 亚洲精品五月| 农村熟妇高潮精品A片| 婷婷99狠狠| 久青操| 第1影院之五月婷婷| 怡红院精品视频久久久久久久久| 99精品无码| 色性综合| 婷婷五月电影院| 99热天堂| 色亭亭五月天丁香综合AV - 百度 - 百度| 春色激情| 五月天色官网| 99久热| 99视频色在线观看| 激情四射五月天| 亚州操操| 任你搞网站| 丁香五月123| 久久久久久久合一狠狠做深爱| 亚洲 在线 另类| 激情五月综合色婷婷| 超碰成人免费| 99热这里只有精品268| 久久久久久久久久8888| www99在线观看视频| 色五月婷婷一二| 综合久久综合五月天婷婷| 五月婷婷九| 成人在线二区| 欧洲亚洲欧洲99久久| 人妻丰满精品一区二区A片| 五月天婷亚洲天综合网综合| 51国精产品自偷自偷综合| 另类小说五月天| 99在线精品观看99| 大香蕉综合| 香蕉久久国产AV一区二区| 日本啪啪天堂| 五月婷中文字幕| 伊久久婷婷| 久久人操| 五月丁香综合啪啪| 欧美色色色| 热中文字幕| 亚洲情欲| 99久久66| 五月丁香色婷婷| 婷婷免费成人视频| 国产成人精品亚洲线观看| 五月天婷婷久色| 色日本颜射| 五月涩涩网| WWW.HENHENL.| 色五月综合在线| 97久久久免费福利网址| 五月丁香影视| 大香av| 色色免费网站| 婷婷导航| 婷婷五月天在线观看| 国产日批视频| 日本精品人妻无码77777| 五月丁香六月情婷婷久久| 天天插操| 激情五月六月婷婷| 免费人人操| 激情综合网五月丁香| 中文字幕在线资源| 丁香五月天激情综合| 免费精品66| 2025神马午夜福利| 婷婷激情五月色综合| 久久国产高清| 超碰人人超碰| 丁香婷婷精品视频| 精品香蕉99久久久久网站| 密桃激情五月天综合网| 色丁香五月婷婷综合久久| 婷婷99狠狠| 91热在线| 五月天开心网| 丁香激激情网| 五月天久久激情| 97久久草草超级碰碰碰| 亚洲色色色色色| 欧美精品在线观看| 四色AVwww| 日本九九视频| 五月天综合色| 99久久成人| 日本9区视频| 97干网站| 综合激情网五月激情| 亚洲在线操| 伍月婷丁香婷| 久久九九99视频| 久久性爱视频| 俺来也综合网精品一区| 国产毛片精品一区二区色欲黄A片| 这里只有精品免费观看网占| 五月丁香激情综合六月涩涩爱| 99热精品无码| 亚洲精品性色| 婷婷综合色网| 性爱久久| 成人精品99| 啪啪 综合网| 99热官网| 这里只有精品免费观看网占| 婷婷情色五月天| 亚洲无码99| 婷婷五月天黄色小说| 在线网黄| 做爰丰满少妇1313| 五月婷婷之综合激情| 中文字幕视频在线播放| 亚洲V国产V欧美V久久久久久| 桔色成人在线| 国产激情综合五月久久| 成人免费黄色短视频| 亚洲人成色A777777在线观看| 丁香五月婷婷久久综合激情网| 五月丁香久久综合91| A1片久久久| 丁香久色| 99草视频在线观看| 成人短视频在线观看| 天干夜夜操| 欧美99| 久久日婷婷| 日本欧美在线| 操你av| 五月丁香婷婷在线| 五月婷婷影视| 欧美三级欧美一级| 六月婷婷网站| 久久婷婷综合基地| 91无码色色| 九九自拍网| 激情综合网激情五月欧美| 久大香蕉| 国产在线网| 色综合区| 99这里只有精彩视频| 九九久久五月天| 碰99在线| 亚洲综合色色色| va婷婷| 丁香五月婷婷无码AV| 久久日九九| 无码激情AAAAA片-区区| 91se在线观看| 玖玖资源网站最新站| 91黄址| WWW.HENHENL.| 色婷婷丁香五月| 99成人在线观看| 天天插天天日天天爽| 五月综合丁香婷婷| 久久视9精| www.99热| 色婷婷五月天久久| 午夜性爱影视一区77| 婷婷五月激情图片| 丁香五月婷婷老师网站| 天天做天天爱| 久久99热这里只频精品6学生| 先锋男人99资源| 精品人人操| 97热超碰| 99燥99日| 99性视频| 精品国产va久| 伊人久久大香线蕉av一区| 婷婷激情久久| 超碰人人色| 丁香六月激情| 另类五月激情| 97久久香草精品视频| 99自拍视频在线| 亚洲AV永久无码影院黑人| 丰满老熟妇BBBBB搡BBB| 99视频自拍| 婷婷社区五月天| 色色亚卅| 婷婷五月天色丁香| 日本久久爽| 国产黄色大片| 欧美私人家庭影院| 久操人妻| 色色亚洲视频| 日韩精品无码99| mmm1717.6dbm人人爱人人操| 丁香色六月婷婷| 9精品一区| 激情网 久久| 色婷婷99| 九九色热| 丁香五月情| 日韩无码色色| 99精品在线下载| 热久久77777| 中文激情网| 婷婷操婷婷干婷婷射| 亚洲免费看片| 九九精品热播| 五月婷视频在线观看| 成人草榴视频| 国产精品99久久久久久久女警| 99热99在线| 991国产精选视频在线播放下载| 六月婷婷在线| 99r这里| AV国产有码| 亚洲婷婷丁香五月亚洲| 激情综合青草| 九九色中文| 狠狠久久婷五月| 久99久在线观看| 色播播五月天| 人人视频人人干人人做| 99热久久这里只有精品2010| 九九热视频免费的| 五月色导航| 丁香五月日啪| 婷婷五月天改成什么了| 狠狠综合| 成人av免费观看| av网址在线| 99爽视频| 亚洲视频操| 九九色色色| 久久九九国产| 神马欧美精| 夜夜爱影院| 婷婷综合影院| 天天综合五月天| 国产91九色| 青青草99热久久精品国| 色很久综合| www:99热视频| 久久婷婷五| 六月丁香成人| 9久9久| 人人操操| jiujiujiuwuyuetian| 色吊丝永久访问网址| 日韩黄色网络| 狠狠人妻色综合| 色玖玖爱| 91久操| 99久久久国产大片| 激情五月黄色小说| 69堂午夜视频最新地址| 思思热99er在线视频| 国产视频久色| 九九视频精品在线免费| 九九热免费视频| 超碰三级片| 超碰免费观看| 久久99精品久| 婷婷丁香婷婷97| 欧美性交一区二区三区| 伊人综合婷婷| 久久五月天色婷婷| 五月色婷婷影院| 91色久| 婷婷日在线观看| 五月色丁香成人| 欧美综合在线五月天色婷婷| 久色五月| 可以看的AV| 99热精品99| 99久久婷婷| 五月天婷婷综合网| 熟女人妻一区二区三区免费看| 日韩AV无码影片| 丁香五月熟女| 91丁香| 婷婷五月天激情小说| 丁香五月天欧美成人| 丁香五月天天日| av网站中文| 99色视频在线| 国产操碰| 综合激情五月天| wwwav大香蕉| av电影在线播放| 色欲影香| 伊人婷婷青青cao| 夜夜操夜夜姧| 五月天色社区| 五月天丁香网站|