欧美成人午夜精品久久久,国产?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
返回資訊列表
婷婷色五月婷婷姐妹| 色九月国产| 性综合网| www。五月天激情| 欧美成人精品A片免费一区99| 久久奄也去色色网站| 九九九激情综合| 婷婷五月天成人网站| 91色碰| 色综合区| 精品综合久久久久久五月天| 久久精品五月| 天天日综合| 狠狠色丁香婷婷基地| 丁香五月停停av| 亚洲婷婷欧美婷婷| 天天五月香欧美| 色婷婷呢狠禁久禁| 99在线免费视频| 亚洲日韩国产黑丝黑丝AVAV一区二区三区| 桃色五月婷婷| 激情综合色图| 丁香桃色综合网| 天天综合区| 五月激情小说| 亚洲精品操一操、噜一噜、摸一摸、爽| 婷婷香蕉精品| 久久久久久激情| 梁铮版《蜘蛛女侠》在线| 日本不卡高字幕在线2019| 蜜桃五月天| 91碰超| 国产精品一区在线观看你懂的| 亚洲第一视频 久久| 影音先锋男人资源站一区二区| 亚洲热视频在线| 婷婷丁香视频| 97干网站| 激情五月天久久| 丁香五月中文字幕色播| 激情五月天综合图片小说网站| 69天堂99| 色五月丁香婷婷| 开心五月婷婷99| 亚洲综合草草| 中文AV网站| AV网站免费在线| 亚洲视频丁香网va| 区美毛片子| 国产亚洲精品久久久久久郑州| 亚洲免费婷婷| 色综合xx| 九色七七| 丁香五月影| 色综合久久88色综合天天看| 天天擼久久擼在线| 怡红院 久久| 99久久国产综合精品五月天喷水\| 色婷婷偷拍| 久久综合热17c| 亚洲Av成人在线观看| 狠狠综合网| 天天天操天天天日| 亚洲激情高潮| 超碰操网| 久久一伦| 婷婷成人基地| 国产在线中文字幕| 五月激情婷婷丁香| 五月开心婷婷中文字幕| 综合网啪| 婷婷五月丁香激情| 婷婷色综合| 影音先锋777xfplay色资源网站| 狠狠干五月天婷婷网| 色婷狠狠| 人妻熟人中文字幕一区二区| 99综合久久| 26uuuu精品一区二区| 夜夜久久综合网| 国产一级视频a| 日韩精品999| 色婷婷五月天在线| 亚洲激情图文小说| 日韩精品999| 91干婷婷| 99精品热| 超碰国产AV| 爱草视频在线观看| 91综合在线| 欧美精品久| 国产精产国品一二三在观看| 激情中文在线| 啪到高潮激情丁香五月| 337p午夜影院| 9久久精品| 日本在线wwww| 五月婷婷电影院| WWW,五月| 99热久草| 99热最新| www夜夜操wwwcon| 免费AAAAA网| 日hao1区| 亚洲日比视频| 大地9中文在线观看免费高清| 久久激情五月天| 九九这里都是精品| 9这里只有精品| AA片在线观看视频在线播放| 婷婷亚洲天堂| www.射伊蕉婷婷| 思思热精品在线| 亚洲五月天婷婷| 激情综合网激情五月天| 亚洲天堂热| 97自拍视频在线| 精品久久99| 午夜不卡久久精品无码免费| 天堂在线婷婷| 大香蕉婷婷色| 97久久香草精品视频| 伊人丁香花综合影院| 日韩六十路91性交电影| 丁香丝袜五月| 国产精品成人AV在线| 久久精品这里只有精品免费首页| 国产精品色情AAAAA片软件| 伊人狼人干| 九九超碰人人| 无码se| a69在线视频| 亚洲婷婷丁香五月视频| 色五月五月婷婷| 婷婷精品在线| 国精产品一区一区三区免费视频| 久久九九亚洲| 俺也去在线久久精品23欧美综合视频网站,丰满人妻一区二区三区在线视频53,丰满 | 亚洲国产精品SUV| 以及AA大片看看| 丁香五月婷婷99| 欧美日朝成人| 丰满人妻一区三区三区| 九九热在线精品视频| 久婷婷婷| 亚洲精品国产A久久久久久| 九九激情| 99热这里是精品| 色噜噜狠狠色综合日日免费| 热99在线| 婷婷五月丁香六月| 久久久国产精品黄毛片| 超碰爱爱爱| 538午夜激情| 狠狠操在线视频| 丁香五月婷婷影院| 91丨九色丨大屁股| 亚洲免费综合一区| 国产熟女一区二区三区五月婷| tingting五月天亚洲| 五月婷婷基地| 天天狠狠夜夜狠狠2023| 九月停停| 涩五月婷婷| 色青五月天| www.狠狠操| 中文字幕在线免费观看视频| 色婷综合| 日操| 亚洲激情五月| 欧美一级色| 久久九九99.www| 五月丁香六月婷婷久久肏| 天天舔天天插天天爱| 草做免费在线观看| 天天综合在线网| 九九亚洲天堂| 99操久久| 性生活视频98791| 九九精品综合| 狠狠色丁香乆乆| 久草视频一,二三四| 97激情五月天| 九九热99熟女| 色欧美一级| 综合性爱网| 色五月婷婷少妇人妻| 色婷婷狠狠| 五月天激情小说| 九九99九九精品视频| 久久激情视频| 久久99综合| 激情综合亚洲色婷婷五月| 激情丁香九九五月综合网| 青青草免费公开视频| 97碰在线免费观看| 五月激情婷婷播播网| 热99免费在线| 91制片厂久久久国产电影| 超碰在线人人| 五月婷婷六月丁香激情| 国产乱人偷精品人妻A片| 色色色婷婷| 国产精品噜噜在线视频| 日本三级中文字幕| www.婷婷激情网.com| 婷婷精品| 天天做天天爱天天玩| 少妇熟女视频一区二区三区| 久久人妻少妇嫩草AV| 五月激情射| 91啪级电影| 超碰人人干| 七七色综合| 色八月婷婷| 丁香五月伊人| W色综合| 91丨九色丨43老版熟女| 人人草人人看| 丁香五月-激情综合| www九九热| 日本颜色视频人人爱| 激情综合亚洲| 九九综合九九| 婷婷五月天在线视频网站| 无码AV免费精品一区二区三区 | 亚洲无码色色| 欧美成人精品A片免费一区99| 色五月欧美| 99er在线观看| 99热这里只有精品9| 精品视频网| 成人小说 五月天 婷婷| 中文字幕成人| 五月婷久久草| 丁香婷婷视频| 色色综合网www| 丁香六月开心| 久久婷婷综合基地| 丁香六月婷婷社区| 欧洲免费视频色| 97久久视频| www.henhenl| 啄木鸟丝袜美女福利视频| 久久草大香蕉| 九九黄色网| 天天爽天天爽| 一区中文字幕电影| 99爱视频免费看| 丁香六月婷婷久久综合| 大香蕉久| 色久综合| 99热一本| www.99热. com这里只有精品| 丁香五月天堂网| 97干网站| 五月天久久网站| 婷婷9月天| 婷婷激情综合色五月久久,色婷婷丁香花,丁香婷婷五月情天,久久婷婷五月综合色 | 久久思思99| 色五月综合网| 午夜成人片400| 玖热精品综合视频| 99日本精品视频热| AAA久久久AAA久久久AAA| 九九综合久久| 狠狠操狠狠色| www.99免费视频| 激情综合网亚洲色图| 婷婷久久综合| 九九色图| 午夜激情婷婷| 97黑人精品区| 另类综合色| 91九九热| 色五月丁香五月婷婷五月成人网| 日本少妇裸体做爰高潮片 | 五月伊人综合| 性爱视频久久| 91人妻色色网| 色色色成人网| 99综合网| 婷婷激情五月| 99热在线观看| 996er热| 六月婷色| 日韩精品一区二区亚洲AV观看| 97热超碰| 五月天亚洲色| 丁香色五月AV在线| www,av好吊操| 婷婷色狠狠| av网站中文| 玩熟女五十AV一二三区| 色五月婷婷丁香婷婷| 五月丁香综合| 婷婷丁香五另类网站| 五月婷婷六月丁香| 天天色爽| 亚洲精品字幕| 亚洲性图一区二区| 久久99大| 开心五月天激情网站| 99丁香五月| 玖操97| 丁香六月激情综合| 丁香五月婷婷姐| 青青草激情网| 婷婷五月天综合久久日美女| 色婷婷色五月天| 久久九九99.www| 六月婷婷久久大全| WWW色色色COM| 五月丁香六月婷婷国产视频| se.久久视频在线观看| 天天天综合网| 日本黄色精品| 性天堂久久| 精品久久婷婷| 欧美日韩成人在线网站| 武则天精品久久| 五夜婷婷| 丁香九月综合| 人妻体体内射精一区二区 | 天天操夜夜肏| 五月婷久草| 亚洲五月花| 五月丁香亭亭AV女优| 天天插天天爽| 大香蕉伊人99| 色色射| 婷婷日在线观看| 六月丁香网| 熟女婷婷网站一婷婷五月一丁香婷婷一婷婷激情网 | www.综合久久.com| 欧美影院婷婷| 婷婷激情丁香五月婷婷激情丁香五月婷婷| 国产精品第一国产精品| 操丝袜视频影院导航| www.99.色| 亚洲视频图片婷婷五月| 色婷婷久久视屏| WWW.99视频| 五月色网| 五月丁香影院| 人妻精品久久久久久| WWW色色色COM| 激情中文在线| 成人噜噜网| 综合网色| 亚洲精品久久久久久久久久吃药| 中文字幕成人日韩| 久艹大香蕉| 91九色精品熟女内射| 99激情视频| 丁香婷婷久久激情| 丁香五月婷婷激情蜜桃| 婷婷五月天成人| 日本九九视频| 亚洲天堂色色| 天堂婷婷丁香六月网| 人妻免费网站| 日本天堂免费99| 手机在线日韩视频中文字幕| 六月婷婷五月天| 婷婷爱综合| 婷婷丁香五月综合网| 99性爱视频网站| 操久久精| 99热这里有精品| 26uuuavcom| 在线观看欧美3区| 色爱99| 五月五婷婷网| 天天插操| 14色综合婷婷| 五月天婷亚洲综合在线嫩草网| 男女啪啪做爰高潮无遮挡| 性色99| 亚洲av成人电影在线观看| 日本超碰在线| 五月丁香综合精品| 日韩av网站在线观看| 久久久久9999| 第一区久久网站| 亚洲午夜Av| 久机视频这只有精品| 2020夜夜操天天爽| 涩涩婷婷五月| 日日干夜夜干| 日日操日日爽| 97精品自拍| 51精品国自产在线| 欧美五月婷婷| 亚洲精品va| 99热传媒| 99热1| 成年AAAA色情| 超91在线视频| 婷婷五月天福利| 天天成人丁香美女AV| 日本97久久久精品| 久热9| 日日操天天| 91AV婷婷| 国产AV熟妇人震精品一品二区 | 精品色色网| 亚洲操B视频| 五月激情婷婷在线| 久热精品视频| 日韩综合天堂| 色五月 婷婷, 大香蕉| 五月天另类视频| 久久99视频| 97在线精品视频| 99丁香五月婷| 吾爱AV导航| 天天操比比| 五月亭亭综合五码| 亚洲av网站| 六月五月天婷婷涩播在线| 狼人婷婷综合| 九九视频精品视频精品| 激情婷婷在线中文字幕| av免费在线看不卡无毒| 桃色五月天| 亚洲 日韩色色| 丁香五月手机视频| www.99热| 狠狠色五月| 九九热在视频| 97色啪| 亚洲爆乳无码精品AAA片蜜桃| 5月婷婷6月六月丁香| 久久五月视频| 五月天丁香看婷婷| 色欲天天综合网| 99这里只有精品|v| 婷婷爱综合| 九九精品热播| 草草女人亚洲| 国产成人网址| 婷婷五月丁香综合激情| 亚洲色婷婷婷婷人人爽| 一月婷婷色色| a级毛片一区二区免费视频| 99综合视频一体| 日日操天天| 亚洲欧洲99| 91精品啪| 中文字幕有多少字| 97色在线| 玖玖资源站中文| 77799热| www.99热这里精品 | 人妻AV在线观看| 99精品无码网站| 婷婷丁香综合| 国产毛片欧美毛片久久久| 99玖玖在线视频| 亚洲综合婷婷| 日本三级黄色大片| 激情文学 综合 九月| 人妻少妇色综合| 狼人婷婷久久| 婷婷五月丁香综合人妻| 91viP在线看| 97久久精品视频| 精品色色| 欧美 日韩 成人| 99.色| 激情网战码亚洲A| 婷婷综合av| 97碰碰碰免费公开在线视频| 伊人久久婷婷| 99热精品在线观看| 久久五月激情| 久久五月天合网| 亚洲性视频| 在线看AV| 成人做爰A片免费看网站找不到了 噼里啪啦在线观看免费完整版视频 | 亚洲人妻AV| 91视频一起草| 美女五月天| 久色中文| 狠狠色五月激情| 秋霞丝袜啪啪啪| 欧美综合五月天婷婷tin| 亚洲无码99| 婷婷丁香五月综合| 99久久久| 日日噜狠狠色综合久久| 操笔无码| 日韩综合网络男女香蕉a片| AV免费在线网站| 超碰成人黄色网| 五月天成人免费视频| 丁香五月先锋| 99无码黄色视频| 思思99re这里只有| 婷婷欧美激情综合| 大香蕉啪啪| 97婷婷在线视频| OYIWbGcPu8H| 婷婷五月天激情小说| 丁香五月性爱| 五月天丁香成人| 五月婷婷婷婷| 丁香五月天网友自拍啪啪啪视频| 九月婷婷丁香| 五月情综合| av九九| 高清国产AV| 91色综合网站在线| 日本一級黃色一級片| 久久免费精彩视频| 五月婷婷五月天| 色婷五月天| 激情亚洲婷婷| 91九色欧美| 99av视频| 互月天综合| 色综合五月婷婷狠狠干| 色婷婷精品小视频| 五月香蕉综合| 婷婷激情五月天7| 婷婷色五月激情| 伊人色综合影院视频| 五月天伊人久久久久| 久久一级免费黄色片| 99视频综合网| 五月天sesese| 另类五月激情| 五月婷婷香蕉| 国产精品久久久爽爽爽麻豆色哟哟 | 夜夜干天天干| 婷婷开心激情五月激情网| 五月婷婷花| 天天摸,天天爽| 狠狠操之狠狠操| 亚洲视频a| 五月婷视频久久| 婷婷操逼| 色婷婷香蕉| 色五月成人| 丁香九月婷婷综合| 国产99久久久| 亚洲丁香花色| 99热综合在线| 无码一区二区三区四区五区| 色丁香五月天射婷婷爱婷婷| 蜜臀AV在线成人| www.激情| 九九综合视频在线观看| 性韩日色婷婷五月天激情啪啪XXX| 伊人久久婷婷| 丁香五月天欧洲在线| 99久久综合| 婷婷五月天成人在线视频| 五月色综合| 亚洲视频五区| 丁香五月电影| 五月婷婷开心深| 插插插丁香五月婷婷| 亚洲九九免费| 久婷婷久草| 五月婷婷之六月丁香| 五月婷深深爱激情网| 先锋av性爱成人电影| 六月丁香激情婷婷| 思思热再线视频| 激情九九这里只有精品| 婷婷六月久久综合导航| 婷婷深爱五月天| 久久激情天堂| 久久久WWW| 五月天天天色| 夜夜操狠狠操| 日韩国产在线精品| 日韩专区五月天婷婷丁香| 亚洲熟妇AV乱码在线观看| 久久婷婷青青草| 天天日日| 九月丁香八月婷婷久久综合久97| 婷婷丁香亚洲色综合91| 97在线精品| 五月丁香怕啪啪| 天天粽合合合合| 久噜久噜| 美女五月狠狠| 爆乳熟妇一区二区三区爆乳照片| www色五月| 久久色情| 激情综合网激情五月俺也去| 欧美三级视频下载| 色综合久久综合中文综合网| 五月综合视频在线| 婷婷五月天人妻| 99操逼| 日本色色网站| 久色网| 欧美三级A做爰在线观看| 色综合久久久无码中文字幕999| 一本狠婷婷综合| 九九色天堂| 欧美综合五月丁香六月婷| av中文在线| 色色色在线播放| 狠狠草综合网| 99无码| 大香蕉婷婷丁香视频在线| 日日撸夜夜操| 操碰色一区就去操| www综合久久| 亚洲中文字幕AV| 久久性爱视频免费| 天天爽天天做| 欧日韩成人| 色婷婷六月| 精品香蕉99久久久久网站| 九九久99免费视频| 久久性操| 天天色五月| 欧美婷婷五月丁香| 人妻人人操| 国产亚洲精品AAAA片APP| 内射 无码 伊人| 超碰无码318604| 日本久久天堂| 色插综合网| 婷婷五月天免费视频| 国产91视频| 成人国产欧美大片一区| 任我肏视频精品| 在线观看亚洲视频影院| 欧美美女国产日韩一区二区久 | 操操天堂| 99精品偷自拍| 婷婷丁香综合| 天天爽在线视频| 久久久99精品| 色色色婷婷五月| 影音先锋女人AA鲁色资源| 99热xx| 婷婷激情在线| 综合五月亭亭9| 色综合天天综合成人网| 婷婷五月天影院| 五月开心播播网| 探花搜索结果 - 黄上黄| 亚洲图色五月天| 91色久| Va另类视频| 色五月婷婷网| 国产日韩欧美性爱| 欧在线一区| 91人妻PORNY九色大屁股| 亚洲十月婷婷综合| 99啪99| 欧美交换配乱吟粗大25P| 激情五月婷婷她| 激情小说五月天社区丁香| 欧美成人网婷婷综合在线| 五月丁香婷婷爱| www.天天干| 碰碰碰91| 狠狠88综合久久久久噜噜噜| 亚洲色热| 久久AAAA片一区二区| 四川操逼站| 亚洲中文丁香| 五月六月丁香激情| 久久久婷婷| 99热99| 影音先锋按摩| 开心色五月天久久久久久久| 婷婷六月天| 欧美色五月| 婷婷九九色| 色婷婷亚洲| 五月婷婷开心六月激情小说| www色婷婷| 色婷婷网大全在线| 久久久WWW| 五月丁香婷中文| av在线免费播放| 色色色色色色色色色影院| 丁香五月91| 丁香六月婷婷综合在线| 激情图片五月天| 男人的天堂99| 久久久久婷婷五月热综合| 丁香五月天啪啪| 另类少妇人与禽zOZZ0性伦| 色婷婷影| 六月天无码网址| 久婷| 8050一级网| 婷婷色在线| 五月天激情婷婷久久| 激情色播| 91婷婷色| 欧美婷婷色五月| 婷婷综合网站| 色吊丝av中文字幕| 亚洲婷婷丁香五月天激情小说| 九月婷婷色色| 激情性爱五月天网页| 97色婷婷| 五月婷婷丁香五月| 亚洲六月综合激情久久下卡| 99热永久在线观看| 第四色大香蕉| 亚洲一二三网| 色婷婷精品小视频| 色婷婷九月| 婷婷成人av| 亚洲 精品 综合 精品| 婷婷六月激情| 婷婷五月天丁香久久| 人人亚洲| 國語久久婷| www.wuyuetian啪啪| 永久的网站AAAA| 色欲婷婷五月天丁香| 操操综合网婷婷| 亚洲综合在线伊人婷| 婷婷激情六月| 激情都市另类| 在线视频色五月| 五月丁香啪综合| 超级碰碰一区| 六月丁香五月激情网| 99色在线视频| 性色婷婷| 激情五月天无人视频在线| 少妇2做爰HD韩国电影| 中文字幕成人| 狠狠色噜噜狠狠| www.婷婷久久五月天| 婷婷在线操| 99久久99九九99九九九| 久久综合色情网站| 丁香五月婷婷色偷偷| 国产精品久久久久久喷浆| 色婷婷基地在线| 婷婷六月激情| 超碰97久久| 色女伊人| 亚洲中字AV电影在线网站| 六月丁香视频网站| 丁香六月婷婷综合| 天天搞天天色综合| 五月天桃色深爱网| 操草草草| 五月婷色丁香| 成人看片网站| 九九热黄色| 亚洲熟妇无码乱子AV电影| 九九色video| 日日干夜夜撸夜夜骑| 99热这里有精力| 97色在线观看视频| 伊人婷婷五月天| 婷婷五月开心六月AV| 婷婷综合激情五月综合| 无码人妻少妇色欲AV一区二区| 在线中文字幕视频| 久9免费视频| 婷婷五月丁香色播| 色综合激情| 色色色色色九九九九九| 五月天婷婷网站| 97在线视频观看| 九九热这里只有精品首页| 丁香九月激情| 九九操操| 色情五月婷| 北京熟妇搡BBBB搡BBBB| 激情宗合哪里能看| 丁香五月手机在线| 激情婷婷| 婷婷视频网| 永久免费视频| 香蕉操亚洲| 日本3级片一区2区| 桃色五月天| 久久狠婷婷| 日本操B视频| 91亚洲视频| 五月色导航| 北京熟妇搡BBBB搡BBBB| 六月婷婷视频| 激情综合色| 激情五月综合视频| 色婷婷亚洲婷婷| 婷婷亚洲五| 丁香婷婷色五月激情综合| www.henhenl| 婷婷99中文字幕| 久久激情五月天| 五月天激情小说| 91九色视频在线观看| 99色五月| 五月丁香激情啪啪网| 五月丁香在线观看| 奇米网大香蕉| 色五月成人| 天天插天天射天天干| 91人碰| 玖玖婷婷综合| 亚洲精品影视| 婷婷香蕉| 五月天另类小说| 成久综合视频| 婷婷久久综合久| 日日干日日色| 强壮的公次次弄得我高潮A片日本 | 色五月开心五月激情五月| 国产精品久久久久久久久久| 色噜噜,噜噜色| 性做爰1一7伦| 2025最新亚洲激情在线| 丁香婷婷基地| 热99久| 久9热视频| www.97碰碰com| 欧美日韩99| 99er这里只有精品视频| www.色婷婷.com| 日日天天操| se色婷婷视频| 丁香五月综合在线视频| 亚洲av成人电影在线观看| 婷婷五月激情在线| 婷婷久久婷婷色五月| 综合婷婷五月天| 久Se视频在线观看| 日韩成人综合网| 久久色频| 51精品国自产在线| 天天舔天天插天天干| 天天肏在线视频| 少妇激情五月天| 丁香五月婷婷激情尤物| 久久99久久99精品免视看婷婷| www.91.com黄| 婷婷五月在线视频| 五月丁香六月婷婷综合网| caop视频| 激情欧美丁香五月| 色色色97| 思思热久久艹| 亚洲综合视频天天精品| 99视频这里有精品| 丁香六月婷婷激情| 五月叮香啪| 人人摸人人干| 五月天婷婷色| 99精品偷自拍| 亚洲色情在线| 91视频精品99| 婷婷五月丁香六月| 亚洲视频a| 一级操逼大片| 九九热精品视频| www.婷婷五月| 国产精品久久欧美久久一区| 五月丁香六月婷婷的女人| 婷婷六月天| 99自拍视频网站| 激情婷婷内射| 高清a片基地| 国产婷婷综合| 五月丁香六月在线欧美| 久久AV无码精品人妻系列试探| 九九久热| 日本色99| 1000部毛片A片免费观看| 婷婷五月骚厕所| 欧美色97| 色999亚洲人成色| 婷婷五月天欧美图片在线播放电驴| 亚洲天堂九九九| 丁香婷婷性爱| 亚洲五月丁| 六月婷在线| 大香蕉九九| 天天天添天天操| 色99婷婷五月天| 欧美日韩一区二区三区四区| 国产美女最新VA在线免费观看| 色97啪啪| 九九热免费| 乱抡小BB| 91chinese 在线| 婷婷五月综合在线| 操一操插一插| 激情性爱五月| 一本大道嫩草AV无码专区| 久久婷婷综合五月趴| 九月婷婷久久久| 99精品视频在线观看| 五月天亚洲色| ww亚洲ww在线观看| 超碰一区二区| 五月丁香操婷逼| 深爱激情网婷婷| caopeng97人人| 狠狠干狠狠干| 亚洲综合激情五月| 久久久18| 久久免费少妇高潮99精品| 久久总和99| 激情婷婷丁香色情五月天| 玖玖精品婷婷| 欧美成人精品A片免费一区99| 天天爽天天摸| 九九九九毛片| 夜色五月天| 久久婷婷啪啪视频| 久久五月激情网| 91精品又长又大又粗又爽又猛| 狠狠操狠狠| 人人爱人人草| 婷婷六月丁香在线| av五月丁香婷婷网| 天天操夜夜操| 色色色色综合| 丁香五月在线视频| 婷婷五月天成人视频| 少妇高潮一区二区三区99欧美| 丁香五月人妻熟女| 久久久久激情| 丁香婷婷九月在线| 97精品欧美91久久久久久久| 99re这里只有精品首页| 色色免费网站| 日韩限制级大尺度黑料泄密大尺度视频一区二区在线观看 | 大香蕉伊然在亚洲90| av人人干| 五月色综合网| 琪琪理论片| 九九性爱网| 少妇出轨做爰高潮A片| 色婷婷9| 激情九九综合网| 综合色久| 操婷婷基地| 麻豆AV一区二区三区| 91九色视频在线观看| 亚洲婷婷月丁香五月| 在线观看996精品| 不卡在线视频| 日本九九九九| 99国产小视频| 色频玖玖五月天| 99热69| 国产精品扒开腿做爽爽爽A片唱戏| 97热在线精品| 五月婷色啪| 中文字幕 码精品视频网站| 曰本aaaaaa丈片| 超碰狠狠操| 在线观看av网站| 日本va视频| 看婷婷五月天网| 91 九色 入口| 91久久日日| 秋霞成人毛片一级A片| 五月丁香婷婷三级| 婷婷欧美色| 性天堂久久| 日韩乱轮AV| 99热这里只有精品2| 天天日综合| 九九操综合网| 亚洲Va成人| 五月天停婷基地| 大地资源色婷婷视频在线| 变态另类9| 五月天色社区| 能看的av片| 97干欧美| 2022久久婷婷| 中文字幕网伦射乱中文| 久久亚洲激情五码| 五月丁香婷婷视频| www.夜夜.com| 六月色婷婷欧美| 99碰碰视频| 97热超碰| 日本操B视频在线观看| 久久激情网| 亚洲天堂大香蕉| 79色色| 色综合五月婷婷狠狠干| 秋霞免费三级片| AAA久久久AAA久久久AAA| 久久99大| 五月丁香影院| AV在线免费播放| 五月丁香六月婷婷网| 这里只有九九精品| 亚洲俩性性爱图片久久第六页| 超碰超碰在线| 狠狠色丁香久久婷婷综合五月| 北条麻妃九九九国产精品视频| 日韩一级片| 深夜男女福利刺激影院一区完整| 五月天开心婷婷激情网站| 亭亭五月天黑人2014| 亚洲一色色色色色色色色| 琪琪色五月天| 操操日韩| 久久全意婷婷| 亚洲亚洲人成综合网络| 久久99网| 亚洲五月天婷婷| 亚洲综合五月| 亚洲第一精品网站| 婷婷五月欧美综合| 《诡秘之主》在线观看| 成人婷99最新| 香蕉伊人综合| 五月色婷丁香| 潘金莲AAAAAAAAAA| 蜜桃人妻无码AV天堂三区| 综合色播| 九九热啪啪| 啪啪六月婷婷| 天天操天天操| 丁香五月婷婷亚洲人| www色五月| 肏屄色播伊人97婷婷| 日本99色| 综合精品99| 丁香五月www| 无码一区二区三区四区五区91c| 伊人久久丁香狠狠婷婷综合香蕉 | 成人在线精品| 免费啪啪亚州视频| 欧美色频| 免费不卡狠操美女视频网| 五月天婷婷丁香六月| 五月天欧美激情| 天天综合天天玩夜夜玩天天玩夜夜玩| 色色色综合视频| √天堂资源在线人妻熟女| 中文AV在线观看| 欧美精品A片一区在线观看| 国产三级在线播放| 99热99日天天干| 丁香五月瑟瑟| 婷婷五月天 丁香五月天 裸体| 国产成人精品一区二区三区视频| 国外亚洲成AV人片在线观看| www.狠狠| 97天堂| 久99热| 久久xx| 九九热10| 97人凄人人操人人爽| 综合婷婷五月天| 亚洲天堂色色| 色综合久久88色综合天天99| 色五月综合在线| 婷婷六月丁| 天天综合社区| 五月丁香操亭亭网| 九九久热| 思思热精品在线观看| 免费观看欧美成人AA片爱我多深| 天天干天天操| 激情开心五月天婷婷基地丁香社区| 色五狠狠| www.狠狠操.com| 五月综合在线婷婷图片| 激情伍月 欧美| 伊人天天色| www.日日日.com| 色狠狠综合网| 99成人无码| 色综合色色色色色| 丁香六月激情综合啪啪| 午夜色丁香| 99色性爰网络| 亚洲热热视频| 婷婷日欧美在线观看| 婷婷久久精品| 五月婷婷六月丁香在线视频免费在线观看| 婷婷五月婷婷| 五月婷啪啪| 97综合在线| 狠狠操狠狠操AV| 欧美激情综合色综合啪啪五月| 五月丁香婷婷色| 成人午夜视频精品一区| 国产精产国品一二三在观看| 婷婷五月天VI| 99热在线极品极品| Av免费网站在线| 91丨九色熟女丨首页| 日韩日比视频| 女婷久久| 色色五月婷| 激情com| 99在线观看免费精品视频| 就爱干 在线| 婷婷夜夜夜夜| 婷婷五月色情天| 99九九视频| 伊人超碰| 五月婷丁香| 亚洲无AV在线中文字幕| 亚洲AV久久久久久久久久久久久久久久 | 综合99在线| 久久婷婷综合国产| 东京热伊人| 狠狠操.com| 丁香婷婷啪啪啪| 免费观看欧美成人AA片爱我多深 | 都市激情小说婷婷| 色噜噜狠狠一区二区三区| 9久热在线视频精品| 第五色婷婷| 色噜噜狠狠色综无码久久合欧美| 婷婷六久久| 婷婷狠狠97| 欧美99热| 五月丁香va| 日日夜夜狠狠干| 狠狠做深爱婷婷久久综合一区| 在线网黄| 97色在线| 天堂呦 呦百度搜索-百度搜索| 人人叉久| 日韩无码专区| 婷婷五月天影视| 丁香五月婷婷激情蜜桃| 九九99九九99| h在线看免费版在线看| 影音先锋91在线资源站| 久久婷婷电影| 五月婷婷色色色| 亚洲激情淫网| 丁香五月中文字幕久色| 婷婷五月综合体验看| 婷婷五月色天| 日本三级成人秘书精品片| 啪啪东京热| 色综合久| 久久婷婷五月综合色播| 婷婷五月天狠狠| 综合大香蕉| 九九AV| 激情婷婷五月社区| AV在线观看网站| 九九婷婷综合| 色婷婷888| 99成人网站| 久久久久久久合一狠狠做深爱| 久久久婷婷五月亚洲97号色| 99re6久热只有精品6在线直播| se色婷婷视频| 亚洲午夜一区二区| 无码一区二区日韩| 久久精品亚洲热| 婷婷人人操| 九九亚洲| 99ri视频在线观看| 好好干Av| 蜜臀嫩草| 五月婷婷六月天| 日本乱子人伦在线视频| 亚洲第一av| 深爱婷婷基地| 丁香六月无码播放| 香蕉综合在线| 99精品偷自拍| 超碰93在线观看| 五月天婷婷久久日| 天天色天天爱天天爽| 香蕉视频91| 国产精品久久久久久久久久| 色黄啪啪| 91精品综合久久久久久五月丁香| 99视频这里只有久久精品 | 五月丁香在线| 色婷婷亚洲综合天堂| 伊人激情啪啪| 天天综合亚洲综合| A片一曲| 色婷婷在线电影| 久久伦乱| 六月色色婷婷| 一区二区乱码视频| 这里只有精品视频在线| 欧美久久久久久久久中文字幕| 99色色热| 热久久99热欧美国产亚洲| 老司机伊人| 永久天堂日本| 五月丁香A片| www.henhengan| 97色色视频| 婷婷狠狠狠爱| 天天爽天天爽天天爽天天爽天天爽天天爽天天 | www.色婷婷| 久久这里有精品视频在线免费观看| 99热这里全是精品| 色综合婷婷99| aaaaa不卡| 婷婷五月天欧美图片在线播放电驴| 五月丁香天堂网| 丁香五月婷婷高清| 色久婷婷五月| 亚洲婷婷欧美婷婷| 国产亚洲精品久久久久久牛牛| 免费AV在线| 婷婷五月天激情在线观看| 啪啪操超碰| 丁香综合日产精品久久| 色综合综合色| 天天操天天爱天天日| 婷婷丁香五月综合激情视频| 久久久久久人妻| 九九婷| 91性高潮久久久久久久久| 九九久热| 97在线精品| WWW99视频| 久久A热| 久久99久久99精品免视看婷婷| 婷婷五月综合免费在线| 五月婷婷 欧美| 亚洲精品在线视频| 亚洲在线免费成人| 九九色综合| 久久婷婷综合五月天| 中文字幕无码人妻少妇免费视频 | 中国无码av| 六月色婷婷色| 噜噜在线| 国产,欧美,学生妹,视频| 婷婷综合五月| 亚洲精品国产精品乱码视99| 免费观看全黄做爰的视频| 变态另类9| 五月婷婷性| 精品夜夜澡人妻无码AV| 97久人人| 夜夜操天天爽| 丰满人妻一区二区三区| 亚洲啪啪网| 六月婷婷九月丁香亚洲综合| 日日日日日| 中文字幕精品在线观看| 色女伊人| 国产美女无遮挡裸体毛片A片| 色九亚洲| 中文字幕色色| 免费无码毛片一区二区A片| 婷婷激情五月综合| 婷婷丁香五月亚洲17cao| 久久婷婷五月丁香蜜桃网|