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

ARTICLE DETAIL

資訊詳情

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

麥克納姆輪底盤運(yùn)動(dòng)學(xué)解算與PID閉環(huán)控制實(shí)戰(zhàn)指南

麥克納姆輪底盤運(yùn)動(dòng)學(xué)解算與PID閉環(huán)控制實(shí)戰(zhàn)指南 麥克納姆輪底盤在機(jī)器人圈子里已經(jīng)不是什么新鮮東西了但真正能把“跑得直、轉(zhuǎn)得穩(wěn)、橫移不飄”做到位的人其實(shí)不多。問題通常出在兩個(gè)環(huán)節(jié)一是運(yùn)動(dòng)學(xué)解算沒吃透四個(gè)輪子的速度分配全靠感覺二是電機(jī)閉環(huán)沒調(diào)好轉(zhuǎn)速指令下去了實(shí)際輪子根本沒跟上。如果你是做機(jī)器人競賽、AGV小車或者服務(wù)機(jī)器人底盤的這篇文章正好能幫你把這兩個(gè)核心問題一次性理清楚。全文不繞彎子直接講運(yùn)動(dòng)學(xué)公式推導(dǎo)、代碼實(shí)現(xiàn)、硬件搭法和PID調(diào)參的實(shí)戰(zhàn)經(jīng)驗(yàn)。先說清楚這篇內(nèi)容能解決什么當(dāng)你給底盤一個(gè)速度指令時(shí)四個(gè)麥克納姆輪各自該轉(zhuǎn)多快這是運(yùn)動(dòng)學(xué)解算的事當(dāng)你發(fā)出轉(zhuǎn)速指令后電機(jī)是否真的轉(zhuǎn)到了目標(biāo)轉(zhuǎn)速這是PID閉環(huán)控制的事。兩件事連起來就是一套完整的底盤運(yùn)動(dòng)控制方案。以下是基于我多次實(shí)際調(diào)底盤的經(jīng)驗(yàn)整理出來的完整流程適合有單片機(jī)基礎(chǔ)、正在做移動(dòng)機(jī)器人底盤的開發(fā)者參考。1. 麥克納姆輪底盤運(yùn)動(dòng)解算的基礎(chǔ)認(rèn)知1.1 麥輪為什么能“橫著走”麥克納姆輪和普通輪子最大的區(qū)別在于輪轂周圍斜向安裝了一圈無動(dòng)力的小輥?zhàn)?。這些輥?zhàn)优c輪子主軸之間一般是45度夾角輥?zhàn)颖旧砜梢栽谑艿絺?cè)向力時(shí)自由轉(zhuǎn)動(dòng)。正因?yàn)檩佔(zhàn)拥拇嬖谳喿愚D(zhuǎn)動(dòng)時(shí)施加給地面的摩擦力方向并不是沿著輪子軸線而是沿著輥?zhàn)拥妮S線分解開了。打個(gè)比方普通輪子像是你穿了一雙防滑鞋走路每一步都嚴(yán)格踩在前進(jìn)方向上麥克納姆輪則像是穿著旱冰鞋卻把腳歪著踩地面吃到的力自然就分了方向。單個(gè)麥輪產(chǎn)生的推力并不正對正前方而是有一個(gè)斜向分量。四個(gè)輪子的斜向推力經(jīng)過矢量疊加后就實(shí)現(xiàn)了前進(jìn)、橫移、旋轉(zhuǎn)以及任意組合的斜向運(yùn)動(dòng)。這也解釋了為什么麥輪底盤容易出問題任何一個(gè)輪子哪怕只有一點(diǎn)速度偏差疊加出來的合力就不是你想要的方向車身就會(huì)跑偏或者打轉(zhuǎn)。所以麥輪底盤對四個(gè)輪子的轉(zhuǎn)速一致性要求極高這種一致性的保障只能靠閉環(huán)控制來完成這也是本文后續(xù)要重點(diǎn)展開的內(nèi)容。1.2 底盤運(yùn)動(dòng)學(xué)模型從速度到輪速描述一個(gè)麥輪底盤在平面上的運(yùn)動(dòng)通常用三個(gè)自由度就夠了沿車身坐標(biāo)系x軸的前進(jìn)速度vx、沿y軸的橫移速度vy、以及繞底盤中心旋轉(zhuǎn)的角速度omega。你給控制器的目標(biāo)量往往是這三個(gè)值控制器需要做的是把這三個(gè)值轉(zhuǎn)換成四個(gè)輪子的轉(zhuǎn)速。這里有一點(diǎn)特別容易踩坑vx和vy的方向是相對于車身坐標(biāo)系還是世界坐標(biāo)系做底盤控制時(shí)一般是相對于車身坐標(biāo)系。如果你想讓小車在世界坐標(biāo)系里沿某個(gè)方向走需要在外部先做一次坐標(biāo)旋轉(zhuǎn)而不是直接丟給底盤。很多人在這一步搞混導(dǎo)致小車在旋轉(zhuǎn)過程中運(yùn)動(dòng)路線完全錯(cuò)誤。運(yùn)動(dòng)學(xué)逆解的基本思路是假設(shè)底盤是一個(gè)剛體那么底盤上任意一點(diǎn)的速度等于質(zhì)心的平移速度疊加因自身旋轉(zhuǎn)產(chǎn)生的線速度。四個(gè)輪子安裝在底盤四個(gè)角上已知車輛半寬b和半軸距a于是每個(gè)輪子中心點(diǎn)的線速度就可以用vx、vy和omega表示出來。由于輪子的安裝方向左前、右前、左后、右后以及輥?zhàn)有苯欠较蚋鞑幌嗤總€(gè)輪子的輪軸方向上的速度分量表達(dá)式也不一樣。這個(gè)推導(dǎo)過程不復(fù)雜但是相當(dāng)繁瑣下面直接給出最終結(jié)果。2. 運(yùn)動(dòng)學(xué)逆解與正解核心代碼實(shí)現(xiàn)2.1 運(yùn)動(dòng)學(xué)公式里的參數(shù)到底怎么設(shè)先定義幾個(gè)參數(shù)vx表示底盤沿車身前方方向的線速度單位取m/svy表示沿車身左方向的線速度單位取m/somega表示底盤逆時(shí)針方向的角速度單位取rad/s。另外需要兩個(gè)機(jī)械尺寸參數(shù)L代表前后輪軸距的一半也就是底盤中心到前輪中心的縱向距離W代表左右輪距的一半也就是底盤中心到左輪中心的橫向距離。這里需要特別提醒L和W一定要量準(zhǔn)。我見過不少人直接把底盤的長和寬除以2就填進(jìn)去了但很多底盤的重心并不在幾何中心如果重心偏得厲害這個(gè)算法在急加速和急停的時(shí)候會(huì)出現(xiàn)可見的車身旋轉(zhuǎn)。嚴(yán)謹(jǐn)?shù)淖龇ㄊ菍?shí)測底盤四輪接地點(diǎn)的幾何中心若重心明顯偏移要么修正L和W的值要么在控制層加一點(diǎn)角速度前饋補(bǔ)償。單位也務(wù)必統(tǒng)一。麥輪運(yùn)動(dòng)學(xué)解算最明顯的錯(cuò)誤之一就是vx、vy用m/somega用rad/s結(jié)果輪子速度算出來之后直接乘了輪半徑換算成角速度時(shí)把π寫錯(cuò)導(dǎo)致實(shí)際轉(zhuǎn)速差好幾倍。這類問題一旦出現(xiàn)小車的表現(xiàn)會(huì)非常詭異——前進(jìn)速度基本正常但一轉(zhuǎn)向就擰成一團(tuán)。建議在程序里所有中間量都用SI單位制只在輸出給電機(jī)驅(qū)動(dòng)器之前再轉(zhuǎn)換為電機(jī)的實(shí)際轉(zhuǎn)速單位。2.2 C語言實(shí)現(xiàn)運(yùn)動(dòng)學(xué)逆解四行公式解決四個(gè)輪子運(yùn)動(dòng)學(xué)逆解的正確公式以常見的“X型”麥輪布局為例前輪八字朝外展開如下// 輸入vx 前后速度vy 左右速度omega 旋轉(zhuǎn)角速度 // 輸出四個(gè)輪子的線速度m/s void kinematics_inverse(float vx, float vy, float omega, float *fl, float *fr, float *rl, float *rr) { // 機(jī)械參數(shù) float L 0.15f; // 半軸距單位米 float W 0.18f; // 半輪距單位米 *fl vx - vy - (L W) * omega; *fr vx vy (L W) * omega; *rl vx vy - (L W) * omega; *rr vx - vy (L W) * omega; }看到這里你可能有個(gè)疑問為什么系數(shù)是(LW)而不是別的因?yàn)榻撬俣萶mega在四個(gè)輪子位置產(chǎn)生的切向線速度大小是omega乘以該點(diǎn)到質(zhì)心的距離取半軸距與半輪距之和即可。如果底盤不是嚴(yán)格的矩形分布比如輪子前后距離和左右距離差別很大系數(shù)就要分別處理但大多數(shù)底盤都是矩形分布直接用(LW)沒有問題。算出來的結(jié)果單位是m/s下一步需要除以輪子的半徑得到輪子的角速度rad/s再根據(jù)減速比換算成電機(jī)的目標(biāo)轉(zhuǎn)速rpm或編碼器計(jì)數(shù)速度。這一步在正式寫代碼時(shí)必須做好單位換算核心原因是后面的PID控制需要的是“每秒編碼器脈沖數(shù)”這種離散反饋值而不是連續(xù)物理量。// 線速度轉(zhuǎn)輪子角速度 float wheel_linear_velocity fl; // m/s float wheel_angular_velocity wheel_linear_velocity / wheel_radius; // rad/s float motor_speed_rpm wheel_angular_velocity * 60.0f / (2.0f * M_PI) * gear_ratio;整體流程就是設(shè)定速度 → 逆解得到四輪線速度 → 除以半徑并乘減速比 → 得到目標(biāo)轉(zhuǎn)速 → 送入PID循環(huán)與編碼器反饋值做差輸出PWM占空比。2.3 運(yùn)動(dòng)學(xué)正解閉環(huán)反饋的數(shù)據(jù)來源運(yùn)動(dòng)學(xué)正解用在什么地方主要是兩個(gè)方面一是里程計(jì)推算二是閉環(huán)控制中的速度觀測。逆解是把“期望速度”變成“輪子目標(biāo)轉(zhuǎn)速”而正解是把“四個(gè)輪子的實(shí)際轉(zhuǎn)速”反推回“底盤當(dāng)前的實(shí)際速度”。有了這個(gè)實(shí)際速度你才能知道小車當(dāng)前是不是真的在按照指令走。正解的公式其實(shí)就是把逆解那組方程反解出來。因?yàn)槿齻€(gè)未知量、四個(gè)方程是超定方程組簡單處理方式是取線性組合。void kinematics_forward(float fl, float fr, float rl, float rr, float *vx, float *vy, float *omega) { float L 0.15f; float W 0.18f; *vx (fl fr rl rr) / 4.0f; *vy (-fl fr rl - rr) / 4.0f; *omega (-fl fr - rl rr) / (4.0f * (L W)); }這個(gè)正解公式的意義在于你把四個(gè)編碼器的實(shí)際讀數(shù)讀回來就能解出底盤的真實(shí)速度和角速度。然后在主控里做一個(gè)觀測器或者直接用這個(gè)值與目標(biāo)值做比較就能判斷底盤是不是跑歪了。精度要求高的場景會(huì)再用IMU數(shù)據(jù)對這個(gè)結(jié)果做融合但基礎(chǔ)的正解已經(jīng)能應(yīng)付大多數(shù)情況。有一點(diǎn)要說明因?yàn)榫幋a器反饋的是輪子的轉(zhuǎn)速而麥克納姆輪在實(shí)際轉(zhuǎn)動(dòng)時(shí)輥?zhàn)訒?huì)產(chǎn)生一定的滑移所以正解算出來的底盤速度和真實(shí)地面上走過的速度會(huì)有誤差。這個(gè)誤差在軟質(zhì)地面上尤其明顯硬質(zhì)平整地面會(huì)好很多。這也是麥輪底盤做高精度里程計(jì)時(shí)的先天短板需要配合其他傳感器修正。3. 硬件選型與底盤閉環(huán)控制的搭建3.1 電機(jī)、編碼器、驅(qū)動(dòng)板怎么搭配才不拖后腿運(yùn)動(dòng)學(xué)解算做得再好硬件跟不上也白搭。麥克納姆輪底盤對電機(jī)的要求有兩點(diǎn)響應(yīng)快、轉(zhuǎn)速反饋精度足。響應(yīng)快主要看電機(jī)和驅(qū)動(dòng)器的動(dòng)態(tài)特性轉(zhuǎn)速反饋精度取決于編碼器分辨率。個(gè)人建議選帶霍爾編碼器的直流減速電機(jī)或者帶編碼器的無刷電機(jī)。直流減速電機(jī)便宜、控制簡單、低速力矩足夠適合中小型底盤無刷電機(jī)效率高、壽命長適合高速場景。編碼器分辨率建議至少每圈300線以上如果控制轉(zhuǎn)速范圍較大最好直接上500線甚至1000線。我用過200線的編碼器低速時(shí)PID的反饋信號抖動(dòng)明顯調(diào)穩(wěn)需要花不少功夫后來換成500線之后低速穩(wěn)定性一下就上來了。驅(qū)動(dòng)板的選擇主要看電流。很多小車主控板上的電機(jī)驅(qū)動(dòng)電流不夠帶載啟動(dòng)或者遇到輕微的卡頓時(shí)電機(jī)會(huì)瞬間掉速PID拼命補(bǔ)PWM也無濟(jì)于事。穩(wěn)妥的做法是估算底盤滿載時(shí)單電機(jī)峰值電流然后驅(qū)動(dòng)板額定電流留出50%以上裕量。主控方面STM32F103系列跑四個(gè)電機(jī)的編碼器計(jì)數(shù)和PID循環(huán)夠用如果還要跑運(yùn)動(dòng)規(guī)劃、SLAM之類的高負(fù)載任務(wù)建議換更高性能的芯片或多核架構(gòu)。3.2 為什么必須上PID閉環(huán)開環(huán)直驅(qū)到底差在哪開環(huán)控制是什么就是你給電機(jī)一個(gè)PWM占空比電機(jī)努力轉(zhuǎn)但你完全不關(guān)心它實(shí)際轉(zhuǎn)速。占空比和轉(zhuǎn)速之間不是嚴(yán)格的線性關(guān)系尤其是直流電機(jī)負(fù)載一變、電池電壓一變同樣的占空比轉(zhuǎn)速就變了。麥輪底盤四個(gè)輪子如果各自轉(zhuǎn)速和期望值有偏差底盤走的軌跡就會(huì)歪這一點(diǎn)我在開環(huán)狀態(tài)下試過非常多次在平整的地面還能勉強(qiáng)直行一上斜坡一個(gè)輪子打滑整個(gè)車的方向當(dāng)場就崩了。閉環(huán)控制的思路則是編碼器實(shí)時(shí)測量電機(jī)轉(zhuǎn)速PID控制器根據(jù)“目標(biāo)轉(zhuǎn)速”和“實(shí)際轉(zhuǎn)速”的誤差動(dòng)態(tài)調(diào)節(jié)PWM占空比讓實(shí)際轉(zhuǎn)速不斷靠近目標(biāo)轉(zhuǎn)速。這有點(diǎn)像你開車時(shí)踩油門控制車速眼睛編碼器看到車速慢了腳PID就稍微加點(diǎn)油門車速快了就松一點(diǎn)。不需要知道路面坡度、風(fēng)阻這些具體參數(shù)只需要根據(jù)偏差修正就行。對麥輪底盤而言PID閉環(huán)最核心的價(jià)值不是讓單個(gè)輪子轉(zhuǎn)得更精準(zhǔn)而是讓四個(gè)輪子之間的誤差被有效收斂這樣疊加出來的底盤運(yùn)動(dòng)才穩(wěn)定。實(shí)測下來四輪閉環(huán)之后底盤直線行駛的偏移量能比開環(huán)縮小十倍以上。3.3 轉(zhuǎn)速環(huán)PID的實(shí)現(xiàn)編碼器測速與PWM輸出在STM32上做轉(zhuǎn)速閉環(huán)典型做法是用定時(shí)器編碼器模式采集正交編碼器信號同時(shí)用另一個(gè)定時(shí)器產(chǎn)生PWM驅(qū)動(dòng)電機(jī)。編碼器模式會(huì)自動(dòng)對A、B相進(jìn)行4倍頻處理500線編碼器實(shí)際測速分辨率就是2000個(gè)脈沖每圈這在大多數(shù)底盤控制里足夠細(xì)膩。轉(zhuǎn)速采集有兩個(gè)常用途徑一種是在固定時(shí)間窗口內(nèi)數(shù)脈沖數(shù)簡單但低速時(shí)更新頻率太低另一種是測量相鄰兩個(gè)脈沖之間的時(shí)間間隔也就是所謂的M法、T法、M/T法測速。工程上常用的方案是M法測速加低速切換具體來說當(dāng)轉(zhuǎn)速高時(shí)數(shù)脈沖當(dāng)轉(zhuǎn)速低時(shí)測脈寬兩者結(jié)合可以在寬速度范圍內(nèi)都保持較好的分辨率。PID計(jì)算頻率建議設(shè)在100Hz到1000Hz之間。我做一些室內(nèi)小車用的200Hz已經(jīng)能滿足大多數(shù)底盤控制場景。頻率太低會(huì)讓響應(yīng)滯后底盤原地旋轉(zhuǎn)時(shí)能明顯感覺到“遲頓感”頻率太高也沒有必要因?yàn)橹绷麟姍C(jī)自身的機(jī)電時(shí)間常數(shù)就在幾十毫秒量級你算得再快電機(jī)也跟不上。PID輸出量最終映射到PWM占空比。這里要注意電機(jī)驅(qū)動(dòng)有死區(qū)PWM小于一定占空比時(shí)電機(jī)根本不轉(zhuǎn)。一般做法是設(shè)置一個(gè)最小占空比閾值比如5%低于閾值的輸出直接歸零避免電機(jī)嗡嗡響在PID輸出進(jìn)入這個(gè)區(qū)間時(shí)做分段線性映射讓電機(jī)在低速時(shí)也有平滑的轉(zhuǎn)速響應(yīng)。4. PID調(diào)參實(shí)戰(zhàn)從拉不開車到穩(wěn)定跟速4.1 調(diào)參前必須完成的三個(gè)準(zhǔn)備動(dòng)作拿到一套新的底盤別急著調(diào)PID參數(shù)先把下面三項(xiàng)基礎(chǔ)工作做完否則調(diào)半天你也說不清問題是參數(shù)問題還是機(jī)械問題。第一確認(rèn)四個(gè)電機(jī)的轉(zhuǎn)動(dòng)方向與編碼器反饋極性一致。給一個(gè)正PWM時(shí)前左輪應(yīng)該正轉(zhuǎn)同時(shí)編碼器計(jì)數(shù)值應(yīng)該增加。如果方向反了PID會(huì)變成一個(gè)正反饋系統(tǒng)輸出越調(diào)越大聽起來跟失控一樣。最好在代碼里做一個(gè)開環(huán)測試手動(dòng)給固定占空比觀察每個(gè)輪子的轉(zhuǎn)向和編碼器的計(jì)數(shù)方向記錄下來形成一張對照表。第二測定電機(jī)的最大轉(zhuǎn)速和PWM的滿量程范圍。比如你的PWM周期是20000Hz滿幅占空比對應(yīng)1000那么先測出空載條件下電機(jī)能到達(dá)的最大編碼器計(jì)數(shù)速度。這一步?jīng)Q定了你的目標(biāo)轉(zhuǎn)速不會(huì)超出實(shí)際能力范圍PID積分項(xiàng)也不會(huì)因?yàn)橐恢憋柡投?。第三合理設(shè)置速度反饋的濾波。編碼器測速天生帶有量化噪聲尤其在低速時(shí)相鄰兩次測量值可能跳變很大。如果你直接把這個(gè)噪聲喂給PID的微分項(xiàng)會(huì)導(dǎo)致PWM輸出抖得厲害。建議在PID計(jì)算之前對測量值做一階低通濾波或者直接用滑動(dòng)平均再送入控制器。濾波系數(shù)不要太大否則會(huì)帶來延遲我的經(jīng)驗(yàn)是截止頻率放在轉(zhuǎn)速環(huán)帶寬的三到五倍。4.2 手把手調(diào)三參數(shù)先把P調(diào)穩(wěn)再加I和D調(diào)PID的第一步是先把I和D置零只保留比例P。給底盤一個(gè)恒定轉(zhuǎn)速目標(biāo)從較小的P值開始比如P10觀察電機(jī)實(shí)際轉(zhuǎn)速跟隨情況。如果轉(zhuǎn)速偏小而且穩(wěn)定在一個(gè)較低的值說明P太小逐步加大P值如果轉(zhuǎn)速出現(xiàn)周期性的持續(xù)振蕩說明P已經(jīng)過大回退一點(diǎn)找一個(gè)“臨界穩(wěn)定但不振蕩”的點(diǎn)在這個(gè)點(diǎn)附近P通常是最合適的初始值。一個(gè)我常用的判斷方法是讓底盤從靜止突然加速到目標(biāo)轉(zhuǎn)速記錄轉(zhuǎn)速階躍響應(yīng)曲線。P偏小時(shí)響應(yīng)曲線上升很慢永遠(yuǎn)到不了目標(biāo)值P合適時(shí)響應(yīng)曲線能快速到達(dá)目標(biāo)附近且不超調(diào)P偏大時(shí)曲線會(huì)在目標(biāo)值上下反復(fù)穿越形成振蕩。當(dāng)我調(diào)試一個(gè)全新的底盤時(shí)通常在半天內(nèi)就能利用這個(gè)現(xiàn)象找到一個(gè)不錯(cuò)的P初值。P定下來之后再引入積分I。積分的作用是消除穩(wěn)態(tài)誤差。所謂穩(wěn)態(tài)誤差就是P控制下轉(zhuǎn)速穩(wěn)定在目標(biāo)轉(zhuǎn)速的95%附近而始終追不上那剩下的5%。這時(shí)逐步加大I轉(zhuǎn)速會(huì)越來越接近目標(biāo)值。I太大的表現(xiàn)是轉(zhuǎn)速出現(xiàn)低頻振蕩周期比較長并且會(huì)緩慢上下漂移聽著電機(jī)像在“喘氣”。一旦看到這個(gè)現(xiàn)象立刻把I降下來。最后加微分D。D的作用是抑制超調(diào)相當(dāng)于提前踩剎車。編碼器噪聲大的情況下D會(huì)產(chǎn)生高頻抖動(dòng)這時(shí)候反而會(huì)讓系統(tǒng)發(fā)熱變大、聲音刺耳。所以D寧小勿大一般從零開始每次增加一點(diǎn)點(diǎn)觀察階躍響應(yīng)是否變得更干脆。如果發(fā)現(xiàn)加了D之后響應(yīng)反而變差或者電機(jī)聲音變尖說明D帶來的噪聲放大已經(jīng)壓過了它的抑制作用。4.3 實(shí)戰(zhàn)中的常見問題與排查速查表調(diào)參過程中最怕的其實(shí)是各種奇奇怪怪的現(xiàn)象分不清到底是哪個(gè)環(huán)節(jié)出了問題。我把這些年遇到的典型問題和對應(yīng)的排查思路整理成了下面這張表對照排查可以節(jié)約大量時(shí)間。現(xiàn)象可能原因排查與對策底盤直行時(shí)往一邊偏同側(cè)輪子轉(zhuǎn)速偏低或輪子打滑用上位機(jī)同時(shí)讀四輪反饋轉(zhuǎn)速找出異常輪檢查驅(qū)動(dòng)輸出和機(jī)械阻力原地旋轉(zhuǎn)時(shí)車身畫圈運(yùn)動(dòng)學(xué)逆解的L/W參數(shù)不準(zhǔn)重新實(shí)測半軸距和半輪距檢查坐標(biāo)方向定義與公式是否匹配電機(jī)發(fā)出高頻嘯叫底盤抖動(dòng)PID微分項(xiàng)被編碼器噪聲放大降低D增加測速濾波檢查編碼器線纜是否遠(yuǎn)離電機(jī)動(dòng)力線目標(biāo)轉(zhuǎn)速低時(shí)電機(jī)一頓一頓PWM死區(qū)沒有處理或PID輸出低于啟動(dòng)閾值增加最小PWM輸出映射再疊加一個(gè)小幅前饋高速轉(zhuǎn)向時(shí)底盤有甩尾感轉(zhuǎn)速環(huán)響應(yīng)跟不上或者底盤重心偏高增加PID帶寬換低重心底盤必要時(shí)對加速度做限幅四輪都轉(zhuǎn)但底盤不走麥克納姆輪輥?zhàn)幽p或卡死檢查輥?zhàn)邮欠耢`活轉(zhuǎn)動(dòng)麥輪對地面清潔度要求較高排查這類問題有一個(gè)通用的思路先單輪后整車。把四個(gè)輪子分別獨(dú)立給相同的轉(zhuǎn)速指令觀察它們的實(shí)際反饋是否一致。這個(gè)測試能直接暴露機(jī)械阻力、驅(qū)動(dòng)故障和編碼器問題。四輪轉(zhuǎn)速一致了再上整車的運(yùn)動(dòng)測試這時(shí)候如果還有問題基本都集中在運(yùn)動(dòng)學(xué)解算和整車機(jī)械上了。5. 一個(gè)容易被忽略的細(xì)節(jié)速度限幅與梯形加減速調(diào)好PID之后很多人在實(shí)際跑動(dòng)中仍然會(huì)碰到一個(gè)問題底盤給一個(gè)較高的目標(biāo)速度小車猛地一下沖出去車身明顯有振蕩甚至發(fā)出“嘣”的一聲機(jī)械撞擊。這不是PID沒調(diào)好而是速度指令的突變程度太大了。任何物理系統(tǒng)都有慣性和響應(yīng)極限你直接給階躍速度指令PID控制器一定會(huì)在極短時(shí)間輸出大幅值從而引起過沖。解決方法是給目標(biāo)速度加一個(gè)斜率限幅或者梯形加減速規(guī)劃。通俗地說別讓目標(biāo)速度瞬間從0跳到1m/s而是讓它在0.2秒內(nèi)平滑地從0升到1m/s。這個(gè)008秒的斜率可以根據(jù)底盤的加速度能力來設(shè)定比如設(shè)定最大加速度為2m/s^2那么在程序里每毫秒增加的目標(biāo)速度不能超過0.002m/s。梯形加減速比S型曲線更容易實(shí)現(xiàn)且對大多數(shù)底盤足夠了。實(shí)測下來加了梯形加減速之后PID的調(diào)參壓力大幅降低因?yàn)槟繕?biāo)速度不再跳變PID的微分項(xiàng)也不會(huì)被激發(fā)底盤的啟停更加平順。這個(gè)方法的性價(jià)比特別高強(qiáng)烈建議操作。我個(gè)人的經(jīng)驗(yàn)是在PID閉環(huán)的代碼架構(gòu)里把運(yùn)動(dòng)學(xué)逆解、速度規(guī)劃、PID循環(huán)分成三個(gè)獨(dú)立的模塊。運(yùn)動(dòng)學(xué)逆解只負(fù)責(zé)狀態(tài)轉(zhuǎn)換速度規(guī)劃負(fù)責(zé)生成平滑的目標(biāo)值PID只負(fù)責(zé)跟蹤。模塊之間通過結(jié)構(gòu)體傳參調(diào)參和排查問題都會(huì)非常方便尤其是后面要加入里程計(jì)融合、導(dǎo)航控制時(shí)這種分層的設(shè)計(jì)能省下大量時(shí)間。6. 更進(jìn)一步的擴(kuò)展方向主體功能跑通之后你可以在這個(gè)基礎(chǔ)上做幾個(gè)有意思的擴(kuò)展。第一個(gè)是加入IMU閉環(huán)融合用陀螺儀數(shù)據(jù)修正底盤的角速度誤差。因?yàn)辂溳喸谶\(yùn)動(dòng)時(shí)輥?zhàn)哟蚧瑫?huì)導(dǎo)致實(shí)際角速度和期望角速度有偏差I(lǐng)MU的角速度反饋能有效校正這個(gè)問題讓底盤旋轉(zhuǎn)更加精準(zhǔn)。第二個(gè)是整車的速度觀測器。比如通過四個(gè)輪子的碼盤反饋跑運(yùn)動(dòng)學(xué)正解得到底盤的估計(jì)速度再和IMU數(shù)據(jù)做互補(bǔ)濾波或卡爾曼濾波得到一個(gè)更準(zhǔn)確的速度和位姿估計(jì)。這個(gè)數(shù)據(jù)是后續(xù)做自動(dòng)導(dǎo)航、路徑跟蹤的基礎(chǔ)。第三個(gè)是加入模型參考自適應(yīng)控制或者前饋。有些高端底盤在PID前饋里加入電流環(huán)的補(bǔ)償讓電機(jī)在變負(fù)載條件下依然有穩(wěn)定的轉(zhuǎn)速。這些內(nèi)容本質(zhì)上還是在底層閉環(huán)上做文章基礎(chǔ)仍然是Motion Solve加上經(jīng)典的PID控制先把基礎(chǔ)做好再做這些擴(kuò)展會(huì)容易很多。說到底麥克納姆輪底盤控制并不是一個(gè)高不可攀的技術(shù)它核心就是運(yùn)動(dòng)學(xué)解算加閉環(huán)控制。我最深的體會(huì)是調(diào)好的底盤和沒調(diào)好的底盤開起來完全是兩臺(tái)車。技術(shù)點(diǎn)不復(fù)雜但每一步都需要細(xì)心和耐心尤其是機(jī)械參數(shù)測量和PID調(diào)參。花一個(gè)周末把這兩塊拿下你就能擁有一臺(tái)指哪走哪的麥輪底盤后面做路徑規(guī)劃、視覺導(dǎo)航都有了穩(wěn)固的底層支撐。
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
淫视馆av三区| 操碰99在线视频观看| 色丁香久久| 亚洲成人超碰| 91热在线| 99热这里只有精品8| 五月丁香色色网| 26uuu欧美日本| 久久人操| 天堂无码人妻精品AV一区| 一起草无码视频| 大香蕉综合网| 69五月天视频| 99久久婷婷五月| 五月丁香六月综合激情无码软件亮点| www.婷婷,com| 亚洲精品视频在线播放| 夜夜嗨一区二区三区直播内容| 99热这里只有精品98| 久久激情网| 情五月亚洲婷婷| 爱99干99| 91九色欧美| 日本丁香久在线| 国产免费一区二区三区三州老师F1F1.CC| www.sebowuyue| AA久久| 色婷婷影| 中文av网| 婷婷五月丁香六月天亚洲综合| 丁香啪啪中文字幕| 国产成人+综合亚洲+天堂| www超碰| 日日噜噜夜夜狠狠久久丁香六月| 狠狠狠狠狠操| 激情黄色小说色五月| 超碰人人在线| 五月丁香激情六月| 99啪| 久操乱| 99精品福利视频| 99精品高潮| 久久xx| 久99| 在线免费观看激情视频| 精品久久99码| 天天插天天插天天插天天插 | 全网最新网黄大秀直播高清,主播国产录屏在线| 五月丁香综合| www.婷婷五月天.com| 天天综合网91| 伊人在线另类| 久久久性爱视频| 求可以看的AV网址| 亚洲AV第二区国产精品| 91狠狠综合网| 淫五月停停| 玖玖在线视频| 婷婷五月天综合中文| 免费在线a| 婷婷丁香成人| dingxiangtingtingliuyue| 99色在线观看视频| 丁香伍月婷电影全集| 婷婷丁香小说| 久久九精品| 色五月超碰| 婷婷五月天激情综合婷婷五月天激情综合| 91在线精品一区二区| 五月婷啪啪| 六月综和久久| 亚洲激情综合网| 五月天激情美女久久| 五月天自拍视频| www.色情五月天.com| 日日爽日日| 婷婷五月花西瓜| 色色色色色色色色五月先| 五月天婷a在线| 91色综合网| 久久九九大香蕉电院| 色五月琪琪| 欧美十二区| 狠狠色婷婷7777久| 久久99综合网| 九九热99热| 第2色五月婷| 97人妻碰碰碰久久| 国产精女同一区二区三区久| 五月婷婷丁香六月| 综合久久99| 五月天成人网在线观看| 亚洲另类电影| 久草婷婷视频| 九九99精品视品| 综合久| 日在线V视频在线播放| 综合网啪| 操操熟女| 97色 五月天丁香| 国产精品久久..4399| 丁香六月天婷婷开心综合| 91超级碰在线视频| 26.uuu丁香五月婷婷| 影音先锋男人站,影音先锋男人色资源网,影音先锋AV最新资源站,影音先锋AV资源 | 亚洲字幕AV一区二区三区四区| 婷婷狠狠18禁久久| 九九热这里只有精品6| 亚洲麻豆乱码国产2028| 夜夜噜夜夜奇| 五月丁香成人版| 99er日韩| 丁香五月 综合| 91免费看片| 激情五月影院| 精品成人无码A片观看香草视频| 九九精品99| 亚洲操B视频| 9|人妻人人操| 超级碰碰视频无码| 伊人玖玖婷婷| 激情综合色图| 午夜一区| 丁香五月婷婷狠狠色| 婷婷久久精品| 色噜噜狠狠色综合网| 久久99免费视频| 九月停停| 丁香六月青青草| 国产XXXX搡XXXXX搡麻豆| 九九婷婷网五月天| 天天爽夜夜操| A片试看120分钟做受图片| 天天综合网在线| 第四色激情网| 欧美美女视频| 婷婷五月天 丁香五月天 裸体| 中文字幕日产A片在线看| 俺去也综合| 日本久久高清| 大香蕉人妻| 天天操天天曰| 九九视频在线观看视频6| 五月天开心网| 91久久久久久久久18| 色99网| 在线观看亚洲视频影院| 开心激情网五月天| 成人精品一区日本无码网| 色婷婷成人做爰A片免费看网站| 97久久超碰| 六月丁香啪啪啪| 婷婷六月五月天综合| 色婷婷丁香五月天在线视频| 婷婷六月天亚州| 色久综合天天做视频| 欧美丁香六月激情视频| 无月播播激情在线观看视频| 色停停五月,在线观看| 思思热精品在线| 婷婷丁香小说| 久久久婷| 99久99久| 91丨九色丨熟女|新版| 91精品久久久久| 婷婷五六月丁香| 五月天婷婷基地丁香| 五月综合激情久久| 天天爽日日爽夜夜爽| 婷婷六月丁| 婷婷99狠狠| www.色五月.com| 99久久婷婷国产综合精品草原| 婷婷六月丁香在线| 思思热在线视频99| 久久九区| 欧美久久一级内射wwwwww.| 人人爽网| 欧美日本黄色| 久久九九99字幕| 99热这里只有精品免费观看| 久草五月天| 成功精品影院| 色九九九九| 日韩成人网址| 狠狠干伊人| 五月婷婷在线视频观看| 99精品在线播放| 香港九九六区八区99| 人妻激情视频| 五月天久久婷婷婷| 色五月婷婷操逼| 丁香五月色| 色综合婷婷99| 精品99这里有| 性爱视频99| 狠狠色噜噜狠狠狠888| 欧美婷婷色| 十二区无码| 亚洲另类婷婷综合| 亚洲激情免费视频| 婷婷五月在线视频| 91久久精品无码一区二区三区| 亭亭丁香久久五月| 亚洲狠狠干| 婷婷99狠狠| 亚洲电影中文字幕| 99re热视频这里只有综合亚洲| 99久久综合网| 伊人久久婷婷| 9色小视频在线观看| 亚洲综合成人网站| 五月天成人在线精品| 日婷婷| 综合网五月| AV操一操| 天天干天天日天天插| 婷婷五月天电影在线| 伊人婷婷大香蕉| 欧美成人精品三区综合A片| 国产色香蕉精品五夜婷| 色综合性视频| www.五月天婷婷| 日本丰满久久| 日韩欧美成人网| 婷婷丁香色情| 99热在线观看免费精品| 精品久久穴| 99黄色性生活| 日韩在线视频中文字幕| www五月天com| 婷婷视频在线| 万月丁香狠狠爱| 都市激情久久| 99精品在线播放| 久久99jiu9| 日韩AAA| 久久久WWW| 五月天大香蕉视频| 亚州AV超碰人人操| 日韩限制级大尺度黑料泄密大尺度视频一区二区在线观看 | 久久婷婷五月综合激情国产| 91丁香色五月| 丁香五月人妻熟女| 1000部毛片A片免费观看| 丁J香六月首页| 亚州精品色情在线观看| 在线99热| 九热视频| 久久99网站| 人人操女人| 五月天影院| 99热久久这里只有精品| 婷婷六月网| 99热在线只有精品| 丁香五月婷婷色| 丁香五月天激情综合| 色.五月综合网| 色月视频| 成人午夜视频精品一区| 五月丁香六月婷婷免费| 亚洲A片成人无码久久精品青桔| 亚洲激情四射| 久久五月天婷婷| 玖玖爱综合网| 99久视频| 五月天天丁香婷婷在线中| www.久久久.com| 激情婷婷五月少妇| 超碰成人av| 丁香五月欧美| 色色激情网| 草一草avb| ′久久99一| 五月婷婷在线视频| 操人久久| 狠狠爱综合网| 久久AAAA片一区二区| 色综合五月| 丝袜大香蕉| 播五月丁香三月婷婷| 国产三级在线播放| 五月天天天天天天天天天天天天天天天婷婷婷 | 香蕉网久久| 人妻精品一区二区三区| 六月婷婷九月丁香| 婷婷色五月激情| 日韩九九视频| 伊人激情AV一区二区三区| 婷婷五月成人有| 丁香九月激情| 五月天色婷婷基地| 黑人无码一区| 亚洲操操操| 色婷婷视频| 99这里只有精品| 婷婷久久国产视频| 五月天色软件| 激情深爱五月天| 99九九在线精品热动漫| 九九综合| 夜丁香五月婷婷| 999九九九久久久99HD| 五月开心久久| 看黄的网站18禁| 在线观看免费视频| 天天色天天爱天天爱天天爱y| 99久久精品国产色欲| 玖玖综合色| 日日日日做夜夜夜夜无码| 五月综合久久| 蜜乳国产网站| 五月婷婷九九久久| 五月婷婷丁香六月| 丁香五月开心婷婷| 亚洲精品亚洲人成人网| 无码人妻丰满熟妇奶水区码| 色色亚洲视频| 少妇AB又爽又紧无码网站| 亚洲五月天天| 五月天大香蕉AV| 99久久网站| 天天 日综合| 91主播在线| 婷综合| 开心激情色婷婷五月天| 绿色小导航AV| 狠狠色综合网| 十一月婷婷激情四射| 国产亚洲99久久精品| 99国产在线精品视频| 99这里只有| 大香蕉五月天婷婷丁香91| 99婷婷| 久久久久久久合一狠狠做深爱| 国产成人亚洲综合亚洲| 91啪啪| 激情五月天婷婷视频| 久久9999| 日木WWW视频| 天天干天天拍| 五月开心啪啪| 另类小说五月天| 97超碰,人人舔,人人操,人人摸 | 久操大香蕉| 婷婷婷婷午夜| 婷婷俺去也| 婷婷综合成人五月天| 婷婷狠狠97| 五月丁香久久| 玖玖爱伊人| 激情五月视频| 六月婷婷俺也去| 成人资源在线| 日韩性爱AV| 女婷久久| 婷婷狠狠干| 天天日夜夜B久久| 操人精品| 狠狠狠狠狠狠草| 淫视馆aV二区一区| 色色a| 欧美激情丁香五月天久久婷婷一区| 18久久| 国产午夜精品一区二区三区嫩草| 91精品无码| 99热这里只有精品在线播放| 色人五月婷婷| 天搞天天天天天| 色涩影院六月丁香| 婷婷桃色网| 亚洲色婷婷| 日韩人妻无码精品| AV性爱在线| 九九精品丁香花| 99在线观看精品视频| 久久少妇视频| 五月婷婷狠狠干| 欧洲永久精品| 91青娱乐青青草| av五月天婷婷丁香| 精品久久久中文字幕大豆网推荐理由| 五月丁香综合| 99九九视频| 亚洲免费观看高清完整版AV线| 五月天另类小说久久小说网| 思思久久96热在精品国产,| 久操大香蕉| 亚洲精品视频电影| 婷婷七月丁香色色| www.激情com| 黄色国久久| 免费无码毛片一区二区A片| 丁香五月激情婷婷| 色啪综合| 久久婷婷五月综合| 99精品热| 亚洲情欲| 五月天综合在线| 97干在线| 五月婷婷综合在线| 五月天婷婷影院| 五月婷色色| 久久久久久久久人妻| 5月丁香六月情| 五月婷婷丁香伦理网| 五月天天丁香婷婷在线中| 色婷婷综合视频| 五月天开心色情网| 人妻久久久久| 欧美五月丁香啪啪响视频| 开心婷婷五月天综合| 婷综合| 丁香六月激情四射| 91九色精品熟女内射| 九九热10| 久久99免费视屏| 热99国产精品| 秋霞午夜理论| 99久久99热这里只有精品| 五月激情另类| 亚洲中文乱字字幕线在永久| 久久婷婷激情视频| www热久久yy9| 91久久婷婷| 久久五月天综合| 香蕉婷婷| 欧美婷婷丁香社区在线播放| 久久婷婷大香蕉| 欧美啪啪网| 综合网狠狠| 综合激情肏逼网| 婷婷中文无码| 婷婷亚洲五月丁香综合在线| 午夜国产精品AV在线播放| 婷婷色丁香六月| 五月天狠狠| 亚洲婷婷丁香| 久久婷婷五月| 超碰A V在线| 超碰免费99| 婷婷激情综合| 99热在线观看| 色婷婷亚洲综合网站| 色色影院黄大片| 亚洲综合婷婷五月| 色婷婷国色天香综合| www,五月天激情| 天天舔天天操| 99热精品在线播放| 久久婷婷五月丁香蜜桃网| 热久久这里只有三级视频| 性色av大香综合| 五月综合久久| 97五月天婷婷| 久婷婷婷| 亚洲经典三级| 97日本在线| 中文字幕黄色片| 日本五月婷婷久久久六月丁香| 99爱免费视频在线观看| 99九九玖玖| 999热这里只有精品| 超碰日韩成人| 婷婷五月网图片区| a色色色色色| 干婷婷五月天| 丁香婷婷视频| 丁香激情网| 激情婷婷丁香五月| 99人人操人人操人人精| 六月色婷婷色| 99热免费看| 99热免| 大色鬼综合| 色玖玖玖| www.婷婷,com| 五月丁香婷婷基地| 亚洲一二三网| 日韩啪啪视频| 五月婷婷在线播放| 丁香五月激情综合| 五月久久婷婷天堂视频| 天天摸天天高潮天天爽| 人妻中文在线| 停停六月 综合| 婷婷激情丁香五月天综合| 99热99热在线| 69精品人人人人| 色婷婷文字幕| 激情 婷婷 丁香五月天| 狠狠草在线观看| 熟妇内谢69XXXXXA片| 怡春院久操| 天天做综合网色综合| 色婷婷操逼| 操91综合网| 中文网AV| 99热在线精品播放| 色综啪啪啪啪啪啪| 夜夜天天久久婷婷| 伊人99热| 六月婷婷色色色| 开心综合激情综合| 久久综合婷婷| 97操碰在线视频| 丁香五月在线观看综合| 九九在线精点品| 欧美日韩成人在线网| 米奇影视资源婷婷狠狠色激情欧美五月丁香| 日韩超碰在线| 久久婷婷综合拍| 激情婷婷狠狠干| 99色在线| 九九热这里只有精品7| 色99网站| 婷婷色色网站| 深爱开心激情网| 99啪啪| 亚洲无aV在线中文字幕| 天天综合中文| 91九色 熟| 亚洲精品小视频| 亚洲高清在线| 五月丁香在线视频观看| 俺去也五月天婷婷| 九色视频91| 五月天婷婷爱| 99爱爱网| 在线观看婷婷5月| 九 九九九AV| 久久有码| 中文字幕无码AV| 这里只有在线精品| 午夜大香蕉| 久久久久妻| 伊人五月天| 日本一级大片| 99色色视频| 五月丁香六月停停停| 六月色色婷婷| 久久婷婷一级片| www.热99热| 日本操B视频| 天天爽,天天操。| 99热超碰| 手机激情网| 国精产品一区一区三区免费视频| 天天爽日日搞| 日韩在线看AV| 丁香久久久| 中文字幕人妻一区二区| 九九热国产| 伊人超碰在线| 精品久久这里热66| 五月狠狠| wwww.色婷婷| 婷婷五月丁香综合| 久久综合干| 国产精品黑丝| 五月激情婷婷图片基地| 91网站黄| www一起操| ady狠狠入| 无码字幕中文| 亚洲狠9| 天天综合精品| 婷婷久草| 久久99综合| 开心五月网 | 九九无码| 欧美色爱五月天| 五月丁香久久丝袜啪啪| 99综合99| 日日操人人操| 亚州AV超碰人人操| 婷婷精品性性性性性性性| 99精品视频在线| 婷婷丁香五| www.minyis.com【JT】实力收量可预付TG@LXSPSW8| 丁香五月综合激情性爱| 综合激情五月婷婷| 91九色熟女| 91超级碰在线视频| 操久久网| 久热这里只有精品性色AV| 久久五月激情综合| 久久99精品视频| 久久九九网| 色天使色婷婷| 中文无码婷婷| 国产日批视频免费播放| 免费日韩99| va中文资源在线观看| 丁香六月开心| 国产欧美日韩性爱| 五月丁香六月婷婷,婷| 丁香激惜男女| 丁香五月婷婷亚洲人| 99er这里只有精品视频| 婷婷操逼| www久久99com| 激情文学天天| 五月婷婷就去色| 欧美婷| 久久久久人妻中文| 色婷婷综合视频| 欧美性色视频| 成人在线视频网| 色色色9| 天天操天天操天天操天天操天天操| 天天爽天天爽| 久久综合九色综合97婷婷| 天天干天天日蜜臀av| 超碰成人在线免费观看| 丁香九月综合| 一夜福利不卡| 激情九九这里只有精品| 色综合久久五月天| 99超级碰免费视频| 最近中文字幕2019视频1| 亚洲在线免费成人| 亚洲一区二区色图-亚洲精品国产精品乱码-成人AV | 五月婷婷色播| 超碰av在| 六月婷婷九月丁香| 天天想夜夜爽天天爽| 日日干干天天干| 国产精品日韩十五区| 五月天婷婷免费视频| 综合五月婷婷| 国产欧美日韩综合精品一区二区| 亚洲天堂AV综合网| 丁香五月婷婷激情尤物| 丁香五月婷婷久久综合激情网 | 激情五月综合网| 狠狠肏综合网| www激情| 超碰精品在线| 99婷婷狠狠成为人免费视频| 天色综合网| 久久伊人五月天| 欧美视频在线观看噜噜| 激情五月丁香亭亭| 久久婷婷色| 久9精品视频在线| 久热99热| 日日撸天天干| 九九热精品99| 免费视频WWW在线观看网站| 丁香五月天激情四射网络不好| 99热大香蕉| 精品综合久久久久久五月天| 色综合五月天| 中国女人做爰A片| 亚洲精品网址| 婷婷五月综合婷婷| 激情亚洲网| 婷婷色五月天在线| 久久婷五月影院| 亚洲精品视频在线| 九九在线这里只有精品视频| 五月丁香777| 国产精品成av人在线视午夜片| 六月婷婷av| 五月丁香亭亭天天舔| 9久热免费视频99| 成人无码精品1区2区3区免费看| 二级黄色毛片| 思思热热久久| 久机视频这只有精品| 久久久91精品| 亚洲无码成人网| 五月丁香六月情| 99热成人| 久久性操| 另类五月激情| 99精品偷自拍| 人人操日| 丁香五月激情五月开心五月| 大香蕉啪啪啪| 99九九99九九九视频精彩| 久热中文字幕在线线观看| 婷婷久久五月丁香| 婷婷六久久| 成人色站,在线视频,看片-SS1AV| 99在线精品视频| 久久五月天激情| 色噜噜狠狠色综合日日| 中文字幕 中文字幕明步| AA片在线观看视频在线播放 | 亚洲AV激情五月综合网| 免费啪啪亚州视频| 狠狠爱婷婷五月天| 婷婷 激情 五月| 第四色五月天| 五月婷视频| 熟女激情网| 色色色婷婷| 玖玖婷婷五月天毛片| 伊人五月天综合网| 91色涩| 伊人天堂婷婷| 婷婷激情五月天亚洲综合| 色色色综合色| 99久久精品国产色欲| 久久欧洲综合网| 婷婷五月天黄色| 91色综合久久| 丁香久久五月天视频在线观看| 99精品在这里| 99自拍网| EEUSS鲁片一区二区三区| 亚洲午夜成人av电影网| 丁香五月天在线视频| 99这里有精品视频| 久久182| 亚洲五月天婷婷综合| 国产精产国品一二三在观看| 婷婷五月69| 91婷婷色 | 蜜桃人妻无码AV天堂三区| 综合色色网| 欧美大香蕉视频| 天堂久久大香蕉| 亚洲色色香蕉| 五月丁香激情综合网官网| 啪啪啪五月天| 亚洲欧洲中文日韩久久AV乱码| 久久五月天婷婷视频| 色婷婷五月在线| 91精品国产91久久久久青草| 91人人操人人| 无码区婷婷五月花开| 狼人婷婷久久| 五月婷婷天堂| 中文字幕,综合,91| 激情综合色婷婷啪啪六月天| 五月丁香啪啪综合| 婷婷字幕在线| 色色COm| 99久久婷婷国产综合精品电影| 色丁香在线视频| 97精品人人A片免费看| 丁香九月综合| 欧美日综合| 丁香五月婷婷狠狠色| www99热| 五月婷婷9| 人妻久久久久久久 | 噼里啪啦在线观看免费完整版视频| 精热在线综合网| 这里有精品| 夜夜操夜夜爽| 97人妻碰碰中文无码久热丝袜| 婷婷丁香视频在线观看免费| 五月婷色| 狠狠干狠狠干狠狠干狠狠干| 色色欧美色色色| 99er6热在线观看精品6| 色婷婷丁香AV综合| 激情 婷婷 丁香五月天| 亚洲黄网在线| 99热这里只有精品青草| 91日日日| 99亚州综合精品成人网| 亚洲俩性性爱图片久久第六页| 亚洲超碰在线| 狠狠操天天操综合| 久777| www天天色天天射| 极品色丁香| 日日夜夜天天综合| 婷婷久久五月天亚洲欧美国产日韩在线观看 | 91精品激情9| 亚洲五月婷天天操| 婷婷丁香激情五月天色色色| 夜夜撸天天操| 99日精品视频| 久久免费操| 黄色五月婷婷| 亚洲久热| 丁香五月激情婷婷| 五月深情久久| 色综合大香蕉| 日韩好吊操| 亚洲综合五月天婷婷| 五月天啪啪啪| 久久九九综合| 密着浓厚中出乚交尾GvG935| 午夜丁香婷婷| 丁香五月日韩| www.久久爱| 九九热视频思思| 激情五月天的婷婷| 婷婷丁香五月综合| 亚洲免费99| 大香蕉久热| 开心婷婷五月| 啪啪亚洲综合| 丁香婷婷五月天激情四射| 99色在线| 色色色.COM| 亚洲综合视频网| 粉嫩AV久久一区二区三区| 先锋av性爱成人电影| 午夜丁香六月婷| www久久99| 五月丁香操亭亭网| 99性视频| 99色在线观看视频者| 日韩久热| 五月丁香六月婷婷在线小说视频| 99视频免费播放 | 五月天婷婷激情网| 色五月综合| 天天做天天爱天天综合网| 91热久久| 精品九九九久| 99热伊人| 婷婷五月天成人网站| 91人人超碰在线| 熟妇人妻中文字幕无码老熟妇| 丁香五月六月| 六月丁香啪啪| 日本丰满久久| 99久久99九九九99九他书对| 美女亚洲五月丁香| 99小视频在线观看| 欧美激情综合| 激情丁香五月| 三十路磁力链接| 亚洲在线操| 久操香蕉| AV性爱网| 深爱激情六月天| 丁香五月花婷婷开心| 激情超碰网| 涩五月婷婷| 日韩另类在线观看| 久久 这里只有精品1| 五月色色色| 丁香婷婷久| 五月丁香婷婷啪啪| 色色五月天婷婷丁香| 99热这里只有精品23| 色色爽爽天天| 色婷婷五月综合色婷婷| 思思热在线观看| 欧美狠狠色| 久久99这里只有精品视频| 亚洲色碰| 91日本在线免费| 九九热在线视频| 国产精品色婷婷久久久精品| 色吧综合网| 国产午夜精品一区二区| 人人干天天操五月丁香| 日韩久久视频| 欧美啪啪五月天| 91在线操逼视频| 香蕉综合在线| 激情五月婷婷五月| 美国天天日天天操| 这里只有精品视频在线观看免费| 欧美日韩国产一区| 在线亚洲综合| 日韩无码AV电影网站| 狠狠干狠狠干| 久久婷婷亚洲| 婷婷综合视频| 四色AVwww| 久色五月婷婷综合| 四月婷婷五月色综合| 久碰婷婷视频| 我想看国产大学生口爆吞精的视频| 亚洲精品一区中文字幕乱码| 天天干天天拍| 久久久中文| 色综合中文| 婷婷综合在线| 激情五月天色婷婷| 六月婷婷狠狠做| 久99视频在线观看| 亚洲无码你懂的| 五月天天丁香婷婷| 成人无码髙潮喷水A片| 日日操天天操| 天天舔天天操| 99av视频| 9久热这里只有精品| 可以直接看的av网站| 亚洲色婷婷色| 亚洲艹网| 五月丁香六月婷婷综合在线| www久久99| 97干网站| 4399高清无码视频| 1024亚洲| 亚洲4区国产欧美| 9色免费网| 午夜激情久久| 婷婷新网址| 在线观看欧美3区| 中文婷婷狠狠| 久久ri精品视频| 丁香啪啪中文字幕| 99视频免费播放 | 思思久ren热| 色六月天天激情综合网| 欧美99| 大香蕉久艹| 91超碰人人操| 五月婷婷色色色| 天天看A片| 99无码视频| 天天操天天爱天天日| 五月丁香成人网| 99五月丁香丁| 婷婷五月成人色综合| 成人天天爽| 99re66热这里只有精品| 久久久大香蕉| 中文字幕在线日亚洲9| 色综合久| 狠狠色婷婷7| 婷婷黄色五月天在线视频| www.91.com处女在线直播| 亚洲天堂亚洲色色色| 成人久久天天x资源站| 五月婷婷网久久| 亚洲人人操BD| 秋霞影音91人妻久久| 婷婷丁香亚洲五月天| 激情婷婷五月天在线观看| 噜噜噜噜在线| 俺也去在线视频| 综合色色色| 久久总和99| 另类小说五月天| 国产精品电影| 国产在线网| 67久久| 色综合香蕉视频| 色色狼人综合| 碰碰91| 99视频地址| 五月婷婷综合网在线播放| 青青草六月丁香| 五月天婷婷在线观看| 久久性爱视频| 日韩视频99| 久婷久婷| 午夜大香蕉| 婷婷五月丁香五月| 在线免费视频caop| 九月色婷婷综合| 九九伊人网| 精品福利911| 五月丁香777| 91日本在线观看| 欧美性生交XXXXX无码小说| 综合五月激情| 婷婷操久久| 思思网站| 五月天婷婷在线AN| 九九综合| 国产真实乱了老女人视频| 久久综合综合综合| 久草性爱| 开心五月丁香综合久久| 婷婷丁香激情| 超碰人人99| 丁香五月性| 狠狠色综合无线观看| 碰碰女| 2023天天日夜夜爽| 五月性色| 婷婷久久综合| 色婷婷亚洲综合av| 九九五月天| 丁香五月在线视频黑人| 亚洲视频99| 色色色综合网| 成人视频免费观看高清完整版在线观看| 婷婷久久丁香五月| 五月夜丁香| 五月天丁香| 99综合网| 综合色色综合| 5月丁香婷婷| 91精品国产综合久久密臀| 国产.亚洲.欧洲视频在线| 久久婷婷五月天| 国产色色小草视频| 成人av免费观看| 五月丁香花开综合网| 久久久五月五丁香| www.色五月| 国产亚洲网站在线| 插插干干干色| 99热在线观看| 少妇真实被内射视频三四区| 99久久精品国产色欲| 激情综合网,五月| 丁香五月综合激情性爱| 激情久久久| 亚洲无aV在线中文字幕 | 99免费| 亚洲色久| 啪啪黄页网| 激情综合激情五月| 激情五月婷| 激情五月婷婷视频| 99精品在线观看| 久久久久久性爱视频| 天天操天天插| 中文字幕成人影视| 婷婷免费无视频| 亚洲av网站| 99情色五月天| 精品九九在线观看视频| 噜噜视频| 91在线就要啪| 99激情网| 天天做天天爱| 亚洲偷| 五月天婷婷激情网| 亚洲天天| 亚洲精品久久久无码| 成年人夜夜喷水| 婷婷丁香在线播放| 成人看片网站| 亚洲婷婷五月| 丁香五月六月激情| 婷婷丁香在线| 五月婷婷国产| 欧美色色色| 丁香激情五月| 9操在线| 激情深爱五月| 1024亚洲无码| 午夜色色色极品视频| 久久色五月天| 色婷婷色和| 色婷婷狠狠色| AA丁香综合激情| 天天肏夜夜肏| 日本色爽| 天天综合网~91| 五月婷婷啪啪| 日韩五月丁香| 怡红院AV亚洲一区二区三区H| 九色七七| 来吧亚洲综合网| 九九精品丁香花| 婷婷五月天深爱| 五月丁香婷婷在线| 婷婷五月丁香超碰| 激情VA视频| 九九热狼人| 激情五月丁香在线观看直播| 97久久久| 五月婷婷免费在线| 97资源碰碰| 精品99视频| 五月天最新网| av一区免费看| 丁香婷婷十月| 激情小说色五月| 26UUU欧美激情一区二区| 色播丁香| 五月激情婷婷图片基地| 天天干狠狠| 色色五月天丁香| 色色热| 在线中文字幕免费视频| 亚洲九九99精品视频在线播放| 欧美日韩中文国产一区发布| 天天婷婷综合| www.夜夜操.com| 丁香五月婷婷狠狠色| 99热都是精品| 亚洲综合1024| 精品99在线| 欧美日韩成人在线观看| 99热资源在线| 五月丁香自拍| 99热在线观看精品| 9 1在线视频| 久久99热在线观看| 色五月综合97| 久热这里只有| 日本精品九九九| 天天影院色| av成人在线播放| 激情五月天偷拍综合网| 色婷六月| 久久92| caop在线| 久久精品性爱| 亚洲午夜AV| 色五月五月婷婷| 梁铮版蜘蛛女在线观看| 久久小视频| 婷婷瑟五月天久久综合| 影音先锋91网站在线观看| 精品久久久久久久久久久久人妻| 大香蕉久久综合网| 色婷丨日丨天丨综合久久| 超碰婷婷色| 99爱在线视频观看| 青青草婷婷久久| 涩涩五月天| 亚洲综合1024| 激情丁香五月婷婷| 天堂婷婷五月在线| 被强行糟蹋的女人A片| 91啪级电影| H亚洲| 天天做天天爱天天玩| 久久五月天色婷婷| 婷婷久久久| 色七色九九| 香蕉曰比| 色五月婷婷老师| 色色丁香婷婷| 日产精品久久久久久久蜜臀| 开心五月婷| 色九综合| 六月婷婷视频| 超碰碰碰碰| 少妇人妻丰满做爰XXX| 亚洲丁香五月在线观看| 艹天天射| www九九热| 天天草婷婷五月| 激情综合色婷婷啪啪五月天| 五月丁香人妻| 综合视频久久| 婷婷五月天丁香| 五月天婷婷视频30| 9999热在线免费观看| 九九99免费视频| 日本婷婷丁香五月| 九九久久玖玖爱| 婷婷爱五月天| 色播六月| 色综合婷婷| 夜夜爽天天日| 色婷婷先锋| 在线视频另类| 无码G高清天| 久久五月天激情婷婷| 婷婷色五月婷| 在线va网站| 狠狠色中色| AV在线观看网站| 视频免费精品免费精品免费精品免费精品免费精品免费精品免费99 | 五月丁香婷婷五月色| 亚洲精级| 99a级片| 美女婷婷六月色| 密视AV综合在线| 黄色AV日韩| 婷婷五月综合欧美在线播放| 影音先锋女人av鲁色资源网小说免费| 99热综合| 99热这里只有精品热| 丁香五月婷婷99| 丁香六月婷婷综合| 精品人妻久久久久久久| 国内精品免费一区二区2009| 美女网黄| 婷婷激情五月天亚洲综合| 天天综合网~91| 国产99热| 99热99热不卡| 成人网址在线观看| 色婷青青| 色色狼人综合| 色婷婷深爱五月| 三级毛片7979| 日本强伦片中文字幕免费看| 五月天激情四射网站| 五月天婷婷青青| 涩涩激情五月婷婷| 五月天大香蕉| 常久最新免费的色吊丝| 国产亚洲在线观看| 99精品久久久久久久久| 丁香婷婷色五月激情综合| 丁香五月婷久久| 91操片| 九九成人电影婷婷| 日本精品99网站| www.五月激情红色| 久久婷婷五月丁香网| 伊大人久久| 色五月综合| 99视频只有精品| 丁香婷婷六月天| 婷婷综合色| 五月丁香婷婷激情图片| 五月丁香久久| av在线免费网站 | 另类激情中文| 91九色网| 欧美亚洲成人在线| 色婷网| 综合性爱网| 日日夜夜综合| 激情人妻综合| 日本成人内射| 五月天伊人网| 538久久| 日本久久天堂| 欧美日韩国产日本精品四虎网网站物| 风流少妇A片一区二区蜜桃| 成人在线精品| 日本va欧美va欧美精品88| 天天操夜夜夜拍拍拍| 久久草中文日韩欧美| 国产精品婷婷午夜在线观看| 女人露出p毛视频www网站| 涩涩婷婷五月| 五月婷婷丁香综合,亚洲天堂| 第九色区av天堂| 99久久99久久综合| 五夜丁香| 激情五月四色| 男人综合网| 天堂爱爱| 欧美婷婷| 精品牛仔裤超碰| 99热第一页| 人人操婷婷| 国产毛片精品一区二区色欲黄A片| 亚洲欧美成人在线| 亚洲av综合网| 天天噜| 99热这里只有精品搜| 婷婷五月天激情视频| 丁香六月婷婷综合激情欧美| www.99热视频| 丁香五月色网| 97婷婷五月激情六月丁香伊人| 六月婷婷色色网| 国产小精品| 欧美色综合天天久久综合精品 | 在线超碰免费| 91.www综合| 久久人妻少妇嫩草AV| 五月综合视频| 亚洲综合成人网| 婷婷午夜天| 久久久97| 五月六月伦理| 色激情五月| 天天夜夜爽| 热99AV网站| 色婷婷丁香香香蕉视频| 婷婷日日天天| 久久五月婷天天干| 五月丁香六月婷婷在线播放| 五月婷色丁香|