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

ARTICLE DETAIL

資訊詳情

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

MPC模型預(yù)測(cè)控制從原理到代碼實(shí)現(xiàn):約束優(yōu)化與控制實(shí)戰(zhàn)解析

MPC模型預(yù)測(cè)控制從原理到代碼實(shí)現(xiàn):約束優(yōu)化與控制實(shí)戰(zhàn)解析 在自動(dòng)化控制這個(gè)圈子里摸爬滾打了這么多年我發(fā)現(xiàn)一個(gè)很有意思的現(xiàn)象凡是涉及軌跡跟蹤、路徑規(guī)劃、約束優(yōu)化的項(xiàng)目最后幾乎都會(huì)繞到MPC模型預(yù)測(cè)控制這個(gè)算法上。不管是無人駕駛車輛的橫向控制、機(jī)械臂的柔順抓取還是溫控系統(tǒng)的節(jié)能調(diào)度MPC就像是一個(gè)“能預(yù)知未來的控制器”通過滾動(dòng)求解一個(gè)有限時(shí)域的優(yōu)化問題讓系統(tǒng)在滿足各種硬約束的前提下輸出最優(yōu)的控制動(dòng)作。今天這篇文章我打算把MPC這塊硬骨頭從頭到尾啃一遍從最底層的原理推導(dǎo)到代碼層面的逐步實(shí)現(xiàn)把我自己踩過的坑和總結(jié)的經(jīng)驗(yàn)全部攤開來講清楚希望能給正在入門或卡在瓶頸期的你一點(diǎn)實(shí)在的幫助。先說下這篇東西是寫給誰看的如果你剛接觸MPC被滿屏的Hessian矩陣、KKT條件搞得頭大可以在這里找到一條從感性到理性的認(rèn)知路徑如果你已經(jīng)能用現(xiàn)成工具箱跑通Demo但對(duì)“為什么參數(shù)要這么調(diào)”心存疑惑這篇文章會(huì)給你一些實(shí)用的判斷依據(jù)如果你正準(zhǔn)備在嵌入式設(shè)備或者實(shí)時(shí)系統(tǒng)里部署MPC那么第四章的代碼實(shí)現(xiàn)和第六章的工程化建議可能正是你需要的。1. MPC的核心原理與直覺理解1.1 為什么傳統(tǒng)PID不夠用而MPC更強(qiáng)要理解MPC我覺得最好的切入點(diǎn)是先搞清楚它解決了什么痛點(diǎn)。傳統(tǒng)的PID控制器是“事后調(diào)節(jié)”它只根據(jù)當(dāng)前的誤差來決策參考你的目標(biāo)是讓輸出值等于設(shè)定值它只關(guān)心你現(xiàn)在跑偏了多少不關(guān)心未來會(huì)不會(huì)撞墻。舉個(gè)例子你開車時(shí)如果只看著當(dāng)前車距來踩油門剎車遇到急轉(zhuǎn)彎或前車突然減速的情況反應(yīng)往往慢了半拍——因?yàn)槟銢]有“預(yù)測(cè)”未來很短時(shí)間內(nèi)的趨勢(shì)。而MPC的思想完全是另一個(gè)維度它是“事前規(guī)劃”。它的每一步控制決策都會(huì)基于一個(gè)預(yù)測(cè)模型去推算系統(tǒng)在未來一段時(shí)間比如未來2秒的狀態(tài)軌跡然后在這段預(yù)測(cè)的范圍內(nèi)優(yōu)化出一串控制序列比如未來2秒內(nèi)每0.1秒踩多少油門并且強(qiáng)制要求每一個(gè)時(shí)刻的狀態(tài)都滿足約束比如速度不能超過80加速度不能超過2。執(zhí)行完這一步后系統(tǒng)會(huì)把控制序列的第一段指令發(fā)給執(zhí)行器然后整個(gè)流程滾動(dòng)地重復(fù)。這套機(jī)制帶來的直接好處有三個(gè)第一系統(tǒng)性約束處理變得非常自然你可以把“前車距離不能少于5米”這種硬約束直接寫進(jìn)優(yōu)化問題里而不是像PID那樣靠限幅或分段邏輯去逼近第二控制品質(zhì)顯著提升因?yàn)樗跁r(shí)間軸上統(tǒng)籌了未來一段時(shí)間的代價(jià)不會(huì)為了眼前的小偏差而犧牲后續(xù)的性能第三它天然適合多輸入多輸出MIMO系統(tǒng)比如四輪獨(dú)立驅(qū)動(dòng)的車輛四個(gè)輪子的扭矩分配是一個(gè)典型的耦合優(yōu)化問題很難用單回路PID去解耦。當(dāng)然MPC也不是沒有代價(jià)它的代價(jià)是計(jì)算量大。本質(zhì)上你每個(gè)控制周期都要求解一個(gè)帶約束的最優(yōu)化問題這在算力有限的單片機(jī)上往往是瓶頸。所以很多工業(yè)現(xiàn)場(chǎng)會(huì)出現(xiàn)“幾十毫秒算一次MPC”的場(chǎng)景這已經(jīng)算是不錯(cuò)的表現(xiàn)了。1.2 三要素預(yù)測(cè)模型、滾動(dòng)優(yōu)化、反饋校正拆開“模型預(yù)測(cè)控制”這六個(gè)字核心其實(shí)就三件事預(yù)測(cè)模型、滾動(dòng)優(yōu)化、反饋校正。這三個(gè)要素缺一不可。預(yù)測(cè)模型顧名思義是用來模擬系統(tǒng)動(dòng)態(tài)行為的數(shù)學(xué)模型。在工程實(shí)現(xiàn)中最常用的是線性狀態(tài)空間模型x(k1) A x(k) B u(k)因?yàn)樗銐蚝?jiǎn)單、有成熟的理論支持而且可以直接套用線性MPC框架。如果系統(tǒng)非線性很強(qiáng)比如機(jī)械臂的動(dòng)力學(xué)模型或者自動(dòng)駕駛中的輪胎摩擦模型我們可以使用線性時(shí)變MPC在每個(gè)采樣時(shí)刻把非線性模型線性化得到一個(gè)局部的線性方程。滾動(dòng)優(yōu)化是整個(gè)MPC的靈魂。它不是說“我一次性算好未來10步的動(dòng)作然后全部執(zhí)行”而是只執(zhí)行當(dāng)前這一步下一時(shí)刻重新測(cè)量狀態(tài)、重新預(yù)測(cè)、重新求解。這樣當(dāng)系統(tǒng)受到新的擾動(dòng)或模型失配時(shí)控制器能及時(shí)修正不會(huì)一條道走到黑。這個(gè)“滾動(dòng)”的動(dòng)作本質(zhì)上是一種帶前瞻的閉環(huán)反饋策略而不是開環(huán)的“放電影”。反饋校正則是把模型預(yù)測(cè)和實(shí)際系統(tǒng)之間的差異考慮進(jìn)來的環(huán)節(jié)。因?yàn)槟P陀肋h(yuǎn)不可能完美預(yù)測(cè)軌跡和真實(shí)軌跡總會(huì)存在偏差所以MPC的做法是在每次采樣時(shí)用傳感器反饋的實(shí)際測(cè)量值比如當(dāng)前位置、當(dāng)前速度替換掉模型預(yù)測(cè)中的對(duì)應(yīng)狀態(tài)然后重新開始新一輪預(yù)測(cè)。這一步保證了系統(tǒng)不會(huì)因?yàn)槟P驼`差而持續(xù)發(fā)散是MPC能夠落地的關(guān)鍵“安全網(wǎng)”。1.3 從直覺到數(shù)學(xué)優(yōu)化問題長(zhǎng)什么樣如果把MPC的直覺轉(zhuǎn)化成數(shù)學(xué)語言你會(huì)看到這樣一個(gè)形式化的優(yōu)化問題在每個(gè)控制時(shí)刻 k已知當(dāng)前狀態(tài)x(k)我們要求解以下問題min J sum_{i0}^{N-1} [ (x_{ki} - x_ref_{ki}) Q (x_{ki} - x_ref_{ki}) u_{ki} R u_{ki} ] (x_{kN} - x_ref) P (x_{kN} - x_ref) s.t. x_{ki1} A x_{ki} B u_{ki} x_{ki} ∈ X_constraint u_{ki} ∈ U_constraint for i 0, 1, ..., N-1這里N是預(yù)測(cè)時(shí)域我們可以看未來多少步Q和R是對(duì)狀態(tài)誤差和控制量的權(quán)重矩陣P是末端代價(jià)權(quán)重。Q越大說明我越在意狀態(tài)跟蹤的精度R越大說明我越在意控制動(dòng)作的平穩(wěn)性。X_constraint和U_constraint是狀態(tài)和輸入的上下界約束。求解完這個(gè)帶約束的二次規(guī)劃問題QP后我們會(huì)得到一個(gè)最優(yōu)控制序列u(k), u(k1), ..., u(kN-1)然后只提取第一步u(k)應(yīng)用到被控對(duì)象上。等到下一個(gè)采樣周期用新的測(cè)量值作為初始狀態(tài)再次滾動(dòng)求解。這個(gè)流程就是MPC的完整閉環(huán)。值得一提的細(xì)節(jié)是預(yù)測(cè)時(shí)域N的選取。N太小比如N1或2MPC就退化成近似貪婪控制提前量的價(jià)值大打折扣N太大優(yōu)化問題的變量數(shù)和約束數(shù)爆炸求解時(shí)間直線上升。實(shí)際工程中N的經(jīng)驗(yàn)取值通常是讓預(yù)測(cè)時(shí)長(zhǎng)覆蓋系統(tǒng)動(dòng)態(tài)的上升時(shí)間比如一個(gè)溫度系統(tǒng)的時(shí)滯是2分鐘上升時(shí)間是5分鐘那么預(yù)測(cè)時(shí)域N至少要讓總預(yù)測(cè)時(shí)長(zhǎng)達(dá)到3~5分鐘以上否則前瞻性不夠。2. 從零搭建MPC數(shù)學(xué)模型與設(shè)計(jì)流程詳解2.1 狀態(tài)空間模型這是MPC的“眼睛”MPC是一次典型的“模型驅(qū)動(dòng)”的控制方法所以建模這一步至關(guān)重要。如果你連對(duì)象的基本動(dòng)態(tài)都描述不準(zhǔn)那后面算出來的控制序列基本是瞎指揮。對(duì)于很多實(shí)際項(xiàng)目來說我們需要的不是精確到每一個(gè)非線性細(xì)節(jié)的復(fù)雜模型而是一個(gè)能在工作點(diǎn)附近足夠準(zhǔn)確的線性模型——這就是為什么在工業(yè)現(xiàn)場(chǎng)MPC最常用的模型就是離散狀態(tài)空間模型。建模思路通常是兩條路線機(jī)理建模和數(shù)據(jù)辨識(shí)。機(jī)理建模是從物理定律出發(fā)推到運(yùn)動(dòng)方程比如根據(jù)牛頓第二定律推出小車的速度加速度關(guān)系根據(jù)熱力學(xué)方程推出溫度的升溫冷卻規(guī)律數(shù)據(jù)辨識(shí)則是拿輸入輸出數(shù)據(jù)來擬合系統(tǒng)參數(shù)常用的方法是子空間辨識(shí)或最小二乘估計(jì)。工程中往往是兩條路結(jié)合用機(jī)理確定結(jié)構(gòu)用數(shù)據(jù)校準(zhǔn)參數(shù)。舉個(gè)非常經(jīng)典的例子假設(shè)我們要控制一輛小車的縱向速度設(shè)狀態(tài)量為x [位置, 速度]輸入為u [驅(qū)動(dòng)力]。忽略空氣阻力時(shí)離散化后的狀態(tài)空間方程可以寫成A [[1, dt], [0, 1]] B [[0], [dt / m]] C [[1, 0]] D [[0]]這個(gè)dt是采樣周期m是車的質(zhì)量。你可以看到A矩陣描述了“位置會(huì)隨著時(shí)間被速度累積”B矩陣描述了“力通過加速度影響下一時(shí)刻的速度”。有了A和BMPC就能在時(shí)間軸上推演狀態(tài)了。2.2 MPC設(shè)計(jì)流程七個(gè)步驟一條龍如果你的項(xiàng)目準(zhǔn)備上MPC我建議你按照下面這七步流程走基本不會(huì)跑偏。第一步明確控制目標(biāo)。你是想讓輸出跟蹤一個(gè)參考軌跡還是讓狀態(tài)穩(wěn)定在一個(gè)設(shè)定點(diǎn)或者是在兩個(gè)目標(biāo)之間做最優(yōu)切換目標(biāo)不同代價(jià)函數(shù)定義就不同。第二步確定采樣周期和預(yù)測(cè)時(shí)域。采樣周期上限沒有特定要求但至少要比系統(tǒng)動(dòng)態(tài)的上升時(shí)間快5到10倍比如目標(biāo)是控制機(jī)械臂末端運(yùn)動(dòng)上升時(shí)間是0.5秒采樣周期建議在10~50毫秒之間。預(yù)測(cè)時(shí)域的預(yù)測(cè)時(shí)長(zhǎng)通常設(shè)置為上升時(shí)間的2~3倍然后轉(zhuǎn)換成步數(shù)N。第三步建立被控對(duì)象的數(shù)學(xué)模型。這個(gè)模型可以是線性的也可以是非線性的。如果模型是非線性的但工作范圍不大盡量在工作點(diǎn)做線性化。第四步構(gòu)造約束條件。把所有物理限制列全執(zhí)行器飽和扭矩限幅、閥門開度限幅、狀態(tài)安全界限溫度上限、位置邊界、變化率限制加速度不能太猛。約束寫得越準(zhǔn)確MPC的優(yōu)勢(shì)越明顯。第五步設(shè)計(jì)代價(jià)函數(shù)權(quán)重。Q和R的初值可以按“布里森法則”來定Q diag(1/max_deviation^2)R diag(1/max_u^2)意思是讓不同量綱的誤差和控制量在歸一化之后具有可比性。這一步往往會(huì)反復(fù)調(diào)整后面我會(huì)專門講怎么調(diào)權(quán)重。第六步選擇求解器并實(shí)現(xiàn)代碼。在線的QP求解器有很多選擇比如OSQP、qpOASES、CVXGEN后面代碼部分會(huì)詳解。第七步仿真驗(yàn)證與硬件部署。先在Simulink或者Python仿真環(huán)境里跑通再移植到嵌入式平臺(tái)同時(shí)做好數(shù)據(jù)標(biāo)定和在線調(diào)參。2.3 一個(gè)DP問題的補(bǔ)充為什么Q和R矩陣要用對(duì)角陣在設(shè)計(jì)代價(jià)函數(shù)時(shí)Q和R矩陣最常用的形式是對(duì)角陣比如Q diag([q1, q2])。這背后的邏輯是我們通常假設(shè)各個(gè)狀態(tài)量之間、各個(gè)控制量之間的代價(jià)可以解耦也就是位置偏差的代價(jià)和速度偏差的代價(jià)是互不干擾的。如果你發(fā)現(xiàn)狀態(tài)之間存在強(qiáng)烈的耦合關(guān)系比如同時(shí)減小位置誤差和速度誤差會(huì)互相矛盾那就需要引入Q的非對(duì)角元素形成一個(gè)全矩陣權(quán)重不過這會(huì)讓QP問題的數(shù)值性變差工程上一般不輕易這么干。R矩陣通常就設(shè)成對(duì)角線上的標(biāo)量代表我們對(duì)控制量的“客氣程度”。R太大控制器會(huì)變得溫吞吞的響應(yīng)慢R太小控制器會(huì)特別激進(jìn)可能頻繁觸達(dá)約束邊界。這個(gè)參數(shù)直接影響閉環(huán)系統(tǒng)的魯棒性和執(zhí)行器壽命調(diào)參時(shí)切忌“猛拉猛放”。Q矩陣中如果你特別在意穩(wěn)態(tài)精度可以把對(duì)應(yīng)狀態(tài)的Q設(shè)大如果你更在意過程的平穩(wěn)性避免大起大落就應(yīng)該相對(duì)調(diào)大R或調(diào)小Q。3. 完整代碼實(shí)現(xiàn)Python一步步跑通MPC3.1 準(zhǔn)備工作安裝必要的Python庫(kù)在實(shí)際寫MPC之前需要確認(rèn)環(huán)境已經(jīng)裝好以下幾樣工具numpy矩陣運(yùn)算和狀態(tài)空間更新的基礎(chǔ)scipy有一些優(yōu)化算法可以作為備選osqp一個(gè)非??斓膬?nèi)點(diǎn)法QP求解器針對(duì)稀疏矩陣做了大量?jī)?yōu)化和cvxpy配合起來體驗(yàn)極佳cvxpy一個(gè)建模范式很強(qiáng)的凸優(yōu)化庫(kù)可以在一行內(nèi)描述目標(biāo)函數(shù)和約束適合快速原型驗(yàn)證control這是一個(gè)工具箱可以方便地創(chuàng)建狀態(tài)空間模型、計(jì)算階躍響應(yīng)幫助觀察模型特性安裝命令很簡(jiǎn)單pip install numpy scipy osqp cvxpy control如果你的環(huán)境比較干凈這一套裝下來通常不會(huì)遇到什么大坑。偶爾可能有cvxpy和osqp的版本兼容問題如果發(fā)現(xiàn)導(dǎo)入失敗試試先卸載再重裝pip uninstall osqp cvxpy pip install osqp cvxpy。3.2 雙積分器對(duì)象的MPC示例代碼逐行拆解為了讓你能在一分鐘之內(nèi)看懂MPC的代碼骨架我選了一個(gè)最經(jīng)典的“雙積分器”對(duì)象它的狀態(tài)方程是x1 x2, x2 u物理上可以通俗理解為“位置由速度決定速度由加速度決定”的一維慣性系統(tǒng)。很多伺服電機(jī)的位置環(huán)都可以近似成這個(gè)模型。以下是完整的MPC控制主循環(huán)代碼import numpy as np import cvxpy as cp import matplotlib.pyplot as plt # 系統(tǒng)參數(shù) dt 0.05 # 采樣周期50ms m 1.0 # 質(zhì)量歸一化 N 20 # 預(yù)測(cè)時(shí)域步數(shù) T 10 # 仿真總時(shí)長(zhǎng)秒 steps int(T / dt) # 仿真步數(shù) # 離散狀態(tài)空間模型x(k1) A x(k) B u(k) A np.array([[1, dt], [0, 1]], dtypenp.float64) B np.array([[0], [dt / m]], dtypenp.float64) nx A.shape[0] # 狀態(tài)數(shù) nu B.shape[1] # 控制量數(shù) # 約束定義 u_max 2.0 x_max 5.0 # 權(quán)重矩陣 Q np.diag([2.0, 0.1]) # 更關(guān)心位置誤差速度權(quán)重相對(duì)低 R np.array([[0.1]]) # 控制量代價(jià) # 目標(biāo)參考狀態(tài)期望把位置控制在1.0處穩(wěn)定不動(dòng) x_ref np.array([1.0, 0.0]) # 初始化 x np.array([0.0, 0.0]) # 初始狀態(tài)位置0速度0 u_log [] x_log [x.copy()] # 定義優(yōu)化變量 X cp.Variable((nx, N1)) # 狀態(tài)變量軌跡N1個(gè)時(shí)刻的狀態(tài) U cp.Variable((nu, N)) # 控制變量軌跡N個(gè)時(shí)刻的控制 # MPC主循環(huán) for k in range(steps): # 代價(jià)函數(shù)跟蹤誤差 控制代價(jià) cost 0 constraints [] for i in range(N): cost cp.quad_form(X[:, i] - x_ref, Q) cp.quad_form(U[:, i], R) cost cp.quad_form(X[:, N] - x_ref, Q) # 末端代價(jià)增加穩(wěn)定性 # 動(dòng)態(tài)約束狀態(tài)轉(zhuǎn)移方程 for i in range(N): constraints.append(X[:, i1] A X[:, i] B U[:, i]) # 初始狀態(tài)約束 constraints.append(X[:, 0] x) # 輸入約束和狀態(tài)約束 for i in range(N): constraints.append(cp.abs(U[:, i]) u_max) constraints.append(cp.abs(X[:, i]) x_max) # 求解QP問題 prob cp.Problem(cp.Minimize(cost), constraints) prob.solve(solvercp.OSQP, verboseFalse) # 檢查求解是否成功 if prob.status not in [optimal, optimal_inaccurate]: print(fStep {k}: QP solve failed with status {prob.status}) break # 取第一個(gè)控制量應(yīng)用到系統(tǒng) u_applied U[:, 0].value u_log.append(u_applied) # 用真實(shí)系統(tǒng)這里也用同一模型模擬更新狀態(tài) x A x (B u_applied).flatten() x_log.append(x.copy()) # 繪圖展示結(jié)果 x_log np.array(x_log) u_log np.array(u_log) plt.figure(figsize(10,6)) plt.subplot(2,1,1) plt.plot(x_log[:,0], labelposition) plt.plot(x_log[:,1], labelvelocity) plt.axhline(yx_ref[0], colorgray, linestyle--, labelref position) plt.ylabel(states) plt.legend() plt.subplot(2,1,2) plt.step(range(len(u_log)), u_log, wherepost, labelcontrol input) plt.ylabel(u) plt.xlabel(step) plt.legend() plt.show()這段代碼是整個(gè)MPC實(shí)現(xiàn)最簡(jiǎn)練的版本你跟著跑一遍應(yīng)該能看到位置從0平滑收斂到1.0速度先升后降、最終歸零控制量始終被鉗在[-2, 2]的范圍內(nèi)。這正是MPC約束處理能力的直觀體現(xiàn)如果換成沒有約束的LQR控制器在初始位置離參考點(diǎn)很遠(yuǎn)時(shí)控制量會(huì)瞬間暴漲到遠(yuǎn)超執(zhí)行器上限的值。3.3 代碼背后的幾個(gè)坑求解失敗、不可行和數(shù)值病態(tài)跑上面的代碼時(shí)你可能會(huì)遇到幾個(gè)問題我先提前打個(gè)預(yù)防針。第一個(gè)坑是QP求解失敗。常見原因包括約束沖突比如兩個(gè)狀態(tài)約束互相擠兌、預(yù)測(cè)時(shí)域過大導(dǎo)致數(shù)值不穩(wěn)定、或者是初始狀態(tài)正好落在約束邊界上。排查思路是先把約束全部放寬一點(diǎn)看看問題是否可解然后逐步收緊找到瓶頸。第二個(gè)坑是代價(jià)函數(shù)權(quán)重差異過大。如果你把Q設(shè)成diag([1e10, 1e-10])優(yōu)化求解器精度的數(shù)值范圍遠(yuǎn)超合理區(qū)間很可能出現(xiàn)“明明每個(gè)變量都標(biāo)了0.1但優(yōu)化出來的軌跡卻震蕩得很厲害”這種病態(tài)問題。解決辦法是先做量綱歸一化再合理縮放權(quán)重。第三個(gè)坑是用真實(shí)系統(tǒng)模型和控制器模型不一致時(shí)的“模型失配”。仿真里我用同一個(gè)A和B模擬真實(shí)對(duì)象在現(xiàn)實(shí)中這是不可能的。建議測(cè)試時(shí)給真實(shí)模型加一點(diǎn)隨機(jī)擾動(dòng)或參數(shù)漂移再觀察MPC還能不能把系統(tǒng)穩(wěn)住。提示如果你第一次跑仿真發(fā)現(xiàn)控制量在觸達(dá)約束邊界時(shí)出現(xiàn)抖動(dòng)先別急著懷疑MPC的穩(wěn)定性很可能是QP求解器的收斂精度設(shè)置得太緊或太松。試試把OSQP的eps_abs和eps_rel調(diào)到1e-4左右通常能緩解這個(gè)問題。3.4 進(jìn)階非線性系統(tǒng)的線性時(shí)變MPC如果被控對(duì)象是非線性的比如倒立擺、四旋翼、車輛運(yùn)動(dòng)學(xué)模型直接用上面的線性MPC是行不通的。業(yè)界常用的手段是線性時(shí)變MPCLTV-MPC在每個(gè)采樣時(shí)刻把非線性模型在當(dāng)前狀態(tài)和輸入工作點(diǎn)附近做一階泰勒展開得到一個(gè)局部的線性模型然后基于這個(gè)局部模型求解MPC問題。舉例來說車輛運(yùn)動(dòng)學(xué)模型x v cos(theta) y v sin(theta) theta v / L tan(delta)其中(x,y)是車輛位置theta是航向角v是縱向速度delta是前輪轉(zhuǎn)角。在每一時(shí)刻把速度和航向角固定在當(dāng)前值對(duì)狀態(tài)做線性化就能得到隨時(shí)間變化的A和B矩陣。然后把之前代碼中的A和B替換成每個(gè)采樣周期重新計(jì)算的A_k和B_k其余流程不變。這種做法的計(jì)算量會(huì)大一些因?yàn)槊總€(gè)周期都要重新組裝約束矩陣但效果比單點(diǎn)線性化好得多尤其是在大范圍軌跡跟蹤場(chǎng)景中幾乎是指定動(dòng)作。4. MPC的關(guān)鍵參數(shù)調(diào)優(yōu)讓控制器“活”起來4.1 預(yù)測(cè)時(shí)域N短則激進(jìn)長(zhǎng)則遲鈍預(yù)測(cè)時(shí)域N是MPC里最有手感的超參數(shù)之一。當(dāng)你把N調(diào)得很短比如只有3步每步預(yù)測(cè)總的0.15秒MPC只能看到很近的未來它的行為會(huì)非常短視——為了盡快消除當(dāng)前誤差會(huì)猛加油門或猛打方向表現(xiàn)接近貪婪控制。當(dāng)你把N拉得很長(zhǎng)比如100步MPC看得遠(yuǎn)控制動(dòng)作會(huì)變得非常平滑但代價(jià)是計(jì)算量猛增而且太長(zhǎng)的預(yù)測(cè)時(shí)域會(huì)讓較遠(yuǎn)的預(yù)測(cè)軌跡跟實(shí)際跑出的軌跡產(chǎn)生巨大偏差優(yōu)化那些不可靠的遠(yuǎn)視野反而是浪費(fèi)算力。經(jīng)驗(yàn)法則先用階躍響應(yīng)或動(dòng)態(tài)仿真測(cè)出系統(tǒng)從初始狀態(tài)到穩(wěn)定狀態(tài)的大致上升時(shí)間然后把N * dt設(shè)為上升時(shí)間的1.5~3倍。比如系統(tǒng)上升時(shí)間約2秒采樣周期50ms那么N取60~120之間的值。當(dāng)然如果算力有限可以適當(dāng)調(diào)小N并以終端的權(quán)重來彌補(bǔ)遠(yuǎn)眺能力的缺失。4.2 代價(jià)權(quán)重Q和R從頻域正則化的視角理解Q和R的調(diào)參說到底是平衡“跟蹤精度”和“控制能量”之間的折中。這個(gè)折中不只是工程直覺的問題背后還有深刻的控制理論含義。從最優(yōu)控制的角度看Q和R通過代價(jià)函數(shù)定義了一個(gè)“性能度量”而MPC每次都是在當(dāng)前約束下最小化這個(gè)度量。R提高等價(jià)于在頻域上對(duì)高頻控制動(dòng)作施加懲罰等效于一個(gè)低通濾波器抑制了系統(tǒng)的高頻振蕩Q提高則等效于提高系統(tǒng)的閉環(huán)帶寬讓跟蹤誤差衰減得更快。所以我的調(diào)參策略是這樣的初值采用布里森法則歸一化量綱。先固定R把Q逐步增大到系統(tǒng)出現(xiàn)邊緣振蕩的位置記錄那個(gè)臨界Q值。然后固定Q把R從很小逐步增大直到控制量的高頻波動(dòng)幅度顯著下降同時(shí)關(guān)閉系統(tǒng)振蕩。最后微調(diào)比例關(guān)系仿真驗(yàn)證目標(biāo)是否滿足。每次調(diào)參后都要跑幾組不同幅值、不同初態(tài)的仿真防止“只對(duì)單個(gè)場(chǎng)景有效”的過擬合調(diào)參。4.3 約束的軟硬處理什么時(shí)候該軟化約束MPC的最大賣點(diǎn)是硬約束處理但硬約束也有副作用一旦約束太緊或者受擾動(dòng)影響出現(xiàn)不可行解整個(gè)優(yōu)化問題就直接失敗輕則控制器凍結(jié)重則系統(tǒng)失控。工程上常用的做法是“軟約束”。也就是在約束條件里加入松弛變量epsilon并修改代價(jià)函數(shù)為min J tracking_cost lambda * sum(epsilon) s.t. x_min - epsilon x x_max epsilon epsilon 0這樣當(dāng)約束滿足不了時(shí)求解器可以選擇輕微越界并付出懲罰而不是直接宣布無解。lambda的大小決定了“越界被容忍的程度”。軟約束在溫度控制、軌跡跟蹤中尤其常用——寧可讓溫度稍微超調(diào)0.5攝氏度也不要讓整條產(chǎn)線停機(jī)。4.4 采樣周期與實(shí)時(shí)性平衡MPC的實(shí)時(shí)性完全取決于求解一個(gè)QP問題的耗時(shí)。采樣周期設(shè)得太短控制器根本來不及算完下一幀指令就會(huì)產(chǎn)生執(zhí)行延遲設(shè)得太長(zhǎng)則控制的作用頻率太低動(dòng)態(tài)性能下降。理想情況是QP求解耗時(shí)占采樣周期的20%~40%留出足夠余量給傳感器讀取、狀態(tài)估計(jì)和控制輸出。如果求解耗時(shí)太長(zhǎng)可以嘗試以下手段縮短預(yù)測(cè)時(shí)域N、降低系統(tǒng)模型維度比如去掉快動(dòng)態(tài)模態(tài)、使用熱啟動(dòng)上一時(shí)刻的最優(yōu)解作為下一時(shí)刻的初始猜測(cè)、或者換用更快的求解器qpOASES在QP規(guī)模幾百個(gè)變量的情況下通常比OSQP快不少。5. 工程落地中的常見問題與調(diào)試技巧5.1 震蕩和發(fā)散從穩(wěn)定性角度排查MPC的穩(wěn)定性理論條件很嚴(yán)格工程實(shí)現(xiàn)中更容易因?yàn)閷?shí)現(xiàn)細(xì)節(jié)出岔子。最常見的震蕩來源有三個(gè)模型失配導(dǎo)致的預(yù)測(cè)偏差、采樣周期過長(zhǎng)導(dǎo)致的控制滯后、權(quán)重設(shè)置不當(dāng)導(dǎo)致的高頻激勵(lì)。排查方法建議先做“模型誤差模擬測(cè)試”在仿真中故意把真實(shí)對(duì)象的增益調(diào)成控制器模型增益的1.2倍看系統(tǒng)還穩(wěn)不穩(wěn)。如果1.2倍就發(fā)散說明你的MPC魯棒性太差大概率需要增加R權(quán)重或縮短預(yù)測(cè)時(shí)域。5.2 狀態(tài)估計(jì)的重要性MPC不能直接吃傳感器噪聲MPC的輸入是當(dāng)前狀態(tài)x(k)但傳感器直接測(cè)量的往往不是狀態(tài)而是帶噪聲的觀測(cè)信號(hào)。如果直接把原始測(cè)量值丟給MPC作為初始狀態(tài)噪聲會(huì)被控制器當(dāng)成真實(shí)擾動(dòng)導(dǎo)致控制序列劇烈波動(dòng)。工程上的標(biāo)準(zhǔn)做法是在MPC前面加一個(gè)狀態(tài)估計(jì)器最常用的是卡爾曼濾波器??柭鼮V波器通過系統(tǒng)模型和傳感器的雙通道信息給出一個(gè)對(duì)真實(shí)狀態(tài)的最優(yōu)估計(jì)值再把這個(gè)估計(jì)值作為MPC的輸入。這樣傳感器的高頻噪聲被極大抑制MPC才能發(fā)揮出原有的平滑控制優(yōu)勢(shì)。5.3 實(shí)際部署時(shí)的“熱啟動(dòng)”技巧在嵌入式平臺(tái)上跑MPC每一幀的求解時(shí)間要壓到極致熱啟動(dòng)是繞不開的優(yōu)化手段。所謂熱啟動(dòng)就是利用上一時(shí)刻解出來的最優(yōu)控制序列和狀態(tài)軌跡作為本次求解的初始點(diǎn)。對(duì)OSQP和qpOASES這類求解器而言給定一個(gè)接近最優(yōu)的初始點(diǎn)迭代收斂次數(shù)通??梢詼p少一半以上。我的代碼里雖然沒有顯式寫熱啟動(dòng)cvxpy會(huì)自動(dòng)做一部分但在裸寫OSQP接口時(shí)這個(gè)優(yōu)化是少不了的。另外你可以把上一幀的最優(yōu)解序列整體平移一步作為當(dāng)前幀的初始點(diǎn)——這比全部填零要高效得多。5.4 調(diào)試用的“黃金三件套”曲線調(diào)試MPC時(shí)我強(qiáng)烈建議你必看三條曲線參考軌跡和實(shí)際軌跡的對(duì)比、控制量變化曲線、每個(gè)時(shí)刻的關(guān)鍵約束余量比如離約束邊界的距離。如果軌跡跟蹤差先看參考軌跡是不是定得太激進(jìn)如果控制量抖成鋸齒先看R權(quán)重是不是太小如果約束余量長(zhǎng)期為零說明系統(tǒng)長(zhǎng)期貼著邊界跑這時(shí)候要警惕硬約束不可行的風(fēng)險(xiǎn)建議改成軟約束。還建議打印每個(gè)控制周期的QP求解狀態(tài)和求解耗時(shí)連續(xù)多個(gè)周期失敗就要立刻停機(jī)防護(hù)這是工程上的底線要求。6. 更進(jìn)一步的擴(kuò)展思路自適應(yīng)MPC、經(jīng)濟(jì)MPC與分布式MPCMPC并不只是“一個(gè)算法”它是一整個(gè)框架。當(dāng)你把基礎(chǔ)的線性MPC跑熟之后完全可以往下面幾個(gè)方向延伸。自適應(yīng)MPCAdaptive MPC是解決模型失配的進(jìn)階方案。它的做法是在線估計(jì)系統(tǒng)參數(shù)然后實(shí)時(shí)更新預(yù)測(cè)模型。比如車輛的質(zhì)量隨著乘員數(shù)量變化通過在線辨識(shí)質(zhì)量參數(shù)并更新B矩陣可以讓控制器在所有負(fù)載條件下都保持良好性能。經(jīng)濟(jì)MPCEconomic MPC是流程工業(yè)的熱門方向。它不再只關(guān)注設(shè)定點(diǎn)跟蹤而是直接優(yōu)化經(jīng)濟(jì)效益相關(guān)的目標(biāo)函數(shù)比如能耗最小、產(chǎn)量最大、溫室氣體排放最少。哲學(xué)上經(jīng)濟(jì)MPC把“控制”和“優(yōu)化”融為一體在保證安全約束的前提下讓系統(tǒng)直接運(yùn)行在最優(yōu)的經(jīng)濟(jì)工作點(diǎn)附近。分布式MPCDistributed MPC面向大規(guī)?;ヂ?lián)系統(tǒng)。比如多臺(tái)無人機(jī)協(xié)同編隊(duì)或者一個(gè)工廠里多臺(tái)反應(yīng)釜的聯(lián)動(dòng)控制如果每臺(tái)設(shè)備各自跑獨(dú)立的MPC它們之間的耦合效應(yīng)會(huì)導(dǎo)致整體性能下降分布式MPC通過交換彼此的未來軌跡信息實(shí)現(xiàn)局部自治全局協(xié)調(diào)是目前多智能體控制研究的熱門方向。7. 給初學(xué)者的幾點(diǎn)心法最后從個(gè)人經(jīng)驗(yàn)角度分享一些調(diào)試MPC的心法和習(xí)慣。心法一“先看約束后調(diào)權(quán)重”。很多人一上來就狂調(diào)Q和R卻忽略了約束邊界的合理設(shè)置。其實(shí)約束的可實(shí)現(xiàn)性決定了MPC的可行性如果約束本身定得太緊或互相沖突再好的權(quán)重也白搭。先把約束邊界用物理理解校準(zhǔn)再去調(diào)權(quán)重。心法二“從仿真到硬件逐步增加復(fù)雜度”。不要一上來就在真實(shí)設(shè)備上調(diào)試MPC先在Python仿真里把控制器參數(shù)調(diào)好再做硬件在環(huán)測(cè)試最后才上真機(jī)。真機(jī)上出問題時(shí)不要急著改算法先確認(rèn)狀態(tài)估計(jì)、執(zhí)行器標(biāo)定、通信延時(shí)就緒。心法三“記錄每一步的調(diào)試數(shù)據(jù)”。MPC的調(diào)試過程往往是非線性的哪個(gè)版本改了哪些權(quán)重、哪行代碼把這個(gè)約束從硬轉(zhuǎn)軟這些細(xì)節(jié)都是寶貴資產(chǎn)。我自己的習(xí)慣是給每個(gè)實(shí)驗(yàn)版本建一個(gè)日志文件記錄時(shí)間、參數(shù)文件、仿真結(jié)果、問題現(xiàn)象這樣三個(gè)月后再回頭調(diào)整參數(shù)時(shí)不至于對(duì)著一堆文件抓瞎。心法四“MPC不是萬能的但它依然值得掌握”。MPC的局限在于模型依賴和計(jì)算開銷有時(shí)一個(gè)調(diào)好的PID反而更簡(jiǎn)單可靠。但掌握了MPC你就擁有了一把能同時(shí)處理約束、多變量和非線性問題的通用鑰匙在復(fù)雜的控制場(chǎng)景里它帶來的結(jié)構(gòu)性優(yōu)勢(shì)往往是其他方法給不了的。這些經(jīng)驗(yàn)來自我在幾個(gè)實(shí)際項(xiàng)目中的反復(fù)摸索希望能幫你少走一些彎路。動(dòng)手跑一次MPC感受一下“預(yù)測(cè)—優(yōu)化—執(zhí)行—再預(yù)測(cè)”這個(gè)閉環(huán)的魅力你會(huì)對(duì)它有一個(gè)比看一百篇文章都更扎實(shí)的理解。
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
亚洲区在线| 六月婷婷日| 色婷婷丁香中文在线播放| www.99精品视频| 不卡的AV网站| 国产精品国产成人国产三级| 九九色综合九九色| 五月天婷婷綜合院| 亚洲小视频| 免费的日逼视频| 97久人人| 亚洲天堂色| 免费看欧美成人A片无码| 婷婷无码视频| 激情综合激情综合| 五月丁香六月婷婷开心网| 久久黄色免费视频| 久久这里只有精品视频26| 五月婷婷成人| 丁香五月Av| 91啪级电影| 激情黄色小说色五月| 超碰99成人在线| 亚洲爆乳无码精品AAA片蜜桃| 91人人操人人爱| 天天爽综合网| 五月涩涩网| 丁香 婷婷五月| 欧美日韩91| 久99久在线观看| 日本色色色| 大香蕉伊人99| 六月婷婷激情| 色欲AVV| 五月婷在线| 色五月婷婷大| 欧美婷婷五月激情| 婷婷五月丁香综合激情小说| 五月丁香久久综合| 大香蕉久久| 婷婷成人AV| 五月天小说激情| AA片在线观看视频在线播放| 香蕉AV777XXX色综合一区| 99精品视频网站| 五月婷婷欧美| 一区二区乱码视频| 九九自拍网| 9有码中文| 五月综合视频| 综合网网欲色| 五月色婷婷影视在线电影| 人妻中文在线| 五月婷婷影| 色综合天天天天做夜夜| 婷婷色五月情| 69色色视频| 99视频在线观看视频| 高清无码 一区 二区 三区| 开心婷婷五月天综合| 久久婷婷综| 九九人人看| 第1影院之五月婷婷| 超级碰 久久9| 婷婷性爱综合| 操碰久| 99狠狠| 国产成人va在线| 99爱爱| 六月婷欧美丁香综合| 日韩亚洲视频| 日韩视频女神99| 激情婷婷网| 婷婷色基地在线看 | 人妻内射视频| 色99网| 丁香五月婷婷影院| 人人摸人人| 激情美女五月天激情在线| 色婷婷五月婷婷五月婷婷五月| 激情婷婷丁香色情五月天| 国产精品噜噜在线视频| 在线A色| 亚洲天堂AAA| 色亚洲色宗合| 婷婷丁香一月| 久热播这里只有精品| 丁香五月狠狠综合欧美| 操一操插一插| 日本婷婷色日| 婷婷丁香花五月天| 夜夜操夜夜操| 日产精品久久久久久久蜜臀| 婷婷色色欧美综合网| www.99riav99| 91 九色 入口| 久久婷婷亚洲| 婷婷色五月天第7色| 干婷婷五月天| 99热99热| 五日激情综合| 91精品久久久久| 深爱五月激情五月| 亚洲日本韩国| 有码一区二区三区| 日韩黄色网络| 深爱激情中文五月天av| 天天色,天天操,天天射| 婷婷五点亚洲| 婷婷五月丁香欧洲| 色五月在线观看| 激情久久久| 国产熟妇的荡欲午夜视频| av在线播放网站| 狠狠色综合图片| 99热官网精品在线| 久操福利| 这里只精品| 五月丁花色综合网| 成人丁香| 5月丁香啪啪啪| 亚洲va综合va国产va中文| 亚洲乱码日产精品BD| 久久九九Com| 变态另类色图 | 五月婷婷六月天| 国产又粗又大又爽又黄| av不卡网站| av操B网站| 热久久色| 五月天激情国产综合婷婷婷就去爱| 十月丁香婷婷| 亚洲综合热| 五月丁香自拍| 拍真实国产伦偷精品| 婷婷五月天99综合网站| 十区AV| 99久久www| 91人妻色色网| 激情www.98com| 精品成人a v无码内射| 免费啪啪亚州视频| 日本欧美成人片AAAA| 色啪久| 99热欧美精品| 久久免费精品小视频| 五月色导航| 五月婷婷性| www.99婷婷| 在线播放成人网站| 9999热精品| 五月婷中文字幕| 99re久热只有精品6在线直播| 我要射综合| 久久这里只精品| 久久ab| 九九九激情综合| 天综合日日夜综合7799| 这里只有精品偷拍| 五月激情婷婷六月| 婷婷丁香色五月| 天天躁日日躁狠狠躁日日躁2022年5月9日 | 丁香五月婷婷婷婷欧美综合| 五月天激情视频五月天| 99热在线精品观看| 午夜AV网| 色情久久久| 婷婷丁香五月视频| 婷婷激情六月视频| 日本99视频| 色婷婷四虎| 91丨九色丨国产打屁股| 天堂草在线看www| 丁香五月播播| 好大好粗嗯啊-一级黄色大片免费观看-成人AV| 九九色婷婷| 天天撸夜夜爽| 久操人妻| 九九在线91| 伊人激情啪啪| 天天操夜夜爽歪歪| 六月丁香久久| 久re热视频| 五月丁香怕怕综合| 婷婷色综合av| 亚洲欧洲中文日韩久久AV乱码| 九月av在线| 丁香成人五月天| 六月天六月婷| 大香蕉久操| 老美AA片| 91玖玖| 天天干天天干天天干天天干天天干天天干天天 | 全网最新网黄大秀直播高清,主播国产录屏在线| 天天操综合网站| 另类天堂| 五月婷婷亚洲色图| 婷婷深爱五月天在线| 狠狠狠色激情综合适合| 国产真人做爰视频免费| 欧洲综合视频| www.色五月.com| 五月丁香啪啪网| 久激情| 日日色五月天| 激情久久综合| wwww.色婷婷| 色欲Av五月天| 久久与婷婷| 丁香五月婷婷综合啪啪| 久操b网| 婷婷五月天在线观看第二页| 九九av| 亚洲超级碰| 九九视频精品在线免费| 亚洲综合九九| 五月综合丁| 婷婷五月天少妇| 久久婷婷91| 久月久在线视频| 五月婷婷六月丁香| 成人在线视频一区| 97涩婷婷| 激情综合婷婷| 久久9视频| 六月婷婷九月丁香| 五区毛片七区毛片| 国产在线aaa片一区二区99| 欧美天堂久久| 人。妻久久| 成人免费120分钟啪啪| 色射影院| 五月天激情小说| 97色精品视频 | 噜噜色五月| 色色色五月婷| 久热99久热| 五月丁香婷婷综合激情基地| 六月丁香五月天| 婷婷爱五月| 激情五月无码| 人妻少妇色综合| 另类激情码| 激情网五月婷婷| 久久草大香蕉| 97人人超| 亚洲美女高潮久久久久久69| 色狠狠综合入口| 天天干天天爽天天操| 九九99精品| 精品亚洲国产成AV人片传媒 | 久综合4| 久久五月六月| 99精品在线观看| 亚洲在线视频321| 综合激情深爱| 无码日本精品XXXXXXXXX | 91九色国产| 色色色色色网| 婷婷中文综合网| 五月深爱婷婷| 色五月婷婷网| 五月伊人综合| 天天综合网在线| 精品亚洲日韩99欧美片| 丁香狠狠色婷婷久久无码视频| 亚洲精品久久久久久久久久飞鱼| 亚洲va日| 99热这| 欧美日本黄色| 狠狠色成人影片| 9l视频自拍九色9l黑人| 欧美婷婷五月天综合| 一区二区免费看| 加勒比久热| 涩五月丁香| 少妇大叫太大太粗太爽了A片| 色欲婷婷五月天| 天天弄天天操| 亚洲AV无码一区二| 亚洲精品永久久久久久| 中文字幕五月久久婷婷| 狠狠色综合精品视频在线| 欧美性爱丁香五月| 亚洲精品五月| 激情五月天婷婷播播久久综合91| 丁香网五月网| 九九成人电影婷婷| 久久99热精品a片在线观看| 丁香五月影院| 色综合爱综合| 风流少妇A片一区二区蜜桃| 丁香五月天激情五月天激情五月天激情网| 天天插天天射| WWW丁香五月| 婷婷五月激情小说| 天天做综合| 26uuu| 99re免费精品视频| 激情五月综合| 中文字幕永久在线| 激情五月激情综合网| 99在线观看| 五月丁香综合啪啪| 婷婷丁香69精华| 99久久综合| 欧美性爱五月天| 婷婷色婷婷| 超碰免费人人| 婷婷五月天小说| 五月色婷婷在线观看| 天天操综合网| 色播丁香五月婷婷操:屄| 五月天婷婷基地| 天天天操天天天爰| 亚洲亚洲人成综合网络| 亚洲九九99精品视频在线播放| 男女啪啪做爰高潮无遮挡| www.日韩艹| 天天碰夜夜操| 亚洲最大五月天成人网| 九 九九九AV| 免费观看欧美成人AA片爱我多深| 九月av在线| 五月天天天天天天天天天天天天天天天婷婷婷| 色五婷婷| 五月丁香黄色视频| 亚色网站小视频| 极品人妻VIDEOSSS人妻| 五月丁香婷婷伊人| 色yeye色综合| 97色在线观看视频| 69热在线| 精品一二三区久久AAA片| 五月www| 影音先锋91资源站| 久9久9久9久9久9久9| 99精品热| 日产精品久久久久久久蜜臀 | 日本激情91| 丁香婷婷十月| jiuse91在线| 五月天六月色| 久久停停超碰| 亚洲激情四射| 亚洲精品性色| 五月丁香偷拍| 91超碰人人操| 这里只精品| 操操操B| 亚洲人成人五月天| 激情五月色综合网| 婷婷99狠狠| 五月色婷婷综合色| 香蕉婷婷五月| 丁香色婷婷五月天| 久久婷婷色| 婷婷亚洲综合| AV天堂婷婷五月天| 激情亭亭五月| 在线观看中文字幕| 思思热在线精品视频网站| 五月天婷婷激情六月久久| 婷婷 色 丁香 夜| 翔田千里 50岁 无码| 综合色99| 五月婷婷这里都是精品| 激情综合另类| 91操熟女| 五月丁香综合久久| www亚洲无码| 色综合久久综合中文综合网| 五月天婷婷日日爱| 操逼亚洲天堂| 性生活视频98791| 五月丁香六月婷婷精品| 99热人人艹| 激情内射p| 26uuu精品一区二区| 天天插天天插| 五月天成人在线| 99热一本久道| 黄网免费看| 亚洲综合色网站| 天天干在线播放| 97色色视频| 91操操| 久久综合99综合| 五月婷婷香| 性爱网五月天| 国产精品成人AV在线观看春天| 天天檫天天爽| 任你擦免费视频| 人人干人人看| 婷婷五月天激情综合深爱激情| www久久艹| 天天干天天干天天干| 天天操夜夜爽| 五月天成人综合| 精品一二三区久久AAA片| 久久久久久久久人妻| 久草天堂| 丰滿爆乳一区二区三区| 97碰久久| 婷婷丁香亚洲五月天| 婷婷色偷拍| 婷婷狠狠操| 天天日天天日天天搞| 啪啪丁香五月| 日韩一本操| 天天爽天天爽| 色综合色综合色综合高潮| 丁香五月婷婷久久久| 色私五月婷婷| 九九九午夜影院成人| 婷婷国产欧美97| 99色色网| 五月丁香六月色| 天天激情综合| 久久婷婷五月激情综合| 久久97| 99久久精品视频女神1| 综合久久久| 国产精产国品一二三在观看| 9热视频在线观看| 五月婷婷在线视频免费观看| 亚洲热久| 内射人妻视频国内| 亚洲啪啪网| 丁香婷婷五月天色播| 婷婷丁香五月激情密臀av| 99色热| 精a品a| 婷婷五月小说色综合| 色亭亭丁香五月天| 免费精品99| www夜夜操wwwcon| 九九热欧美| 伊人九热| 五月婷婷六月激情| 久久免费精彩视频| 思思色综合网站| www.jiujiujiu| 人人摸人人操人人爱| 婷婷五月六月| 精品综合久久久久久五月天| 曰曰久久| 99热免费18| 色欲久久综合| 天天色天天| 南京搡BBBB搡BBBB| 久久久WWW| 在线一起草av| 亚洲视频在线观看| 色欲婷婷五月天| 婷婷五月天美女视频| 久久狠狠欧美| 99久久五月丁香野外| 免费看欧美成人A片无码| 91人人操人人| 真实亲子乱子伦高清在线观看| 亚洲99激情| 婷婷丁香亚洲色综合91| 91久女| 久久伊人五月天| 第四色婷婷丁香五月| 丁香婷婷综合五月天| 婷婷九月综合| 超碰京东热av男人的天堂| 202丰满熟女妇大| 99热这里都是精品| 久久久久人妻精选| 国内婷婷丁香社区在线播放| 超碰女人天堂| 欧美亚洲成人在线| 热久久999| 九九aV| 日本五月天网站| 五月丁香狠狠地噜噜噜噜| 99,色| 4438成人电影| 蜜乳AV成人| 成人综合网站| 99热综合网| 日熟女| 天天色天天色天天色天天色天天色| 国产综合视频婷婷| 蜜桃婷婷狠狠久久综合| 性爱激情综合网| 99久久网站| 日韩精品999| 天天婷婷| 婷婷五月骚厕所| 综合逼五月激情婷婷| 婷婷色播婷婷| 丁香五月天.com| 91人妻九色大屁股| 风流少妇A片一区二区蜜桃 | 五月 成人 婷婷| 色色草97| 黄网在线免费| 五月天偷拍| 色啪综合| 激情人妻综合| 五月婷婷亚洲色视频| 丁香五月色情| 激情五月天开心网丁香无码| 99视频色在线观看| 婷婷五月天av| 亚洲综合婷婷五月| 五月停停色| 98热精品| 最新婷婷五月丁香| 五月天福利影院导航| 婷婷伊人| 五月天偷拍| 超碰在线人妻| 五月丁香大相交| 狠狠高潮精品亚洲1| 婷婷五月精品中文字幕| 99热只有精品在线观看| 91碰超| 色婷婷色综合| 99亚洲精品综合在线 | 色五月色情| 婷婷五月激情欧美大胆视频| 日本无码专区| 亚洲精品国产A久久久久久| 91久久久久久久| 色综合色色色| 久久综合五月| 五月丁香婷婷六月| 国产成人99久久亚洲综合精品| 色婷另类| 丁香五月婷婷av| 能看的av| 日本婷婷色日| 亚洲五月天婷婷| 五月第四色| 五月丁香婷爱在线| 99亚洲日韩| 婷婷爱五月天人人爱| 激情婷婷五月天在线观看| 人人色AV| 五月婷婷免费| 五月婷婷乱| 六月丁香五月婷婷首页| www.主妇. com| 日本妈妈乱| 久久久久久欧美精品se一二三四| 91丨九色丨东北熟女| 丁香六月婷婷开心| 99热婷婷| 丁香五月网站| eeuus五月婷| xxxx五月| 色婷婷丁香五月在线| 丁香五月成人论坛| 超碰AAAAAAV| 色婷婷五月综合在线| 色五月丁香一区在线| 天干干夜夜操| 五月欧美色色五月| 色噜噜狠狠狠综合曰曰曰| 五月婷婷欧美激情| 五月丁香啪啪伦理电影| 五月丁香六月婷婷在线播放| 五月激情婷婷开心| 日日日天天干| 欧美婷婷五月天| 丁香五月天狠狠| 综合99视频| 色五月av| 黄色片区子| 99久久婷婷国产综合精品草原| 亚洲色99| h在线看免费版在线看| 国产精品久久久久久久久久免费| 丁香,开心成人,久久| 色婷婷狠狠禁18久久| 午夜]香婷婷深深爱| 岛国资源站| 91性人人| 五月婷婷色播| 91欧美| 人人操Av| 丁香五月激情月| 26uuu亚洲欧美| 五月天涩涩| 深爱婷婷丁香五月激情| 人人草人人看| 激情五月天视频| 激情综合五月天| 精品一二三区久久AAA片| 婷婷99狠狠躁天天久久久九九九| 黄色av高清| 色色影院黄大片| 五月丁香激情综合啪啪| 91操碰| ...婷婷国产成人亚洲日韩| 婷婷五月天亚洲激情戏精品| 99在线精品视频免费观看20| 国产午夜一区二区三区| 天天操加勒比| 久热伊人| 黃色三级三级三级三级 qixing300.shrkbk.com www.jinbozs.com tianmiaosw.com | 九九爱激情| 婷婷爱五月| 丁香激情久久| 九九精品热| 免费色婷婷| 亚州操逼网| 色婷婷基地| 99热精品一区| 五月天.com| 九九色综合网| 97色婷| 色婷丁香91| 大香蕉九九操| 久久精彩综合视频| 婷婷操逼网| 日日操夜夜骑| 欧美日韩99| 免费无码毛片一区二区A片| 大鸡巴伊人网| 色色五月天网站| 激情婷婷内射| 亚城区在线| 五月丁香啪啪综合| 日本乱子人伦在线视频| 婷婷久久色| 亚洲精品电影| 九九久久综合网站| 大香蕉久久婷婷| 99综合| 国产性av| 日本人人干| 久久这里只有精彩| 丁香婷婷伊人| 亚洲欧洲国产精品| 少妇人妻丰满做爰XXX| 五月丁香婷婷伊人日韩| 久久免费9| 婷婷色系婷色| 六月丁丁香| 超碰在线看| 国内久久婷婷| 任你艹| 99热这里只有精品2024| 九热视频在线精品15| 五月婷婷激情| 九九精品热播| 五月天无码视屏播放| www.婷婷.com| 五月综合色| 久久久久视剧HD| 伊人久久婷婷| 精品51XX| 成人丁香五月| 久久探花91swag| 婷婷五月丁香久久| 午夜婷婷五月天在线| 9久热在线视频精品| 99在线精品免费视频| 五月深情久久| 人人草公开操| 播四月婷婷六月丁香| 六月色婷婷| 激情五月婷婷色色| 激情五月天婷婷久久久久久久久久久| 亚洲va欧美va天堂v国产综合| 这里只有精品视频| 99伊人婷婷在线| wuyuedingxiang99| 九九热在线精品视频| www.狠狠| 99日精品视频| 五月婷丁香在线视频在线| 丁香久月| 综合色色五月| 日本91在线| 99热这里只有的精品视| 色婷婷婷婷| 伊人成综合五月婷婷| Av狠狠色丁香婷| 岛国av网站| 无码人妻AV久久久一区二区三区 | 婷婷五月成人| 五月婷婷激情久久| 成人在线日韩| 婷婷成人AV| 亚洲女婷婷五月基地综合久久久| 热久久91| 热婷婷av| 五月丁香六月婷婷综合免| 99精品久久久久| 久久艹 五月天| 九九色婷婷| 久久人妻久久| 色色激情五月天| 日本操片| 丁香九月婷婷色| 天天干天天爽| 干一干xxxx| 五月丁香六月婷婷亚洲| www五月| www91精品| 久久机只有这里精品| 婷婷综合网站| 色五月综合97| 色婷婷五月网| 五月婷婷丁香五月| caopeng97人人| 亚洲婷婷丁香五月视频| 婷婷丁香人妻天天爽| 丁香五月激情月| 五月婷婷干| 天天天天天天操| 超级碰碰碰碰视频| 久久机热这里只有精品| 亚洲综合色网| 99久久99九九99九九九| 操一操干一干| 亚洲九N| 天天日天天做天天舔| 五月天婷婷在线观看| 野战J办公桌椅H| 欧美激情综合| 丁香五月综合激情性爱| 九色综合五月天婷五月| 激情综合五月激情| WWW.99热| 91se在线观看| 天天婷婷色六月| 国产精品久久久久久喷浆| 97久久超碰| 婷婷内射视频在线| 一区二区三区四区牛| 五月丁香六月婷婷a v| AAA久久| 婷婷涩五月| 噜噜吧天天爱| 狠狠色噜噜狠狠狠狠狠色综合久久| 九九热视频网站| av九九| 激情五月天啪啪| 激情www| 久久久婷丁香五月| 五月激情视频网| 99久热| 91青娱乐青青草| 丁香五月婷老师| 丁香五月婷婷激情97| 亚洲精品乱码久久久久99| 99性视频| 久色网址| 成人综合AV| 美腿丝袜AV天堂网| 天天干天干| 亚洲一二三网| 国产精品视频久久99| 97在线观看| 天天草天天爱| 在线播放成人网站| 国产人妻操逼| 亚欧州精品视频| 日本精品九九九| 五月婷婷啪啪啪啪| 老师高潮流白浆喷水的A片| 色99视| 狠狠爱综合| 色亚洲无码| 久久女婷| 日韩性视频| AA久久| 91九色中文字幕女在线观看| 精品人妻伦一二三区久久| 天天草天天舔| 成人在线不卡| 色爽九九| 99色在线观看视频| 大伊香蕉玖玖爱| www.色色色色| 九九色中文| 丁香五月婷婷综合网| 色婷婷成人色网| 亚洲性色XXXXX| 五月天婷久久| 色情久久久| 这里只有精品96| www.日日夜夜| 久久久天堂国产精品女人| 亚洲看av的网站| 欧美搡BBBBB摔BBBBB| 婷婷五月在线综合| 婷婷丁香六月天| 五月天激情播播网| 色婷婷视频| 亚洲视频色色| 中字幕视频在线永久在线观看免费| 婷婷六月爽| 疯狂做受XXXX高潮A片动画| 66久久视频在线| 成人做爰A片免费看网站找不到了 噼里啪啦在线观看免费完整版视频 | 日韩在线观看亚洲| 日本爆乳片手机在线播放| 久9精品| 五月天激情小说| 黑人熟妇一区二区三区| www.久久爱.com| 欧美色99| 噜噜噜狠狠色综合| 色优久久| 99久久久久| 99成人精品六| 高清资源站日A美A欧亚…| 色色婷婷综合网| 日操夜操天天操不卡| 五月天综合影院| 婷五月天| 五月丁香婷婷视频| 9l视频自拍9l九色9l成人| 91婷婷在线| 婷婷丁香五月亚洲欧美| 色综合色综合色综合色综合| 日本三级片片| 欧美成人日韩| 五月婷婷久久久| 夜夜躁爽日日| 婷婷丁香五月视频| 激情人妻蜜夜系列区| 天天日天天操天天干| WWW.五月com| 婷婷五月丁香六月| av在线免费网站| 天天搡日日搡aaaaⅩ| 国产亚洲99久久精品| 亚洲色啪| 插插五月天| 久久99免费视频网站| 噜噜狠狠色| 成人av在线网站| 婷婷爱五月天| 婷婷综合激情五月中文字幕| 综合六月久久| 激情综合五月婷婷六月丁香| 成人在线视频一区| 九九九九综合| 综合在线网| 九九色婷婷五月天| 五月天婷婷影院影院观看| 五月丁香激情综合啪啪| 老司机伊人| 色综合色综合色综合高潮| 午夜无码熟熟妇丰满人妻 | 婷婷丁香在线| 丁香网站| 夜夜爽天操| 97色操| www99热| 久久色五月天| 日本操B视频| 婷婷亚洲欧美丁香五月| 综合99视频| 六月丁香五月天| wwccc久久久| 国产色色色色色| 99热99久久| 婷婷第六色| 久99婷婷色综合| 夜夜谢天天干| 久久婷婷精品| 极品人妻VIDEOSSS人妻| 五月丁香六月婷婷久久| 99热主页日本| 五月综合激情婷婷六月色窝| 国产成人+亚洲+欧洲| 大香蕉婷婷丁香| 天天做天天爱天天爽| 婷婷之六月丁香| 亚洲Av成人在线观看| 激情综合亚洲| 五月丁香六月婷婷免费视频| 《丁香激情综合久久伊人久久》影视在线观看 -高清预告手机免费播放 -三妹影院 | 天堂久久精品| 99国产精品白浆在线观看免费| 久久久精品色| 超碰人人艹| 亚洲成人在线在线| 婷婷99狠狠| 日日天天天| 婷婷狠狠青青| 婷婷五月丁香综合| 午夜性爱影视一区77| 冬月かえでAV无码播放| AAA久久| 亚州视频九九99| 99色久| 狠狠丁香| 天天撸夜夜爽| 五月婷婷色色网址| 天天玩夜夜操| 五月婷婷丁香色播网| 99热播放| 亚洲春色奇米影视| 色婷婷狠| 人妻熟妇六区| 成人版视频在线观看| 国产全是老熟女太爽了| 五月天啪啪啪| 五月伊人综合| 丁香五月97视频| 中文av网站| 国产色99| 99re热在线视频| 91丁香色| 丁香六月久久| 九九热这里只有国产精品| 91综合在线视频| 性做久久久久久久免费看| 99re8在这里只有精品| 五月丁香激情片| 香蕉五月婷婷| 精品久久人妻| 婷婷五月天激情诱惑| www久久久| 五月刺激丁香月综合| 色播婷婷五月天| 互月天综合| 亚洲精品视频电影| 丰满老熟妇BBBBB搡BBB| 五月婷婷激情日本| sewuyue第四色| 欧美日韩成人在线网| 蜜桃成语时李时珍 免费| 五月婷婷丁香俺日污视频| 激情无码五月天| 天堂久久大香蕉| 99久在线精品99re8热| 丁香六月欧美| 婷婷免费成人视频| 婷婷丁香社区| 国外亚洲成AV人片在线观看| 五月丁香六月激情在线| 五月天 综合 在线| 狠狠色色综合| 国产婷伊人| 超碰在线成人| 色五月婷婷激情| 色色综合色视频| 五月花激情网| 99操| 综合性爱网| 黄色99网| 99热最新| 丁香六月欧美| 无码成人AAAAA毛片AI换脸| 人人妻人人澡| 开心五月激情婷婷| 久久色五月| 91精品人妻少妇无码影院| 欧美日韩成卜| 五月丁香人妻| 婷婷五月丁香五月综合网| 丁香五月婷婷成人综合| 国产免费一区二区三区三州老师F1F1.CC| 不卡在线超碰| 伊人久久大香线蕉av最新| 天天摸天天日天天舔| 五月天国产成人| 色噜久| 99热爆在线| 五月丁香网站| 久热黄色| 蜜桃五月天| 人人人人人人人人人草| 五月丁香六月婷婷啪啪| 1024人妻无码中文字幕| www超碰| 色射影院| 丁香五月Av| 热这里| 91Chinese在线| 操婷婷基地| 久久精品一区二区三区四区| 成人AV免费观看| 亚洲五月花| 天天干天天干天天干天天干天天干天天 | 99色热视频| 色99热| 天干天天干天天天天天| 五月婷婷综合网| 色五月欧美| 成人视频免费观看高清完整版在线观看| 人人爱操| 九九热免费视频| 这里只有精彩视| 五月丁香婷婷色色色| AV大片在线观看| 99视频在线观看地址| 狠狠插狠狠操| 久久综合影院| 亚洲天码视频www蛋播视频| 色婷婷综合中心| 五月丁香美女视频| 色播播婷婷| 丁香五月天社区婷婷| 成人做爰黄A片免费看直播室男男 A片试看120分钟做受图片 | 99在线视频播放| 激情文学五月丁香六月婷婷| 涩五月丁香| 欧美色色色色色色色色色色影视| 啪啪激情综合| 东京热免费视频网站| 五月丁香久久激情综合| 青草视频在线播放| 99热日本| 伊人99热| 99在线视频播放| 99乱视频| 性生活久久人妻| 97深爱伊人综合| 色噜噜狠狠色综合伊人| 色婷婷导航| 91久久九久久九久久九久久九久久| 色色综合五月| 99久久婷婷国产综合精品电影| 大香蕉手机视频| 91操人| 我爱大香蕉| 九九热re99re6在线精品| 思思久久精品| 色噜噜狠狠插综合| 色欲资源网| 色青青视频| 九月婷婷综合八月丁香在线观看| 久99热| 国产熟女一区二区三区五月婷| 天天se在线视频| 丁香婷婷午夜| 精品9l九九九九九77777| 99热 精品在线| 欧美搡BBBBB摔BBBBB| 色婷婷基地| 婷婷五月天网| 丁香成人五月天| 97丁香婷婷| 97在线精品视频| 五月丁香色婷婷久久| 婷婷狠狠18禁久久| 九九99一区| 丁香五月综合网亚洲综合欧美狠狠 | 激情五月天天狠狠久久| 丁香六月欧美| 婷婷五月天免费视频| 亚洲经典小视频| AV国产有码| 五月天伊人日日噜影片AV| 管管補管管紱| 五月丁香六月婷婷在线小说视频| 夜夜骑日日操| 婷婷五月激情的图片| 99黄色性生活| 亚洲人妻av| 欧美色99| www.婷婷六月天| 超碰com| 激情六月婷婷| 色五月天丁香婷婷| 亚洲一区国产传媒| 日韩在线视频中文字幕| 8区视频在线| 天天色播| 五月丁香六月久久| 伊人大香五月天| 99在线视频免费| 五月人人丁香婷婷五月人人丁香| 夜夜天天久久婷婷| 久久伊人日日夜夜| 五月综合婷婷久久在线| 日韩人妻操逼视频| 丁香五月欧美激情| 五月色天情| 激情综合网五月激情| 这里只有精品在线视频在线观看| 99爱免费视频| jiqingliuyuetian| 成人色五婷婷| www.狠狠操| 欧美精品99| 激情婷婷丁香五月天| 激情九月婷婷| 亚洲热视频在线| 婷婷五月天激情网| 国产成人精品一区二区三区视频 | 九月色婷婷婷| 亚洲在线成人| 操大屄五月天视频| 久久月天堂| 综合五月丁香97| 欧美毛卡| AV动漫不卡无码免费| 久久狼人天堂| 激情综合网五月在线播放| 六月亚洲婷婷6月中文字幕| 六月五月丁香五月欧美| 高清无码 一区 二区 三区| 日日干干天天干| 热99热9| 华人在线免费| 久久精品性爱| 五月婷婷偷拍| 色婷婷www| 六月天婷婷| 91丁香综合| 五月久久丁香| 九色在线观看91av| 任你日视频| 性韩日色婷婷五月天激情啪啪XXX| 色七色九九| 欧美熟女乱又伦| 常久最新免费的色吊丝| 五月丁香六月激情视频| 久久狼人天堂| 色婷婷小说| 97色色色| 丰满少妇猛烈A片免费看观看 | 精品99在线| 色一情一乱一乱一区91Av| 老司机午夜福利视频金瓶梅| 天天做天天双| 天天擼久久擼在线| 六月丁香综合| 97精品在线| 天天日天天爽| 久久人妻少妇嫩草AV| 色婷婷丁香AV综合| 26uuu偷拍亚洲欧洲综合| 91九色在线| 人人舔人人色人人高潮| 99热精地址| A久久| www色色色com| A片试看50分钟做受视频| 丁香五月天堂亚洲社区| 97亚洲婷婷| 色狠狠综合| www.色婷婷。com| 久久久久久久合一狠狠做深爱| 真实亲子乱子伦高清在线观看| 色综合久久综合中文综合网| 99精品网| 亚洲丁香婷婷| 丁香婷婷色色| 激情五月深爱五月| 丁香五月天天高清在线| www.9797国产| 五月丁香亭亭| www.金莲av| 婷婷五月天中文字幕| 激情五月天婷婷直播| 五月丁香婷中文字幕| 99热这里只有在线| 五月天丁香综合| 亚洲精品字幕在线观看| 五月丁香激情综合网官网| 久久9999| 五月天婷五月天综合网小说首页-五月天激激婷婷大综合,婷婷亚洲综合五月天小说 | 婷婷色5月激情网| 任你爽精品免费视频6| 日韩操人| 五月丁香啪啪网| 丁香五月婷婷激情四射深爱激情| 婷婷色一二三区波多野结衣| 丁香婷婷基地| 欧美黑人巨大猛烈cuckold| 婷婷色色婷婷| 丁香色色网| 密着浓厚中出乚交尾GvG935| aV欲望人妻中文字幕| 99碰碰| 丁香婷婷五色月| 天天综合久久| 婷色五月天| 操日本色| 99热99ai| www.五月天社区| 97中文在线| 香蕉久久国产AV一区二区 | 九九这里有精品| 日本三级第一页| 久久在这里99| 六月婷婷色五月| 99精品在线观看视频| 丁香五月天婷婷激情| 久久婷婷五月综合网| 五月丁香六月成人| 婷婷五月激情片| 天天射影院| 极品少妇XXXX精品少妇偷拍| 五月丁香五月丁香五月丁香五月丁香91| 婷婷五月天AV网| 99热亚洲精品66| 日韩AAAAA| 丁香五月综合网| 色婷婷操逼| 蜜臀嫩草| 色999五月色| av在线婷婷| 99热91| 五月丁香六月激情啪| 另类天堂| 天天视频精品9| 欧美日韩成人在线| 涩五月色婷婷| 婷婷狠狠干| 91n啪啪| 一起草无码视频| 色婷婷激情五月天| 色99在线观看| 黄色AAAAAAA| 婷婷99狠狠躁天天躁| 五月天色婷婷网| 色婷婷综合网| 亚洲 欧洲 国产 伦综合| 九热在线这里有精品6| 狠狠色五月天| 91妻人人爽人人看片| 51成人| 成人性爱精品视频| 亚洲无码99| 久久sp免费视频| 狠狠另类视频| 影音先锋一区| 欧美97超碰| 丁香五月婷婷六月婷婷| 色婷婷久久综合久色综| 中文字幕网伦射乱中文| 九九99热| 五月丁香六月婷综合成人综合| 人人爱国产| 九一牛视频探花| 婷婷五月天激情在线观看| 123草逼网| 碰碰人人人| 久久久色婷婷五月天| 欧美五月丁香| 亚洲精品久久久久久久久久吃药| 婷婷射图| 深爱激情网五月天| 亚洲操操操| 墨西哥毛片内射精| 丁香八月综合激情| 亚洲av免费在线| 97干资源在线观看| 啪啪婷婷五月天激情| 超碰成人在线观看| 久久日本wwww色| 五月激情综合婷婷| 草一草avb| 亚洲成人综合网在线免费观看| 五月婷婷就去色| 91欧美| 丁香激情五月少妇| 五月天在线视频尤物视频在线看| www.超碰在线|