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

ARTICLE DETAIL

資訊詳情

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

ODrive固件解析:從STM32定時(shí)器時(shí)基到8kHz控制環(huán)的實(shí)現(xiàn)

ODrive固件解析:從STM32定時(shí)器時(shí)基到8kHz控制環(huán)的實(shí)現(xiàn) 直接開工。搞過 ODrive 的人都知道這玩意兒在電機(jī)控制圈子里是個(gè)“繞不開的參考系”。開源、硬件設(shè)計(jì)漂亮、固件質(zhì)量高而且它那套代碼里藏了不少底層細(xì)節(jié)普通 demo 工程里根本看不到。尤其是從定時(shí)器時(shí)基到 8 kHz 控制環(huán)這一整條鏈路幾乎是所有想深入 FOC 控制、想自己移植固件、或者想搞明白“為什么我的電機(jī)跑起來噪音那么大”的人的必修課。這一篇是系列的第二篇核心就一件事講清楚 ODrive 固件里定時(shí)器時(shí)基是怎么搭建的又是怎么一步步把它變成實(shí)際執(zhí)行 PID 控制律的 8 kHz 控制環(huán)。這里會(huì)涉及 STM32 定時(shí)器的底層配置、PWM 生成、更新中斷觸發(fā)、以及中斷服務(wù)程序里的任務(wù)調(diào)度最終帶你把整個(gè)調(diào)用鏈路串起來。適合誰(shuí)看想讀 ODrive 源碼但不知道從哪下手的用 STM32 自己寫 FOC 想抄作業(yè)的以及已經(jīng)在跑 ODrive 但總感覺“里面有事兒”的好奇派??赐赀@篇你應(yīng)該能說出“8 kHz 控制環(huán)”到底是哪個(gè)中斷拉起來的那個(gè)中斷里又干了哪些事。1. 內(nèi)容整體設(shè)計(jì)與思路拆解1.1 先搞清楚 8 kHz 控制環(huán)到底是個(gè)什么概念很多人一聽“控制環(huán)”第一反應(yīng)是“一個(gè) PID 循環(huán)”。這句話不算錯(cuò)但對(duì) ODrive 來說控制環(huán)不是一個(gè) while(1) 里跑的邏輯而是一個(gè)被定時(shí)器中斷精確驅(qū)動(dòng)的硬實(shí)時(shí)任務(wù)。在 ODrive 固件里它把控制邏輯分成了好幾層電流環(huán)最內(nèi)層負(fù)責(zé)把 d/q 軸電流快速壓到目標(biāo)值頻率最高。速度環(huán)中間層基于編碼器測(cè)速得到的速度值輸出電流指令。位置環(huán)最外層基于目標(biāo)位置和實(shí)際位置的誤差輸出速度指令。ODrive 把這幾個(gè)環(huán)放在同一個(gè)定時(shí)器中斷里跑整個(gè)控制周期的頻率就是 8 kHz。也就是說每過 125 微秒CPU 會(huì)強(qiáng)制暫停當(dāng)前手頭的事跳到中斷服務(wù)函數(shù)依次完成編碼器讀數(shù)、坐標(biāo)變換、PID 計(jì)算、PWM 占空比更新然后再跳回去干之前的事。為什么是 8 kHz這其實(shí)是幾個(gè)約束條件折中的結(jié)果STM32F405 的 CPU 主頻是 168 MHz8 kHz 意味著每個(gè)控制周期約有 21000 個(gè) CPU 周期可用。電流環(huán)需要在一個(gè)周期內(nèi)完成至少一次完整的 Clarke/Park 變換加 PI 運(yùn)算再加上速度環(huán)、位置環(huán)的 PID運(yùn)算量不小。控制頻率越高電流環(huán)帶寬越高電機(jī)噪音和振動(dòng)越小但 CPU 壓力也越大。8 kHz 不是隨便拍腦袋定的它是一個(gè)在“能帶動(dòng)多少運(yùn)算量”和“控制性能還需要提升多少”之間的平衡點(diǎn)。后續(xù)你會(huì)看到ODrive 里很多參數(shù)都跟這個(gè)頻率掛鉤比如電流環(huán)的 PI 增益、濾波器的截止頻率、甚至看門狗的超時(shí)判斷。所以先記住這個(gè)數(shù)8 kHz 是 ODrive 固件的控制心跳頻率。1.2 時(shí)基選型為什么用定時(shí)器而不是 SysTickODrive 固件運(yùn)行的平臺(tái)是 STM32F405/F407 系列這個(gè)系列提供了多個(gè)定時(shí)器。這里就涉及一個(gè)關(guān)鍵選擇為什么控制環(huán)的中斷源用的是高級(jí)定時(shí)器 TIM1而不是大家更熟悉的 SysTick滴答定時(shí)器如果你看過一些 STM32 工程會(huì)發(fā)現(xiàn)很多人用 SysTick 做延時(shí)或者做簡(jiǎn)單的時(shí)間片輪詢。SysTick 確實(shí)簡(jiǎn)單Cortex-M 內(nèi)核自帶不用翻手冊(cè)就能配好。但它有一個(gè)先天不足SysTick 的優(yōu)先級(jí)是固定的你沒法把它調(diào)成比外設(shè)中斷更高的優(yōu)先級(jí)。在電機(jī)控制這種場(chǎng)景里控制環(huán)必須搶占一切不能容忍被串口中斷、USB 中斷打斷。一旦控制中斷被其他中斷延誤電流環(huán)的執(zhí)行時(shí)間跳動(dòng)會(huì)直接反映在電機(jī)噪音和電流波形上。TIM1 是高級(jí)定時(shí)器它不僅可以輸出帶死區(qū)的互補(bǔ) PWM還自帶更新中斷。ODrive 的巧妙之處在于它讓 TIM1 既承擔(dān) PWM 輸出職責(zé)又承擔(dān)控制環(huán)中斷來源一份硬件資源兩重功能這是非常典型的嵌入式思路。軟件上把中斷優(yōu)先級(jí)設(shè)為最高保證任何時(shí)刻控制中斷來了都能打斷其他任務(wù)。你需要理解的核心思路是控制環(huán)的中斷源不一定非要用定時(shí)器但必須滿足兩個(gè)條件——可精確配置頻率、優(yōu)先級(jí)足夠高。用定時(shí)器是 STM32 平臺(tái)上一個(gè)很自然、很成熟的方案。SysTick 在這種硬實(shí)時(shí)場(chǎng)景里不具備優(yōu)勢(shì)。1.3 從定時(shí)器到控制環(huán)的整體鏈路先給你一張“地圖”把整個(gè)過程在邏輯上畫出來。ODrive 固件啟動(dòng)后進(jìn)入 main 函數(shù)完成一堆初始化最后進(jìn)入一個(gè) while(1) 主循環(huán)。但主循環(huán)里干的全是慢節(jié)奏的事USB 通信、日志輸出、參數(shù)保存、狀態(tài)機(jī)切換這些。真正干控制活的是那段中斷驅(qū)動(dòng)的代碼。整個(gè)鏈路是這樣走的初始化階段配置 TIM1 的時(shí)基讓它產(chǎn)生頻率為 8 kHz 的更新事件開啟更新中斷并把 NVIC 里 TIM1_UP_TIM10 的中斷優(yōu)先級(jí)調(diào)到最高。啟動(dòng)階段使能定時(shí)器計(jì)數(shù)TIM1 開始跑更新中斷開始按 125 微秒一次的頻率觸發(fā)。運(yùn)行階段每次進(jìn)入中斷服務(wù)函數(shù)依次執(zhí)行“讀編碼器/讀電流采樣值 → 電流環(huán) FOC 計(jì)算 → 速度環(huán) PID → 位置環(huán) PID → 更新 PWM 比較寄存器”。主循環(huán)階段處理對(duì)實(shí)時(shí)性不敏感的任務(wù)比如通過 USB 接收上位機(jī)的指令、解析參數(shù)、打印狀態(tài)。這個(gè)結(jié)構(gòu)中主循環(huán)像是一個(gè)“后臺(tái)辦公室”處理各種不急的瑣事定時(shí)器中斷像是“生產(chǎn)線上的節(jié)奏器”每 125 微秒發(fā)出一聲“干活了”把控制任務(wù)從上一道工序推到下一道工序。硬件中斷的確定性保證了控制周期的穩(wěn)定這正是電機(jī)控制領(lǐng)域最核心的追求。2. 核心細(xì)節(jié)解析與實(shí)操要點(diǎn)2.1 定時(shí)器時(shí)基的計(jì)算與配置要理解 ODrive 的代碼你得先能自己把時(shí)基算出來。這一步不難但很容易搞錯(cuò)。STM32 的時(shí)基由三個(gè)寄存器控制PSC預(yù)分頻器、ARR自動(dòng)重載值、以及時(shí)鐘源頻率。公式非常簡(jiǎn)單定時(shí)器頻率 定時(shí)器時(shí)鐘源頻率 / (PSC 1) / (ARR 1)ODrive 用的 STM32F405TIM1 掛在 APB2 總線上。當(dāng)系統(tǒng)主頻 168 MHz、APB2 預(yù)分頻系數(shù)為 1 時(shí)TIM1 的時(shí)鐘頻率就是 168 MHz。如果 APB2 分頻為 2則定時(shí)器時(shí)鐘為 84 MHz此時(shí)定時(shí)器會(huì)額外倍頻到 168 MHz具體要看芯片的時(shí)鐘樹。要實(shí)現(xiàn) 8 kHz可以用很多組合比如PSC 0ARR 20999頻率 168 MHz / 1 / 21000 8000 HzPSC 1ARR 10499頻率 168 MHz / 2 / 10500 8000 HzPSC 83ARR 249頻率 168 MHz / 84 / 250 8000 Hz第一種組合 ARR 偏大適合需要較長(zhǎng)周期的 PWMODrive 里因?yàn)?TIM1 同時(shí)還要輸出 PWMPWM 頻率和微步細(xì)分有關(guān)所以它的 PSC 和 ARR 需要綜合計(jì)算。打開固件源碼你會(huì)看到timer_freq和pwm_freq這兩個(gè)變量被反復(fù)計(jì)算就是在調(diào)這組參數(shù)。有一個(gè)細(xì)節(jié)值得注意ODrive 支持 PWM 中心對(duì)齊模式也就是定時(shí)器計(jì)數(shù)先往上加、再往下減。這種模式下的更新事件頻率是 PWM 頻率的兩倍一個(gè)完整的三角波周期產(chǎn)生兩次溢出中斷如果你不理解這一點(diǎn)后面分析中斷觸發(fā)頻率時(shí)會(huì)卡住。2.2 中斷服務(wù)函數(shù)的編寫風(fēng)格ODrive 的中斷服務(wù)函數(shù)寫得非常干凈沒有一堆 if-else。它直接在中斷里調(diào)用一個(gè)統(tǒng)一的入口函數(shù)然后這個(gè)入口函數(shù)內(nèi)部會(huì)做一次“當(dāng)前階段判斷”決定這一拍要執(zhí)行什么任務(wù)??创a的時(shí)候你會(huì)發(fā)現(xiàn)ODrive 的 TIM1 中斷服務(wù)函數(shù)本身非常短真正的大頭在Motor::update()這類函數(shù)里。這種風(fēng)格的好處是中斷入口保持極短減少中斷延遲控制邏輯獨(dú)立成類方便復(fù)用和測(cè)試。這里給你一個(gè)實(shí)操層面的建議寫電機(jī)控制代碼時(shí)不要往中斷里塞浮點(diǎn)打印、塞日志、塞編碼器數(shù)據(jù)的串口發(fā)送。你在調(diào)試時(shí)可能會(huì)忍不住想“順便發(fā)個(gè)數(shù)據(jù)看看波形”但只要串口傳輸時(shí)間超過了控制周期控制環(huán)就被你親手毀了。ODrive 的做法是中斷里只操作共享內(nèi)存標(biāo)志通信任務(wù)由主循環(huán)統(tǒng)一處理。2.3 優(yōu)先級(jí)與搶占為什么 NVIC 配置必須正確NVIC嵌套向量中斷控制器的優(yōu)先級(jí)配置是 ODrive 能穩(wěn)定運(yùn)行的又一關(guān)鍵。Cortex-M4 支持搶占優(yōu)先級(jí)和子優(yōu)先級(jí)。ODrive 把 TIM1 更新中斷的搶占優(yōu)先級(jí)設(shè)為最高這樣任何時(shí)刻來了控制中斷其他中斷都得讓路。哪怕你正在處理 USB 傳輸控制中斷來了也會(huì)先打斷 USB 服務(wù)函數(shù)跑完控制任務(wù)再回去繼續(xù)處理 USB。我見過不少人把控制中斷的優(yōu)先級(jí)和串口中斷設(shè)成相同優(yōu)先級(jí)或者只比串口高一點(diǎn)點(diǎn)結(jié)果電機(jī)運(yùn)行的時(shí)候偶發(fā)抖動(dòng)電流波形上出現(xiàn)毛刺。原因很簡(jiǎn)單串口中斷本來就頻繁如果控制中斷排隊(duì)等串口處理完那這個(gè)周期的控制計(jì)算就被延遲了執(zhí)行時(shí)間抖動(dòng)自然體現(xiàn)在電機(jī)噪音里。正確配置分兩步在NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority里設(shè)置最高搶占優(yōu)先級(jí)。確保NVIC_IRQChannelSubPriority不會(huì)因?yàn)槠渌?jí)中斷導(dǎo)致?lián)屨蓟靵y。需要記住的是分配給控制環(huán)中斷的時(shí)間資源是定死的一旦被搶走這個(gè)控制周期就補(bǔ)不回來。這是硬實(shí)時(shí)系統(tǒng)的基本特性。2.4 時(shí)基相關(guān)的幾個(gè)“坑”很多人把 ARR 配置成 PWM 頻率對(duì)應(yīng)的值卻發(fā)現(xiàn)更新中斷頻率不對(duì)原因就是上面說的中心對(duì)齊模式下更新事件觸發(fā)在頂點(diǎn)和底點(diǎn)。有些定時(shí)器配置需要在初始化時(shí)額外生成一次更新事件否則第一次中斷不會(huì)來。PSC/ARR 修改后需要重新初始化定時(shí)器或者使用影子寄存器功能否則會(huì)出現(xiàn)一個(gè)周期內(nèi) PWM 頻率突變的問題。我對(duì)這項(xiàng)工程印象最深的一點(diǎn)是ODrive 里為了精確限制 PWM 的更新頻率專門用了一個(gè)叫PWM_UPDATE_MECH的機(jī)制它保證 PWM 在線更新時(shí)的相位同步這種細(xì)節(jié)如果不是自己調(diào)過毛刺很難想到。3. 實(shí)操過程與核心環(huán)節(jié)實(shí)現(xiàn)3.1 時(shí)基初始化代碼分析打開 ODrive 固件源碼找到init_pwm()函數(shù)核心工作就是配置 TIM1。我在這里用偽代碼加注釋的方式還原一下配置流程方便你對(duì)照源碼理解void init_pwm(TIM_TypeDef* TIMx) { // 1. 先把定時(shí)器時(shí)鐘打開以 APB2 為例 RCC_APB2PeriphClockCmd(RCC_APB2Periph_TIM1, ENABLE); // 2. 時(shí)基單元初始化設(shè)定 PSC 和 ARR TIM_TimeBaseInitTypeDef tim_init; tim_init.TIM_Prescaler 你算好的 PSC; tim_init.TIM_Period 你算好的 ARR; tim_init.TIM_CounterMode TIM_CounterMode_CenterAligned1; // 中心對(duì)齊模式 TIM_TimeBaseInit(TIMx, tim_init); // 3. 如果是中心對(duì)齊模式需要單獨(dú)設(shè)置更新中斷的觸發(fā)時(shí)機(jī) // 一般在頂點(diǎn)/底點(diǎn)都觸發(fā)實(shí)際頻率為 PWM 頻率的 2 倍 // 4. 使能更新中斷 TIM_ITConfig(TIMx, TIM_IT_Update, ENABLE); // 5. 使能定時(shí)器 TIM_Cmd(TIMx, ENABLE); }這一段就能解釋很多事TIM_Period決定了 PWM 的周期也決定了更新中斷的間隔。如果你手頭跑的是 ODrive v3.x 固件默認(rèn)的 PWM 頻率在 20k~40k 之間配合中心對(duì)齊模式更新中斷頻率變成 PWM 頻率的兩倍。但是ODrive 內(nèi)部會(huì)配置成“只在底點(diǎn)觸發(fā)中斷”這樣就保證中斷頻率仍然是 8 kHz同時(shí) PWM 頻率更高能有效降低電機(jī)噪音。實(shí)測(cè)下來這一步配置正確與否區(qū)別非常大配置錯(cuò)了控制環(huán)頻率變成 PWM 頻率的另一倍電流環(huán)參數(shù)就得重新調(diào)。3.2 PWM 比較寄存器更新定時(shí)器時(shí)基只是骨架真正的控制輸出體現(xiàn)在 PWM 占空比上。FOC 控制最后一步是生成三路 SVPWM 信號(hào)每路信號(hào)的占空比對(duì)應(yīng)逆變器三相的開關(guān)狀態(tài)。ODrive 的做法是在控制中斷里算出三相占空比數(shù)值然后寫入 TIM1 的三個(gè)比較寄存器CCR1/CCR2/CCR3。因?yàn)閱⒂昧祟A(yù)裝載寄存器實(shí)際的比較值更新會(huì)發(fā)生在下一個(gè)周期開始時(shí)這樣避免了一個(gè)周期內(nèi) PWM 占空比突變導(dǎo)致的電流畸變。這個(gè)“預(yù)裝載”機(jī)制用生活類比來說有點(diǎn)像樂隊(duì)指揮。指揮定時(shí)器給每個(gè)樂手比較寄存器一個(gè)樂譜預(yù)裝載值但樂手們不會(huì)在指揮手一揮的瞬間立刻改而是等到這個(gè)小節(jié)結(jié)束、下一小節(jié)開始的時(shí)候才統(tǒng)一翻頁(yè)。這樣就保證了每個(gè)人都在同一個(gè)節(jié)拍點(diǎn)切換不會(huì)有人早半拍有人晚半拍。3.3 執(zhí)行頻率驗(yàn)證方法怎么確認(rèn)系統(tǒng)真的是按 8 kHz 在跑你不會(huì)去用示波器測(cè)量中斷執(zhí)行時(shí)間——測(cè)一個(gè)中斷執(zhí)行時(shí)間實(shí)際上是很難的事情。常見的做法是在中斷服務(wù)函數(shù)入口翻轉(zhuǎn)一個(gè) GPIO。用示波器看這個(gè) GPIO 的方波頻率就能直接讀出控制環(huán)頻率。再用示波器測(cè)量中斷執(zhí)行時(shí)間也就是 GPIO 高電平的寬度就能看出每個(gè)控制周期用了多少 CPU 時(shí)間。實(shí)測(cè) ODrive 在 8 kHz 控制頻率下完整跑完一輪電流環(huán)速度環(huán)位置環(huán)大約占用 80~120 微秒。這個(gè)數(shù)字和 125 微秒的控制周期一比你會(huì)發(fā)現(xiàn)在 CPU 還有余量。那為什么不用 16 kHz因?yàn)殡娏鳝h(huán)的帶寬不光取決于執(zhí)行頻率還受限于 ADC 采樣時(shí)間、PWM 死區(qū)時(shí)間、編碼器讀取延遲等因素頻率翻倍并不代表性能翻倍。3.4 中斷到控制環(huán)的調(diào)用鏈ODrive 里中斷服務(wù)函數(shù)和你真正想找的 PID 邏輯之間隔了一層“調(diào)度邏輯”??聪潞?jiǎn)化后的調(diào)用順序TIM1_UP_TIM10_IRQHandler - Motor::update() - read_encoder() / read_current() - current_controller_.update() - controller_.update() // 包含位置環(huán)、速度環(huán)邏輯 - write_pwm_commands()每一步都有講究。讀編碼器必須在控制周期開始階段做越早越好因?yàn)榫幋a器讀數(shù)越接近這個(gè)周期開始時(shí)的真實(shí)速度速度環(huán)的采樣延遲越小。讀電流采樣值也類似它直接決定了電流環(huán)的響應(yīng)質(zhì)量。控制環(huán)的實(shí)際執(zhí)行順序是內(nèi)環(huán)電流環(huán)先執(zhí)行外環(huán)速度/位置后執(zhí)行。之所以電流環(huán)最優(yōu)先是因?yàn)殡娏鳝h(huán)的反電動(dòng)勢(shì)更快延遲會(huì)導(dǎo)致電流相位滯后直接影響力矩輸出的精度。3.5 主循環(huán)與中斷的數(shù)據(jù)交換主循環(huán)和中斷經(jīng)常需要共享數(shù)據(jù)比如用戶通過上位機(jī)改了速度指令這個(gè)指令需要通過 USB 中斷傳到主循環(huán)再在主循環(huán)里寫入共享內(nèi)存下一拍控制中斷就會(huì)讀到新的目標(biāo)值。這個(gè)數(shù)據(jù)交換的實(shí)現(xiàn)處處體現(xiàn)“無(wú)鎖編程”的思想。中斷里只是讀取共享變量主循環(huán)只在安全時(shí)機(jī)修改共享變量或者用獨(dú)立的緩沖區(qū)完成狀態(tài)同步。你在源碼里不會(huì)看到一堆 mutex那是因?yàn)?ODrive 故意把數(shù)據(jù)流設(shè)計(jì)成了單生產(chǎn)者單消費(fèi)者的模式。真要在自己的工程里復(fù)刻這套邏輯先別急著加鎖先想想你的數(shù)據(jù)流是不是單向的。單向數(shù)據(jù)流加上內(nèi)存屏障基本就夠了。4. 常見問題與排查技巧實(shí)錄4.1 控制環(huán)頻率不對(duì)的排查步驟這是最常遇到的問題。你按照源碼改了參數(shù)覺得應(yīng)該是 8 kHz但測(cè)量出來要么翻倍要么減半。第一步確認(rèn) TIM1 的時(shí)鐘源頻率。很多人從別的工程拿了初始化代碼芯片主頻不同APB2 分頻不同時(shí)基就差出來了。用 debugger 直接讀 RCC_CFGR 寄存器的值這個(gè)最靠譜。第二步確認(rèn)計(jì)數(shù)器模式。如果你用的是中心對(duì)齊更新事件頻率和 PWM 頻率的關(guān)系是兩倍關(guān)系。尤其要注意 ODrive 里使用的是 CenterAligned1 模式更新中斷在計(jì)數(shù)頂點(diǎn)和底點(diǎn)都會(huì)觸發(fā)必須檢查中斷標(biāo)志位過濾邏輯。第三步看中斷優(yōu)先級(jí)有沒有被其他頻繁中斷搶占。如果中斷優(yōu)先級(jí)配錯(cuò)控制中斷的執(zhí)行間隔會(huì)出現(xiàn)偶發(fā)變長(zhǎng)你在示波器上看到的不再是干凈的方波。我處理過最多的 case 是明明代碼沒問題但控制環(huán)頻率偏了最后發(fā)現(xiàn)是 APB2 分頻設(shè)置被別的初始化函數(shù)改了。建議每次配置定時(shí)器之前先打印一下定時(shí)器時(shí)鐘頻率。4.2 電機(jī)運(yùn)行時(shí)抖動(dòng)、噪音大的原因噪音大的原因往往不是 PID 參數(shù)太激進(jìn)而是底層時(shí)基不干凈。如果控制環(huán)執(zhí)行時(shí)間抖動(dòng)在幾個(gè)微秒以上電流環(huán)輸出的相位噪聲會(huì)直接變成電機(jī)抖動(dòng)。這里有個(gè)實(shí)用的診斷方法把控制環(huán)的執(zhí)行時(shí)間測(cè)出來把執(zhí)行時(shí)間的波形和電流波形放到同一個(gè)時(shí)間軸上對(duì)比。如果電流波形上的毛刺出現(xiàn)的位置和執(zhí)行時(shí)間變長(zhǎng)的位置重合那問題就在中斷優(yōu)先級(jí)或者中斷阻塞上。還有一個(gè)隱蔽的原因電流采樣值是在 PWM 計(jì)數(shù)器頂點(diǎn)觸發(fā)的 ADC 采樣的如果你把采樣點(diǎn)配置錯(cuò)了采樣到的電流值會(huì)帶有巨大的開關(guān)噪聲進(jìn)而導(dǎo)致電流環(huán)計(jì)算出來的占空比噪聲放大。4.3 定時(shí)器更新中斷偶爾丟失的問題定時(shí)器更新中斷不會(huì)“丟”但確實(shí)會(huì)發(fā)生“被同優(yōu)先級(jí)中斷屏蔽”的情況。Cortex-M 的中斷系統(tǒng)里如果正在處理一個(gè)優(yōu)先級(jí)相同的中斷新到的中斷必須等待。而 TIM1_UP_TIM10 這個(gè)中斷向量在 ODrive 里同時(shí)也對(duì)應(yīng)用途不那么嚴(yán)格的 TIM10。如果你在代碼里開了 TIM10而又不小心把優(yōu)先級(jí)設(shè)成和 TIM1 一樣那 TIM10 的中斷就會(huì)跟控制環(huán)搶執(zhí)行時(shí)間。這種問題的排查很痛苦因?yàn)楝F(xiàn)象像是“偶爾丟中斷”。唯一的辦法是全工程搜索所有定時(shí)器中斷把控制環(huán)中斷優(yōu)先級(jí)設(shè)為絕對(duì)最高其他所有中斷都要讓路。4.4 看門狗和暫停操作帶來的問題ODrive 支持通過上位機(jī)暫停電機(jī)暫停操作本身會(huì)直接關(guān)閉 PWM 輸出但定時(shí)器還在跑。如果你在暫停時(shí)還需要保持控制環(huán)的編碼器讀數(shù)更新那定時(shí)器不能停。ODrive 的處理是暫停狀態(tài)只置標(biāo)志位控制環(huán)還在繼續(xù)跑只是輸出占空比被置為安全值。如果你自己寫代碼時(shí)用了“暫停就關(guān)定時(shí)器”的做法那再啟動(dòng)時(shí)要重新做同步很容易漏掉 PWM 的初始相位同步電機(jī)啟動(dòng)時(shí)會(huì)有彈跳。我的建議是暫停就封 PWM 輸出讓控制環(huán)繼續(xù)空轉(zhuǎn)。4.5 控制環(huán)頻率參數(shù)怎么調(diào)整才安全如果你想試 16 kHz 控制環(huán)不要只改定時(shí)器。你要同時(shí)確認(rèn)三件事ADC 采樣時(shí)間是否足夠短。電機(jī)驅(qū)動(dòng)芯片的硬件過流保護(hù)響應(yīng)時(shí)間是否跟得上。電流環(huán) PI 參數(shù)是否需要重新整定。頻率翻倍后執(zhí)行時(shí)間也翻倍你必須先量測(cè)新的執(zhí)行時(shí)間是否還在控制周期內(nèi)。如果執(zhí)行時(shí)間接近甚至超過控制周期那不用測(cè)也知道結(jié)果——系統(tǒng)完全不工作。我實(shí)測(cè)過ODrive 默認(rèn)狀態(tài)下的執(zhí)行時(shí)間大約在 80 微秒左右升到 16 kHz 時(shí)執(zhí)行時(shí)間會(huì)略長(zhǎng)但依然有裕量。問題是 PID 參數(shù)需要重調(diào)不然同樣的帶寬目標(biāo)下離散化誤差變了增益也需要調(diào)整。5. 斷電重啟后時(shí)基配置的校驗(yàn)與調(diào)試5.1 上電初始化順序的講究ODrive 的初始化順序是有講究的先初始化時(shí)鐘樹再初始化 GPIO再初始化定時(shí)器最后配置中斷和全局變量。如果你把定時(shí)器初始化放在編碼器接口初始化之前有的編碼器接口配置會(huì)順手把定時(shí)器的重映射改掉導(dǎo)致時(shí)基計(jì)算對(duì)不上。調(diào)試的時(shí)候我建議你在定時(shí)器初始化函數(shù)里加一個(gè)斷點(diǎn)打印 ARR 和 PSC 的最終值先確認(rèn)這兩個(gè)數(shù)和你預(yù)期一致。然后再往下走等跑到控制中斷里再打印讀到的編碼器值確認(rèn)真實(shí)物理量進(jìn)入系統(tǒng)。5.2 一個(gè)快速驗(yàn)證時(shí)基是否穩(wěn)定的技巧想讓控制環(huán)穩(wěn)定運(yùn)行你可以不用 PID 輸出先做開環(huán)測(cè)試。給一個(gè)固定占空比跑起來看電機(jī)是不是勻速轉(zhuǎn)動(dòng)。如果電機(jī)轉(zhuǎn)動(dòng)時(shí)有明顯的卡頓感說明控制執(zhí)行頻率不穩(wěn)定或者 PWM 更新時(shí)機(jī)不對(duì)。這個(gè)測(cè)試簡(jiǎn)單但非常有效它能幫你把“時(shí)基問題”和“控制算法問題”分離。時(shí)基不穩(wěn)后面調(diào)什么都白搭先解決基礎(chǔ)問題再往上層走。5.3 關(guān)于調(diào)試接口是否影響時(shí)基的說明很多人開著調(diào)試器跑電機(jī)的時(shí)候發(fā)現(xiàn)電機(jī)聲音跟拔掉調(diào)試器不一樣。這不是錯(cuò)覺。調(diào)試器的實(shí)時(shí)跟蹤機(jī)制會(huì)影響 CPU 執(zhí)行效率如果開啟了DEBUG_MODE里的 trace 或者頻繁斷點(diǎn)控制環(huán)的時(shí)間微調(diào)會(huì)受影響。我的建議是關(guān)閉 J-Link 的實(shí)時(shí)數(shù)據(jù)請(qǐng)求盡量不要在中斷里打斷點(diǎn)。每次打斷點(diǎn)中斷服務(wù)函數(shù)的時(shí)間特征都不一樣。你可以把數(shù)據(jù)寫到內(nèi)存里等停了再讀效果遠(yuǎn)好于打斷點(diǎn)。6. 寫在最后的個(gè)人實(shí)操心得說實(shí)話我自己第一次讀 ODrive 源碼的時(shí)候最大的感受不是它的 FOC 算法多精妙而是它對(duì)“時(shí)間”這件事的認(rèn)真程度。每一段代碼都在小心翼翼地維護(hù)一個(gè)確定性的時(shí)間節(jié)奏。這種節(jié)奏一旦被打破什么高級(jí)算法都救不回來。從定時(shí)器時(shí)基到 8 kHz 控制環(huán)本質(zhì)上就是在回答一個(gè)問題你憑什么保證每隔 125 微秒做一次一樣的動(dòng)作答案是用硬件定時(shí)器用嚴(yán)格的優(yōu)先級(jí)配置用不阻塞的中斷服務(wù)函數(shù)用預(yù)裝載寄存器來同步輸出。如果你打算在自己的工程里復(fù)刻這套機(jī)制先別急著抄代碼先把下面這幾個(gè)問題想明白你的控制頻率是多少為什么是它你的時(shí)基用的是哪個(gè)定時(shí)器它和 PWM 是什么關(guān)系你的中斷服務(wù)函數(shù)里有多少事在做是不是有不必要的操作你的中斷優(yōu)先級(jí)配對(duì)了沒有還有沒有其他中斷在執(zhí)行時(shí)阻塞了控制環(huán)把這些問題的答案寫下來再做代碼移植你會(huì)發(fā)現(xiàn) ODrive 源碼瞬間“透明”了。最后再分享一個(gè)小技巧調(diào)試時(shí)把控制環(huán)執(zhí)行時(shí)間、控制頻率、PWM 占空比更新延遲這幾個(gè)參數(shù)做成變量塞進(jìn) ODrive 自己的日志系統(tǒng)里用上位機(jī)實(shí)時(shí)拉曲線。我靠這個(gè)方法排查過好幾個(gè)詭異的問題——某個(gè)變量看起來是平均值正常但瞬時(shí)值已經(jīng)跑飛了。這種級(jí)別的排查光靠看代碼是看不出來的。下一篇文章我會(huì)繼續(xù)拆解電流環(huán)的代碼重點(diǎn)講 Clarke/Park 變換在固件里怎么寫的、電流 PI 調(diào)節(jié)器的抗飽和機(jī)制以及 SVPWM 那段代碼背后的數(shù)學(xué)原理。到時(shí)見。
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
婷婷伊人激情婷婷| 夜夜穞天天穞狠狠穞AV美女按摩| 色播播五月天| 五月成人网站| 亚洲人妻av| 天天干天天干天天干天天干天天干| 99色| 艹B高清无码| 丁香五月婷婷欧美性爱| av在线免费网站 | 97色色在线视频| 综合网五月| 婷婷无码视频| 天堂伊人干| 超碰2021| 天搞天天天天天| 国产精品噜噜在线视频| 天天综合色综合| 久久色频| 婷婷五月丁香综合激情| 狠狠干综合| 色五月丁香91| 五月色网| 色色哒五月婷婷六月丁香| 激情 婷婷| 丁香五月婷婷影院| 啪啪九九色| 大香AV| 超碰人妻在线| 色婷婷狠狠干芒果TV| 丁香激情五月天| 99ri视频| 久久精品系列| 丁香五月aV| 色综合天天综合成人网| 日日影院 | 精品自拍99| 色婷婷AV在线| 久久这里99| 99这里都是精品| 日本99视频| 亚洲中文字幕在线观看| 91精品国产91久久久久青草| 狠狠五月综合在线| www.色五月| 五月天久久小说| www.91色| 99这里有精品| 91色性感五月婷婷丁香| 另类激情五月| 深爱激情综合网| 亚洲综合在线伊人婷| 久热最新视频 | 五月天综合久久丁香91| 色婷婷成人在线| 思思热AV| 久久精品A片777777| 婷婷成人在线| 能看的av片| 91se在线视频| 自拍视频在线观看9| 99视频色在线观看| 人妻久久婷婷| 免费在线a| 99热婷婷| 极品人妻VIDEOSSS人妻| 婷婷九月亚洲| 亚洲尤物在线| 色色婷婷五月天| 久久久精品婷婷五月天| 亚洲天天免费| 五月天成人综合| 99久久終合| 激情五月天在线| 色玖玖导航| 五婷婷综合网| 九九色综合| 九九热99热| 国产亚洲精品久久久久久豆腐| 久久免费丁香| 色五月丁香婷婷| 白天AV月月| 五月天开心网| 中文字幕乱码亚洲精品一区| 婷婷综合视频| 99黄色| 九九热精品视频在线观看| 五月婷婷六月天| 久久密臀婷婷| 久久只有这里精品免费| 色婷婷狠狠干芒果TV| 影音先锋一区二区三区| av不卡网站| 色色九九五月天| 99热这里只有精品21| 9热久久| 色的色综合| av网址在线| 久久九九99视频| 久久精品99久久久久久久久| 婷婷五月永远18免费久久久| 久色视频| 国产午夜伦鲁鲁| 97五月婷婷| 婷婷五月天成人动漫| 五月婷婷在线免费| 日韩少妇内射免费播放| 婷婷五月天成人导航| 91久久婷婷人人澡草| 99操| 99综合熟女| 亚洲天天免费| 激情综合久久| 婷婷丁香五月激情密臀av| 立川无码av| 丁香五月成人婷婷| 久久久亚洲成人无码A片| 色五月首页| 国产精品色婷婷AV综合色色| 色色热| 五月天伊人久久久久| 日韩一区二区三区无码| 狠狠爱激情网| 丁香社92视频| 婷婷成人小说综合| 五月丁香在线| 五月丁香久久| 五月色丁香| 99色色网| 超碰成人电影| 五月婷婷熟女| 丁香五月电影| 五月开心婷婷网| 任你爽精品免费视频6| 色综合中文色综合网| 国产激情av| 大香蕉久久婷婷| w婷婷五月婷婷w| 五月激情视频网| 99热在线精品播放| 国产成人亚洲综合亚洲| www色婷婷久久综合久色| 丁香九月婷婷综合| 久久久激情| 天天色播| 少妇2做爰HD韩国电影| 色yeye色综合| 激情五月天色色网| 婷婷五月开心中文字幕色| 欧美电影在线播放| 丁香五月天AV| 亚洲av成人在线| 啪啪一区| 思思99热在线| 日本wwww在线| 美女激情综合| 五月婷婷久久爱| 任你搞免费视频观看| 精品A√| 再綫Av免费視品| 操一操干一干| 久久久久视剧HD| 伊人婷婷色激情丁香| 99久久9| 久久Xx| 思思色综合网站| 五月丁香综合激情| 婷婷六月丁香五月| 99色在线视频观看| 能看的av| 伍月婷丁香花全集| 中文字幕在线免费| 亚洲狠狠终合停停终合| 伊人婷婷大香蕉| 久久久久亚洲AV成人无码电影| 激情久久肏屄视频| 开心五月丁香啪| 久久国产AV| 丁香五月91| 五月天婷五月天综合网小说首页-五月天激激婷婷大综合,婷婷亚洲综合五月天小说 | 免费V片在线| 丁香六月欧美| 天天久久狠狠色综合| 久热超碰91| 超碰在线观看成人视| 丁香六月婷婷综合啪啪| 超碰99热在线观看| www91精品| 久久婷婷五月综合伊人| 欧美性色五月天| 激情久久丁香| av中文网| 欧美日朝成人| 日日操,天天操| 99热线观看9| 99热99在线| 日日操,夜夜撸| 9l视频自拍九色9l视频在线观看| 97色色色| www.五月婷婷.com| 丁香五月婷婷欧美成人色图| 狠狠爱综合| www.91热久久| 91精品国产91久久久久青草| 色丁香五月| 激情五月天色婷婷综合| 日日夜夜狠狠干| 人人操超碰| 久久这里有精品视频在线免费观看| 大地资源色婷婷视频在线| 亚洲人人操| 婷婷五月天激情网站| 91日本在线| 久久婷婷艹| 日本女人久久| 色综合久久伊伊婷婷五月| 99色在线| 日本久久极品| 色婷婷狠狠禁久久| www狠狠| 亚州激情在线视频| 四川BBB搡BBB搡多人乱亂| 九九在线热九九在线热99热| 亚洲激情综| 超碰日日操| site:pnnrt.com| 丁香五月精品视频| 婷婷五月电影院| 亚洲免费av观看| 超碰国产在线| 亚洲激情五月丁香久久久久| 日本在线观看aaa 99| 婷婷射婷婷舔| 久久五月激情综合| 久久这里有精品| 狠狠五月丁香色婷| 丁香五月婷婷基地| 五月色丁香婷婷中文字幕| 色狠狠婷婷| 五月亚洲| 国产亚洲99久久精品| 99久久久99久久91熟女| 夜夜撸日日骑| AV在线观看网站| 九月性爱网| 久久婷婷亚洲| 91超碰在线观看| 日韩啪啪网| 综合色情网| 久草婷婷| 五月色网| 婷婷免费无马| 最近中文字幕2019视频1| 一区二区免费看| 天天日天天干天天爽| 婷婷五月色丁香在线看| 99热九九在线| 超碰renrenai| 天堂婷婷五月在线| www.99热国产| 婷婷丁香中文字幕| 亚洲情综合五月天| 操人妻AV| 婷婷五月天激情网| 丁香六月婷婷久久综合| 久久丁香五月| 色色丁香| 国产偷人爽久久久久久老妇APP| 五月天开心网| 超碰久热| 色婷婷成人做爰A片免费看网站| 丁香五月婷婷基地| 99热啪啪| 202丰满熟女妇大| 国内外色色色色色成人视频| 丁香五月av| 99激情| 色色网站| www.久久99| 99热97| 日韩色色视频| 伊人综合网站| 激情丁香五月| 色婷婷色99国产综合精品| 五月天婷婷色| 伊人在线视频| 午夜精品人妻无码一区二区三区| 伊人激情AV一区二区三区| 亚洲色久| 色综合色综合网| 91久久久久久| www.99视频| 激情开心五月天| 亚洲精品久久久久AV无码| 精品一区二区三区四区五区六区| 欧美精品XXXXBBBB| 黄桃AV无码免费一区二区三区| 久久天天| 色五月xxx| 国产JK精品白丝AV在线观看| 国产热精品| 影音先锋五月婷婷| 亚洲成人无码网站| 天天干天天操天天爱| 麻豆精品| 久色| 天天操天天干天天射| ss99热| 原琪琪色影院| 天天透天天干| 亚洲电影中文字幕| 影音先锋毛片网站| 99精品视频网| 五月激情网络| 婷婷大乡焦噜噜| 综合婷婷五月丁香在线观看| 五月天婷婷网站888| 玖玖99婷婷| 婷婷亚洲丁香五月| 婷婷六月激情| 成人午夜无码视频| 99热精品在线| 亚洲无码yw| www.韩日视频| 夜夜躁狠狠 | xxxx五月激情| 碰超99| 夜色综合网| 五月天婷婷婷| 五月婷婷久久网| 亚洲五月天综合| 婷婷色五月亚洲| 久久刺激网| 亚洲成人网站在线| 婷婷五月天av| 99精品国产乱码久久久人妻| 97色碰| 五月天激情图片| 99热官网| 色综合久久无码| 五月丁香六月色| 新激情五月天天在线网| 天天日天天干天天插天天射| 伦99热| 人人操Av| 亚洲第一黄网| 五月天婷婷成人资源站| 99er精品视频| 久久激情网| 五月天另类小说久久小说网| 97婷婷色| 五月天天天色| 天天综合色| 99久热在线精品99re6热| 啪啪综合| 五月开行婷婷色五月| 色五月色五天色情网| 婷婷五月六月丁香| 婷色五月天| 亚洲黄色av网站| 99热成人| 丁香花五月天激情| 婷婷丁香色情| 深爱1激情网| 色 五月婷婷基地| 丝袜人妻| 色域五月婷婷丁香| 日韩五月丁香| 久婷婷| 欧美婷婷色| 99爱视频在线| 日本在线va| 久久久久久人妻久久久久久久久久人妻久久久 | 亚洲日韩乱码一区二区三区四区| 九九九九这里只有精品| 欧美日本国产欧美日本韩国99| 丁香五月六月综合激情| 91精品久久久久久综合五月天| 九九久久综合网站| 婷婷五六日| 色欲Av五月天| 性韩日色婷婷五月天激情啪啪XXX| 国产操碰| 97成人丁香| 亚洲成人无码专区| 在线观看996精品| 大香蕉在线99热| 9色资源在线| 人五月天婷婷喷水| 99色色视频| 在线可以看的av网址| 人人操A| 六月婷婷七月丁香| 欧美色欲色欲天天天www| 婷婷五月色网| 五月婷婷激情在线| 久久 婷婷 五月天| 五月天久久www| 99久久网站| 激情中文在线| 五月婷婷av| 伊人在线视频| 日本美女天天日天天爽| 丁香五月在线观看| www九九热| 五月天婷婷免费视频| 国产在线网址1| XX色综合| 精品久久久久成人码免费动漫| 五月婷婷六月丁香玖玖玫瑰91| 丁香婷色| 久久香蕉婷婷五月天| 久久男人网婷婷| 精品久热| 九九99在线观看视频| 夜夜干夜夜操| 日韩小视频在线99| 米奇影视资源777狠狠色婷婷五月天激情网| 日本欧美在线| 欧美毛卡| 婷婷色五月婷| 99九九在线视频| 99热这里只有精品16| 亚洲综合五月天婷婷| 日本在线免费中文com.| 强辱丰满人妻HD中文字幕| 五月久久婷婷丁香| 国精产品一区一区三区有限公司杨 | 涩五月婷婷| 成人网站av免费网站推荐| 婷婷丁香激情| 69精品人人人人人人人人人| 五月丁香黄色视频| 亚洲精品网站色视频| 激情五月丁香五月| 大地9中文在线观看免费高清| 91综合在线观看首页| www.99热| 99热综合在线| 五月婷综合| 五月丁香激情综合六月涩涩爱| 日韩色久| www.色窝| 99热只有| 97久久超碰| 国产亚洲精品久久久久久久久动漫 | 婷婷无码视频| 天天摸色吧天天摸色吧| 99热精品在这里| 99热这里只有精品1| 天天干天天操天天拍| jiZZdr| 97色在线| 婷婷六月啪啪| 久久久久久天天日天天爱| www久久99| 欧美久久网| 九九久久99精品免费观看www| 五月天婷婷基地综合网| 国产91资源在线| 激情婷婷五月丁香啪啪啪| 午夜福利成人AV91| 激情综合啪啪| 久久欧洲综合网| 激情综合色婷婷六月天| 夜夜骑夜夜撸| 超碰亚洲欧美| 99在线资源| 婷婷六月综合在线| 国产无套精品一区二区| 婷婷六月色开| 99热综合| 9 9 9色色| 久久五月天婷婷视频| 另类综合国产| 五月激情啪啪| 亚洲无码性爱| 欧美三级欧美一级| 99视频在线观看视频| 丁香五月社区| 91中文在线| 精品一二三区久久AAA片| 久这里只有精品99| 丰满老熟妇BBBBB搡BBB| 亚洲综合视频网| 亚洲激情五月天| 99啪啪| 免费无码毛片一区二区A片 | 久99视频| 大香AV| 色婷婷av在线观看| 深爱激情五月网| 久久九九热视频| 五月停视频天堂| 五月停停999| 五月丁香久久呀| 久久精彩免费视频| 狠狠色丁香婷婷基地| 蜜桃五月天| 激情五月丁香五月| 97人人干人人操| 日本色色影片| 九九大香蕉黄色影院| 欧美婷婷精品激| 99爱在线视频| 五月天色婷婷网| 九九热在线99| 91精品丝袜久久久久久| 大香蕉视频婷| 成人必爱视| 夜夜爽天天日| 五月丁香综合网| 中文字幕,综合,91| 国产黄大片在线观看画质优化| 五月综合色播播丁香婷婷| 九九综合| 丁香五月伊人| 六月婷婷激情| 五月丁香六月| 久久久精品99亚洲综合| 青青999| 99爱视频在线观看| 五月丁香淫淫婷婷婷| 99热99在线| 欧美黄色一级录像| 这里只有精品视频99| 九九综合视频在线观看| 色婷婷情片| 少妇人妻偷人精品无码视频新浪| 思思热精品在线视频| 天天狠天天狠| 久久国产高清| 成人无码精品1区2区3区免费看| 舔色婷婷| 国产婷婷色五月| AV在线二十六页| 色婷婷影| 五月丁香六月婷婷婷婷| 92久久精品一区二区| 开心五月婷婷激情| 国产在线黄色| 99re免费在线视频| 婷婷婷婷婷开心无码播放| 婷婷五月天性色| 中文字幕乱码亚洲精品一区| 97超碰在线免费观看| 五月天色婷婷视频| 国产亚洲在线| 丁香久久激情俄| 精品人妻一区二区三区四区不卡在| 天天日夜夜曹| 国精产品一区二区三区| 99这里有精品视频3| 国产婷婷久久| 成人精品免费在线观看| 欧美大片| 婷婷狠狠操| 成人AV中文字幕| 亚洲aV写真天天综合网久久| 超碰97干| 亚洲一级AV在线免费播放| 成人草榴视频| ..真实国产乱子伦对白在线_欧| 综合啪啪| 五月丁香性爱| 天天五月天综合网址| 荡乳尤物3HP1V5| 99视频久久免费视频| 天天干天天爽| 亚洲小说五月婷婷| 九九亚洲| 深爱激情网婷婷| 亚洲中文字幕在线观看| 天天综合天天玩夜夜玩天天玩夜夜玩 | 色色性爱视频| 日日夜夜爽| 婷婷色情小说| 99er6热在线观看精品6| 蜜乳国产网站| 欧美丁香五月天| 五月丁香网中文字幕| ri电影在线| 丁香密臀AV激情网| 日韩欧美老妇性视频91久久久| 日韩操啪| 日韩在线一级| 国产亚洲色婷婷久久99精品91 www.riverspirits.org www.hnnun.com www.changh | 色五月婷婷久久| 色五月婷婷丁香婷婷| 99亚洲天堂| 99热伊人| 成人五月天婷婷| 五月婷婷深深爱| 97久人人| 日本高清久| 91精品无码| 天天干天天干天天操| 五月丁香久久网| 少妇做爰免费视看片| 天天艹夜夜爽| 中文AV网站| 婷婷丁香人妻天天爽| 超碰狠狠色| 婷婷综合成人五月天| 综合性视频99| 亚洲经典小视频| 亚洲A色| 26UUU精品一区二区| 九九热最新| 婷婷内射视频在线| 大香蕉久操| 大香蕉五月天婷婷| 99爱这里只有精品免费视频| 五月丁香久久久久| 91精品久久久久久| 99久热| 嫩草AV久久伊人妇女超级A| 苗黎美女四级成人版一级二级毛片| 六月五月天婷婷涩播在线| 五月天婷婷基地| 超碰97在线操| 亚洲乱啪| 久99久在线| 性韩日色婷婷五月天激情啪啪XXX| 色五月丁香五月五月婷婷| 精品综合久久久久久五月天| 婷婷干五月综合在线播放| 熟女激情五月天| 日本色色网站| 狠狠操综合| 中国AV性爱观看| 婷婷六久久| 色综合色| 丁香五月性爱| 色五月亚洲| 五月天综合久久| 最近免费中文字幕大全高清大全1 色狠狠色噜噜AV天堂五区 | 久草婷| 五月婷视频久久| 丁香五月社区| 日本人人xxx| 91色婷婷综合久久中文字幕二区| 99ER热精品视频| 狠狠干无码| 久久九九99| WWW嗯嗯啊啊啊啊| 九九在线视频| 五月婷婷综合色啪| 激情熟女网| 欧美精品999| 夜夜天天久久婷婷| 99热日| 99热超碰在线| 午夜丁香婷婷| 五月综合视频在线| 人人操大| 五月丁香啪啪网| 五月婷婷丁香色播网| 九热...av| 丁香五月天堂网| 综合激情站| 青青草原亚洲天堂| 五月激情综合网婷婷| 天天免费日日夜夜夜夜| 丁香五月天人体| 丁香婷婷基地| 婷婷成人五月天| 伊人大香久久| 激情五月婷婷综合网| 亚州在线中文字幕| 五月婷婷玖玖综合玖玖爱| 欧美日韩国产成人在线| 99婷婷五月天| 色老久久| 五月噜噜噜色综合| 色屌丝中文字幕| 色色五月天婷婷| 99精品热视频| 在线资源av-超碰中文在线-成人AV| 97亚洲色 torrent magnet| 996er在线观看| 色五月综合在线| 免费视频WWW在线观看网站| 婷婷丁香成人五月天| 色噜综| 久久色吧| 97香蕉碰碰人妻国产欧美| 大香蕉婷婷丁香天堂AV| 五月丁香婷婷激情在线视频| 国产熟女日日骚五月丁香爱| 婷婷五月天色播| 九九碰九九爱97| 草草操操| 久久艹网| 五月丁婷婷| 99久久极情精品一区| 大香蕉在线观看9| 色域五月婷婷丁香| 九九AV在线| 日韩欧美一区二区三区四区| 97色色色| 人人色AV| 五月99久久| 六月激情网| 九九精品自拍| 亚洲视频另类| 思思久久思思| 超碰在线国产| av无码电影| 五月婷婷综合潮喷| 久久国产一区二区三区| 亚洲色情久久| av在线观看网站| 超级碰碰视频无码| 五月丁香狠狠| 这里只有精品96| 婷婷丁香五月激情综合站_久久五月丁香激情综合_开心五月综合激情综合五月_婷 | 91人妻视频| 五月婷婷无码| 97人人干| 日韩成人综合网| 中文字幕欧美久久| 丁香六月婷婷综合在线| 日韩AV无码影片| 免费AV黄在线播放| 色色a| 色噜噜狠狠色综合成人99| 色婷婷五月天小说网| 欧亚成人A片一区二区| 激情综合啪啪啪| 婷婷五月天久久| 桃色激情五月天| 婷婷五月天第三页| 日韩日比视频在线| 另类图片婷婷五月天| www.9操| 久久只有这里精品免费| 婷婷伊人网| www久久99| 97在线精品视频| 97视频.干com| 91在线日| 欧美色图天堂网色| 五月婷视频| 中文字幕网站在线观看| 天天做天天爽| 久9视频免费播放| 婷婷五月天av| 99热精品观看| 国産精品| 天天爽人人综合免费7799| 九九色人| 日韩综合网络男女香蕉a片| 26UUU欧美激情一区二区| 超碰资源在线| 1024国产| 可以免费观看的av网址| 99久热这里只有精品| 99 热国产在| 欧美性爱五月天| 激情综合五月激情| 久热免费| 婷婷AV丁香| 337p大胆噜噜噜噜噜91Av| 久久伊人婷婷| 99熟女| 天天日天天色| 热99精品视频| 午夜婷婷五月天在线| 思思99热在线| 九九热免费视频| 色99xx| 婷婷五月无码| 婷婷的色色五月天| 91美女被操| 亚洲性爱干干| 狠狠干最新地址| 丁香五月婷久久| 色五月色图| 日日操夜夜撸| 九九色99| www.久久爱.c n| 五月天社区| 五月婷婷色男女| 97操在线| 日韩在线观看亚洲| 久久99热这里只有精品首| 色婷婷成人做爰A片免费看网站| 精久久色| 丁香六月婷婷久久亚洲天堂| 8区视频在线| 伊人五月天日日夜夜久久久天天| 男人的天堂婷婷色五月| 99激情视频| 思思久久99热| 国内自拍1区| 久99热在线观看| 噜综合| a级毛片一区二区免费视频| 日本婷婷综合精品| 色五月婷婷综合| 99超级碰免费视频| 性色做爰片在线观看WW| 久久久久久久91| 久操大屁股女人av| 丁香五月天.com| 五月婷婷亚洲| 五月丁香婷婷钟和色图| 91九色视频在线观看| 日韩色色小视频| 亚洲六月色| 亚洲精品久久久久久久久久吃药| 91欧美| 极品人妻VIDEOSSS人妻| 在线五月婷| 97碰人人操| 激情綜合網址| 99精品热视频只有精品10| 热99视频精品| 26UUU精品一区二区Com| 五月婷婷啪啪| 丁香五月欧美色综合| 天天弄天天爽| 日韩精品电影| 激情久久久久| 激情综合网激情五月天| 久久天天| 丁香五月色网| 天天拍夜夜爽日日| 五月丁香六月激情综合| 99热99干| 去干网av| 色综合av超碰| 99热思思| 午夜天天精品视频| 中文字幕黄色电影网址| 亚洲av日韩无码| 九九久久99精品免费观看www| 国产精品成av人在线视午夜片| 久青草影院| 久久婷婷综合五月天| 我要色综合五月婷婷| 六月丁香啪啪| 五月天停停日日| 在线五月婷| 日韩 mm 不卡| 岛囯综合激情网| 99自拍视频| 天天草天天爽| 99在线视频精品| 中文字幕色色| 天天拍夜夜爽日日| 66精品国产成人| 久久人人九| 99偷拍视频在线日本| 日本成人噜噜噜噜噜| 五月婷婷av| 五月婷婷激情网| 婷婷五月无码| 九九无码AV| 狠狠干五月天| 日日爽日日| 色吧综合网| 精品人人操| 六月婷婷综合| 青草青草久9视频在线视频| 这里只有视频精品| 五月婷婷视频| 性爱网六月丁香| 精品久久久久久久久久久久人妻| 婷婷色色五月天| 五月婷婷啪啪网| 色99在线视频| 97se在线视频| 国产婷婷色综合AV蜜臀AV| 久草天堂| 日日爽夜夜爽| 美女激情婷婷| 熟女乱论网| 成人国产综合| 在线超碰91| www天天干| 97精品人人A片免费看| AV在线资源| 九九无码| 日韩久综合| 激情五月婷| 97久久草草超级碰碰碰| 午夜爱爱爱成人| 婷婷丁香色五月亚洲| 人妻激情在线| 91se在线观看| 激情综合99| 五月欧美丁香在线观看| 久久九精品| 丁香激情五月天| 色www.con| 99热碰碰热| 91碰人人| 啪到高潮激情丁香五月| Av在线资源| 激情五月丁香综合网站| 91肏肏肏| 五月激情久久综合网| 日韩成人无码人妻| 人人叉久| 五月婷婷激情四月| 97碰碰在线观看视频| 色狠狠色| 综合九九久久| 天天激情欧美美女| 色婷久| 亚洲无AV在线中文字幕| 激情五月伊人婷婷| 91色综合网| 青青草色在线视频观看| 久久 婷婷 五月天| 99久久精品色老| 91久久精品无码一区二区三区| 五月天伊人综合| 久久久com| 另类激情中文| 婷婷5月天激情综合| 免费看成人AA片无码视频吃奶| 综合色五月天| 热99这就是精品视频| 99热首页| 五月丁香六月婷婷网| 人人草人人爱| 色婷婷天堂| 五月丁香婷中文| 粉嫩av蜜桃av蜜臀av| 九九激情网| 性综合网| 国产人妻人伦精品一区二区| 国产成人精品一区二区三区视频 | 99精品手机在线视频| 91熟妇大香蕉| 在线99精品| 99毛片| 天堂A∨在线| 久久久久久久综合狠狠综合| 婷婷基地成人五月天| 五月丁香综合久久| 久久久五月激| 91精品久久久久久综合五月天| 久久机热/这里只有精品| 天天干一干| www.超碰在线| 超碰在线成人| 五月天激情色色| 色五月天婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷 | 99热这里只有精品一| 婷婷丁香在线播放| 26uuu| 狼友视频在线观看18| 婷婷五月丁香五月| 国产精品人人做人人爽人人添| 日韩限制级大尺度黑料泄密大尺度视频一区二区在线观看 | 久久er99热精品一区二区| 秋霞AV吧| 日韩AV在线电影| 六月婷婷色色色| 九九热精品| 天天艹夜夜爽| 色婷婷五月在线| 狠狠综合网| 风流少妇A片一区二区蜜桃| 婷婷伊人久久无码色五月| 91久草五月天婷婷| 91视频久久久| 综合久久婷婷| 丁香五月激情月| 亚洲va欧洲va国产va不卡| 激情综合激情综合| 亚洲五月天激情| 91九色超碰| 日韩精品电影| 天天色综合天天| av网站中文| 色香欲综合| 天天日夜夜爽| 久久3级片| 一月婷婷色色| 五月久久五月激情| 亚洲五月天婷婷在线| 99在线观看视频| 91久久婷婷| 欧美大片| 中日韩狠狠色| 色综合播放| 天天综合网在线| 色婷婷激情| 久久综合55| 日韩影院三级| 99爱这里只有精品| 狠狠色噜噜色狠狠狠综合久久成人波| 狠狠狠狠狠狠色| 国产午夜精品AV一区二区麻豆| 9热在线视频精品| 狠狠狠婷婷五月综合| 精a品a| 久久激情五月婷婷| 色婷婷丁香女女| 国产91视频| 日韩av大全| 中文资源在线a| 666555。COm毛片| 91偷拍视频| 色婷婷丁香五月色综合网| 久久婷婷色| 久久精彩视频99| 综合欧美五月婷婷| 五月丁香偷拍| 婷婷五月天国产传媒| 九九99九九99偷拍视频免费看| 日日鲁鲁夜夜爽爽| 久99久在线| 成人AV片播放| 这里只有精品视频视频在线观看| 99re热视频这里只精品5| 色色99| 超碰av天堂| www..com色爱| 成人欧美日韩| 亚洲中文AV网站| 9久热免费视频99| 婷婷香五月综合激情| 思思热99热| 96丁香婷婷九月蜜桃综合久久| 亚洲操人| 六月婷婷色综合| 亚洲视频在线观看| 婷婷五月天堂| 色五月丁香五月天| 日韩色色视频| 97久久五月丁香婷婷| 六月婷婷亚洲| 97人妻碰碰中文无码久热丝袜| www.久9| 99热这里只有精品1998| 亚洲六月婷婷| 婷婷综合97| 99国产视频网| 久久A极片| 99久久综合| 日韩99视频| 无码人妻一区二区一牛影视| 99爱免费在线观看| 逼里香不卡| 欧美黑人巨大性生话| 99黄色性生活| 九色啦蜜臀| 国产综合A片| 丁香五月天无码| 120分钟婬片免费看| 婷婷丁香激情综合色情| 99爱视频在线观看这里只有精品| 97超碰,人人舔,人人操,人人摸 | www.夜夜操| 超碰99在线观看| 六月丁香婷婷综合狠狠爱夜夜爱| 激情五月丁香五月色| 爱爱色五月天| 开心五月网| 久草五月天| 六月丁香影院| 丁香五月五月婷婷欧美大香蕉 | 亚洲色五月| 九九99九九99九九99视频网| 久久久久人妻精品| 婷婷综合干| 五月天成人在线播放丁香| 99精品久久| 欧美操人| 伊人www22综合色| 超碰在线综合| 久久激情网| 婷婷五月丁香四射| 天天插天天| 亚洲免费综合一区| 亚洲开心激情网| 色爱综合网| 婷婷五月天av| 91精品久久久久久| 99热青青草| 另类综合激情| WWW99热| 日本操碰碰| 91色综合网| 九九精品综合| 在线免费观看激情视频| 天天色综合图片| 久草五月丁香婷婷综合| 亚洲最大五月天成人网| 美女被操一区二区| 五月天深爱激情网| 十二区无码| 风流少妇A片一区二区蜜桃| 丁香五月av在线| 人人操AV| 婷婷五月综合色中文字幕| 久久久久婷婷五月热综合| 丁香婷婷社区| 婷婷色五月婷婷姐妹| 综合激情四射一theav| 99色| 五月天婷婷基地| 天干干夜夜操| 色婷网| 丁香五月婷婷高清| 六月婷婷激情| 九色啦蜜臀| 九九亚洲小视频| 丁香婷婷网| 婷婷终合色图| 五月婷婷综合成人| 99热这里有精品| av色婷婷| 婷婷免费视频| 色五月婷婷婷婷| 午夜婷婷丁香| 久久一级片| 国产成人精品一区二三区熟女在线| 99人妻碰碰碰久久久久视| www色五月天| 99这里有精品免费| 五月婷婷激情性爱| 97超级碰碰碰久久久| 五月丁香五月婷婷| 婷婷六月综合基地| 婷婷五月六月激情| 伊人丁香五月| 欧美在线看| 婷婷丁香五月天操逼| 久久综合九色综合97婷婷| 欧美日韩aaa| 91丁香五月| 思思热精品在线观看| 最新午夜理论片| 日本啪啪天堂| 婷婷色偷拍| 中文字幕人妻AV| 久草丁香婷婷1024| 亚洲精品久久久无码| 成人丁香五月天| AV在线观看网站| 麻豆雪千夏| 成人va在线播放| 婷婷娌伦网| 99性爱视频网站| 五月婷婷色吧!| 亚州激情在线视频| 九色91美女| 五月激情综合性爱| 激情文学 综合 九月| ..真实国产乱子伦毛片| 大香蕉AV在线| 天天爽天天日| 丁香午夜天| www.91婷婷| www.狠狠操| 99这里| 色五婷婷开心缴| 五月婷婷综合潮喷| 国产精品蜜臀99| 五月的丁香六月的婷婷| 五月综合激情图片 | 欧美大片免费观看| 99精品视频免费观看| 色色五月婷婷| 九久9精品| 日本色99| 色婷婷中文在线| 99久热| 综合成人小说婷婷| 激情五月,色播五月| 开心激情网五月| 五月之婷婷| 亚洲九九99精品视频在线播放| 天天摸,天天爽| 丁香五月日啪| 99爱在线| 影音先锋xfplay资源男人网| 丁香婷婷五月天网站| 很很操96| 伊人春天av| 婷婷五月天成人在线视频| 九九精品在线视频观看| 婷婷五月天在线看| 女人露出p毛视频www网站| 久久激情综合| 超碰激情网| 成人短视频在线观看| 如何安全看伊人婷婷| 欧美日韩一a.无| 美女亚洲五月丁香| 91精品熟女| 丁香月五月天婷婷久久| 久久一热免费视频| 无码网| 欧美综合丁香网| 伊人综合网4| 黄涩毛片| 色香五月天| 激情五月天免费视频| 色综合天天天天做夜夜| 婷婷六月激情综合| 九九这里有精品| 五月婷婷啪啪| 美女网黄| 久久9视频| 开心五月婷婷激情| 婷婷丁香六月| 五月天激情色色| 久久久9久| 亚洲在线播放| 五月丁香激| 五月天久久婷婷| 五月亭亭六月色| 丁香五月天婷婷久久综合| 婷婷狠狠五月综合| 国产午夜精品久久久观看| 狠狠干夜夜干| 婷婷中文在线| 99热综合在线| 天天干,噜噜色,狠狠色| www.伊人天堂偷偷婷婷| 99er久久| 婷婷六月丁香五月| 久久狼人天堂| 丁香五月Av| www.婷婷| 大香蕉AV电影在线| 玖玖激情网| 五月天婷婷免费| 激情五月激情综合俺也去婷婷小说| 久草 天堂| 久久无码激情视频| 五月天自拍视频| 青草少妇激情| 热成人网| 五月天天久久香| 岛国av网站| 日本不卡一区二区三区| 久色大香蕉| 亚洲天堂青草| av国产精品偷| 天天天天天天天干| 开心五月色婷婷综合开心网| 色色色色网| 97热精品| 丁香六月综合激情| 国产亚洲99久久精品熟| 黄色激情久久| 九九热这里有精品视频| Av性爱网站| 婷婷 月 丁香| 丁香色成人| 天天干,天天日| 天天干天天av天天射| www.爱婷婷.com| 超碰在线成人| 婷婷五月开心中文字幕在线| 五月天涩涩| 久久久激情视频|