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

ARTICLE DETAIL

資訊詳情

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

二輪平衡車全套源碼:卡爾曼濾波與PID三環(huán)控制實(shí)戰(zhàn)

二輪平衡車全套源碼:卡爾曼濾波與PID三環(huán)控制實(shí)戰(zhàn) 簡(jiǎn)介這是一套面向電子愛(ài)好者與嵌入式初學(xué)者的二輪平衡車DIY完整資料包涵蓋從硬件搭建到軟件調(diào)試的全鏈路內(nèi)容。資源定位為STM32平臺(tái)平衡車的開(kāi)源學(xué)習(xí)套件包含互補(bǔ)濾波、卡爾曼濾波、DMP三種姿態(tài)解算方案的源碼三套工程均編譯通過(guò)、可直接燒錄驗(yàn)證適合希望動(dòng)手制作平衡小車或深入理解濾波算法差異的讀者。壓縮包大小148.18MB內(nèi)置全部平衡小車相關(guān)資料類型上以Keil工程源碼、電路原理圖、PCB文件、連線說(shuō)明文檔為主硬件與軟件配套呈現(xiàn)可以大幅降低DIY門檻。已有3129人學(xué)習(xí)瀏覽整體經(jīng)過(guò)本科階段完整調(diào)試驗(yàn)證是一份少有的“從零到跑通”的參考資源。讀者可以獲得實(shí)物接線指引、電路設(shè)計(jì)源文件以及三種濾波方案的對(duì)比實(shí)現(xiàn)既能直接復(fù)刻樣車也能基于源碼二次開(kāi)發(fā)用于課程設(shè)計(jì)、畢業(yè)設(shè)計(jì)或興趣項(xiàng)目。1. 平衡車全套源碼從零開(kāi)始搭一輛能站穩(wěn)的兩輪車第一次接觸二輪平衡車的人往往以為難點(diǎn)在機(jī)械組裝等真把套件拼好、電機(jī)轉(zhuǎn)起來(lái)才發(fā)現(xiàn)真正讓人頭疼的是讓它站穩(wěn)。一個(gè)常見(jiàn)現(xiàn)象是車能啟動(dòng)但兩三秒內(nèi)就朝一個(gè)方向沖出去或者原地高頻抖動(dòng)這就是典型的角度環(huán)與速度環(huán)沒(méi)配合好。市面上能跑的平衡車源碼不少但大多數(shù)要么只給姿態(tài)解算片段要么把 PID 調(diào)參寫成玄學(xué)讓新手連入口都找不到。這套二輪平衡車全套源碼的價(jià)值在于它把從傳感器讀取、姿態(tài)解算到雙環(huán)/三環(huán)控制、PWM 輸出的完整鏈路都串起來(lái)了適合正在做課設(shè)、電賽備賽或想入門嵌入式控制的人直接照抄再改。2. 姿態(tài)解算選型卡爾曼濾波、DMP 與互補(bǔ)濾波的取舍和落地代碼2.1 三種解算方案的適用邊界為什么不是越復(fù)雜越好平衡車要解決的核心問(wèn)題是MPU6050 輸出的加速度計(jì)和陀螺儀數(shù)據(jù)各自有硬傷。加速度計(jì)在靜止時(shí)能準(zhǔn)確給出重力方向但車體一震動(dòng)高頻噪聲會(huì)直接把角度信號(hào)淹沒(méi)陀螺儀積分得到的角度在短時(shí)間內(nèi)很平滑但積分漂移會(huì)隨時(shí)間累積幾秒后角度就開(kāi)始“飄”。姿態(tài)解算的全部工作就是把這兩個(gè)都不完美的信號(hào)融合成一個(gè)相對(duì)可信的角度。卡爾曼濾波的思路是把角度和陀螺儀零偏作為狀態(tài)量每次拿加速度計(jì)的角度做測(cè)量更新拿陀螺儀的角速度做預(yù)測(cè)更新。它收斂快、動(dòng)態(tài)響應(yīng)好但需要反復(fù)調(diào)協(xié)方差矩陣的過(guò)程噪聲和測(cè)量噪聲調(diào)不好就會(huì)出現(xiàn)角度滯后或者過(guò)沖。DMP 是 MPU6050 內(nèi)部的硬件解算引擎DMP 庫(kù)初始化后直接讀四元數(shù)再轉(zhuǎn)歐拉角CPU 占用極小但它把融合過(guò)程當(dāng)黑匣子輸出是相對(duì)姿態(tài)想改濾波特性基本無(wú)從下手。互補(bǔ)濾波則用一個(gè)系數(shù) alpha 把兩個(gè)信號(hào)按頻率高低切開(kāi)陀螺儀負(fù)責(zé)高頻段加速度計(jì)負(fù)責(zé)低頻段。代碼只有幾行在平衡車這種垂直安裝、運(yùn)行范圍不到 30 度的場(chǎng)景里完全夠用而且調(diào)試只要調(diào)一個(gè) alpha。我的建議很簡(jiǎn)單做課設(shè)或功能演示優(yōu)先互補(bǔ)濾波代碼短、好解釋、調(diào)參直觀做競(jìng)賽或追求極限動(dòng)態(tài)響應(yīng)用卡爾曼濾波DMP 庫(kù)適合不想碰矩陣運(yùn)算、把精力全放在 PID 上的人。這套源碼把三種方案都放了切換時(shí)只需要改融合函數(shù)入口不用動(dòng)上層控制邏輯。2.2 卡爾曼濾波實(shí)現(xiàn)一維模型與核心代碼卡爾曼濾波在平衡車場(chǎng)景里可以簡(jiǎn)化為一維模型——只對(duì)俯仰角pitch做融合橫滾角同理但角度變化幅度遠(yuǎn)小于俯仰可以先不處理。狀態(tài)量有兩個(gè)角度 angle 和陀螺儀零偏 bias。預(yù)測(cè)方程用的是陀螺儀角速度減掉零偏后的值測(cè)量方程用的是加速度計(jì)算出的角度。下面是一份可直接嵌入單片機(jī)的卡爾曼濾波 C 代碼typedef struct { float angle; // 融合后的角度輸出 float bias; // 陀螺儀零偏 float P[2][2]; // 協(xié)方差矩陣 float Q_angle; // 角度過(guò)程噪聲 float Q_bias; // 零偏過(guò)程噪聲 float R_measure; // 測(cè)量噪聲 } Kalman_t; void Kalman_Init(Kalman_t *kf) { kf-angle 0.0f; kf-bias 0.0f; kf-P[0][0] 0.0f; kf-P[0][1] 0.0f; kf-P[1][0] 0.0f; kf-P[1][1] 0.0f; kf-Q_angle 0.001f; kf-Q_bias 0.003f; kf-R_measure 0.03f; } float Kalman_Update(Kalman_t *kf, float new_angle, float new_rate, float dt) { float rate new_rate - kf-bias; kf-angle dt * rate; kf-P[0][0] dt * (dt * kf-P[1][1] - kf-P[0][1] - kf-P[1][0] kf-Q_angle); kf-P[0][1] - dt * kf-P[1][1]; kf-P[1][0] - dt * kf-P[1][1]; kf-P[1][1] kf-Q_bias * dt; float S kf-P[0][0] kf-R_measure; float K[2]; K[0] kf-P[0][0] / S; K[1] kf-P[1][0] / S; float y new_angle - kf-angle; kf-angle K[0] * y; kf-bias K[1] * y; float P00_temp kf-P[0][0]; float P01_temp kf-P[0][1]; kf-P[0][0] - K[0] * P00_temp; kf-P[0][1] - K[0] * P01_temp; kf-P[1][0] - K[1] * P00_temp; kf-P[1][1] - K[1] * P01_temp; return kf-angle; }這套代碼的邏輯是每毫秒調(diào)用一次 Update傳入加速度計(jì)解算出的角度 new_angle 和陀螺儀的原始角速度 new_rate。注意代碼里 P 矩陣的更新方式和網(wǎng)絡(luò)上流傳的簡(jiǎn)化版不太一樣這里是完整保留了協(xié)方差矩陣的遞推關(guān)系在車體低轉(zhuǎn)速時(shí)能明顯減少角度輸出的抖動(dòng)。參數(shù)調(diào)整的經(jīng)驗(yàn)是如果車體反應(yīng)遲鈍、倒下前角度還沒(méi)跟上就把 Q_angle 調(diào)大一點(diǎn)如果角度噪聲大、車體原地微抖就把 R_measure 調(diào)大。 dt 必須和實(shí)際調(diào)用周期一致如果主循環(huán)是 2ms 調(diào)用一次dt 就傳 0.002寫死 0.001 會(huì)讓濾波輸出失真這也是很多人移植濾波代碼后發(fā)現(xiàn)角度“慢半拍”的直接原因。2.3 互補(bǔ)濾波與 DMP更輕量的替代方案互補(bǔ)濾波的實(shí)現(xiàn)思路非常直觀陀螺儀積分后的角度在短時(shí)間內(nèi)可信加速度計(jì)直接解算的角度在長(zhǎng)時(shí)間內(nèi)可信所以每次取 0.98 倍的陀螺儀角度加上 0.02 倍的加速度計(jì)角度一秒內(nèi)完成約 50 次這樣的遞推后陀螺儀漂移就被不斷“拉回”到加速度計(jì)參考軸上。典型代碼如下#define ALPHA 0.98f float Complementary_Filter(float acc_angle, float gyro_rate, float dt) { static float angle 0.0f; angle ALPHA * (angle gyro_rate * dt) (1.0f - ALPHA) * acc_angle; return angle; }ALPHA 越大濾波結(jié)果越信任陀螺儀角度平滑但滯后明顯ALPHA 越小角度越容易受振動(dòng)影響但跟隨加速度計(jì)的速度更快。平衡車上一般從 0.95 起步試車體前后傾斜時(shí)角度響應(yīng)遲鈍就減小到 0.90高頻抖動(dòng)就回調(diào)到 0.98。它雖然沒(méi)有卡爾曼濾波那種嚴(yán)格的統(tǒng)計(jì)最優(yōu)性但在平衡車這種控制周期只有 5ms、角度變化率有限的場(chǎng)景里性能差異幾乎感知不到。DMP 的接入路徑是官方庫(kù)配合 I2C 讀取。初始化時(shí)調(diào)用 dmp_init 并配置采樣率主循環(huán)里通過(guò) dmp_read_fifo 獲取四元數(shù)再用四元數(shù)轉(zhuǎn)歐拉角的公式得到 pitch。需要注意三點(diǎn)一是 DMP 初始化后必須先調(diào)用 dmp_set_fifo_rate 把輸出頻率設(shè)到 100Hz 左右太高的頻率會(huì)導(dǎo)致 FIFO 頻繁溢出二是讀取時(shí)要用 dmp_get_pitch 這類接口而不是直接拿原始四元數(shù)算避免單位轉(zhuǎn)換錯(cuò)誤三是 DMP 的 yaw 會(huì)隨機(jī)漂移但平衡車控制根本不依賴 yaw只取 pitch 和 roll 就夠了。3. 源碼架構(gòu)拆解數(shù)據(jù)流、工程結(jié)構(gòu)與啟動(dòng)順序3.1 從傳感器到 PWM 輸出的完整數(shù)據(jù)鏈路這套源碼的工程結(jié)構(gòu)并不復(fù)雜核心可以分成四層傳感器層負(fù)責(zé)初始化 MPU6050 并讀取原始數(shù)據(jù)解算層負(fù)責(zé)把原始數(shù)據(jù)變成角度和角速度控制層跑 PID 三環(huán)輸出層把控制量換算成 PWM 占空比。數(shù)據(jù)從傳感器到電機(jī)輸出完整鏈路是MPU6050 原始數(shù)據(jù) → 加速度計(jì)/陀螺儀分量提取 → 姿態(tài)解算 → 機(jī)械角度與角速度 → 直立環(huán) PD → 速度環(huán) PI → 轉(zhuǎn)向環(huán) PD → 左右電機(jī) PWM。這條鏈路里最容易斷的位置在解算層和控制層之間。解算層輸出的是“物理角度”單位是度控制層期望的輸入是“相對(duì)于機(jī)械中位”的角度偏差。如果車體安裝時(shí)傳感器不是絕對(duì)水平解算出的角度就帶了固定偏置這時(shí)必須做機(jī)械零點(diǎn)校準(zhǔn)把這組偏置值記錄在結(jié)構(gòu)體里否則直立環(huán)會(huì)一直朝著一個(gè)方向推電機(jī)車一上電就沖出去。源碼里用了 Angle_Offset 結(jié)構(gòu)體來(lái)存三軸零偏這個(gè)設(shè)計(jì)很實(shí)用換車架時(shí)只需要重新校準(zhǔn)不需要改控制代碼。3.2 主循環(huán)與控制周期設(shè)計(jì)整個(gè)控制實(shí)時(shí)性依賴定時(shí)器中斷而不是主循環(huán) while(1) 里裸跑。源碼用定時(shí)器產(chǎn)生 5ms 中斷中斷里依次執(zhí)行讀取 MPU6050 原始數(shù)據(jù)、姿態(tài)解算更新、直立環(huán)計(jì)算、速度環(huán)計(jì)算、轉(zhuǎn)向環(huán)計(jì)算、最終 PWM 輸出。這段代碼是核心中的核心按順序?qū)懬宄?duì)后期調(diào)參非常關(guān)鍵。主循環(huán)部分通常長(zhǎng)這樣int main(void) { System_Init(); // 時(shí)鐘、GPIO、定時(shí)器初始化 MPU6050_Init(); // 傳感器初始化含自檢 Kalman_Init(kf); // 選擇卡爾曼濾波時(shí)啟用 PID_Init(); // 三環(huán) PID 參數(shù)初始化 Encoder_Init(); // 編碼器捕獲初始化 Motor_Init(); // PWM 定時(shí)器初始化 MPU6050_Calibrate(); // 靜止校準(zhǔn)獲取零點(diǎn)偏置 while (1) { // 主循環(huán)只做低優(yōu)先級(jí)任務(wù) // 串口打印調(diào)試數(shù)據(jù)、按鍵檢測(cè)、OLED 顯示 Debug_Print_Angle(); Delay(10); } }這里有一個(gè)值得注意的設(shè)計(jì)控制部分全部塞進(jìn)中斷回調(diào)主循環(huán)只做調(diào)試信息輸出和按鍵掃描這樣 CPU 不會(huì)被耗時(shí)的浮點(diǎn)運(yùn)算卡住控制節(jié)拍穩(wěn)定。代碼里涉及到一個(gè)關(guān)鍵的結(jié)構(gòu)體 Balance_Control_t里面保存了角度目標(biāo)值、速度累加值、上一次誤差等狀態(tài)每次中斷更新它主循環(huán)讀它避免數(shù)據(jù)競(jìng)爭(zhēng)。3.3 模塊劃分與關(guān)鍵參數(shù)速查表源碼把功能拆成了獨(dú)立的模塊文件命名和職責(zé)對(duì)應(yīng)得非常清楚。下表列出主要文件、核心接口和修改參數(shù)時(shí)的關(guān)注點(diǎn)方便拿到源碼后快速定位文件模塊核心接口參數(shù)修改點(diǎn)mpu6050.cMPU6050_Init / MPU6050_Read低通濾波帶寬、采樣率分頻kalman.cKalman_Init / Kalman_UpdateQ_angle / Q_bias / R_measurepid.cPID_Calc / PID_Reset三環(huán) Kp / Ki / Kd、積分限幅motor.cMotor_SetPWM / Motor_InitPWM 頻率、死區(qū)補(bǔ)償、方向翻轉(zhuǎn)encoder.cEncoder_Read / Encoder_Init編碼器線數(shù)倍頻、方向判定control.cBalance_Control_Run目標(biāo)角度、速度環(huán)輸出限幅這套源碼里一個(gè)值得學(xué)習(xí)的點(diǎn)電機(jī)和編碼器的方向判定用宏定義統(tǒng)一管理更換電機(jī)或把編碼器裝到另一側(cè)時(shí)只需要改一個(gè)宏不用在 PID 輸出里到處改正負(fù)號(hào)。初次移植時(shí)最容易翻車的就是方向問(wèn)題電機(jī)轉(zhuǎn)了但編碼器計(jì)數(shù)方向反了直立環(huán)直接變成正反饋車越倒越加速。4. 三環(huán) PID 控制參數(shù)整定流程與輸出限幅實(shí)戰(zhàn)4.1 直立環(huán)、速度環(huán)、轉(zhuǎn)向環(huán)的分工與串聯(lián)方式平衡車控制系統(tǒng)的框架是三個(gè)控制環(huán)疊加在同一個(gè)輸出通道上。最內(nèi)層是直立環(huán)輸入是當(dāng)前角度與目標(biāo)角度的偏差輸出是電機(jī)力矩目標(biāo)是讓車體保持垂直外層是速度環(huán)輸入是目標(biāo)速度與當(dāng)前速度的偏差輸出不是直接疊加到 PWM 上而是改變直立環(huán)的目標(biāo)角度最外層是轉(zhuǎn)向環(huán)輸入是轉(zhuǎn)向目標(biāo)與當(dāng)前偏航角速度的偏差輸出疊加到左右電機(jī)的差模分量上。這種串聯(lián)方式的核心設(shè)計(jì)意圖是直立環(huán)必須最靈敏響應(yīng)速度要快所以用 PD 控制Kp 負(fù)責(zé)把角度偏差轉(zhuǎn)化成恢復(fù)力矩Kd 提供阻尼防止過(guò)沖速度環(huán)用 PI 控制因?yàn)樗俣日`差的消除需要積分項(xiàng)來(lái)克服靜摩擦力轉(zhuǎn)向環(huán)和直立環(huán)一樣用 PD因?yàn)檗D(zhuǎn)向動(dòng)作本身是瞬態(tài)的不需要積分。三個(gè)環(huán)的輸出疊加順序是先算直立環(huán)得到基礎(chǔ) PWM再疊加速度環(huán)修正量最后疊加轉(zhuǎn)向環(huán)差模量等效于左電機(jī) 直立環(huán) 速度環(huán) 轉(zhuǎn)向環(huán)右電機(jī) 直立環(huán) 速度環(huán) - 轉(zhuǎn)向環(huán)。4.2 參數(shù)整定流程從靜止到運(yùn)動(dòng)的三個(gè)階段調(diào)參順序強(qiáng)烈建議按下面的步驟走跳過(guò)任何一步都會(huì)讓后面排查變得痛苦。第一步先把車體用繩子吊起來(lái)或者用手扶著讓車輪懸空第二步調(diào)直立環(huán) Kp從小到大逐步加直到用手把車體掰到一邊時(shí)能感覺(jué)到明顯的回復(fù)力矩并且車體不再一松手就軟塌塌地倒下第三步加 Kd抑制車體在目標(biāo)角度附近的振蕩標(biāo)準(zhǔn)是車體被瞬時(shí)撥動(dòng)后能在 1 到 2 個(gè)周期內(nèi)收斂而不是持續(xù)高頻抖動(dòng)第四步把車放到地面調(diào)速度環(huán) Kp讓它能抵抗輕輕的推拉而不倒第五步加速度環(huán) Ki消除長(zhǎng)時(shí)間勻速漂移最后調(diào)轉(zhuǎn)向環(huán)讓車體能按照遙控指令平滑轉(zhuǎn)向而不打轉(zhuǎn)。調(diào)參過(guò)程中一個(gè)可行的中間狀態(tài)判斷方法代碼里加一個(gè)串口調(diào)試輸出每 10ms 輸出一組數(shù)據(jù)格式為當(dāng)前角度、目標(biāo)角度、直立環(huán)輸出、速度環(huán)輸出、最終 PWM。調(diào)參時(shí)盯著這幾個(gè)數(shù)值的關(guān)系看如果車體靜止時(shí)直立環(huán)輸出不為零說(shuō)明目標(biāo)角度和實(shí)際零點(diǎn)不一致如果速度環(huán)輸出持續(xù)朝一個(gè)方向增長(zhǎng)說(shuō)明積分項(xiàng)在飽和需要檢查限幅。源碼里提供了這種調(diào)試宏開(kāi)關(guān)默認(rèn)注釋掉打開(kāi)后編譯即可。直立環(huán)和速度環(huán)的代碼通常是這樣串聯(lián)的int16_t Balance_Control_Run(float angle, float gyro, int16_t speed_left, int16_t speed_right) { float angle_err g_balance.angle_target - angle; float angle_out g_pid_balance.Kp * angle_err g_pid_balance.Kd * (-gyro); float speed_avg (speed_left speed_right) / 2.0f; float speed_err g_balance.speed_target - speed_avg; float speed_out g_pid_speed.Kp * speed_err g_pid_speed.Ki * g_pid_speed.integral; g_pid_speed.integral speed_err * 0.005f; if (g_pid_speed.integral 1000.0f) g_pid_speed.integral 1000.0f; if (g_pid_speed.integral -1000.0f) g_pid_speed.integral -1000.0f; float pwm_base angle_out speed_out; return (int16_t)pwm_base; }這段代碼里有幾個(gè)關(guān)鍵細(xì)節(jié)直立環(huán)的微分項(xiàng)用的是陀螺儀的角速度 gyro而不是角度誤差的差分這樣能避免對(duì)加速度計(jì)噪聲做微分放大的問(wèn)題速度環(huán)的積分項(xiàng)手動(dòng)做了限幅防止車被持續(xù)外力推著時(shí)積分無(wú)限增大導(dǎo)致外力消失后車瘋狂朝反方向沖出去速度環(huán)輸出是疊加到 angle_out 上的這正好實(shí)現(xiàn)了“速度環(huán)通過(guò)改變目標(biāo)角度來(lái)影響直立環(huán)”的設(shè)計(jì)意圖。限幅參數(shù)的經(jīng)驗(yàn)范圍可以這樣記直立環(huán)輸出在 -700 到 700 之間速度環(huán)輸出在 -300 到 300 之間轉(zhuǎn)向環(huán)輸出在 -200 到 200 之間最終 PWM 輸出限幅在 -900 到 900。這些數(shù)值不是固定的具體要看電源電壓和電機(jī)額定參數(shù)。如果 PWM 滿偏值本身設(shè)定是 1000就不要讓最終輸出長(zhǎng)期貼著 1000 跑否則電機(jī)處于飽和狀態(tài)速度環(huán)和轉(zhuǎn)向環(huán)都會(huì)失效車體會(huì)呈現(xiàn)明顯的“失控感”。5. 避坑排查五種高頻故障現(xiàn)象原因與解決記錄5.1 電機(jī)高頻“嗞嗞”聲且車體劇烈抖動(dòng)現(xiàn)象上電后電機(jī)沒(méi)有正常轉(zhuǎn)動(dòng)而是發(fā)出尖銳的高頻嘯叫同時(shí)車體以肉眼可見(jiàn)的頻率劇烈抖動(dòng)用手按住車體時(shí)能感覺(jué)到明顯的振動(dòng)力度但一松手就倒向一側(cè)。原因PWM 頻率設(shè)置過(guò)低常見(jiàn)值是幾百赫茲。電機(jī)驅(qū)動(dòng)電路和電機(jī)的電感在這種頻率下產(chǎn)生明顯的電流波動(dòng)導(dǎo)致力矩輸出斷續(xù)而直立環(huán)又把這種斷續(xù)當(dāng)成角度誤差來(lái)響應(yīng)形成正反饋振蕩。解決把 PWM 定時(shí)器的頻率配置成 10kHz 到 20kHz 之間。在源碼的 motor.c 里修改定時(shí)器分頻和重載值讓 PWM 頻率進(jìn)入人耳聽(tīng)不到的超聲范圍。修改后電機(jī)聲音會(huì)變得很干凈車體的高頻抖動(dòng)會(huì)立刻消失。檢查手段是用示波器看 PWM 波形頻率或者聽(tīng)聲音變化明顯可感知。5.2 MPU6050 初始化失敗I2C 通信卡死現(xiàn)象程序運(yùn)行到 MPU6050_Init 時(shí)卡住串口沒(méi)有打印任何信息或者打印了初始化失敗提示復(fù)位后依舊如此。原因排除了接線錯(cuò)誤后最常見(jiàn)的是 I2C 總線上沒(méi)有上拉電阻。部分開(kāi)發(fā)板內(nèi)部已經(jīng)集成上拉但外接 MPU6050 模塊時(shí)如果連接線過(guò)長(zhǎng)、接觸不良總線 SCL/SDA 處于高阻態(tài)單片機(jī)檢測(cè)不到從設(shè)備應(yīng)答。解決給 SCL 和 SDA 各加一個(gè) 4.7k 歐姆上拉電阻到 3.3V另外 I2C 速率不要太高源碼里默認(rèn)配置為 400kHz把分頻系數(shù)改大降速到 100kHz 試試能提高抗干擾能力。檢查手段是單獨(dú)寫一個(gè)只掃描 I2C 設(shè)備地址的測(cè)試函數(shù)看能否返回 0x68 或 0x69如果返回值不對(duì)優(yōu)先懷疑上拉和接線。5.3 靜止時(shí)角度輸出緩慢漂移現(xiàn)象車體靜止放在桌面上串口打印的姿態(tài)角度數(shù)值每隔幾秒就變化零點(diǎn)幾度時(shí)間越長(zhǎng)漂移越明顯導(dǎo)致直立環(huán)誤以為車體在傾斜。原因最直接的原因是陀螺儀零偏未校準(zhǔn)。MPU6050 出廠時(shí)存在溫漂和個(gè)體差異的零偏如果不做靜止校準(zhǔn)陀螺儀積分會(huì)把這個(gè)固定偏差不斷累積導(dǎo)致角度隨時(shí)間漂移。另外一個(gè)常見(jiàn)原因是加速度計(jì)未做低通濾波高頻振動(dòng)噪聲被直接引入角度計(jì)算。解決第一步在初始化后讓車體完全靜止 1 秒以上采樣陀螺儀輸出求平均值作為零偏補(bǔ)償值第二步確認(rèn)濾波系數(shù)是否正確把加速度計(jì)原始數(shù)據(jù)經(jīng)過(guò)低通濾波后再算角度。這套源碼里已經(jīng)實(shí)現(xiàn)了 mpu6050_offset_cal 函數(shù)調(diào)用位置在主循環(huán)之前使用時(shí)要確認(rèn)車體確實(shí)靜止否則會(huì)把運(yùn)動(dòng)狀態(tài)當(dāng)成零偏記錄下來(lái)。5.4 電池電壓下降后車子突然變軟或朝一個(gè)方向加速現(xiàn)象滿電時(shí)車體直立穩(wěn)定運(yùn)行幾分鐘后電池電壓降低車體開(kāi)始慢慢前傾直立環(huán)輸出不足以把它拉回來(lái)最后朝前加速倒下。原因這是典型的 PWM 輸出未做電源電壓補(bǔ)償。當(dāng)電池電壓下降時(shí)同樣占空比下電機(jī)實(shí)際電壓降低、力矩變小但控制環(huán)的 PID 計(jì)算依然按滿電壓的等效關(guān)系輸出相當(dāng)于控制器對(duì)執(zhí)行機(jī)構(gòu)的控制能力打了折扣系統(tǒng)增益隨電壓變化。解決在讀取電池電壓的 AD 值后按電壓比例對(duì)最終 PWM 輸出做修正常見(jiàn)做法是維持一個(gè)基準(zhǔn)電壓比如 12V 時(shí)輸出 1000 對(duì)應(yīng)滿占空比當(dāng)電壓降到 10V 時(shí)輸出限幅值同步按 10/12 縮放保持電機(jī)的實(shí)際出力不變。這樣電壓變化時(shí)控制參數(shù)基本不受影響。源碼里預(yù)留了 voltage_compensate 接口沒(méi)有實(shí)現(xiàn)完整邏輯建議自行填充 AD 采集代碼。5.5 裝好后轉(zhuǎn)向環(huán)正常一加速度環(huán)就左右甩尾現(xiàn)象單獨(dú)調(diào)直立環(huán)時(shí)車體很穩(wěn)手輕輕推也能恢復(fù)直立。但開(kāi)啟速度環(huán)后車體開(kāi)始前后往復(fù)擺動(dòng)幅度越來(lái)越大最后變成左右甩尾式的失穩(wěn)。原因速度環(huán)積分系數(shù)設(shè)置過(guò)大或者速度環(huán)輸出限幅值設(shè)得太高。速度環(huán)輸出改變的是直立環(huán)的目標(biāo)角度如果目標(biāo)角度變化幅度過(guò)大、變化速度過(guò)快直立環(huán)會(huì)認(rèn)為車體嚴(yán)重偏離目標(biāo)產(chǎn)生一個(gè)很大的輸出導(dǎo)致電機(jī)猛烈加速反過(guò)來(lái)又讓速度誤差更大形成惡性循環(huán)。解決把速度環(huán)的 Ki 減半再觀察同時(shí)把速度環(huán)輸出限幅從 300 收窄到 150讓速度環(huán)對(duì)目標(biāo)角度的改變更溫和。另外確認(rèn)速度環(huán)的反饋方向是否正確——車體向前運(yùn)動(dòng)時(shí)編碼器值應(yīng)為負(fù)速度誤差為負(fù)輸出應(yīng)為正如果方向反了速度環(huán)會(huì)持續(xù)加大車速導(dǎo)致失控。判斷方法用手推動(dòng)車體觀察串口打印的速度值符號(hào)和方向是否一致不對(duì)的話修改編碼器方向宏定義。6. 進(jìn)階用法上電自檢、數(shù)據(jù)觀測(cè)與站立自鎖調(diào)試技巧最后分享三個(gè)在這套源碼基礎(chǔ)上常用的進(jìn)階技巧能顯著減少調(diào)試時(shí)間和維護(hù)成本。第一個(gè)是上電自檢流程在進(jìn)入主循環(huán)之前依次執(zhí)行傳感器初始化、零偏校準(zhǔn)、電機(jī) PWM 輸出置零、編碼器讀數(shù)清零然后延時(shí) 500ms 等待電源穩(wěn)定再解除電機(jī)剎車。這個(gè)流程看起來(lái)簡(jiǎn)單但能避免一個(gè)問(wèn)題——很多車一上電就突然加速是因?yàn)殡姍C(jī)在初始化瞬間收到了一個(gè)殘留在 PWM 寄存器里的舊值。正確做法是初始化最后把 PWM 輸出強(qiáng)制寫到 0再做一次編碼器清零確保第一幀控制輸出時(shí)所有反饋都是干凈的。第二個(gè)是數(shù)據(jù)觀測(cè)方法。調(diào)平衡車必須能看到角度和輸出不然全靠手感是玄學(xué)。建議用串口以 100Hz 頻率輸出一段格式化數(shù)據(jù)終端里按列顯示角度、目標(biāo)角度、直立環(huán)輸出、速度環(huán)輸出、最終 PWM。調(diào)試時(shí)重點(diǎn)看兩個(gè)指標(biāo)一是靜止時(shí)角度和目標(biāo)角度的差長(zhǎng)期是否為零不為零就要重新做機(jī)械零點(diǎn)校準(zhǔn)二是撥動(dòng)車體一次后角度能否在兩個(gè)來(lái)回內(nèi)收斂到目標(biāo)值附近如果連續(xù)振蕩四次以上就說(shuō)明 Kd 不夠或者濾波環(huán)節(jié)的相位滯后太大。更快的方式是先用仿真工具對(duì)卡爾曼濾波和 PID 參數(shù)做一次離線驗(yàn)證很多數(shù)學(xué)工具都能直接導(dǎo)入傳感器采集的數(shù)據(jù)調(diào)好參數(shù)再燒進(jìn)單片機(jī)能明顯減少在實(shí)物上反復(fù)燒錄的次數(shù)。第三個(gè)是站立自鎖功能。平衡車有兩種常見(jiàn)工作模式上電即平衡、上電視為待機(jī)模式。待機(jī)模式更安全——上電后車子不轉(zhuǎn)按下按鍵后才啟動(dòng)平衡算法。實(shí)現(xiàn)方式不復(fù)雜主循環(huán)檢測(cè)按鍵按下置位 enable 標(biāo)志控制中斷里檢查該標(biāo)志沒(méi)有置位時(shí)直接把 PWM 輸出置零且不執(zhí)行 PID 計(jì)算。這個(gè)習(xí)慣值得保留特別是調(diào)試階段車子放在桌面時(shí)不會(huì)被意外啟動(dòng)的電機(jī)帶跑。初始化時(shí)我一般會(huì)強(qiáng)制走一遍整體檢查先看傳感器數(shù)據(jù)是否穩(wěn)定再看角度能否跟隨手動(dòng)傾斜再確認(rèn)電機(jī)方向與編碼器方向一致最后才松開(kāi)手讓它進(jìn)入平衡狀態(tài)。從那以后我每次移植新源碼或者換新硬件都強(qiáng)制走這一遍節(jié)省過(guò)太多排查時(shí)間希望幫到你。整套源碼的完整工程文件、依賴庫(kù)和燒錄說(shuō)明都在壓縮包里按 README 里的引腳映射接好線燒錄后先調(diào)直立環(huán)就能站起來(lái)。本文還有配套的精品資源點(diǎn)擊獲取
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
91聚色综合网| 国产99久久久| 操逼综合激情网| 开心五月天激情网| www色色com| 久久婷婷五月免费视频| 天天色综合综合| www.minyis.com【JT】实力收量可预付TG@LXSPSW8 | 99碰超| 蜜乳中文字| 丁香五月天天| 欧洲99视频在线| 欧美色图天堂网色| 五月婷免费视频| 综合久久五| 丁香五月天激情视频| 精品人妻一区二区| 99热久久这里只有精品2010| 天天成人综合视频| 五月婷婷激情69| 天堂婷婷五月在线| 久热这里只有精品性色AV| 欧美色色色色色色色色色色| 欧美碰碰碰| 狠狠五月婷婷| 日本色色色色色色色色一色二色| 99在线精品免费视频| 青草激情综合| 婷婷综合色色| 欧美97色| 大香蕉五月丁香| 五月综合视频| 五月婷视频| 色香五月天| 五月婷婷五月丁香综合| 婷婷五月综合婷婷| 欧美五月丁香啪啪响视频| 色色免费网站| 武则天精品久久| 91精产品自偷自偷综合| 久久aaaaa| 欧美三级视频| 色色综合网。| 超碰无码老师| 五月成人丁香av91| 91聚色综合网| 丁香婷婷五月天成人| 97精品人人A片免费看| 99热这里只有精品1| 亚洲国产成人在线| 欧洲毛片基地c区| 伊人久久大香蕉网| 五月婷婷丁香婷婷| 丁香五月欧美午夜视频| 狠狠色大香蕉| AV在线大香蕉| 伊人碰碰碰| 五月丁香综合影院| 五月丁香激情婷婷| 99色色网| 五月开心久久| 色婷婷五月综合| 久久这里只有精品99| 97精品综合久久| 色综合色五月| 91欧美日韩综合| 97色片| 久久99激情| 激情五月天色播| 26uuu精品一区二区| 深爱婷婷丁香五月激情| 亚洲欧美999| 婷婷五月综合视频| 99爱这里只有精品免费视频| 婷婷五月天激情诱惑| 婷婷五月天激情基地| 26uuu另类亚洲欧美日本一| 五月婷色丁香| 成人性爱精品视频| 丁香五月激情婷婷婷婷在线观看| 日本狠狠干| 人妻aV在线| 99久热| 色五月天电影| 五月停停999| 九九热99免费视频| 日本一级一级一级一级| www久久久| 1000部毛片A片免费观看| 国产精自产拍久久久久久蜜| 九久久婷婷| 久777| 亚州欧美黄色电影| 色 噜噜 九月 婷婷| 欧美人人超级碰| 欧美乱码国产一级A片| 九九十99视频| 亚洲激情av| 全亚洲最大的婷婷五月天网站COM| 掩去也综合五月视频| 丁香六月天婷婷| 欧美A A A A A| 色亭亭九月| 亚洲av无码影院| 9视频1在线| 五月丁香综合影院| 色色综合网站| 激情精品久久| 婷婷激情六月天视频| 欧美VA在线| 99热官网| 五月婷婷婷婷| 高清资源站日A美A欧亚…| 精品99*| 五月天激情黄色网址| 久久9999| 五月丁香六月婷婷啪啪综合| 99热这里只有精品2024| 五月激情婷婷国产精品久久久久久 | 大香蕉五月天婷婷| Www.sesese丁香| 欧美超碰亚洲| 国产在线黄色| 天天日人人| 激情婷婷丁香色五月| 思思热AV| 91超级碰碰碰| AA片在线观看视频在线播放| 婷婷久久天堂网| 黄色激情久久| 亚洲激情免费久久| 丁香婷婷婷五月| 久久亚洲无码| AA丁香综合激情| 色综合久久久无码中文字幕999| 31色区视频免费看| 欧洲亚洲免费视频9| 影音先锋按摩| 激情综合色婷婷啪啪六月天| 五月丁香六月色婷婷综合五月天| 日本性激情色播| 激情五月天小说| av在线免费网站 | 色五月97| 丁香五月婷婷啪| 日本九九热| 日韩十国产极品久久| 丁香婷五月天开心六月| 久99热| 婷婷五月丁香青青草在线| 超碰精品国产首页| 激情com| anquye五月| 激情综合五月| 中文字幕日产A片在线看| 激情性爱五月天网页| 久久99久久久| 99热国产国产| 夜夜爽天天爽| 丁香六月婷| 91黄色五月天视频| 91精品久久久久久| 久久久久久丁香五月| 99性爱视频| 色色网站| 超碰在线资源| 天天综合情| 密桃激情五月天综合网| 91狠狠色| 大香网伊人久久综合| 99精品网| 婷婷欧美激情| 五月丁六月香av| 伊人在线视频| 极品人妻XXXXOOOO| 精品人妻在线| 俺也去综合| 色偷偷色婷婷| AA片在线观看视频在线播放| 99a级片| 色情丁香五月天| 九九热99热| 婷婷五月激情五月激情| 日本玖玖在线| 五月天天天操天天爽夜夜操| 99综合| 五月婷婷色色| 青青久久91| 亚洲AV成人精品日韩在线播放| 五月天色在线| 五月婷婷丁香| 五月天激情亚洲| 国产 码在线成人网站| 99九九精品视频| 在线不卡视频| 秋霞av不能| 色亚洲无码| 五月天激情婷婷小说| 欧美人人操| 欧美性生交XXXXX无码小说| 九九综舍久久| 六月婷婷国产| 色色色热热热| 丁香五月中文字幕| 日韩成人影片网站| 狠狠综合| 丁香六月激情| 亚洲视频在线网站| 久久视网36| 婷婷五月激情天| 91婷婷| 午夜福利8055| 91视屏在线观看com.wwwvv| 午夜九九九九九九九九九九九九九| 亚洲字幕AV一区二区三区四区 | 婷婷五月丁香91| 狠狠操.COM| 99九九综合久久九九| 婷婷五月丁香图片人人操| 超碰97人人操| 天天做天天爱天天要| 少妇综合网| 激情久久综合网| 亚洲视频丁香网va| 99热精品在线播放| 五月丁香六月婷婷久久| 玖玖资源天天无码| 99热精品免费| 91色在线/日韩| 久久免费婷婷视频| 欧美叉叉叉BBB网站| 97色女人在线| 激情五月天无人视频在线| 99色视频| 另类图片色五月| 亚洲色涩视频| 91色在线 | 日韩| 河北真实伦对白精彩脏话| 国产成人av在线播放| 五月天俺去也| 成人亚洲精品久久久久| 丁香婷婷六月婷婷六月婷婷六月婷婷| 久久天堂网| 丁香啪啪中文字幕| 九九热区一区二区三区| 色婷婷成人| 久久久性爱网| 天天爽天天操| 男人的天堂99| 天天成人丁香美女AV| 久色| 五月婷在线观看| 五月婷婷在线视频观看| 涩丁香| site:wpjngj.com| 啪啪激情网| 97在线干| 久久这里有精品视频| 伊人无码高清| 国产永久一二一起草| 伊久久婷婷| 99热日本精品| 淫荡工a| 99热综合| 91超级碰碰| 久久婷婷内射| 色婷婷激情五月天| 久久99热这里只有精品| 久久日婷婷| 懂色av蜜臀av粉嫩av永陈冠希| 激情综合网 激情五月天| 99热精品在线| 五月婷婷激情四季| 久色激情| www.91在线观看| 婷婷激情视频欧美视频自拍视频欧美剧| 屁股翘好撅高迎合跪趴| 婷丁香五月天| 欧美搡BBBBB摔BBBBB| 色色综合成人网| 色婷婷先锋| 大香蕉丁香| 国产玖玖资源| 亚洲综合碰| 色婷婷五月天综合网| 日韩成人精品中文字幕| 五月欧美色播| 婷婷五月天激情网| 久热超碰91| 欧美婷婷成人| 男人天堂AV在线一区二区| 欧美啄木乌丝袜人妻系列| 中日韩美欧成人一区二区精品在线| 欧美天天五月丁香免费观看| 亚洲天堂99| 亚洲色婷婷| 丁香五月婷婷基地| 色色五月婷| 97久久精品| 五月丁香婷婷婷激情爱爱| 天天色宗合| 91热视频| 2025年最新亚洲在线欧美| 色射影院| 成人AV中文字幕| 五月天色五月| 九九十99视频| 伊人www22综合色| 成人中文字幕在线| 激情五月久久| 亚洲色图五月丁香| 操碰99| 色婷婷国产精品综合在线观看| 99爱视频在线观看| 激情爱爱网站超大免费| 色欲天天综合| 美日韩成人| 婷婷深爱五月| 最新午夜理论片| 天天日夜夜爽| 亚洲无码成人性爰网| 激情内射人妻1区2区3区| 思思色综合网站| 乱乱av| 五月天玖玖狠狠色色| 激情5月婷婷| 日韩精品无码99| 97碰 在线视频观看| 五月婷婷六月丁香在线视频| 亚洲av成人电影在线观看| 99热思思| 99久视频| www五月| 色五月aV| www.91热久久| 婷婷丁香小说| 久99久精品视频| 亭亭色色五月天| 五月婷婷激情刺激| 国产又爽又猛又粗的视频A片| 最新五月天婷婷影| 涩涩激情五月婷婷| 国产精品国产| 99热精品在线播放| 免费无码毛片一区二区A片| 久久视频九九视频| 成人一区在线观看| 亚洲成人AV在线观看| www.超碰| 嫩BBB搡BBBB榛BBBB| 欧美综合五月丁香六月婷| 91在线精品一区二区| 五月天婷婷久久视频| 六月婷婷久久| 99色综合| 婷婷五月色丁香在线看| 日本毛片内射| 色婷婷99| 丁香五月综合图片在线观看| 亚洲天堂有码| 香蕉国产2013| 色情·com| 51精品国自产在线| 超碰成人免费| 99色视频| 欧美狠狠地| 91视频免费后入强操| 99re免费精品视频| 婷婷五月天激情偷拍| 超碰99热精品在线| 天天噜| 深夜男女福利刺激影院一区完整| CHINESE熟女老女人HD视频| 免费播放99性爱视频| 色99免费视频中文| 99热6精品| 亚洲五月天天| 色欲色香,www,com| 国产一级片| 日91高清无玛| 久久色情| 日韩黄色影院| www.婷婷,com| 91人操人人人操人| 婷婷操逼网| 久在热99| AV在线免费播放| WWW.五月天9999| 久久月天堂| 婷婷五月色综合| 综合久久婷婷五月丁香| 色综合网页| 五月丁香好婷婷A片网| 五月丁香久久网| 久久九九思思| 91操片| 一本久久亚洲五月婷婷| 99热 在线播放| www久久久| 五月丁花色综合网| 三级毛片7979| 开心激情站| 色色 亚洲| 99精品久久久久久久婷婷| 日日躁夜夜躁狠狠久久AV| 综合五月婷婷| 最新热中文字幕| 在线五月婷| 美女网黄| 操操操操操电影网| 久久作爱| 人人妖人人97| 亚州色婷婷| 开心五月丁香婷婷| 精品牛仔裤超碰| 久草热8精品视频在线观看| 日操夜撸| 69热在线| 91fuliwang| 91久久久久久| 新精品99| 色情综合网| 1024AV视频| 婷婷久久五月丁香| 丁香五月综合在线播放| 丁香色五月 97干| 91干婷婷| 色婷婷影视| 欧美激情综合色综合色| 成人AV免费观看| 日韩乱轮AV| 色综合久久天天综合网| 激情综合亚洲色婷婷五月| 91视频精品99| 五月婷婷影视| 色色色成人网| 色 色 色综合com| 大功率国产在线| 丁香五月婷综合| 99久久网站| 亚洲热视频| 亚洲天天免费| 色欲五月婷婷| 夂夂夂夂夂夂夂夂夂夂夂夂夂夂夂夂夂夂夂亚洲亚洲亚洲亚洲亚洲亚洲亚洲亚洲色 | 九月婷婷丁香| 久草大| 久久性都花花世界成人免费视频| 久热这里只有精品99re| 色综合色色| 色播丁香五月婷婷操:屄| 97超级操操| 亚洲欧洲中文日韩久久AV乱码| 成人免费在线电影| 五月香六月婷| 韩国情人在线电视剧免费观看高清版全集 | 碰碰碰91| 色婷婷丁香花五月天| 亚洲中文字幕AV| 久久精品亚洲一级牲爱综合| 韩国情人在线电视剧免费观看高清版全集| 激情綜合網址| 亚洲丁香婷婷| 99re6在线视频精品免费| 无码橾| 99热99这里有免费的精品| 91久久婷婷| 99热精品超碰| 五月婷婷视频| 99无码视频| 99爱爱网| 五月天婷婷丁香社区| 激情深爱综合| 色色五月天丁香婷婷| 久久五月婷天天干| 五月丁香久久| 粉嫩av懂色av蜜臀av熟妇| 丁香婷婷色情社区成人小说| 五月婷婷视频啪啪美女| 超碰成人电影| av最新在线| 婷婷色五月91啪啪| 国产成人+综合亚洲+天堂| 久久在线大香蕉| 国产精品久久7777777精品无码| 丁香婷婷综合精品六月初| 丁香五月电影院在线观看| 大香蕉AV电影在线| 天天日天天插| 九九热在线观看视频| 五月天激情小说| 人人做天天爱| 就爱啪啪婷婷| 99精品视频免费在线播放| 大香蕉婷婷丁香| 1024在线观看免费视频| 日韩艹比| 天天爱天天操| 玖玖资源在线视频| 久久婷婷五月综合伊人| 激情五月久久| 久久精品只有这| 五月天激情日色在线| 婷婷97狠狠干| 色情综合网| 99日逼视频| 色五月色情| 5月丁香美女影院| 色色色综合网| 狠狠色噜噜狠狠狠888| 五月天婷婷基地综合网| 五月丁香激情综合网| 高清无码中文字幕aVDV| 婷婷激情鹿城五月天| 欧美激情 日韩无码 婷婷 五月天| 亚洲精品影视| 婷婷爱爱蜜臀天天操| 激情性爱网站| 丁香伊人五月色婷婷五十路| 狠狠色噜噜狠狠狠777奇米| 青青久在线视频免费观看| 丁香色婷婷| 久久综合人妻| 九月丁香婷婷| 久99视频| 亚洲啪啪啪啪| 丁香六月婷婷开心| 另类A片| 99热日| 五月天亚洲综合网| 九热视频| 婷婷丁香五月在线播放| 亚洲色情网站| 夜丁香五月婷婷| 五月色俺婷婷| 天天干天天爽天天爽| 色五月天成人在线| WWW·色色色·COM| 超碰97久久| 性爱七区| 9 1在线视频| 久久182| 久久五月天 91| 红桃91人妻爽人妻爽| 99久久喉9| 婷婷丁香18| 字幕网AV中文字幕| 婷婷丁香五月天综合激情| 亚洲电影在线观看| 久久精品无码一区| 丁香婷婷成年| 五月丁香婷婷欧美色图视频五月丁香777电影| 亚洲视频一区| 九九九激情综合| 97色在线| 免费观看全黄做爰的视频| 婷婷丁香社区| 三级片AAA久久久AAA久久久AAA | www.色情五月天.com| 国产亚洲成人综合| 四射综合网| 热热99爱爱| 九九热99熟女| 97爱艹婷婷开心丁香激情综合| 国产伦亲子伦亲子视频观看| 色色五月婷婷狠狠| 99色综合久久| 五月婷久久综合| 十区av| 偷拍91九色| 色99色| 狼友超碰| 婷婷五月天激情网| 丁香五月狠狠在线观看| 久久婷婷五月综合激情国产| 五月中旬婷婷丁香六| 亚洲人成人五月天| 丁香久久| 99色在线观看视频| 亚洲人妻av| 人人爽天天爽| 亚洲成av人影院| 日韩色色色色| 婷婷五月日本| 日韩99视频| 久久99婷婷| 五月天丁香六月综合| 日本的α片xxxwww| 这里只有精品99www| 久久色五月天综合网| 久久视频这里有精品99| 五月激情网站| 五月婷六月| 人妻AV在线| 全部老头和老太XXXXX| 中文字幕1区2区。| 中文字幕av网站| 成人资源在线| 亚洲精品99| 狠狠操天天操| 丁香五月在线看| 六九色综合婷婷五月天| 亚州操操| 婷婷五月天激情网| 超碰人妻公开在线| 九九人人看| 日韩成人AV在线| 婷婷色五月激情| 九色视频这里只有精品| 99精品视频网站| 激情综合网五月丁香| 六月丁香五月婷婷| 苗黎美女四级成人版一级二级毛片| 偷拍九九热| 五月丁香啪。| 婷婷午夜| 欧美婷| 韩国激情五月天综合网| 色色五月婷| 久久婷婷五月天| 伊人在线另类| 99大香蕉| 精品国产va久| 亚洲色情网站| 青青草tp| 99视频内射三四| 久久激情四射| 色婷婷yy久| 99爱在线| 99热在线精品播放| 激情五月天噢美| 丁香五月第四色88| 天天爱天天爽| 亚洲激情在线| 人人综合色| 五月丁香操婷逼| 丁香五月第九色| 99久久6| 99热99在线| 成人做爰黄A片免费看直播室男男 A片试看120分钟做受图片 | 9|在线观看视频| 亚洲无线视频| 婷婷五月天少妇| 天天摸天天做天天爱天天爽| 婷婷五月天亚洲| 99九九这里有免费视频| 五月婷婷激情久久| 婷婷五月天综合蜜桃| 99热这里只有精品首页| 天天干天天干天天干天天干天天干| 亚洲五月六月婷婷| 91九色小视频| 综合久久丁香婷婷,五月婷婷六月丁香,开心激情综合网,六月丁香在线观看,婷婷丁 | 九月色婷婷综合| 五月婷婷激情网| 丁香五月 性爱| 无码人妻电影| 天天日天天操天天干| 久久五月天网| 中字幕视频在线永久在线观看免费| 婷五月天| 色丁香五月婷婷婷| 亚洲精品婷婷| 丁香五月av| 婷婷色情五月| 在线VA视频| www.99视频| 日本狠狠干| 久久99免费视屏| 五月激情丁香五月| 天天做天天爱天天摸| 丁香五月停停av| 91久久久久久久| 久热99视频在线观看| 超碰成人电影| 深爱激情69热| 九九99精品| 色五月,婷婷大香蕉| 天天爱天天日| 婷婷五月天成人网| 欧美性做爰大片免费看办公室| 人人插9| 色欲丁香久久| 亚洲成人AV在线播放| 日韩在线看AV| 综合99久久| 久久欧洲综合网| 婷婷婷婷色| www狠狠爱com| 激情99。| 九九99精品视频| 婷婷综合中文字幕| 色五月网址| 丁香婷婷视频| 国产午夜精品一区二区三区嫩草| 久久精品婷婷五月丁香| 激情黄色小说五月天| 三级黄网站| 特黄三级又爽又粗又大| 五月天播播综合| 久综合| 色婷婷中文| 久久er视频6| www.五月天激情| 丁香激情网| 激情文学第四色婷婷丁香五月| 99热精品一区| 婷婷精品| 人人操人人爰人人一天天碰夜夜拍夜夜爽-中国A级毛片天天看天天谢… | 五月丁香六月综合激情网| 婷婷色五月天在线观看| 操人精品| 五月天婷婷五月| 很很干天天干| 秋霞AV美国| 米奇激情婷婷| 26uuu日韩| 99人人操人人操人人精| 亚洲久久日| 五月婷婷激情中心| 五月丁香| 激情久久五月天| 五月亭亭性| 三十熟女| 99成人网一区| 97人人搞| 91日综合欧美| 99热大片| 99热在线观看| 激情五月天色色网| 亚洲激情综合| 91热久88| 婷婷五月欧美综合| 人人干av| 日本三久久| 欧美成人精品一区二区| 另类少妇人与禽zOZZ0性伦| 亚洲国产成人在线| 色5月丁香婷婷| 色九月丁香婷婷蜜桃在线观看| 亚洲色五月天在线| 丁香久久| 97色色婷婷五月天| 亚洲国产精品VA在线看黑人| 99热最新国内| 天天做天天要天天爽| www.婷婷五月| 中文无码婷婷| 五月天伊人久久久久| 日本97人人| www.五月天。com| 色丁香五月婷婷| 日本色色网| 丁香婷婷色| 久久婷中文字幕| 99re思思热久久| 另类五月激情| 激情五月综合ì香亚洲| 婷婷激情五月| 六月婷婷成人| 五月丁香亚洲综合| 日韩综合天堂| 国产97色在线 | 日韩| www91久久| 另类综合婷婷五月天欧美视频| 人妻日日日| 激情综合五月色在线| 五月激情视频| 成久综合视频| 国产亚洲在线观看| 中美日韩成人在线| www.91.com黄| 99超级碰碰| www.婷婷五月天.com| 大香人妻| 五月婷婷 激情五月| 亚洲正能量欧美| 99热精国产这里只有精品| 少妇人妻丰满做爰XXX| 精品无码色| 狠狠狠狠狠| 色五月综合网| 婷婷久久网| 男人大jjc女人免费视频| 丁香六月 人妻| 激情小说五月天| 玖月婷婷爱丁香| 激情综合久久| 欧美va亚洲va| 色色亚洲| 五月天六月丁香| 色婷婷六月| 99色在线视频观看| 色色色热热热| 久久99热这里只有精品首| 狠狠色丁香| 五月花综合| 伊人五月综合网| 玖玖视频福利| www狠狠| 亚洲综合网区| 五月丁香啪啪啪| 综合丁香婷婷五月天| 香蕉久久国产AV一区二区| 五月天五月色婷婷综合| 操人91| 五月丁香激情综合啪| 99视频内射三四| site:minyis.com| 能看的av| renre人人操国产超碰在线| 久久黄色片| 狠狠狠五月婷婷六月丁香| 综合久久激情久久| 色综合综合网| yw.av| 99精品视频网站| 超碰色天堂| 亚洲激情另类| 久久婷婷五月综合伊人| 九九久久精品| 欧洲永久精品| 久久精品一区二区三区四区| 色宗合久久五月婷婷| 影音先锋秋秋五月婷婷| 国产日韩亚洲欧美在线观看| 色婷婷AⅤ| 婷婷涩涩五月天| 美女网黄| 日本丁香五月| 人人爱天天摸摸天天爱| 欧美日本韩国亚洲| 亚洲 五月 婷婷 成人| 亚洲天堂AV综合网| 停停五月色宗合| 九月影院義母在线播放| 丁香色五月天| 色丁香五月婷婷婷| 最近中文字幕2019视频1| www开心激情网| 亚洲成人AV一区在线观看| 99无码精品| 开心激情站| 日韩成人精品一区久久久久| 91人妻九色大屁股| 欧美婷婷成人| 九九热啪啪| 五月激情站| 九九视频这里只有精品在线播放| 99热网精品| 五月天婷婷无码视频| 97日本在线| 六月婷婷激情| 婷婷五月天伊人在线| 97人妻超级碰碰碰碰碰| 天天插插天天| 色婷婷AⅤ| 激情久久久久| 天天上天天爽| 亚洲中文AV| 久狠狠狠| 99日本黄站| 国产日韩欧美| www.丁香五月| www.久久99热地址发布| 五月婷在线| 米奇影视资源婷婷狠狠色激情欧美五月丁香| 99操不停| 精品爆操| 丁香丁婷五月激情| 91精品国产综合久久久不卡电影| 亚洲成人在线五月天| 99热这里| 亚洲精品又粗又大又爽A片 | 五月天亚洲综合网| 久久xx| XX色综合| 亚洲va欧美va天堂v国产综合| 日本 欧美在线| 被男人添B超爽视频| 丁香五月天网友自拍啪啪啪视频| 色婷婷五月天偷拍| 日本色婷婷| 国产裸舞表演WWWW| 五月婷婷人人人操| 桃色五月天| 美女妹子后射视频网站在线观看| 亚洲小电影在线观看黄999| 狠狠干狠狠干| 蜜桃五月天| www.99热视频| 亚洲亚洲人成综合网络| 99这里| 五月天丁香六月综合| 《亚洲操B久久免费在线观看,亚洲操B久久在线播放》在线播放 - 高清资源 - 97 | 国産精品| 激情的五月| 丁香六月av| 激情五月天色播| 99热99re6国产在线播放| 91婷婷丁香五月| 无码日本精品XXXXXXXXX | 五月激情婷婷丁香天堂| 九九热这里只有精品7| 婷婷五月天VI| www.色五月.com| 插少妇综合网| 亚洲成人网站在线| 少妇大叫太大太粗太爽了A片 | 亚洲午夜精品久久久久久人妖| 五月天久久婷| 另类精品视频在线观看| 巴基斯坦粉嫰无码视频| 婷婷久久免费| 麻豆AV一区二区三区| 色播五月婷婷五月| 这里只有精品亚洲| 九色综合五月天婷五月| 色婷婷网| 丁香丝袜五月| AV在线免费播放| 国产免费性爱| 97狠狠色| 五月丁香欧美综合免费视频| 婷婷五月色影视先锋| 丰满少妇猛烈A片免费看观看 | 69er小视频| 99热99精品| 高潮毛片又色又爽免费| 色婷婷五月在线| 26uuu国产精品| 欧美久久网| 97精品人人A片免费看| 狠狠色成人影片| 天天爱天天做天天舔| 99热热热国产超碰| 最近中文字幕2019视频1| 久久亚洲无码| 色久五月| 五月婷婷丁香综合| 任你弄在线视频免费| 91Chinese在线| 五月天婷婷在线播放免费| 亚洲日韩国产黑丝黑丝AVAV一区二区三区| 激情www| 五月婷婷久草在线视频综合| 亚洲色五月| 991自拍视频| 亚洲综合色婷婷| 丁香五月综合在线观看| 99综合视频在线| 亚洲天堂制| 婷婷六月色| 久草大| 美女100%露全身无挡网站| www.henhenl| 色香蕉婷婷| 婷婷色五月天在线| 五月激情站| 婷婷五月永远18免费久久久| 日本一级特黄大片AAAAA级| 久久5 9视频免费观看| 欧美25p| 久色婷婷200| 六月丁香婷啪射| AV在线观看网站| jiujiuxiangjiaowang| 久久久97| 五月天综合| 九九亚洲小视频| 久久九九99| 丁香激情五月少妇| 久草热8精品视频在线观看| 欧美日韩成人| 青草五月天| 色视五月天婷婷| 五月婷成人| 99免费偷拍视频| 国产做爰视频免费播放| 天天狠天天叉| 这里只有精品视频在线| 天天干天天操天天上| 91热爆在线| 91亚洲免费片| 国产黄大片在线观看画质优化| 六月丁香综合| 操日挥操日日| 狠狠婷婷爱| 日本三级中国三级99人妇网站| 日韩黄色AV无码| .青娱乐天天操B| 免费黄色视频网址| 色丁香婷婷| 久久婷婷成人综合色怡春院| 五月天激情中文字幕| 99久久99视频只有精品| 人妻aV在线| 91高潮喷水久久久久久久久| 婷婷伊人| 日韩啪啪视频| 中文AV在线观看| 十月丁香九月婷婷综合| 春色激情第四色| 九九热亚洲中文在线观看免费| 久久综合伊人77777蜜臀| BlACKEDRAW视频一区二区| 五月丁香| 九九黄色网| 天天干天天爽| 婷婷激情五月天激情| 人人综合五月人人婷婷| 五月丁香色婷婷婷基地| 九九色图| 色婷婷综合影院| 337久久| 欧美成人AAA片一区国产精品 | 国产一二三四五六七八视频| 99re这里只有精品免费| 久久香蕉影院| 亚洲激情综| 丁香五月电影院在线观看| 99爱在线| 婷婷五月天AV| 五月天激情视频网站| 丁香亚洲婷婷五月| av 一区三区四区| 超碰在线精品| 97碰人人操| 亚州色综合| www91色网站| 欧美A级成人婬片免费看理论| 日日夜夜干| 99热都是精品| 五月婷在线观看| 激情五月丁香社区| 丁XX 成人| 99免费| 色播婷婷五月天| 99这里只有精品在线| 五月婷婷色丁香| 色色成人網| 777色婷婷爱五月| 婷婷五月在线免费| 色99网| 人妻久久婷婷| 99久久97久久欧美综合网| 婷婷影院欧美| 色色婷婷婷丁香五月天| 99精品久久久久久久久| www.99色在线| 波多婷婷久久| 91色性感五月婷婷丁香| 激情四射亚洲| 丁香六月婷婷缴情欧美| 欧美日本韩国亚洲| 99婷婷精品推荐在线视频| 少妇大叫太大太粗太爽了A片| 亚洲九区| 五月婷婷六月丁香| 99ri视频| 五月天成人综合| 激情五月天色色网| 色色国产| 五月丁香婷婷色| 97精品综合久久| 337p大胆噜噜噜噜噜91Av| 色偷偷五月天| 激情五月天小说网| 色香蕉影院| 五月婷久久| 99久视频| 国产精品VIDEOSSEX久久发布| 久久人妻视频| 国产精品扒开腿做爽爽爽A片唱戏| 婷婷色在线| 99婷婷| 欧美黑人巨大性生话| 亚洲精品无码一区二区| www.色婷婷| 天天色粽合合合合合合合| 色色色综合| 五月丁香婷婷啪啪| 99在线免费观看| 大香蕉久| 国产毛片欧美毛片久久久| 人妻体体内射精一区二区| 九八Av| 六月五月天婷婷涩播在线| 婷婷在线中文字幕| 欧美在线ee日韩| 日本丰满久久| 光棍影院日韩精品| 九月av| 99九九精品视频| 婷婷九月| 五月丁了香蕉综合| 四虎婷婷五月天| 小视频一区| 婷婷色爱| 26uuu在线观看| 激情亭亭五月| 日本久久高清| 亚洲色网络| 欧美大肥婆大肥BBBBB| 色狠狠色噜噜AV天堂五区| 激情性爱五月天网页| 涩婷婷视频快播人妻| 奇米网大香蕉| 欧美婷婷日本| 久久婷婷青草五月天| 色婷婷久久综合久色| 日日色五月天| www激情网| 婷婷五月亚洲一本在线丁香| 日本色婷婷| 五月激情综合网| 日日噜噜夜夜狠狠久久丁香六月| 婷婷综合五月天| 狠狠干.com| 中文字幕高清av| 六月婷婷香蕉| 超碰91在线| 99这里只有免费的精品| 色婷婷影音| 激情婷婷五月社区| 大香蕉99热| 天天天干夜夜夜操| 荫道BBWBBB高潮潮喷| 97成人丁香| 婷婷久久在线| 色99亚洲| 香蕉婷婷色五月| 五月天小说激情| 婷婷综合五月天亚洲综合| 激情五月婷婷在线观看| 激情五月丁香五月| 婷婷中文字幕| 亚洲AV影片在线观看| 国洲夜色亚热在线久久| 五月丁香六月成人| 综合激情啪啪| 久久九精品| 极品人妻VideOssS人妻| 综合色99| 91久久久久久| 99五丁香月| 色欲影香| 五月丁香在线视频观看| 六月婷婷影院| 爱婷婷都市激情| 精品久久99码| 噜噜在线| AV亚洲在线| 91久久综合亚洲噜噜成人在线| 99er这里只有精品视频| 操逼在线视频| 婷婷五月天福利| 丁香五月播播| 亚洲狠狠爱婷婷| 五月婷免费视频| 色婷婷久久综合| 无码中文一区二区三区| 九九精品网| 97综合在线| 亚洲欧美在线观看| 午夜成人在线免费视频| 丁香六月啪啪| 91精品国产综合久久密臀| 婷色五月天| 五月婷在线| 国产在线网址1| 成年人夜夜喷水| 天天摸天天舔天天爽| 五月丁香AV在线| 女婷久久| 国外亚洲成AV人片在线观看| www.久9| 在线日韩视频| 五月婷婷婷婷婷| 日本99在线| 无码免费人妻A片AAA毛片西瓜 | 综合色色婷婷| 久久99久久99精品免观看粉嫩| 成人电影一区| 九97免费视频| 操碰97| www夜夜操wwwcon| 六月丁香综合| 亚洲国产精品二二三三区| 五月丁香婷婷婷激情爱爱| 丁香五月婷婷无码AV| 色婷婷五月天视频在线| 五月天社区| 伊人婷婷大香蕉在线| 狼人婷婷综合| 五月丁香综合精品| 四月婷婷五月丁香| 九九视频在线观看视频6 | 久久婷婷五| 狠色综合网| 99热这里只要精品免费| 五月天激情四射网站| 久久精品一区二区三区四区| 性爱激情小说AV五月丁香花| 99热 免费| 午夜丁香婷婷| 九九热超碰| 五月天丁香欧美激情| 久久色频| 欧美综合激情丁香五月六月婷| 丁香五月天社区| 久久婷婷色综合老司机| 99色在线视频观看| 亚洲va在线∨a天堂va欧美va| 99热这里只有精品中文字幕| 二区成人视频| 五月份婷婷| www天天色天天射| 五月天婷婷久久| 91丨九色熟女丨首页| 久久99热这里只有精品23| 五月婷在线| 精品一二三区久久AAA片| 欧美在线看| 国产在线另类五月婷婷| 九月婷婷综合| wwww.9免费视频| 秋霞午夜理论| 可以看的av| 国产性av| 色五月成人| 99re热视频这里只精品5| 大香蕉五月天婷婷| 91在线看免费 九九九九| 色婷婷丁香五月天在线视频| 色婷久九| Av狠狠色丁香婷| 婷婷精品| 一级黄色尤物综合视频手机在线观看| 99精品在线| WWW久| 99视频在线观看欧| 啊v视频在线观看| 激情国产五月| 久久99这里只有精品| 五月丁香婷婷深深爱| 欧美久久一级内射wwwwww.| 婷婷在线免费| 六月婷婷在线| 成人片黄网站色大片免费毛片| 日韩久热| 丁香五月婷婷色偷偷| 五月激情在线| 在线视频99| 婷激情五月| 色五月综合| 99精品久久| 欧美人人草草| 狠狠五月天婷婷| 97碰久久| 久久久五月天婷婷成人网| 男人天堂亚洲综合| 久久久999精品| 五月婷婷精品视频| 99热青青草原| 99这里只有精品视频| 久久五月天色婷婷|