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

ARTICLE DETAIL

資訊詳情

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

STM32直線倒立擺控制程序:從硬件選型到PID/LQR調(diào)參全解析

STM32直線倒立擺控制程序:從硬件選型到PID/LQR調(diào)參全解析 簡介一套基于STM32F10x的直線倒立擺控制程序面向嵌入式控制初學(xué)者、自動(dòng)化專業(yè)學(xué)生以及機(jī)電一體化開發(fā)者核心解決倒立擺的實(shí)時(shí)平衡控制問題。工程在經(jīng)典PD、PID基礎(chǔ)上引入微分先行、梯形積分、抗積分飽和與積分分離等優(yōu)化策略并配置了完整的系統(tǒng)初始化、硬件外設(shè)驅(qū)動(dòng)GPIO、ADC、PWM和傳感器數(shù)據(jù)處理代碼。包內(nèi)目錄劃分清晰BALANCE模塊負(fù)責(zé)平衡控制算法HARDWARE為底層驅(qū)動(dòng)SYSTEM包含時(shí)鐘與中斷配置USER存放應(yīng)用邏輯便于按模塊閱讀和復(fù)用。資源包共214個(gè)文件包括55個(gè)頭文件、48個(gè)C源文件、26個(gè)d和26個(gè)o等編譯中間文件、Keil工程文件uvprojx/uvopt及hex可執(zhí)行文件另有htm說明文檔和txt說明整體約3.79MB。目前已有818人學(xué)習(xí)瀏覽適合課程設(shè)計(jì)、畢業(yè)設(shè)計(jì)或競賽作品參考也可作為平衡控制算法驗(yàn)證平臺(tái)。通過閱讀該工程還能理解STM32標(biāo)準(zhǔn)外設(shè)庫的調(diào)用方式、控制算法在嵌入式環(huán)境中的離散化實(shí)現(xiàn)以及模塊化工程組織方法是學(xué)習(xí)實(shí)時(shí)控制與嵌入式開發(fā)的實(shí)用參考。1. 直線倒立擺不是玄學(xué)STM32控制程序到底能幫你省掉什么第一次接觸直線倒立擺的人十有八九是在課程設(shè)計(jì)或?qū)嶒?yàn)室里被它折磨過的擺桿裝上去了電機(jī)也轉(zhuǎn)了但小車就是不能把擺桿穩(wěn)穩(wěn)立在豎直位置。很多人下載了現(xiàn)成的STM32控制程序燒進(jìn)去發(fā)現(xiàn)擺桿瘋狂抖動(dòng)兩秒然后砸下來第一反應(yīng)是代碼有問題第二反應(yīng)是硬件壞了。實(shí)際上直線倒立擺是一個(gè)典型的“系統(tǒng)匹配”問題底層機(jī)制、傳感器選型、控制周期和算法參數(shù)缺一不可。這份STM32控制程序把機(jī)械結(jié)構(gòu)、編碼器接口、PWM驅(qū)動(dòng)、角度環(huán)和速度環(huán)的完整邏輯都打包好了我拆開看過工程結(jié)構(gòu)清晰核心控制代碼帶注釋適合想快速復(fù)現(xiàn)并在這個(gè)基礎(chǔ)上調(diào)參數(shù)的人。省掉的不是寫代碼的時(shí)間而是你從零摸清“倒立擺為什么能站起來”這條思路的時(shí)間。新手能照著接好線、燒寫、調(diào)參熟手可以直接改控制律拿它當(dāng)算法驗(yàn)證平臺(tái)。2. 控制對(duì)象與硬件選型從機(jī)械結(jié)構(gòu)到STM32外設(shè)的匹配很多嵌入式項(xiàng)目可以先寫代碼再考慮硬件但直線倒立擺不行。它的控制效果很大程度取決于機(jī)械精度和傳感器分辨率如果硬件選型不對(duì)后續(xù)算法再怎么調(diào)都救不回來。這一章先講清楚控制對(duì)象是什么再說明程序里每一個(gè)外設(shè)為什么這樣配。2.1 直線倒立擺的物理模型與狀態(tài)量直線倒立擺的經(jīng)典結(jié)構(gòu)是一條水平導(dǎo)軌導(dǎo)軌上有一個(gè)小車小車上固定一根可以自由旋轉(zhuǎn)的擺桿。電機(jī)帶動(dòng)小車在導(dǎo)軌上左右移動(dòng)通過給小車施加水平力來控制擺桿的角度。理想情況下不考慮摩擦和空氣阻力擺桿的運(yùn)動(dòng)方程可以寫成(M m) * x_ddot m * L * theta_ddot * cos(theta) - m * L * theta_dot^2 * sin(theta) F m * L * theta_ddot * cos(theta) m * L^2 * theta_ddot - m * g * L * sin(theta) 0其中 M 是小車質(zhì)量m 是擺桿質(zhì)量L 是擺桿質(zhì)心到旋轉(zhuǎn)軸的距離x 是小車位移theta 是擺桿與豎直方向的夾角。在擺桿穩(wěn)定在豎直位置附近時(shí)theta 很小可以近似 sin(theta) ≈ thetacos(theta) ≈ 1并把高階項(xiàng)去掉得到一個(gè)線性狀態(tài)空間方程。這個(gè)過程是整個(gè)控制程序的理論基礎(chǔ)——最終控制律都是在這個(gè)線性化模型上設(shè)計(jì)的。程序里讀到的狀態(tài)量通常有四個(gè)小車位置 x、小車速度 x_dot、擺桿角度 theta、擺桿角速度 theta_dot。前兩個(gè)來自導(dǎo)軌一端的編碼器或拉線傳感器后兩個(gè)來自擺桿旋轉(zhuǎn)軸上的編碼器。這個(gè)資源中默認(rèn)使用的是增量式編碼器通過 STM32 的定時(shí)器編碼器模式直接讀取不需要額外搭解碼電路。2.2 電機(jī)、編碼器、驅(qū)動(dòng)器與STM32的接口設(shè)計(jì)選電機(jī)時(shí)這個(gè)程序針對(duì)的是直流減速電機(jī)帶有霍爾編碼器或光電編碼器。減速比一般在 30:1 以上否則小車加速太快控制精度跟不上。電機(jī)的功率不需要太大但扭矩要能拖動(dòng)小車和擺桿。驅(qū)動(dòng)部分用的是典型的 H 橋驅(qū)動(dòng)模塊比如常見的 L298N 或者 TB6612。STM32 輸出 PWM 信號(hào)控制電機(jī)轉(zhuǎn)速輸出兩個(gè) GPIO 信號(hào)控制正反轉(zhuǎn)。編碼器的接口是這個(gè)項(xiàng)目里最容易接錯(cuò)的地方。如果用的是霍爾增量式編碼器它有 A、B 兩路輸出直接接 STM32 的定時(shí)器通道。以某常用定時(shí)器為例PA0 和 PA1 可以配置成 TIM2_CH1 和 TIM2_CH2開啟編碼器模式后定時(shí)器計(jì)數(shù)器值會(huì)隨電機(jī)轉(zhuǎn)動(dòng)自動(dòng)增減不需要中斷輪詢。這個(gè)程序里默認(rèn)編碼器分辨率為 13 線/圈經(jīng)過 4 倍頻后電機(jī)軸每轉(zhuǎn)一圈產(chǎn)生 52 個(gè)脈沖再乘上減速比就是輪子實(shí)際轉(zhuǎn)動(dòng)帶來的位移分辨率。如果發(fā)現(xiàn)位置反饋跳動(dòng)優(yōu)先檢查編碼器 A/B 相接反沒有接反會(huì)導(dǎo)致方向判斷混亂控制正反饋擺桿會(huì)越調(diào)越倒。電機(jī)驅(qū)動(dòng)部分的接線可以按下面的引腳對(duì)應(yīng)關(guān)系來確認(rèn)信號(hào)STM32引腳說明PWM-IN1PA8定時(shí)器1通道1輸出PWMPWM-IN2PA9定時(shí)器1通道2輸出反向PWMDIR-1PB0方向控制高電平正轉(zhuǎn)DIR-2PB1方向控制低電平反轉(zhuǎn)ENCODER-APA0定時(shí)器2通道1ENCODER-BPA1定時(shí)器2通道2不要直接拿 STM32 的 3.3V 引腳驅(qū)動(dòng)電機(jī)驅(qū)動(dòng)模塊的邏輯端很多 H 橋模塊需要 5V 邏輯電平。程序里默認(rèn)在初始化 GPIO 時(shí)把引腳設(shè)置為復(fù)用開漏輸出并外接上拉電阻這個(gè)細(xì)節(jié)很容易被復(fù)制代碼的人忽略結(jié)果就是 PWM 信號(hào)出來了但電機(jī)不動(dòng)。2.3 程序框架定時(shí)器、PWM與中斷優(yōu)先級(jí)安排整個(gè)控制程序跑起來依賴幾個(gè)關(guān)鍵外設(shè)一個(gè)定時(shí)器產(chǎn)生 PWM一個(gè)定時(shí)器工作在編碼器模式一個(gè)定時(shí)器產(chǎn)生固定周期的控制中斷。倒立擺控制的本質(zhì)是一個(gè)周期性任務(wù)每個(gè)控制周期讀取編碼器計(jì)算角度和位置通過控制律得到控制量更新 PWM 占空比??刂浦芷谠蕉滔到y(tǒng)可以處理的角速度范圍越大但對(duì)傳感器分辨率和計(jì)算開銷也越苛刻。這個(gè)程序選的是 1kHz 控制頻率也就是 1ms 一個(gè)中斷周期。中斷優(yōu)先級(jí)安排是常見的隱藏坑。PWM 中斷和編碼器中斷如果優(yōu)先級(jí)設(shè)置不當(dāng)會(huì)導(dǎo)致控制周期抖動(dòng)。這個(gè)程序把控制周期定時(shí)器中斷優(yōu)先級(jí)設(shè)為最高搶占優(yōu)先級(jí)為 0子優(yōu)先級(jí)為 0編碼器更新中斷設(shè)為次高。因?yàn)榫幋a器工作在硬件計(jì)數(shù)模式其實(shí)不需要中斷只有定時(shí)器溢出時(shí)才需要讀取。串口中斷優(yōu)先級(jí)最低避免收發(fā)數(shù)據(jù)打斷控制周期??刂蒲h(huán)的骨架大致是這樣的void ControlTASK_Init(void) { TIM_TimeBaseInitTypeDef TIM_InitStruct; RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3, ENABLE); TIM_InitStruct.TIM_Prescaler 84 - 1; // 84MHz時(shí)鐘分頻到1MHz TIM_InitStruct.TIM_Period 1000 - 1; // 1kHz中斷頻率 TIM_InitStruct.TIM_ClockDivision TIM_CKD_DIV1; TIM_InitStruct.TIM_CounterMode TIM_CounterMode_Up; TIM_TimeBaseInit(TIM3, TIM_InitStruct); TIM_ITConfig(TIM3, TIM_IT_Update, ENABLE); NVIC_InitTypeDef NVIC_InitStruct; NVIC_InitStruct.NVIC_IRQChannel TIM3_IRQn; NVIC_InitStruct.NVIC_IRQChannelPreemptionPriority 0; NVIC_InitStruct.NVIC_IRQChannelSubPriority 0; NVIC_InitStruct.NVIC_IRQChannelCmd ENABLE; NVIC_Init(NVIC_InitStruct); TIM_Cmd(TIM3, ENABLE); } void TIM3_IRQHandler(void) { if (TIM_GetITStatus(TIM3, TIM_IT_Update) ! RESET) { TIM_ClearITPendingBit(TIM3, TIM_IT_Update); Encoder_Read(); // 讀取編碼器計(jì)數(shù)值 Control_Update(); // 計(jì)算控制量 Motor_SetPWM(); // 更新PWM輸出 } }參數(shù)說明TIM_Prescaler 設(shè)為 83 是因?yàn)橄到y(tǒng)主頻 84MHz分頻后計(jì)數(shù)時(shí)鐘為 1MHzTIM_Period 為 999計(jì)數(shù) 1000 次產(chǎn)生一次更新事件得到 1kHz 中斷。如果主頻不同這兩個(gè)參數(shù)需要按實(shí)際值換算否則控制周期會(huì)偏整定好的參數(shù)會(huì)失效。3. 控制算法落地從PID到LQR的實(shí)現(xiàn)與參數(shù)整定硬件接口通了以后真正的核心是控制算法。這個(gè)資源同時(shí)提供了 PID 和 LQR 兩種實(shí)現(xiàn)并且把切換方法寫在注釋里。新手用 PID 起步熟手可以改狀態(tài)反饋矩陣。這一章把兩條路都拆開給出可以直接抄的代碼以及參數(shù)怎么從無到有地調(diào)出來。3.1 PID控制為什么能穩(wěn)住倒立擺倒立擺系統(tǒng)是一個(gè)開環(huán)不穩(wěn)定的系統(tǒng)擺桿稍微偏離豎直位置重力就會(huì)讓它繼續(xù)倒下。PID 控制器的思路是檢測(cè)到角度偏差輸出一個(gè)力讓小車加速使擺桿恢復(fù)平衡。單環(huán) PID 往往不夠用因?yàn)橹豢刂平嵌葧?huì)讓小車越走越偏最后沖出導(dǎo)軌。所以這個(gè)程序采用串級(jí) PID 結(jié)構(gòu)內(nèi)環(huán)控制角度外環(huán)控制小車位置。角度環(huán)的輸入是擺桿角度偏差輸出是小車速度給定。位置環(huán)的輸入是位置偏差輸出作為角度環(huán)的修正量。換句話說當(dāng)小車偏離導(dǎo)軌中心時(shí)角度環(huán)的目標(biāo)值會(huì)被修正讓擺桿略微傾斜產(chǎn)生一個(gè)加速度把小車?yán)刂行?。這種結(jié)構(gòu)在工程里很常用。看一下角度環(huán)的實(shí)現(xiàn)代碼float AnglePID_Calc(float target_angle, float measured_angle) { float error target_angle - measured_angle; float p_out angle_kp * error; float d_out angle_kd * (error - last_angle_error) / dt; last_angle_error error; return p_out d_out; }邏輯說明這里沒有積分項(xiàng)是因?yàn)榈沽[角度環(huán)的主要目標(biāo)是快速抑制偏差積分作用反而容易引入超調(diào)和振蕩。實(shí)際調(diào)試中只需要調(diào)整 angle_kp 和 angle_kd 兩個(gè)參數(shù)。參數(shù)說明angle_kp 決定恢復(fù)力的大小設(shè)太小時(shí)擺桿軟綿綿地倒下設(shè)太大時(shí)擺桿高頻抖動(dòng)。angle_kd 提供阻尼抑制角速度過大導(dǎo)致的過沖。一般先給 kp 一個(gè)較小值讓它勉強(qiáng)能撐住然后逐漸加大 kd 消除抖動(dòng)。位置環(huán)也是一個(gè)類似的比例加微分控制器輸出量疊加到目標(biāo)角度上float PosPID_Calc(float target_pos, float measured_pos) { float error target_pos - measured_pos; float p_out pos_kp * error; float d_out pos_kd * (error - last_pos_error) / dt; last_pos_error error; return p_out d_out; }整個(gè)控制量計(jì)算流程是先算位置環(huán)輸出用這個(gè)值修正角度環(huán)目標(biāo)再算角度環(huán)輸出得到一個(gè)速度給定最后把速度給定換算成 PWM 占空比限幅后送給電機(jī)。注意這里的兩個(gè) PID 都是 PD 形式積分項(xiàng)被故意去掉了因?yàn)榈沽[工作在平衡點(diǎn)附近穩(wěn)態(tài)誤差主要由摩擦力等非線性因素造成加積分項(xiàng)容易和微分項(xiàng)打架。3.2 LQR控制器狀態(tài)反饋矩陣的計(jì)算與離散化PID 調(diào)參需要經(jīng)驗(yàn)LQR 則提供了更系統(tǒng)的設(shè)計(jì)方法。LQR 是對(duì)線性狀態(tài)空間模型求解一個(gè)最優(yōu)狀態(tài)反饋矩陣 K使代價(jià)函數(shù) J ∫(x^T Q x u^T R u) dt 最小。Q 矩陣對(duì)應(yīng)各個(gè)狀態(tài)的權(quán)重R 矩陣對(duì)應(yīng)控制量的權(quán)重。這個(gè)程序里給出的方法是先離線算好 K 矩陣再寫入代碼而不是在 STM32 里做矩陣運(yùn)算。在 MATLAB 或 Python 里計(jì)算 K 矩陣的代碼import numpy as np from scipy import linalg # 直線倒立擺線性化后的狀態(tài)矩陣自行根據(jù)物理參數(shù)計(jì)算 A np.array([[0, 1, 0, 0], [0, 0, -3.0, 0], [0, 0, 0, 1], [0, 0, 30.0, 0]]) B np.array([[0], [1.0], [0], [5.0]]) Q np.diag([100.0, 10.0, 200.0, 20.0]) R np.array([[1.0]]) K linalg.solve_continuous_are(A, B, Q, R) K np.linalg.inv(R).dot(B.T.dot(K)) print(K matrix:, K)邏輯說明A 矩陣的第二行第三列 -3.0 代表擺桿角度對(duì)小車的耦合項(xiàng)第四行第三列 30.0 是重力效應(yīng)項(xiàng)。不同擺桿長度和質(zhì)量的 A 矩陣數(shù)值不同但結(jié)構(gòu)是一樣的。Q 矩陣?yán)飻[桿角度的權(quán)重遠(yuǎn)大于小車位置因?yàn)榭刂频氖滓繕?biāo)是穩(wěn)定擺桿位置靠后。R 矩陣代表電機(jī)出力代價(jià)R 越小控制越激進(jìn)但 PWM 更容易飽和。得到 K [k1, k2, k3, k4] 后控制量 u -K · x。在 STM32 里實(shí)現(xiàn)時(shí)狀態(tài)向量就是四個(gè)反饋值。因?yàn)榭刂浦芷诠潭?1ms可以離散化后直接算void LQR_Control(void) { float u - (lqr_k1 * state_x lqr_k2 * state_v lqr_k3 * state_theta lqr_k4 * state_omega); if (u PWM_MAX) u PWM_MAX; if (u -PWM_MAX) u -PWM_MAX; Motor_SetPWM((int16_t)u); }參數(shù)說明lqr_k1 到 lqr_k4 就是上面算出的 K 矩陣元素。狀態(tài)量單位要注意如果角度用手算的弧度位置用米那么 K 矩陣也對(duì)應(yīng)這套單位。程序里默認(rèn)編碼器讀取的計(jì)數(shù)脈沖值需要轉(zhuǎn)換成米角度轉(zhuǎn)換成弧度否則控制量數(shù)量級(jí)不對(duì)。3.3 代碼結(jié)構(gòu)各模塊如何協(xié)同打開工程目錄核心文件有幾個(gè)main.c 負(fù)責(zé)初始化和主循環(huán)encoder.c 負(fù)責(zé)編碼器數(shù)據(jù)處理motor.c 負(fù)責(zé) PWM 和方向控制control.c 負(fù)責(zé)控制算法uart.c 負(fù)責(zé)與上位機(jī)通信。工程文件里還有一份 README說明引腳映射和怎么改物理參數(shù)。主循環(huán)里沒有復(fù)雜的邏輯真正的工作都放在中斷里int main(void) { SystemInit(); GPIO_Config(); Timer_Init(); Encoder_Config(); Motor_Config(); UART_Init(); Control_Struct_Init(); while (1) { // 主循環(huán)僅在必要時(shí)執(zhí)行低優(yōu)先級(jí)任務(wù) if (uart_rx_flag) { uart_rx_flag 0; Param_UpdateFromHost(); // 通過串口修改參數(shù) } } }這段代碼的意義是明確分層控制邏輯全部在中斷里執(zhí)行主循環(huán)只處理串口通信和參數(shù)修改。這樣避免了主循環(huán)中的任何一個(gè)程序分支拖慢控制周期。控制周期里的 Encoder_Read() 函數(shù)有兩個(gè)關(guān)鍵點(diǎn)一個(gè)是讀取擺桿編碼器要處理零點(diǎn)漂移另一個(gè)是讀取小車編碼器要考慮方向反轉(zhuǎn)。程序里通過編碼器的計(jì)數(shù)方向直接判斷小車運(yùn)動(dòng)方向因此初始化時(shí)必須用當(dāng)前編碼器值作為位置零點(diǎn)否則小車一上電就跑偏。4. 調(diào)試與避坑編碼器噪聲、零點(diǎn)漂移、電機(jī)死區(qū)等常見問題排查寫代碼可以靠邏輯推演調(diào)倒立擺就是純體力活加眼力活。我拆過這個(gè)程序后把最容易出現(xiàn)的四個(gè)問題按現(xiàn)象列出來每個(gè)都給出了排查路徑。你遇到的問題大概率是其中一種。4.1 現(xiàn)象小車往一個(gè)方向頂死電機(jī)持續(xù)發(fā)熱這是最常見的翻車現(xiàn)場。上電后擺桿還沒立起來小車就瘋了一樣往導(dǎo)軌一端沖直到撞到限位開關(guān)。原因有兩個(gè)一是擺桿編碼器的零點(diǎn)沒有對(duì)準(zhǔn)豎直位置。程序默認(rèn)上電瞬間的角度是零度但如果機(jī)械上擺桿此時(shí)不是豎直的控制程序會(huì)誤以為擺桿偏差很大于是朝一個(gè)方向猛推小車。二是 PWM 方向接反了導(dǎo)致負(fù)反饋?zhàn)兂闪苏答仭=鉀Q方法是先進(jìn)入“測(cè)試模式”把程序里的控制量輸出固定為一個(gè)很小的值觀察電機(jī)轉(zhuǎn)向是否與編碼器方向相反。然后手動(dòng)把擺桿撥到豎直位置在程序里讀取當(dāng)前編碼器值把這個(gè)值寫入 Angle_Zero_Offset。有些程序支持通過按鍵設(shè)置零點(diǎn)下載的這個(gè)工程里在串口指令中定義了 ZERO 命令發(fā)送后程序會(huì)把當(dāng)前編碼器值記錄到 Flash。從那以后我每次給擺桿做機(jī)械維護(hù)后都會(huì)強(qiáng)制走一遍零點(diǎn)校準(zhǔn)流程。4.2 現(xiàn)象擺桿高頻抖動(dòng)角度數(shù)據(jù)跳變抖動(dòng)說明控制回路有噪聲或控制增益過高。拿著示波器或通過串口把角度數(shù)據(jù)打印出來如果看到角度值在 0 附近左右跳變而不是平滑變化基本可以斷定是編碼器信號(hào)噪聲。增量式編碼器的 A/B 線如果和電機(jī)電源線走在同一個(gè)線槽里電機(jī)換向時(shí)的電流沖擊會(huì)耦合到編碼器信號(hào)上。解決方法有幾個(gè)把編碼器線單獨(dú)走遠(yuǎn)離電機(jī)線在編碼器電源引腳加 100nF 去耦電容或者在程序里對(duì)編碼器計(jì)數(shù)值做濾波。這個(gè)程序里提供了一個(gè)簡單的滑動(dòng)平均濾波函數(shù)適用于角度信號(hào)。注意濾波會(huì)增加延時(shí)濾波窗口太大會(huì)讓控制相位滯后所以窗口長度不要超過 3 個(gè)采樣點(diǎn)。我當(dāng)時(shí)調(diào)這步時(shí)發(fā)現(xiàn)光是給編碼器線絞合就能消除大半跳變。4.3 現(xiàn)象能直立但抗擾性差一推就倒擺桿能立住但輕輕一碰就大幅度擺動(dòng)甚至倒掉。這說明控制器的阻尼作用不夠。在 PID 模式里優(yōu)先加大 angle_kd在 LQR 模式里相當(dāng)于需要在 Q 矩陣中加大角速度的權(quán)重。如果你已經(jīng)用了默認(rèn)參數(shù)但系統(tǒng)仍然很軟還有一個(gè)隱藏原因是控制周期不對(duì)。這個(gè)程序默認(rèn) 1kHz但如果有人把 main.c 里的系統(tǒng)時(shí)鐘改了比如超頻到 168MHz而定時(shí)器分頻沒有相應(yīng)調(diào)整實(shí)際控制周期會(huì)變短或變長。判斷方法很簡單程序里有一個(gè)毫秒計(jì)數(shù)變量用秒表對(duì)比串口打印的時(shí)間戳。如果發(fā)現(xiàn)每 1000 個(gè)周期的時(shí)間明顯不是 1 秒需要重新計(jì)算定時(shí)器分頻值。常見做法是在初始化時(shí)用邏輯分析儀抓一個(gè) PWM 翻轉(zhuǎn)波形來驗(yàn)證周期。4.4 現(xiàn)象程序燒進(jìn)去沒反應(yīng)電機(jī)不轉(zhuǎn)這個(gè)問題多數(shù)不是程序邏輯錯(cuò)誤而是硬件配置問題。檢查點(diǎn)按順序來先量驅(qū)動(dòng)模塊邏輯電源是否 5V再看 STM32 的 PWM 引腳是否有波形輸出最后看編碼器是否插反。我在拆這個(gè)工程時(shí)發(fā)現(xiàn)它的電機(jī)驅(qū)動(dòng)部分默認(rèn)是共陽接法需要把驅(qū)動(dòng)模塊的跳線帽調(diào)整到對(duì)應(yīng)模式如果跳線帽不對(duì)PWM 信號(hào)會(huì)被拉到地電機(jī)自然不動(dòng)。另外要注意 GPIO 的復(fù)用配置。這個(gè)程序用了定時(shí)器復(fù)用功能如果漏掉了 GPIO_PinRemapConfig或者把引腳占用了PWM 不會(huì)從正確的引腳輸出。程序里有供電前自檢流程如果某個(gè)外設(shè)初始化失敗LCD 或串口會(huì)打印錯(cuò)誤碼。先把自檢跑通再碰控制邏輯。5. 進(jìn)階讓倒立擺更穩(wěn)的四個(gè)技巧與驗(yàn)證方法當(dāng)你把基礎(chǔ)版調(diào)通以后擺桿能立起來但總感覺它像站在氣球上。我在復(fù)現(xiàn)過程中嘗試了四個(gè)改進(jìn)效果明顯而且改動(dòng)量都不大。第一個(gè)技巧是把編碼器角度信號(hào)和陀螺儀做互補(bǔ)濾波。純編碼器的分辨率有限在高速擺動(dòng)時(shí)角速度信號(hào)會(huì)有滯后和噪聲。如果擺桿上集成了一顆六軸傳感器可以用加速度計(jì)估算角度再用陀螺儀估算角速度與編碼器融合?;パa(bǔ)濾波的代碼我寫在控制中斷里float angle_fused alpha * (last_angle gyro_rate * dt) (1.0f - alpha) * accel_angle;alpha 的物理意義是信任陀螺儀的比例一般在 0.95 到 0.98 之間。alpha 越大融合后的角度越平滑但對(duì)加速度計(jì)的響應(yīng)越慢。這個(gè)參數(shù)需要和編碼器噪聲水平折中。第二個(gè)技巧是加入摩擦力前饋。直線導(dǎo)軌和齒輪箱的靜摩擦力會(huì)讓小車在低速時(shí)“卡頓”控制量小于靜摩擦閾值時(shí)小車不動(dòng)大于閾值后又突然竄動(dòng)。在算出控制量后加上一個(gè)與運(yùn)動(dòng)方向相反的常量補(bǔ)償if (current_speed 0) u friction_comp; else if (current_speed 0) u - friction_comp;friction_comp 的取值靠實(shí)驗(yàn)觀察讓程序輸出一個(gè)固定 PWM然后從小逐漸增大記錄小車剛好開始移動(dòng)的 PWM 值乘一個(gè) 0.8 的系數(shù)作為補(bǔ)償量。第三個(gè)技巧是使用串口上位機(jī)在線調(diào)參。工程里包含了上位機(jī)通信協(xié)議格式是“參數(shù)名數(shù)值”字符串控制中斷的快照通過 DMA 發(fā)送到串口。我通常用匿名上位機(jī)展示角度曲線邊推擺桿邊觀察波形邊改參數(shù)比反復(fù)燒寫程序效率高得多。第四個(gè)技巧是增加一個(gè)“軟限位”保護(hù)邏輯。導(dǎo)軌兩端有機(jī)械限位開關(guān)但倒立擺慣性大撞上去容易損壞機(jī)械結(jié)構(gòu)。程序里在位置環(huán)中加入了緩沖區(qū)域當(dāng)小車位置接近導(dǎo)軌末端時(shí)自動(dòng)把位置權(quán)重加大強(qiáng)制讓小車減速。驗(yàn)證方法我習(xí)慣分三步走第一步讓擺桿從 30 度偏角釋放記錄恢復(fù)時(shí)間好的參數(shù)應(yīng)該在 1 秒內(nèi)擺回豎直位置并且不出現(xiàn)大的過沖第二步在擺桿穩(wěn)定后用手撥動(dòng)觀察能在幾次擺動(dòng)內(nèi)恢復(fù)第三步在小車勻速運(yùn)動(dòng)過程中給擺桿一個(gè)階躍干擾看角度偏差最大值是否能控制在 3 度以內(nèi)。這套方法我現(xiàn)在每個(gè)新參數(shù)組必跑一遍。調(diào)倒立擺最忌沒有章法地亂試。從那以后我每次拿到新的控制程序都會(huì)強(qiáng)制走一遍零點(diǎn)校準(zhǔn)、控制周期驗(yàn)證、編碼器噪聲排查這三件事再碰任何參數(shù)。希望幫到你剩下的交給時(shí)間和耐心。本文還有配套的精品資源點(diǎn)擊獲取
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
五月丁香六月婷精品视频| 狠狠干思思热| 青青草五月天| 色情婷婷| 五月丁香婷婷久久| 亚洲色色香蕉| 在线色五月婷婷| 97午夜一区二区| 五夜婷婷| 可以免费观看的AV| 五月丁香激情婷婷综合| 欧美成性色| se色婷婷视频| 专区无日本视频高清8| 开心五月网| 九九热九九| 99操不停| 青草视频在线播放| 欧美精品999| 亚洲久久婷婷| 色播五月婷婷综合| 国产在线中文字幕| 99热在线只有精品| 久热视频这里只有精品| 严洲天天插| 97极品在线| 五月亭亭直播| 精品激情| 五月天激情久久| 欧洲亚洲欧洲99久久| 踪合专区啪啪| 五月婷久久久| 丁香亭亭激情四射| 国产午夜精品AV一区二区麻豆| 欧美α√| 色狠狠色综合| 天天久久综合| 久色姿源| 日木狠狠干| 97香蕉人人在线观看| AA片在线观看视频在线播放| 大香蕉520| 99色色| 天天搞夜夜叫| 综合激情开心五月| 热99热| 五月丁香六月香香蕉| 色99超碰| 色月丁| 99热 日韩| a网站免费观看| 久久五月激情| 97人人干| 日本丁香五月婷婷| 成人视频九九| www.思思99热| 婷婷.com| 开心五月深爱五月| 婷婷激情人妻| 九九热只有精品| 日本婷婷在线| 九九免费视频| av国产精品| 欧美性爱五月天| 婷婷成人AV| 久播影院免费观看电视剧大全最新网| 丁香五月色欲| 思思热99热| www激情五月天| 99热精品9| 亚洲无码成人性爰网| 男人天堂亚洲综合| 天天色色天天| 九九热re99re6在线精品| 无码任你操| 婷婷五月天另类网站| 思思热99er在线视频| 婷婷丁香六月综合激情站| 99热爱爱干干日| 中文字幕,综合,91| 久久婷婷久久| 婷五月天天| 99在线精品视频观看免费下载| 五月激情综合网| 久热91| 亚洲99综合| 久久作爱| 久久伊人日日夜夜| 五月综合激情视频在线| 婷婷丁香五月综合| 91九色最新视频| 狠狠色色色| 丁香五月 激情文学| 色五月色情| 婷婷综合偷拍| 色情五月天视频网| www激情五月天| 夜夜骑夜夜撸| 99热精品在线播放| 超级碰碰视频无码| 99热精品在线观看| 婷婷五月欧美AA片免费| 久久激情视频99| 开心激情色婷婷五月天| 天天天干夜夜夜操| 成人精品在线观看| 色吧网91| 韩国激情五月天综合网| 开心亚洲久久开心| 国内外色色色色色成人视频| 婷婷色五月激情| 国产精品久久久爽爽爽麻豆色哟哟| 天天干人人奸97| www热久久yy9| 成 久久| 热99AV网站| www久久艹| 亚洲天堂久久| 99视频在线播放大全| www久久99com| 天天综合网站| 激情AV网| 婷香五月网在线| 婷婷伊人久久综合| 五月天成人小说| 五月激情综合网婷婷| 色玖玖玖| 伊人久久五月天综合| 色99在线观看| 亚洲妇女熟BBW| 91n啪啪| 啊v视频在线观看| 久久这里都是精品视频| 婷婷五月天激情网| 久久久91精品| 五月丁香久久网| 婷婷精品综合| 免费无码毛片一区二区A片| www,婷婷,com| 丁香五月婷婷性爱| av九九| 91国产精品视频播放| 久9视频| 色婷婷丁香特级性爱视频| 第四色大香蕉| 欧美久久久久久久久中文字幕| 狠狠色狠狠干| 日韩aaa| 精品九九九久| 婷婷五月精品在线| 97碰碰碰免费公开在线视频| 亚洲综合视频天天精品| 亚洲另类在线观看| www.99在线| 五月天涩涩| 国产成人精品一区二区三区视频| 久久这里只有精彩| 另类激情中文| 9999久久久久| 天天射影院| 综合狠久久| 亚洲99激情| 色五月天丁香婷婷| 色天堂A| www天天爽| 婷婷在线播放| 亚洲第一色网站| 亚洲综合99| 色噜噜五月丁香婷婷| 六月丁香婷婷色69| 色色色香蕉五月婷| 99视频精品全部免费观看| 婷婷六月色| www.狠狠| 婷婷五月天AV| 欧美五月丁香啪啪响视频| 久久久999精品| 欧美网站视频4399| 婷婷色丁香五月| 亚洲 欧洲 国产 伦综合| 午夜激情五月| www.91AV.com| 丁香六月婷婷综合| 91凹凸在线| 精品久久这里热66| 欧美在线97| 久久综合婷婷五月| 五月丁香香蕉| 久久视这里只有精品| 久久综合五月天| 黄色精品五月婷婷| 成人丁香五月天| 国产99久久久| 国产精产国品一二三在观看| 五六月丁香激情视频| 99色在线观看| 久久久久久综合五月婷婷| 熟女人妻一区二区三区免费看| 激情综合五月激情XXXX| 熟女人妻视频| www.久热| 天天性视频| 激情五月婷婷视频一区二区三区| 五月婷成人网| 五他月天啪啪啪| 日本高清综合网五月丁香| 丁香花操逼| 国产欧美va| 男人的天堂97| 婷婷五月天综合网| 亚洲、热| 99人人干人人| 久久五月综合| 婷婷开心五月| 五月天啪啪| 日本久久网| 九九久久99| 99re8热精品免费视频| 婷婷激情五月天小说校园| 中文字幕第四色.999| 超碰色人妾| 99精在线| 久久99热免费| 69久热| 天堂久久婷婷| 综合五月天天天天天五月| 中文AⅤ大全| 九九大香蕉黄色影院| 女同激情久久av久久| 天天激情站| 最新亚洲色色网| 综合久久8| 色综合久久久久| 激情合网婷婷| 大香蕉久| 大香蕉太香蕉视频97| 色欲影香| 青青草原99热| 99热永久在线观看| 吾爱AV导航| 99热这里只| 五月情涩综合婷婷| 亚洲婷婷五月天在线激情综合网| 五月婷久草| 婷婷五月色天| 日日夜夜干| 久热这里只有精品6官网亚洲| 婷婷大香焦| 天天色丁香| 婷婷丁香五月视频| 中文字幕不卡+婷婷五月| 五月婷婷操操| 激情四射五月天| 婷婷色一二三区波多野结衣| 99热在线观看免费精品| 无码99| 色五月丁香激情视频| www.色情五月天.com| 思思热视频在线| 色综合色综合网| 九热视频| 婷婷五月大香蕉| 日韩啪啪网| 五月天婷婷成人| 六月色伊人婷婷| 另类丁香综合| www.ywav| 婷婷综合性爱网| 五月丁香婷婷色色| 久久精品系列| 噜噜精品| 五月丁香花婷婷玉莉AV| 丁香五月激情综合在线观看| 五月天无码| 亚洲无码激情| 欧美日韩国产成人在线| 久久综合五月天激情小说网站| 九九热欧美| 色99在线观看| 999热成人在线综合网| 色婷婷五月影视| 97在线干| 香蕉影院色| 婷婷在线精品| 久久五月婷| 最新久久网址| 99热在线精品播放| 色婷婷伊人| 五月天婷婷爱| 99re8这里只有精品99re8热视频| 五月丁香在线婷婷美女| 日日操,夜夜撸| 天天人人天天爽| 9久久精品| 99啪99| 色都都狠狠色都都色综合色| 婷婷色资源| 爱99干99| 国产黄色在线| 伊人网色婷婷五月天| 桃色五月天| 色综合久久久久| 另类图片天天影视在线观看| 超碰人人干| 亚洲无线视频| 九月色婷婷| 99热这里都是精品| 久久久久久欧美精品se一二三四| 久久99网| 嫩草AV久久伊人妇女超级A| 久热这里| 久久小说| 丁香婷婷影院| 六月激情丁香一道本7777| 色综合久久88色综合天天| 曰本aaaaaa丈片| 欧美日韩国产成人在线| 丁香六月婷| www.99热精品| 色色色色色热| 欧美黑人巨大猛烈cuckold| 99在线免费视| 这里只有精品视频一区| 婷婷激情图片| 五月停亭六月,六月停亭的英语 | www.日韩国产| 另类天堂| 久久婷婷一级片| 五月开行婷婷色五月| 色色哒五月婷婷六月丁香| 色色色.COM| 可以直接看的av| 视频一二区| 日韩成人网址| 五月天丁香色色| 超级碰 久久9| 激情综合网五月在线播放| 天天操夜夜夜夜爽| 99成人小视频| 色婷婷9| 丁香五月天色婷婷| 99热传媒| 中美月韩免费A片| 天天操夜夜爽天天操| 婷婷5月天激情综合| 俺去也在线视频| 色婷婷亚洲五月天| 久99| 五月激情婷婷国产精品久久久久久| 久久多色| 久草xx性爱视频| 丁香五月天论坛| 99综合视频| 婷婷成人基地| 一级二级色大片| 噜噜噜噜噜在线| 五月丁香久久激情网| 99热只有这里有精品| 日本三级日本三级99| 丰满少妇猛烈A片免费看观看| 成人国产欧美大片一区| 91色综合网| 婷婷五月天xxx| 色五月色五天免费视频| 无码99| 在线不卡的视频| 五月五婷婷网| 婷婷亚洲综合| 亚洲精品V天堂中文字幕| 九九综合网色全集| www激情网| 影音先锋一区二区三区| 久久99大| 婷婷丁香五月视频| 人妻中文在线| 一本色道久久综合狠狠躁小说| 99热在线爱| 激情五月天小说| 免费亚洲婷婷| 玖玖爱资源站| 九九视频这里只有精品| 国产99久久久国产精品免费看 | 开心五月丁香综合久久| 亚洲国产成人在线| 婷婷伊人五月丁香天堂网| 这里只有精品视频视频在线观看| 99精品在线观看视频| 久久99久久99精品免视看婷婷| 91久久九色| 久久五月丁香综合17C| 另类 在线| WW婷婷五月天com| 大香蕉啪啪啪| 婷婷射图| 操碰久| 综合综合网| www.五月丁香| 色色婷| 狠狠干天天日| 4438全国最大视频成人网站在线观看| 五月开心婷婷| 丰满少妇猛烈A片免费看观看 | 超碰色色综合| 五月天丁香婷婷社区| 99日热在线视频| 色婷婷五月天激情在线播放| www.久热| 五月丁香激情啪啪| 超碰在线国产| 婷婷内射视频在线| 开心五月婷婷激情| 日日操夜夜爽白洁| 天天天天天天操| 五月天色婷婷图片| 开心五月激情五月丁香五月婷婷| AV国产有码| 九九草热在线观看| 俺去也在线www色官网| 3p日韩网站视频| er99免费视频在线| 婷婷五月天在婷| 五月天停停成人网| 婷婷性爱五月天| 99热新网址| 亚洲综合丁香五月| 99re在线视频精品,这里只有精品18,| 日韩精品VIP| 天天操天天国产三级片处女学生妹| 综合色图婷婷| 色综合久久无码| 婷婷六月丁综合| 狠狠色婷婷7777久综合| 玖玖无码中文| 凹凸7777操操操| 五月亭亭六月激情| 天天搞天天色综合| 强伦轩人妻一区二区电影| 天天色粽合合合合合合合| 伊人玖玖精品| 夜夜撸日日操| 狠狠婷婷色综合| 色综合99色| 伦99热| 亚洲AV网址| 亚州精品色情无码A片| 亚洲中文无码成人| 欧美日韩aaaa| 伊人www22综合色| 开心五月深爱五月| www免费在线视频| 久久久久视剧HD| 国产午夜精品一区二区| 天天操夜夜爽天天操| 五月丁香婷婷久久| 日本成人噜噜噜| 伊人激情综合网| 色五月婷婷少妇人妻| yazhouzonghesese| 99热在线观看| 欧美大肥婆大肥BBBBB| 天天综合网~91| 免费看无码视频A级| 激情综合亚洲| 亚洲综合婷婷六月丁香五月| 99激情在线| 99热这里都是精品| 久久久久久久久久久月丁| 色五月综合网| 亚洲综合婷婷六月丁香五月| 五月婷婷99热| 乱岳熟女50岁| 色欲五月婷婷| 婷婷五月AV| 99热免费精品| 在线综合亚洲欧美65| 色情婷| 亚洲成色综合网站免费观看| 99日精品视频| 色色婷五月天| 五月天成人免费视频| 亚洲色五月| 視频福利乱色| 六月香五月婷| 丁香婷婷五月色成人网站| 色婷婷成人做爰A片免费看网站| www九月婷婷| 玖玖在线视频福利| www.婷婷五月天.com| 亚洲激情综合| 日本久久人| 丁香六月AV| 久久九九热视频| 五月丁香六月婷婷啪啪| www.99精品视频| 亚洲婷婷丁香五月亚洲| 乱码操操| 岛国午夜视频| 成人婷婷五月天| 日日干夜夜干| 91九九九九九九| 大香蕉久久伊人婷婷五月丁香| 五月丁香激情婷婷| 香蕉久久av一区二区三区 | 99热8| 色婷婷成人做爰A片免费看网站| 六月婷色| 秋霞三及片| 9久久精品| 在线视频99| 五月天婷婷青青草| 婷婷久久五月天| 九九热re99re6在线精品| 欧美色色色| 我爱大香蕉| 99九九在线精品热动漫| 狠狠色狠狠操| 久久久久久久91| 99热无码精品| 深爱激情五月网| 91色吧网| 天天婷婷| 婷婷五月天丁香综合网| 99 这里只有精品| 夜夜爽天天爽| 久99久在线| 丁香婷婷噜噜| 婷婷天天五月天| 亚洲狠狠婷婷综合久久久| 丁香五月久久| 丁香五月婷婷Av| 曰日爽日日操| 久爱综合| 色五月色综合| 日日色综合| 超碰超碰在线| 六月丁香五月婷婷| 77777亚洲午夜久久| 色5月婷婷| 久久五月婷6 9| 久久这里在精品视频| 综合色久| 97亚洲色 torrent magnet| 9久精品视频| 91ncm视频| 亚洲色五月婷婷| 碰碰碰97免费精彩视频| 26uuu最新地址| 97sese婷婷| 色狠狠色综合| 亚洲视频1区| 日韩色五月| 久久精品日| 欧美美美女性色视频| 人妻有码乱操| 五月激情婷婷丁香天堂| 综合九九日本| 亚洲激情久久| 99re视频在线播放| 色中色综合| 最新热中文字幕| 少妇综合网| 天天搽天天射| 日本欧美成人片AAAA| 伊人五月人妻精品| 激情精品久久| 色五月中文网| 欧美精产国品一二三区| 玖玖伦理电影| 青青草视频免费观看| 久久婷婷五月激情网站| 性色做爰片在线观看WW| 五月丁香六月婷婷亚洲| 欧美日韩日韩成人| 97人人看| 亚洲婷婷丁香五月在线| 99视频在线| 婷婷激情综合网| 西西4r午夜剧场| 九九久久网| 六月丁香六月婷婷欧美| 国产在这里只有精品| 色色99色色| 九九热123| 丁香六月色婷婷| 五月激情射| 伊人五月综合网| 五月婷婷少妇之| 丁香五月亚洲综合| 欧美超级视频97| 婷婷五月天AV| 琪琪色综合网站| 丁香六月婷婷综合缴| 五月天婷婷免费| 五月激情影院| 亚洲五月天婷婷在线| 九色激情网| 91超级碰碰| 婷婷丁香五月激情中文字幕版| 大香蕉婷婷婷| 激情综合网五月丁香| ri电影在线| 1024成人免费看| 开心婷婷五月| 丁香婷婷五月激情综合| 日本在线观看aaa 99| 久久久精品AV| 激情五月天之五月婷婷| 久re热视频| AAA久久| 五月丁香婷婷三级| 婷婷五月天色色| 免费黄网不卡AV| 欧美日韩成人高清在线| 五月婷婷久久开心网| 婷婷综合干| 丁香五月激情啪啪| 色婷婷丁香香香蕉视频| 1024人妻| 五月婷综合激情| 99久久综合网| 色婷婷五月天偷拍| 激情深爱综合| www91在线| 日本不卡一区二区三区| 色婷婷影院| 99热热热天天人人人超超碰| 色五月琪琪| www.六月丁香看AV| 天天久久66xxx| 五月色情| 婷婷在线视频| 可以直接看的av| 激情婷婷五月天伊人在线观看 | 五月丁香六月婷婷综合在线| 99啪视频在线观看| 国产AV一区二区三区日韩| 噜噜狠狠色综合久| 亚洲丁香五月| 久久久久久草黄色片AV在线观看| 五月丁香婷婷啪啪网| 操操碰| 久久色这里只有精品| 国产韩日亚洲美州欧亚综合在线| 91丨九色丨国产在线| 天天干天天爽| 二色av| 色色性爱视频| 天天操天天操综合| 激情丁香五月天综合| 99艹精品在线观看| 久久精品A片777777| 91精品丝袜久久久久久| 五月激情在线| 91操操操| 99成人精品六| 噜噜噜噜婷婷五月天| 99色日本| 狠狠色丁香久久综合婷婷亚洲成人福利 | 色色婷| 国产婷婷五月天| 激情五月婷婷中文字幕| 亚洲综合激| 91久久1118| 久久精品99久久久久久久久| 色爱爱综合网| 99热爆在线| 无码日本精品XXXXXXXXX | 人人爱操| 国产 亚洲 在线| 性色五月天| 免费看片在线观看| 久综合4| av国产精品| 九九色综合| 婷婷五月激情中文字幕| 婷婷伊人| 久久婷婷五月天| 丁香色综合| 九九精品热播| 婷婷色五天| 婷婷在线激情| 狠狠色成人影片| 五月天婷婷色综合| 精品久久久人妻| 思思国产99| 99热这里只有免费| 五月天另类图片| 人人视频色| 丁香五月av在线| 99热只有精品在线观看| 国产高清RV综合aVa| 亚洲天堂AAA| 日本ww亚洲| 婷婷丁香第一页| 亚洲综合网激情五月天| 颜射 精品性爱av| 色婷婷欧美在线| 视频免费精品免费精品免费精品免费精品免费精品免费精品免费99 | 深爱激情网综合| 天天摸色吧天天摸色吧| 激情综合网五月激情| 丁香六月天之亚州热女| 婷婷丁香五月在线播放| 夜夜谢天天干| 天堂久久婷婷| 99热9| 久热伊人| 青青草青青草五月天| 久久婷婷五月天激情新地址| 日本波多野结衣视频| 超碰啪啪网| 色婷婷第四色| 激情久久网 | 三级毛片视频| 色九月丁香婷婷蜜桃在线观看| 一起操 91N.com| 色丁香五月天| 99热.com| 无码少妇高潮喷水A片免费| 成人五月丁香花| 影音先锋秋秋五月婷婷| 9热在线视频| 99综合一区| 这里只有精品视频视频在线观看| 亚洲成人色五月婷婷综合| 婷婷六月网| 欧美成人五月天| 99精品在线观看视频| 色性日本| 日日噜狠狠色综合久久| 丁香婷婷色五月| 六月丁香婷婷综合色播| 久久久久99精品成人片| 久久金品黃色| 五月伊人网| 久久视频在线视频| 婷婷丁香五月天之开心少妇| 激情久久丁香| 激情无码五月天| 操啊操av| 婷婷九月激情| 成人精品一区日本无码网 | 色五月婷婷av| 91干婷婷| 五月天大香蕉| 婷婷五月天BBw| 五月婷婷啪啪| 色婷婷精品视频在线播放| 日本啪啪网| 激情小说五月天中文字幕| 深爱激情网五月天| 日本三级黄色大片| 九色成人AV在线| 日本综合色图| 五月婷婷av| 久久小视频| 91九色视频在线观看| 五月的婷婷六月丁香| 色婷婷先锋| 色色色色色色综合网| 99在线观看视频| 丁香五月天在线| 日本99久久| AAA久久久AAA久久久AAA| 五月色欧洲| AAA久久| 在线观看欧美3区| 久热2025无码| 开心五月综合激情网| 97碰碰免费.视频| 热中文字幕| 99色在线视频| 5月丁香六月婷婷| 超碰av在线| 免费看片在线观看| 人人色AV| 99热都是精品| 五月天天堂久久| 99色免费观看全部| 国产特级毛片AAAAAAA高清| 91精品无码| 久久激情五月婷婷| 丁香五月婷婷国产av| 玖玖伦理电影| 五月丁香婷婷色色| 综合五月丁香97| 我要看激情五月天| 熟妇人妻中文字幕无码老熟妇 | 久久人妻精品| 中文字幕av在线播放| 激情六月日韩| 99视频综合| 五月婷婷开心爱| 亚洲五月花| 玖玖在线| 天天做天天爽| 毛片蕉地一二| 99热无码| 精品日本视频444| 综合激情综合啪啪| 色婷婷综合网| 永久思思热在线| 在线另类| 久久综合干| 婷婷色综合av| 99久久精彩视频| 婷婷王月天影院| 激情九月婷婷九月| 激情亚洲色图片丁香综合| 少妇性按摩无码中文A片| 五月婷婷激情综合在线| 婷婷香蕉| 久久三级视频| 久久xxxx| 色色婷婷丁香| 国产欧洲欧洲精品久久| 色五月婷婷中文字幕| 六月婷婷激情图片| 超碰大香蕉网| 成人网站在线观看视频| 精品人人操| 色香蕉影院| 大香蕉五月天婷婷| 狠狠色色| 久久婷婷成人视频| 丁香色色网| 精品99久久久久成人网站免费| 天天色粽合合合合合合合| 俺也去在线久久精品23欧美综合视频网站,丰满人妻一区二区三区在线视频53,丰满 | 欧美成人AAA片一区国产精品| 婷婷五月天激情文学小说| 五月丁香六月| 激情婷婷五月天网址| 色色99| 久久婷婷五月综合激情国产| 午夜无码熟熟妇丰满人妻| 很很干在线视频| 色婷婷六月| 99色免费视频| 日韩三级视频一区二区| 老司机日日夜夜青草| 亚洲综合欧美色丁香婷婷888月图片 | 91婷婷丁香| 五月天久久婷婷| 另类色网| A片试看120分钟做受视频红杏| 六月丁香深深爱| 欧洲MV日韩MV国产| 激情五月丁香综合网站| 超碰在线资源| 综合五月天| 国产97色在线| 天天弄天天操| 九九热这里只有精品一| 婷婷五月综合中文字幕| 激情五月天偷拍综合网| 久操福利| 久久精彩视频| 成年人99热| 亚州婷婷五月激情综合| 99re在线视频| 久久99热这里只有| 日韩av一区二区在线/日产精品久久久 | 久久久97| 欧美内射AAAAAAXXXXX| 婷婷五月天熟妇| 人人干人人操外国| AA久久| 婷婷五月天激情偷拍| www.seqingwuyuetian| 婷婷五月激情丁香| 九九99精品视频在线观看| 99啪啪| 99爱无码| 五月丁香婷婷成人版| 婷婷综合视频| 日本色婷婷久久99精品91| 热99.com婷婷| 色色色99| 一本道综合网| 婷婷久久丁香五月| 色婷婷婷av | 九九婷婷网五月天| 色色丁香婷婷综合| 99ER热精品视频| 婷婷五月六| 99色色热| 欧美碰碰| 天天干天天干天天干天天干天天干| 天天色天天噜| 99内射视频| 香蕉AV福利精品导航| 五月天啪啪啪| 丁香九月综合| 久热9热| 99亚洲视频| 国产精品香蕉| 综合玖玖性爱免费视频| 婷婷五月综合社区在线| 69精品人人人人| 久久99这里只有精品视频| 丁香九月综合| 四川女人毛多水多A片| 人人97碰| 强奸幻女毛片| 99热免费| 天天做天天爱天天高潮| 婷婷成人综合免费视频| 色九月欧美| 大香蕉综合网| 亚洲人妻Av| www.丁香黄色五月天人与| 99热综合在线| 色色热日| 色婷婷综合网| 色综合九九| 婷婷五月天狠狠搞干| 五月婷婷激情刺激| 牛牛色av| 日韩黄色中文字幕| 久久xx| www99热| 一本久久亚洲五月婷婷| 91视频五月丁香| 久久婷婷超碰| 色婷婷色99国产综合精品| 色久丁香五| 丁香五月天av| 激情综合网五月在线播放| 色五月,婷婷大香蕉| 伊人激情AV一区二区三区| 九月丁香婷婷综合| 日日夜夜狠狠操| 少妇日麻屄| 内射综合网| 日韩三级视频一区二区| 国产肥白大熟妇BBBB视频| 99亚洲天堂| 日日操夜夜爽| 婷婷.com| 亚洲综合五月天综合| 婷婷亚洲日本| 婷婷人人操| 婷婷免费视频| 免费碰碰视频久| 色在线五月天免费| 综合亚洲色色| 五月丁香香蕉| 密乳Va| 五月香蕉网| 国产精品电| 欧美电影在线播放| 五月丁香六月天| 99热大香蕉| 99久久玖玖| 六月丁香综合| 狠狠干综合网| 亚洲最大五月六月丁香婷婷| 六月婷婷狠狠色在线观看| 免费国产VA国产免费| 九九99精品视频| 色色色在线观看| 艹天天射| 久热爱大香蕉在线蜜臀悦色 | 亚洲色 视频| 亚洲婷婷丁香五月视频| 天天做天天爱天天摸| 97人人操在线| 色色爽爽天天| 婷婷色吧| 六月婷婷啪啪| 色色色五月婷| 色五月婷婷1| 天堂五月婷婷| av在线观看网址| 久久一伦| 五月丁香中文婷婷中文| 欧美激情-区二区三区| 久久成人亚洲欧美电影| 五月婷婷香蕉视频| 99精品视频播放| 五月刺激丁香月综合| 丁香五月婷婷社区| 五月天久久小说| 国产精品人成A片一区二区| 亚州美女| 婷婷欠久少妇| 伊人九九68| se婷97| 97碰在线免费观看| 色婷婷五月影院| 26uuu丁香婷婷五月| 色欲影香| 久久婷色| 激情婷婷五六月天| 成人婷婷五月天| 99色播| 天天色,天天日,天天做| www,天天干| 丁香五月六月综合激情| 超碰成人在线观看| 丁香六月激情| 99热这里有精品| 狠狠婷婷色综合| 一区中文字幕电影| 欧美色偷拍| 久操人妻| 凹凸7777操操操| 开心五月婷婷激情网| 99热在线观看精品免费| 婷婷成年人免费视频| 天天搞天天色综合| 丁香五月影院| 99激情| 大大香蕉综合在线| 热九九九九| 婷婷爱爱蜜臀天天操| 国产亚洲精品AAAAAAA片| 五月综合久久| 狠狠色婷| 色综合中文色综合网| 亚洲精品视频在线播放| 色色色精品无码区| 日本操逼九九九九58日本操逼| 五月婷婷丁香婷婷| 婷婷激情五月| 欧美日本免费一道免费视频| 色婷婷av综合网| 色欲五月婷婷| 亚洲性爱干干| 3www激情| 五月丁香婷婷在线| 天天干天天做| 99精品手机在线视频| 99碰碰视频| 第2色五月婷| 丁香成人色情五月天| 538任你爽| 欧美丰满熟妇BBB久久久| 婷婷丁香综合色AV| 99热9| 5月丁香六月情| 成人在线视频一区| 婷婷中文字幕| AV网在线观看| 一起草AV| 欧美狠狠地| 九色自拍| 激情玖玖sh| 亚洲无线视频| 天天天天天操| 射区导航| 中字幕视频在线永久在线观看免费| 丁香婷婷五月人体| 国产亚洲精品人人| 亚洲色综合性| 在线99热| 嫩草哈哈操| 欧洲不卡视频| 五月婷婷激情四月| 久久人妻久久| jiujiuxiangjiaowang| 色色色激情| 色色色免费视频| 久久婷婷成人综合色怡春院| 黄色AAAA韩国guochansanji| 亚洲久热| Www.激情| 激情五月综合网| 国产精品人妻在线网址| 婷婷成人综合免费视频| 久久婷婷内射| 日逼影音先锋男人资源站| 无码人妻激情| 思思国产99| 五月婷婷综合网| WWW99视频| 另类小说婷婷色| 五月天色丁香| 9色免费网| 管管補管管紱| 久久ww| 4399精品一区二区| 色播播之激情五月婷婷| 久久92| 91人人爱| 婷婷五月丁香高清无码| 色噜噜综合网| 五月丁香六月停停停| 五月丁香综合激情在线观看| www,色婷婷| 色色色香蕉五月婷| 五月天五月色婷婷综合| 亚洲av日韩无码| 影院久久久| 激情婷婷人妻| 久久婷婷成人综合色怡春院| 97久久五月丁香婷婷| 26UUU精品一区二区Com| 丁香五月成人网| 久久精品99久久| 九九99一区| 成人婷婷色综合| 久久99激情| 久久婷色| 中文字幕97超级碰| 激情五月婷婷五月| 丁香婷婷狠狠97| 思思热99er在线视频| 亚洲1区| www.婷婷.com| 国产欧美va| 色天使久久综合| 婷婷丁香五月激情图片| 九九热视频在线观看| 91avse| 久久婷狠狠色| 91久久九色| 五月婷婷六月少妇激情| 久久久精品免费啪啪国| 99re这里只有精品视频6| 能直接看的av网站| 丁香五月婷婷色| 九九这里是免费的视频5| 色五月婷婷五月天激情综合| 色九九七七| 激情深爱综合网| 99久久偷拍视频| 婷婷五月天在线观看免费| 97超美国视频在线观看| 五月丁香狠狠爱婷婷综合| 香蕉综合网| 丁香五月狠狠在线观看| 99久在线精品99re8热| 丁香色六月婷婷| 操99| caop在线视频| 色色吧综合| 婷婷91| 少妇综合网| 婷婷五月在线免费| 五月丁香久久| 亚洲人人96@| 日本色婷婷| 天天噜天天爱| 成人国产欧美大片一区| 伊人婷婷激情| 艳妇野外情欲放荡HD| 天天综合天天玩夜夜玩天天玩夜夜玩| 极品少妇XXXX精品少妇偷拍| 婷婷五月 丁香六月| 曰韩少妇内射免费播放| 丁香网五月网| 色色色色色色色色色影院| 色婷婷在线视频综合| 97人人操人人插| 欧美成人A片AAA片在线播放| 黄色短视频在线观看| 婷婷五月丁香六月| 婷婷欧美激情综合| 日本在线视频播放91| 亚洲免费看片| 99热欧美| 久久99色色| 婷婷五月丁香性爱| 激情五月天影院| 9热视频在线观看| 999婷婷综合| 丁香婷婷五月天校园春色| 99久久国产宗和精品1上映| 亚洲色综久久五月| 丁香五月激情综合久久| 亚洲六月色| 色九九中文字幕| 婷婷五月天天天| 另类激情码| 五月天偷拍| 久久五月婷婷开心网| 综合激情九月婷婷,激情综合婷婷中文字| 激情五月天伊人影院| 婷婷五月色综合| 综合色图区| 综合热无码| www.久9| 另类小说五月天| 欧美综合丁香网| 在线日本www| 91干视频| 激情婷婷综合| 日本无码专区| 99热色精品| 欧美情月伍月天| 九月婷婷在线视频| 色五月婷婷亚洲最大| 啪啪啪综合网| 《亚洲操B久久免费在线观看,亚洲操B久久在线播放》在线播放 - 高清资源 - 97 | 色综合女人99| 99热老司机| 加勒比色色| 在线免费观看激情视频| 日本综合久久| 九九九成人在线视频| www.99热在线| 五月丁香网站| 五月天婷婷在线播放免费| 青青草原亚洲天堂| 亚洲A片成人无码久久精品青桔| 亚洲激情.com| 婷婷五月天综合激情| 97碰碰草| 91啪啪| 婷婷深爱五月丁香网| 国产9色在线/日韩| 1024在线一区| 丁香五月天堂网| 天天肏屄夜夜爽| YW无码| 五月婷婷色| 五月色丁香视频精品| 99热只有精品综合| 97成人丁香| 亚洲激情在线| 5月婷婷五月天| 丁香六月婷婷综情欧美| 亚洲天堂碰碰婷婷| 婷婷九月色| 天天情色综合网| 丁香婷婷久久 | 六月丁香停| 激情伊人网| 久婷婷五月天影院| 免费亚洲婷婷| 亚洲亚洲激情| 日本97在线| 久久99久久99精品,久国产,久久精品免费,99久在线,久久久久国产精品免费网站,9 | 欧美三级巜人妻互换| 人人九色| 99热这里只有的精品视| 91狠狠色丁香婷婷综合久久| 五月天福利影院导航| 日本啪啪天堂| 激情五月天色婷婷| site:pzdcoin.com| 五月丁香婷婷婷激情爱爱| 色五月综合网| 97色97干| 欧美日韩aaaa| 99久久a线观| 色伊人啪| 91人人人人人人人| 五月综合激情婷婷六月色窝| 五月天色综合| 1010日日无码| 日日干五月天婷婷| 99热99美国在线观看| 中文字幕丰满乱孑伦无码专区 | 久久刺激网| 婷婷五月天丁香久久| 久久在线视频免费观看| 伊人久久大香线蕉av最新| 天天爽免费视频| 草AV9999| 婷婷丁香五月av| 日本婷婷在线| 欧美三级级99久久| 亚洲成人av中文|