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

ARTICLE DETAIL

資訊詳情

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

貝塞爾曲線原理與Matlab實(shí)現(xiàn):路徑規(guī)劃平滑軌跡實(shí)戰(zhàn)指南

貝塞爾曲線原理與Matlab實(shí)現(xiàn):路徑規(guī)劃平滑軌跡實(shí)戰(zhàn)指南 搞機(jī)器人路徑規(guī)劃的人大概率都有過(guò)這種經(jīng)歷全局規(guī)劃給出一條直線折線車走到拐點(diǎn)的時(shí)候不是急停就是急轉(zhuǎn)看著都心疼。更麻煩的是把軌跡交給運(yùn)動(dòng)控制器時(shí)速度和加速度在這里直接斷掉不加平滑根本跑不起來(lái)。我最早接觸貝塞爾曲線就是為了解決這類問(wèn)題。后來(lái)在避障小車、機(jī)械臂軌跡、噴涂路徑規(guī)劃這些場(chǎng)景里貝塞爾曲線幾乎成了默認(rèn)的平滑方案。這篇文章把貝塞爾曲線的原理、Matlab實(shí)現(xiàn)、路徑規(guī)劃里的實(shí)際應(yīng)用一次性講透代碼直接給可跑通版本。適合剛接觸路徑規(guī)劃的初學(xué)者也適合想快速在Matlab里出結(jié)果的工程師。1. 貝塞爾曲線的數(shù)學(xué)本質(zhì)與圖形直覺(jué)1.1 從一根橡皮筋說(shuō)起什么是貝塞爾曲線如果只給一個(gè)控制點(diǎn)貝塞爾曲線就是那個(gè)點(diǎn)本身。給兩個(gè)控制點(diǎn)它就是一條直線段。麻煩的是三個(gè)及以上的控制點(diǎn)這時(shí)候曲線怎么走你可以在心里想象一塊木板上釘了幾顆釘子然后把一根橡皮筋繞過(guò)這些釘子。橡皮筋不會(huì)緊貼每顆釘子而是被它們共同“拉”著形成一個(gè)光滑的弧線。貝塞爾曲線就是這根橡皮筋的數(shù)學(xué)表達(dá)。它最反直覺(jué)的地方在于除了第一個(gè)和最后一個(gè)控制點(diǎn)曲線上絕大多數(shù)點(diǎn)都不經(jīng)過(guò)中間控制點(diǎn)。中間控制點(diǎn)只是“吸引”曲線向自己的方向彎曲距離越近吸引越強(qiáng)。這跟很多初學(xué)者想的“用曲線把點(diǎn)連起來(lái)”完全不是一回事但恰恰是這個(gè)特性讓貝塞爾曲線在路徑平滑中特別有用——你不需要讓軌跡精確穿過(guò)每一個(gè)“想法點(diǎn)”只需要讓軌跡被這些點(diǎn)引導(dǎo)就能得到一條安全、平滑、可執(zhí)行的路徑。貝塞爾曲線的數(shù)學(xué)定義是用Bernstein基函數(shù)對(duì)控制點(diǎn)做加權(quán)平均階數(shù)等于控制點(diǎn)數(shù)量減一。如果有n1個(gè)控制點(diǎn)曲線方程長(zhǎng)這樣P(u) Σ (i0到n) B(i,n)(u) * P(i)u ∈ [0,1]其中B(i,n)(u) C(n,i) * u^i * (1-u)^(n-i)C(n,i)是組合數(shù)。這個(gè)式子看著唬人但拆開(kāi)看就是一個(gè)加權(quán)平均的推廣每個(gè)控制點(diǎn)乘以一個(gè)權(quán)重所有權(quán)重加起來(lái)恒等于1。u從0走到1的過(guò)程中權(quán)重分配不斷變化曲線就從起點(diǎn)平滑移動(dòng)到終點(diǎn)。1.2 德卡斯特里奧幾何構(gòu)造法公式歸公式真要直觀理解貝塞爾曲線的形狀變化我推薦德卡斯特里奧算法。這個(gè)算法把曲線生成變成了一組反復(fù)的線性插值手工都能算。以三個(gè)控制點(diǎn)P0、P1、P2為例生成一條二次貝塞爾曲線。先取參數(shù)u在線段P0-P1上按比例u找點(diǎn)A滿足A (1-u)P0 uP1在線段P1-P2上同樣找點(diǎn)B滿足B (1-u)P1 uP2。然后把A和B再按比例u連一次得到點(diǎn)C (1-u)A uB。讓u從0到1遍歷一遍點(diǎn)C的軌跡就是二次貝塞爾曲線。三個(gè)控制點(diǎn)做兩次線性插值四個(gè)控制點(diǎn)就做三次線性插值n1個(gè)控制點(diǎn)做n輪插值。這就是德卡斯特里奧算法的核心重復(fù)線性插值直到只剩一個(gè)點(diǎn)。這個(gè)算法最大的價(jià)值在于它的數(shù)值穩(wěn)定性。直接按Bernstein基函數(shù)公式計(jì)算當(dāng)階數(shù)比較高時(shí)u^i和(1-u)^(n-i)的數(shù)值可能過(guò)大或過(guò)小組合數(shù)也可能非常大計(jì)算機(jī)算起來(lái)容易丟精度。德卡斯特里奧算法只涉及乘法和加法避免了組合數(shù)的大數(shù)計(jì)算在工程里更穩(wěn)。我在教學(xué)和項(xiàng)目調(diào)試?yán)锪?xí)慣先用德卡斯特里奧算法的思路推導(dǎo)再用Bernstein公式做向量化實(shí)現(xiàn)這樣既理解幾何意義又拿到運(yùn)行效率。1.3 貝塞爾曲線的幾個(gè)手算樣例直接看一個(gè)具體例子。假設(shè)控制點(diǎn)P0(0,0)P1(2,4)P2(4,0)求這條二次貝塞爾曲線在u0.5處的點(diǎn)。第一步A 0.5P0 0.5P1 (1,2)。第二步B 0.5P1 0.5P2 (3,2)。第三步C 0.5A 0.5B (2,2)。所以曲線上u0.5處的點(diǎn)是(2,2)正好是拋物線頂點(diǎn)。這個(gè)結(jié)果也能從公式驗(yàn)證二次貝塞爾曲線公式展開(kāi)后是P(u) (1-u)2P0 2u(1-u)P1 u2P2帶u0.5進(jìn)去得到0.25P0 0.5P1 0.25P2 (2,2)。兩條路結(jié)果一致。這種手算的價(jià)值在于建立直覺(jué)參數(shù)u是比例的概念不是時(shí)間的概念。曲線上的點(diǎn)始終是對(duì)控制點(diǎn)的調(diào)和平均權(quán)重由當(dāng)前u決定。后面講路徑規(guī)劃中速度控制的時(shí)候這個(gè)區(qū)別會(huì)非常重要。2. 貝塞爾曲線在路徑規(guī)劃中的工程價(jià)值2.1 為什么不用折線和普通多項(xiàng)式擬合路徑規(guī)劃里最樸素的方案是折線連接。機(jī)器人先走到A點(diǎn)再走到B點(diǎn)再走到C點(diǎn)。缺點(diǎn)很明顯每個(gè)轉(zhuǎn)折點(diǎn)處方向突變?nèi)绻麢C(jī)器人是差速底盤這里必須減速到接近零再轉(zhuǎn)向效率極低如果是機(jī)械臂這里會(huì)帶來(lái)加速度沖擊機(jī)構(gòu)振動(dòng)大、壽命縮短。那用高次多項(xiàng)式擬合呢比如讓曲線精確經(jīng)過(guò)所有路徑點(diǎn)。問(wèn)題更麻煩。高次多項(xiàng)式對(duì)單個(gè)點(diǎn)的擾動(dòng)極其敏感一個(gè)噪聲點(diǎn)就能讓曲線在遠(yuǎn)離該點(diǎn)的地方劇烈振蕩這就是所謂的Runge現(xiàn)象??刂泣c(diǎn)數(shù)量一多多項(xiàng)式階數(shù)水漲船高曲線形態(tài)基本不可控。貝塞爾曲線恰好在這兩者之間找到了平衡。它的階數(shù)雖然也是由控制點(diǎn)數(shù)量決定但曲線的形狀被凸包性質(zhì)緊緊約束住不會(huì)像高次多項(xiàng)式那樣失控。對(duì)于路徑規(guī)劃這種“我需要一條光滑且不會(huì)跑偏太遠(yuǎn)的曲線”的需求貝塞爾曲線是非常自然的候選。2.2 貝塞爾曲線的四個(gè)關(guān)鍵幾何性質(zhì)端點(diǎn)插值性。曲線的起點(diǎn)一定在第一個(gè)控制點(diǎn)P0上終點(diǎn)一定在最后一個(gè)控制點(diǎn)Pn上。這意味著路徑規(guī)劃的起止位置約束可以直接通過(guò)第一個(gè)和最后一個(gè)控制點(diǎn)精確滿足非常方便。端點(diǎn)切線方向。曲線在起點(diǎn)的切線方向由P0指向P1在終點(diǎn)的切線方向由P(n-1)指向Pn。這個(gè)性質(zhì)在泊車路徑規(guī)劃里是寶貝因?yàn)椴窜噷?duì)起點(diǎn)和終點(diǎn)的航向角有嚴(yán)格要求。只要控制點(diǎn)選在車輛朝向的延長(zhǎng)線上曲線出入方向就完全可控。凸包性。整條曲線完全落在所有控制點(diǎn)構(gòu)成的凸包內(nèi)。這個(gè)性質(zhì)在避障里極其重要只要把控制點(diǎn)選在障礙物之外曲線就絕對(duì)不可能穿過(guò)障礙物內(nèi)部。對(duì)于動(dòng)態(tài)避障小車規(guī)劃時(shí)只需要檢查凸包是否與障礙物碰撞計(jì)算量遠(yuǎn)小于逐點(diǎn)檢查。變差縮減性。曲線與任意直線的交點(diǎn)數(shù)量不超過(guò)控制點(diǎn)折線與該直線的交點(diǎn)數(shù)量。翻譯成人話就是曲線比控制點(diǎn)折線更“平穩(wěn)”不會(huì)出現(xiàn)比控制點(diǎn)更劇烈的擺動(dòng)。這個(gè)性質(zhì)讓貝塞爾曲線天然適合生成平滑軌跡不會(huì)自己“抽風(fēng)”。2.3 一個(gè)容易忽略的問(wèn)題參數(shù)速度不等于實(shí)際速度這是貝塞爾曲線在實(shí)際工程中最容易踩的坑。參數(shù)u從0均勻增長(zhǎng)到1對(duì)應(yīng)的曲線點(diǎn)并不是勻速運(yùn)動(dòng)的。因?yàn)榍€上點(diǎn)的實(shí)際運(yùn)動(dòng)速度是|dP/du| * (du/dt)而|dP/du|在曲線不同位置不恒定即使u是線性變化的實(shí)際速度也在改變。舉個(gè)例子四個(gè)控制點(diǎn)(0,0)、(0,10)、(10,10)、(10,0)構(gòu)成的三次貝塞爾曲線u從0到0.5時(shí)走過(guò)的弧長(zhǎng)和u從0.5到1時(shí)走過(guò)的弧長(zhǎng)并不相等。在噴涂路徑規(guī)劃里如果直接把u當(dāng)作時(shí)間噴槍在工件表面移動(dòng)速度就不均勻涂層厚度會(huì)忽厚忽薄在焊接里會(huì)導(dǎo)致焊縫質(zhì)量不一致。解決方案是對(duì)曲線做弧長(zhǎng)參數(shù)化先把曲線按弧長(zhǎng)離散采樣再建立弧長(zhǎng)s到參數(shù)u的映射關(guān)系最后按期望速度控制s的變化。細(xì)節(jié)我放到第4章講這里先記住結(jié)論u均勻不等于速度均勻涉及運(yùn)動(dòng)控制時(shí)必須顯式處理弧長(zhǎng)與速度的關(guān)系。3. Matlab實(shí)現(xiàn)與路徑規(guī)劃實(shí)戰(zhàn)3.1 核心函數(shù)基于Bernstein的向量化實(shí)現(xiàn)Matlab適合向量化編程。直接用for循環(huán)遍歷每個(gè)采樣點(diǎn)算基函數(shù)寫法直觀但效率差采樣點(diǎn)一多就慢。這里給出一個(gè)向量化實(shí)現(xiàn)核心是利用linspace生成u向量再用矩陣運(yùn)算同時(shí)計(jì)算所有采樣點(diǎn)。function curve bezier_curve(P, res) % 生成貝塞爾曲線 % 輸入: % P - 控制點(diǎn)矩陣大小為(n1) x dim每行一個(gè)控制點(diǎn) % res - 采樣點(diǎn)數(shù)即曲線上生成多少個(gè)點(diǎn) % 輸出: % curve - res x dim 的密集曲線點(diǎn)集 n size(P, 1) - 1; dim size(P, 2); u linspace(0, 1, res); curve zeros(res, dim); for i 0:n % Bernstein基函數(shù)向量化計(jì)算 coeff nchoosek(n, i) .* (u.^i) .* ((1 - u).^(n - i)); % 每個(gè)控制點(diǎn)按權(quán)重疊加 curve curve coeff * P(i 1, :); end endnchoosek(n, i)計(jì)算組合數(shù)。u是res×1的列向量u.^i得到每個(gè)采樣點(diǎn)的u冪次(1-u).^(n-i)得到另一部分兩者逐元素相乘后再乘以組合數(shù)得到res×1的權(quán)重向量。coeff * P(i1,:)是res×1乘1×dim的矩陣乘法結(jié)果是res×dim等價(jià)于把每個(gè)點(diǎn)都平移到控制點(diǎn)的位置并按權(quán)重縮放。實(shí)測(cè)下來(lái)100個(gè)控制點(diǎn)、5000個(gè)采樣點(diǎn)的情況下這個(gè)函數(shù)在普通筆記本上十幾毫秒跑完夠?qū)崟r(shí)使用的。如果控制點(diǎn)特別多可以用德卡斯特里奧算法的遞推實(shí)現(xiàn)避免組合數(shù)溢出但一般路徑規(guī)劃控制點(diǎn)不會(huì)超過(guò)十幾個(gè)這個(gè)版本夠用。3.2 完整示例小車平滑繞障路徑生成假設(shè)一臺(tái)小車要從起點(diǎn)(0,0)走到終點(diǎn)(10,0)中間遇到一個(gè)障礙物需要繞過(guò)去。傳統(tǒng)做法規(guī)劃出折線路徑(0,0)-(3,1)-(7,1)-(10,0)。轉(zhuǎn)折點(diǎn)處方向突變直接跟蹤很難受。用貝塞爾曲線把這條折線平滑一下% 控制點(diǎn): 起點(diǎn)、兩個(gè)繞障點(diǎn)、終點(diǎn) P [0, 0; 3, 1; 7, 1; 10, 0]; % 采樣生成曲線 res 200; curve bezier_curve(P, res); % 繪圖對(duì)比 figure; plot(P(:,1), P(:,2), k--o, LineWidth, 1.5); hold on; plot(curve(:,1), curve(:,2), b-, LineWidth, 2.5); legend(控制點(diǎn)折線, 貝塞爾曲線, Location, southeast); title(四控制點(diǎn)Bezier曲線路徑平滑); axis equal; grid on;跑完之后你會(huì)看到曲線從(0,0)出發(fā)平滑繞過(guò)中間兩個(gè)控制點(diǎn)附近最后精確落在(10,0)上。中間兩個(gè)控制點(diǎn)像磁極一樣把曲線“吸”過(guò)去但曲線并沒(méi)有真正觸碰到它們。這個(gè)例子里最核心的認(rèn)知是把路徑規(guī)劃的折點(diǎn)直接當(dāng)作控制點(diǎn)使用不一定能得到理想曲線。想讓曲線更貼近或更遠(yuǎn)離折線需要主動(dòng)調(diào)整控制點(diǎn)位置。工程上一般會(huì)從折線頂點(diǎn)沿角平分線方向偏移一定距離偏移量決定曲線的“切彎”程度。這個(gè)調(diào)參思路在第4章展開(kāi)。3.3 動(dòng)態(tài)避障場(chǎng)景的貝塞爾生成思路動(dòng)態(tài)避障小車的局部路徑規(guī)劃里貝塞爾曲線也能派上大用場(chǎng)。思路是在每個(gè)控制周期內(nèi)根據(jù)當(dāng)前車輛位置、目標(biāo)路徑上的前瞻點(diǎn)、障礙物位置動(dòng)態(tài)生成一組貝塞爾控制點(diǎn)實(shí)時(shí)計(jì)算局部避障軌跡。具體做法當(dāng)前車輛位置作為P0車輛航向方向前方1米處作為P1保證軌跡起點(diǎn)方向與當(dāng)前航向一致。目標(biāo)路徑上的一個(gè)前瞻點(diǎn)作為P3保證軌跡終點(diǎn)方向符合全局路徑趨勢(shì)。P2放在障礙物外側(cè)的安全距離上讓曲線被“推開(kāi)”遠(yuǎn)離障礙物。用三次貝塞爾曲線生成局部軌跡取未來(lái)1-2秒的點(diǎn)作為參考軌跡。每個(gè)控制周期都重新計(jì)算一遍控制點(diǎn)避障結(jié)束之后P2逐步回歸到方向線上曲線自然恢復(fù)為直線。這里面有個(gè)工程細(xì)節(jié)P2偏移方向要和障礙物位置實(shí)時(shí)聯(lián)動(dòng)。最簡(jiǎn)單的方法是把P2的坐標(biāo)寫成障礙物相對(duì)位置函數(shù)比如P2 目標(biāo)方向中點(diǎn) k * 障礙物單位方向向量k是距離系數(shù)。碰撞風(fēng)險(xiǎn)大就增大k風(fēng)險(xiǎn)小就減小k。這樣避障的“幅度”就有了連續(xù)性不會(huì)一幀猛拐、下一幀猛回。我在實(shí)測(cè)小車時(shí)用頻率是20Hz每次生成50個(gè)采樣點(diǎn)整體計(jì)算開(kāi)銷可以忽略不計(jì)。貝塞爾在這里最大的優(yōu)勢(shì)是計(jì)算輕、實(shí)時(shí)性強(qiáng)對(duì)嵌入式平臺(tái)很友好。4. 參數(shù)調(diào)優(yōu)與曲線質(zhì)量檢查4.1 控制點(diǎn)布局這五個(gè)經(jīng)驗(yàn)直接抄貝塞爾曲線能不能用得好90%靠控制點(diǎn)布局。這里整理幾條實(shí)際項(xiàng)目里反復(fù)驗(yàn)證過(guò)的經(jīng)驗(yàn)第一控制點(diǎn)數(shù)量寧少勿多。很多人習(xí)慣把路徑上的所有關(guān)鍵點(diǎn)都塞進(jìn)去當(dāng)控制點(diǎn)結(jié)果控制點(diǎn)多、階數(shù)高曲線開(kāi)始在個(gè)別區(qū)域扭曲調(diào)整一個(gè)點(diǎn)會(huì)波及整條曲線。路徑規(guī)劃里我用得最多的是三次貝塞爾即四個(gè)控制點(diǎn)一個(gè)起點(diǎn)、一個(gè)終點(diǎn)、兩個(gè)中間控制點(diǎn)大多數(shù)平滑需求都能滿足。點(diǎn)再多也建議拆成多段低階曲線而不是一段高階曲線。第二控制點(diǎn)間距和方向要符合直覺(jué)。曲線在起點(diǎn)處的方向完全由P0指向P1決定所以P1的方向決定了出口角度。想讓車頭朝向不發(fā)生突變P1必須選在車輛當(dāng)前朝向的延長(zhǎng)線上且與P0的距離應(yīng)根據(jù)期望的“入彎速度”來(lái)定距離太短曲線會(huì)拐得很急距離太長(zhǎng)曲線會(huì)偏離預(yù)期路徑很遠(yuǎn)。第三對(duì)稱性是釋放控制點(diǎn)位置的捷徑。對(duì)于繞障這種對(duì)稱場(chǎng)景讓P2和P3中間控制點(diǎn)關(guān)于中軸線對(duì)稱布置曲線對(duì)稱且沒(méi)有詭異扭轉(zhuǎn)。對(duì)稱結(jié)構(gòu)出問(wèn)題的概率遠(yuǎn)小于非對(duì)稱布局。第四請(qǐng)把凸包可視化出來(lái)。控制點(diǎn)設(shè)好之后先用fill函數(shù)把控制點(diǎn)凸包畫出來(lái)再看凸包是否與障礙物重疊。如果凸包已經(jīng)碰到障礙物無(wú)論怎么微調(diào)曲線都沒(méi)用因?yàn)榍€保證落在凸包內(nèi)正確做法是調(diào)整控制點(diǎn)讓凸包離開(kāi)障礙物而不是在那里面試圖用“曲線細(xì)節(jié)”去找安全空間。第五曲線末端方向不能忘。終點(diǎn)的切線方向由P(n-1)指向Pn需要確保這個(gè)方向與后續(xù)路徑銜接方向一致否則即使位置連續(xù)方向不連續(xù)也會(huì)導(dǎo)致機(jī)器人到終點(diǎn)時(shí)突然轉(zhuǎn)向。泊車場(chǎng)景尤其敏感后面專門講。4.2 曲率檢查與最差點(diǎn)處理路徑規(guī)劃出來(lái)之后一個(gè)常規(guī)檢查項(xiàng)是曲線的最大曲率因?yàn)榍手苯訉?duì)應(yīng)轉(zhuǎn)向半徑而轉(zhuǎn)向半徑受底盤機(jī)械結(jié)構(gòu)限制。差速小車最小轉(zhuǎn)彎半徑可能很小但阿克曼底盤或麥克納姆輪底盤有明確限制。用離散點(diǎn)近似計(jì)算曲率的方法很簡(jiǎn)單function k curvature(curve) x curve(:,1); y curve(:,2); dx gradient(x); dy gradient(y); ddx gradient(dx); ddy gradient(dy); k abs(ddx .* dy - dx .* ddy) ./ (dx.^2 dy.^2).^1.5; end然后找最大曲率位置k curvature(curve); [max_k, idx] max(k); % 最大曲率點(diǎn)對(duì)應(yīng)的曲線位置 worst_point curve(idx, :);如果最大曲率超出底盤限制優(yōu)先調(diào)整離該點(diǎn)最近的控制點(diǎn)把那個(gè)控制點(diǎn)往外“拉”增大局部彎曲半徑。用手拖動(dòng)一個(gè)控制點(diǎn)并重新運(yùn)行檢查觀察最大曲率的變化這樣反復(fù)幾次就有手感了。另外離散求導(dǎo)對(duì)噪聲敏感密集采樣后如果曲率曲線毛刺明顯可以先對(duì)curve用smoothdata做一次平滑再做曲率計(jì)算。曲率分段不連續(xù)反而說(shuō)明曲線拼接點(diǎn)可能有連續(xù)性缺陷這是分段貝塞爾時(shí)需要重點(diǎn)檢查的項(xiàng)目。4.3 Matlab常見(jiàn)報(bào)錯(cuò)與排查筆記矩陣維度不匹配。這是初學(xué)者最常見(jiàn)的錯(cuò)。P寫成一行多列而不是多行兩列。報(bào)錯(cuò)通常出現(xiàn)在coeff * P(i1,:)這一句如果P是1×n的向量P(i1,:)取到的是單個(gè)標(biāo)量coeff是res×1的列向量?jī)烧邿o(wú)法直接相乘。解決辦法是用size函數(shù)顯式檢查P維度確保P是(n1)×2的矩陣。nchoosek數(shù)值溢出??刂泣c(diǎn)數(shù)量在20以上時(shí)nchoosek(20,10)已經(jīng)是18萬(wàn)多再高階一些會(huì)變得巨大甚至超過(guò)double類型的精確表示范圍。路徑規(guī)劃控制點(diǎn)數(shù)在10個(gè)以上就應(yīng)該警惕解決辦法是改用德卡斯特里奧遞推算法或者把曲線拆成多段三次貝塞爾。曲線“穿墻”。很多人的第一反應(yīng)是我控制點(diǎn)明明沒(méi)靠近障礙物為什么曲線還是穿過(guò)障礙物回到凸包性質(zhì)控制點(diǎn)沒(méi)靠近障礙物但控制點(diǎn)連成的凸包可能覆蓋了障礙物區(qū)域。畫出凸包把凸包往外推曲線自然外移。曲線起點(diǎn)不貼合當(dāng)前位置。檢查你是否把第一個(gè)控制點(diǎn)精確設(shè)置為起點(diǎn)還是隨手填了個(gè)大概值。貝塞爾曲線精確穿過(guò)P0如果P0偏了起點(diǎn)就偏了。這在接管全局路徑時(shí)經(jīng)常發(fā)生車輛實(shí)際位置和路徑起點(diǎn)之間相差幾厘米導(dǎo)致起始段需要緊急修正。典型報(bào)錯(cuò)原因排查手段Matrix dimensions must agree控制點(diǎn)矩陣維度錯(cuò)誤size(P)應(yīng)輸出[n1, 2]曲線起點(diǎn)偏移P0坐標(biāo)未設(shè)置精確打印P(1,:)與真實(shí)起點(diǎn)對(duì)比曲線詭異扭曲控制點(diǎn)數(shù)量過(guò)多/階數(shù)過(guò)高拆成多段三次貝塞爾再拼接最大曲率超限中間控制點(diǎn)過(guò)于接近折角沿角平分線外移控制點(diǎn)5. 進(jìn)階方向多段貝塞爾拼接與工程延伸5.1 多段貝塞爾曲線的C1連續(xù)拼接單段貝塞爾曲線控制點(diǎn)一多局部調(diào)整變得困難現(xiàn)實(shí)中更常用多段三次貝塞爾拼接成一條長(zhǎng)軌跡。拼接最關(guān)鍵的是連續(xù)性。兩段三次貝塞爾曲線第一段控制點(diǎn)是A0、A1、A2、A3第二段控制點(diǎn)是B0、B1、B2、B3。要保證位置連續(xù)B0必須等于A3也就是第二段起點(diǎn)就是第一段終點(diǎn)。要保證切線方向連續(xù)A3和B1必須位于A2延長(zhǎng)線上且滿足B1 - A3 A3 - A2或者寫成 B1 2*A3 - A2。這個(gè)條件的幾何意義是第二段的第一個(gè)控制點(diǎn)B1是第一段倒數(shù)第二個(gè)控制點(diǎn)A2關(guān)于公共點(diǎn)A3的鏡像。這樣拼接點(diǎn)處的切線方向一致曲線看起來(lái)是一根光滑的線而不是折線。如果需要更平滑的曲率連續(xù)C2條件更苛刻一般推薦直接用B樣條或NURBS而不是強(qiáng)行拼貝塞爾。絕大多數(shù)移動(dòng)機(jī)器人路徑規(guī)劃到C1就夠了因?yàn)檐囕v運(yùn)動(dòng)學(xué)能容忍方向連續(xù)曲率跳變則可以通過(guò)速度規(guī)劃里的加速度限制來(lái)處理。5.2 泊車路徑和噴涂路徑里的貝塞爾應(yīng)用泊車路徑規(guī)劃對(duì)這個(gè)“C1連續(xù)”的需求特別突出。車輛從停車位駛出或者倒車入庫(kù)起點(diǎn)和終點(diǎn)都有明確的位姿約束。用分段貝塞爾做泊車路徑的思路是把整個(gè)倒車過(guò)程拆成幾段每段用三次貝塞爾段與段之間滿足C1連續(xù)。起點(diǎn)段的P1設(shè)置在車輛當(dāng)前航向延長(zhǎng)線上終點(diǎn)段的倒數(shù)第二個(gè)控制點(diǎn)設(shè)置在目標(biāo)車位朝向的反延長(zhǎng)線上。這樣車輛從出發(fā)到停車全過(guò)程航向角都是連續(xù)的不會(huì)出現(xiàn)在車位門口突然調(diào)頭的滑稽場(chǎng)面。噴涂路徑規(guī)劃的貝塞爾用法稍有不同。噴槍走的是覆蓋折返路徑在每個(gè)折返點(diǎn)需要平滑過(guò)渡。直接用貝塞爾在折返拐角處生成一個(gè)平滑的“U形”過(guò)渡段可以避免噴槍在角點(diǎn)處減速過(guò)度。過(guò)渡段的形狀直接影響噴涂均勻性所以必須結(jié)合前面講的弧長(zhǎng)參數(shù)化來(lái)設(shè)計(jì)速度曲線保證噴槍在過(guò)渡段和直線段的速度盡可能接近。把貝塞爾當(dāng)“拐角圓角器”用而不是把所有軌跡都替換掉是最省力的思路。5.3 什么時(shí)候該換B樣條或NURBS在寫這篇文章之前我需要誠(chéng)實(shí)說(shuō)一句貝塞爾不是萬(wàn)能的。當(dāng)你遇到以下場(chǎng)景認(rèn)真考慮換B樣條軌跡有幾十個(gè)甚至上百個(gè)需要精確經(jīng)過(guò)的位置點(diǎn)而你又不想把它們變成控制點(diǎn)。B樣條可以做到曲線不經(jīng)過(guò)控制點(diǎn)也能逼近形狀且支持局部修改改一個(gè)點(diǎn)不影響整條曲線。需要曲率連續(xù)的復(fù)雜路徑。三次B樣條天然支持C2連續(xù)拼接起來(lái)比多段貝塞爾省心得多。需要精確控制曲線對(duì)控制點(diǎn)折線的逼近程度。NURBS通過(guò)權(quán)因子可以調(diào)節(jié)“吸引力”大小貝塞爾做不到。不過(guò)B樣條和NURBS的代價(jià)是參數(shù)更多、實(shí)現(xiàn)更復(fù)雜、調(diào)參門檻更高。如果你的場(chǎng)景是“路徑點(diǎn)不多、平滑要求適中、計(jì)算平臺(tái)有限”用分段三次貝塞爾的性價(jià)比遠(yuǎn)高于上B樣條。我自己的經(jīng)驗(yàn)是80%的路徑規(guī)劃平滑需求四控制點(diǎn)三次貝塞爾就能解決剩下20%再考慮B樣條。從最簡(jiǎn)單的一段三次貝塞爾繞障到分段拼接長(zhǎng)軌跡再到配合速度規(guī)劃解決執(zhí)行問(wèn)題這條技術(shù)路線的每一步都不復(fù)雜但環(huán)環(huán)相扣。我在實(shí)際項(xiàng)目里最深的體會(huì)是貝塞爾曲線真正的門檻不在數(shù)學(xué)而在你有沒(méi)有把控制點(diǎn)當(dāng)成“力的方向”而不是“路徑的終點(diǎn)”來(lái)理解。搞明白這一點(diǎn)很多調(diào)參困惑都會(huì)迎刃而解。
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
伊人激情综合| 操碰色一区就去操| 中文字幕无码人妻少妇免费视频 | 99九九中文字幕视频| 九九九九成人| 五月婷色| 午夜激情五月天| 99久在线精品99re8热| 天堂网啪啪| WWW.婷婷五月天.COM| 欧美色色色| 成人在线不卡| 毛片新网地| 色五月激情网| 亚洲性色XXXXX| 久综合4| 五月婷婷香蕉视频| 五月色色激情网| 五月天大香蕉视频| 亚洲无码另类| 天天激情| 婷婷五月天久久久| 伊人喵咪a V| 婷婷丁香五月天狠狠| 无码少妇高潮喷水A片免费 | 99婷婷五月天激情| 国产精品大香蕉| 婷婷激情人妻| 97操视频| 亚洲亚洲人成综合网络| 丁香五月激情月| 综合激情啪啪| 色色三级视频| 玖玖午夜视频| www.狠狠操.com| 爱操天堂| 99热这里只有精品1025| 婷婷五月丁香久久| 综合色播| 免费超碰在线| 99色丁香婷婷综合网| 五月天婷婷丁香| 九九aV| 91男人资源站| 色色婷婷综合| 婷婷五月天影院| 另类在线| 碰久久精品w| 先锋资源91| 激情综合女人网五月播播| 国产成人精品一区二区三区视频| 久久金品黃色| 噜色精品| 久久久99视频| 免费观看日韩成人av| 五月天播播| 婷婷伊人综合中文字幕| 综合久久狠狠| 色狠狠综合| 丁香六月天婷婷开心综合| 综合久久五月| 亭亭玉月丁香| 天天肏天天肏天天肏| 香蕉婷婷色五月| 婷婷丁香六月天| 天堂网啪啪| 色欲操| 另类亚洲电影| 99年操人人爽| 能看的AV| 日本色天堂| 久久无码激情视频| 天天婬色综合| 成人精品在线| 激情综合色播| 五月综合激情图片 | 福利视频在线播放| 91操人| 日本成人噜噜噜噜噜| 天堂色色色| 第九色区av天堂| 五月婷婷婷丁香播| 中国激情网| 婷婷五月综合激情| 97操| 蒲京久久无码视频| 午夜性做爰电影| 日熟女| 能看的AV网站| 久草五月婷婷| www久久艹| 万月丁香狠狠爱| 欧美久热| 99re免费精品视频| 成人综合视频在线| 色色色色综合| 久草xx性爱视频| 丁香五月婷婷99| 色五月激情网| 五月色婷婷综合| 日韩色色视频| 婷婷五月天亚洲| 五月丁香AV、伊人业余、性色熟妇| 综合激情五月婷婷| 另类激情码| 国产精品久久久久久喷浆| 99热国产精品| 久久三级视频| 碰超99| 婷婷五月天在线一区| 天天日狠狠| 亚洲高清在线| 国产成人网站在线观看| 亚洲人人操| 日本三级日本黄色| 五月丁香狠狠爱婷婷综合| 婷婷久草| 日韩免费视频| 极品人妻VIDEOSSS人妻| 国产黄大片在线观看画质优化| 久久伊人大香蕉| 青青草成人网| 亚洲经典小视频| sewuyue第四色| 亚洲五月丁香综合网| 超碰在线9| 啪啪东京热| 美女久久婷婷| 久热一区| Www.久久| 99热99天堂| 伊人久久大香| 五月天婷婷情色| 五月天婷婷久草丁香| AV在线免费观看不卡| 久久东京热婷婷五月| 精品久久久人妻| 美女激情婷婷| 色播激情五月天| www.狠狠艹| 久久婷婷五月天蜜桃| 五月丁香婷爱在线| 婷婷激情丁香六月| 欧美VA在线观看| 婷婷五月丁香久久| 五月丁香六月婷婷成人电影| 色九月婷婷综合| 六月婷婷啪啪| 五月婷婷欧美| 风流少妇A片一区二区蜜桃 | 日本九九九九| 五月婷婷在线视频免费观看| 婷婷五月天改成什么了| 婷婷五月天亚洲精品| 天天情天天狠天天透| 亚洲综合色色| 欧美天天干五月丁香| 五月色丁香综合| 思思色播| 激情婷婷五月亚洲| 激情五月少妇| www.99热视频| 成人中文网| 伊人大综合| 超级碰碰一区| 99热99天堂| 97五月综合网| 国产99美少妇| av操一操| www激情| 91超碰在线观看| 婷婷丁香六月天| 中文字幕丰满孑伦无码专区| AⅤ网站在线看| 99精品网址| 丁香五月最新网址| 婷婷欧美偷拍综合| 午夜五月天| 丁香五月网址| 五月天婷婷狂暴白浆| 人人97操| 欧美亚洲999| 五月丁香激情婷婷综合| 激情久久五月天| 婷婷五月天网| 9999热在线观看| 六月丁香久久| 久久五月婷天天干| 色5月婷婷| 亚洲狠狠色丁香婷婷综合久久| 婷婷婷五月香蕉| 色蜜婷婷| 婷婷中文字幕版| 婷婷五月丁香六月综合网| 久久3p| 天堂成人A片永久免费网站| 丁香五月天91| 天天天天天天天干| 欧美久久网| 开心激情婷婷| 亚洲99综合| 亚洲色婷婷99一9|| 综合色99| 人人97操| 人人干AV| 五月天色图| 一区二区乱视频码| 日日鲁鲁夜夜爽爽| 玖玖热视频| 日比视频91| 天天操B| 色婷婷五月网| 五月丁香成人网| 亚洲情欲久久| 2025天天爽天天摸| 久热这里只有精品6| 麻豆忘忧草午夜| 人妻激情综合| 天天久综合| 成人AV在线网站| 91综合视频丁香| 一区二区aV电影免费看| 1995年关宝慧版蜘蛛女| 99久.| 色激情网| 欧洲高清免费久久| 国产精品色情AAAAA片软件| 国产免费AV在线| 四色五月婷婷在线观看| 极品人妻VIDEOSSS人妻| 新久久五月天激情| 色色吧综合| 9 大屁股在线视频精品| 色五月丁香五月婷婷五月成人网| 色色欧美。| 色性综合| 六月色色| 五月婷久久| 99热这里只有精品2| 色婷婷导航| 新男人天堂人妻| 天天粽合合合合| 久久久18| 色热久| 五月情婷婷| AA片在线观看视频在线播放| 激情综合网激情五月婷婷| 综合色播| 欧美成人va| 九九综合色综合| 激情五月婷婷五月丁香五月开心五月| 毛片九九九九九九九九18| 91操色| 欧美久久婷婷| 热久久91| 五月天激情久久| 91午夜婷婷狠狠久久综合9色| 丁香五月婷婷狠狠色| 色综合99| 9有码中文| 色五月av| 五月婷啪啪| 五月亭亭开心网| 久久机热探花| 久大香蕉| 99热99干| 亚洲色网址| 色婷婷综合成人| 日本在线va| 久久五月天丁香| 亚洲 五月 婷婷 成人| 老美AA片| 韩国三级五月天婷婷。| 六月激情网| 丁香婷婷成人网站| 五月丁香综缴情性爱| 操一操| 91女人18毛片水多国产| 在线综合网| 久久一级片| 天天搞天天爽| 婷婷97碰碰| 五月亭亭开心网| 婷婷色吧| 97碰人人操| 在线网黄| 五月天激情小说网| 天天天摸夜夜夜玩| 玖色色综合| 五月丁香六月婷婷操操操| 婷婷丁香五月社区亚洲| 色丁香影院| 亚洲av另类在线观看| 激情五月图| 97人人干| 99热官网精品在线| 亚洲视频二区| 色婷婷六月| 99视频这里只有久久精品| 九九99九九精品免费| 婷婷九月丁香久久| 五月天另类图片区99| 五月丁香久久网| 久久五月视频| 在线综合网| 色欲五月天| 婷婷五月天涩涩| 丰满人妻一区二区三区| 99精品视频免费在线播放| 91精品激情9| 激情五月天激情五月天| 国产婷婷色五月| 午夜69成人做爰视频| 狠狠激情五月天| 少妇婷婷五月天| 另类图片天天影视在线观看| 精品少妇蜜臀91| 色噜噜五月丁香婷婷| 久久婷婷五月天| 狠狠干2007| 亚洲天堂制| 区美毛片子| 成年AAAA色情| 五月婷婷综合性爱噜噜| 色一情一乱一乱一区91Av| 不卡影院午夜理论片| 99re热在线观看| 四色永久成人网站| 99无码视频| 伊人影音无码一区二区三区| 最新无毒无码AV| 在线综合网| 99色视频| 人妻视频一区而且二区| 婷香五月激情视频| 亚洲无码色色| 日日操夜夜操狠狠操| 男同色五月开心五月激情五月| 性色五月天| 丁香五月婷婷啪| 91啦丨九色丨刺激中文| 99热精品在线在线| 啪色综合| 激情婷婷五月天日本系列| www99精品| 婷婷丁香五月综合网| 99精品在线| 久久杏爱视频| 无码区婷婷五月花开| www.激情| 玖玖无码中文| 九九这里有精品| 欧洲亚洲免费视频区| 色婷婷色丁香色欲av| 婷婷伊人网| www.婷婷五月| 中文字幕久久一区二区三区| 亚洲激情丁香五月天色| 天天射天天干天插色综合| 色婷婷五月天av在线| 大香蕉伊人99| 五月天 无码| 日本丁香五月婷婷| 色婷婷久久综| 久久五月婷婷视频| 国外亚洲成AV人片在线观看| 久久婷婷成人综合色怡春院| 91se在线观看| 色五月首页| 九九色精品| 国产色香蕉精品五夜婷| 婷婷五月丁香青青草在线| 久久五月天综合| 九九热精品视频| 久久成人精品视频| 襙逼网| 五月开心婷婷网| 国产精品 的国产| 久久大大香| 中文字幕,综合,91| 亚洲成人在线五月天| 无码毛片992367| www激情| 黑人无码一区| av免费在线网站| 大香蕉视频99| 青草视频在线观看视频| 久久婷婷伊人| 久久98| 操91| 久草五月天| 人人妻人人澡| 久久丝袜婷婷| 色色色网站| 人妻操在线看| 久热这里只有精品视频6| 五月天婷婷色五月天| 日熟女| 东北黄色一级| 踪合专区啪啪| 丁香五月激情五月| 久久久免费图片视频| 99ER热精品视频| 92久久精品一区二区| 开心五月婷婷激情| 99久久极情精品一区| 99re视频在线播放| 超碰在线人妻| 99视频精品在线| 激情视频网址| 亚洲天天操| 99热这里只有精品2| 九色PORNY9l原创自拍| 婷婷五月天伊人| 99视频只有精品| 天天爱天天吃狠天天透| 亚洲天堂啪啪| 97人人射| 97婷婷色| 国产成人网| 99思思| 久久精品人妻| 超碰在线caop| 色婷婷91激情小说| 丁香久久激情俄| 91精品视频男人的天堂| 激情婷婷久久| 97成人丁香婷婷| 夜夜涩涩涩| 五月人妻婷婷| 丁香婷婷久久综合在线| 噜噜狠狠色| 婷婷在线视频| 尔尔AV一区| 久9热| 五月日韩中文字幕| 第1影院之五月婷婷| 啪啪东京热| 婷婷激情在线| 色婷婷成人在线| 日本成人小说婷婷六月| www.色五月天.com| 99精品福利视频| 人妻aV在线| 国产精品VA在线| 99久久大片| 亚洲人妻Av| 26uuu精品国产| 精品一二三区久久AAA片| 成人超碰网| 熟女国产在线一区二区三区四区| 久久人人九| 天天插天天插天天操| 婷婷激情区| 六月综合婷婷开心伊人| 日韩aaaaa| 大香蕉伊人丁香五月| 欧美婷婷综合网| 色情丁香五月婷婷精品| 国产淫熟妇| 亚洲99在线| 五月丁香综合激情| 狠狠五月天婷婷激情网。| 日韩色五月| 天天日天天舔| 99只有精品| 久久9精品| 中文字幕欧美日韩VA免费视频| 噼里啪啦完整版中文在线观看 | 色婷婷丁香五月| 99热亚洲| 99热超| 激情欧美婷婷| 免费观看的婷婷五月视频在线| 色玖玖爱| 亚洲视频另类| 丁香五月婷婷少妇| 日韩色五月| 79精品视频在线观看,| 久热婷婷综合| 免费AV在线网址| 狠狠爱婷婷爱| 99在线国| www.狠狠操| 野外99热| 丁香六月视频| 九九99免费理论| 久久久亚洲精品一区二区三区浴池| 91婷婷五月丁香碰| 欧美综合在线五月天色婷婷| 九九在线视频| 三级av在线| 97在线视频人妻九色| Www.婷婷五月| 亚洲综合色婷婷| 丁香六月成人网| 丁香五月亭亭六月综合激情网| 婷婷情爱五月天6| 内射在线CHINESE| 色久影院| 日本色狠狠| 免费观看全黄做爰的视频| 色综合女人99| 久久伊人日日夜夜| 99色干| 婷婷丁香综合网| 五月丁香操婷逼| 激情五月天伊人影院| 另类少妇人与禽zOZZ0性伦| 久99在线视频| 欧美成人精品老美女噜噜噜| 蜜臀AV在线观看| 国产67194| 俺去也五月| αv中文字幕在线观| 91综合国免费久入| 可以看的av网站| 中文字幕网伦射乱中文| 99热综合| 狠狠搞狠狠操| 99热人人操人人操| 五月丁香激情欧洲啪啪| 99热在线观看| 开心深爱五月天| 超碰av在线| 天啪色| 五月天综合色| 能看的AV网站| 99热免费| 超碰9在| 开心激情网五月| 五月天天丁香婷婷| 天天干-天天日| www.狠狠| www色婷婷久久综合久色 | 日韩熟女啪啪视频| 丁香五月老师| 极品少妇XXXX精品少妇偷拍| www.国产亚洲69ty.久久久久久久久久久久| 五月丁香亭亭操逼| 九月婷婷激情| 91超级碰在线视频| 丁香婷婷五月综合影院| 欧美色九| 99ri精品视频在线观看| 99综合视频| 五月婷婷亚洲色图| 日韩色色视频| 夜色综合网| 色五月婷婷五月丁香五月| 国产成人精品亚洲线观看| 色色网站免费在线视频| 欧美色五月| www.婷婷五月天啪啪| 成人视频网| 国产va在线视频| 欧美叉叉叉BBB网站| 99爱免费在线观看| 五月色综合| 5月色婷婷| 国产亚洲精品久久一区二区三区| 色天堂A| 日本天堂免费99| 96精品久久久久久久久| 日韩成人电影在线播放| 久久婷婷五月天| 丁香五月婷婷基地| 婷婷久久五月天亚洲欧美国产日韩在线观看| 久热大香蕉| 夜夜躁狠狠| 亚洲12p| 超碰人人操人人干| 婷婷综合五月| 五月天玖玖狠狠色色| 丁香八月综合激情| 久久98热re| 大香蕉精品视频| 色色色999| 五月婷高清视频| 91一起操| 五月天婷婷深深爱| 4438成人电影| 九九香蕉网| 另类图片激情五月天| 七月丁香五月婷婷在线| www夜夜操| 高清视频一区| 国产AV一区二区三区最新精品| 人人草人人爱手机视频看看| 大香蕉大香蕉在线影院| 深爱五月婷婷开心中文字幕| 99精品偷自拍| 丁香五月激情婷婷婷婷在线观看| 日韩在线视频网站| 欧美性猛交XXXX乱大交极品| 99热精品在这里| 亚洲AV网站| 婷婷五月天av| 久久久五月四色| 超碰97干| 亚洲亚洲人成综合网络| 99综合| 99热99在线| 中文婷婷狠狠| 久久香蕉网| tingting五月天亚洲| 色 噜噜 九月 婷婷| 五月丁香六月婷综合成人综合| 99er免费在线观看| 丁香六月婷婷开心婷婷网| 九热视频| 欧洲亚洲精品| 这里只精品| 91精品国产色猫| 欧美在线视频99| 精品三区影院| 色婷婷a v| 国产成人一区二区三区在线观看| 99这里只有精品| 亚洲第一色网站| 五月天丁香综合在线| 伊人婷婷五月天| 激情综合网五月天| 五月丁香av在线| 久久9RE热视频精品98| 91九色网| 在线成人网址| 亚洲色无码| 婷婷激情伍月网| 大香蕉网 久久| 久久精彩视频| 超碰99热精品| 九九精品视频在线6| AV中文在线| 婷婷中文字幕欧美| 国产亚洲在线观看| 丁香五月在线播放| 好激情在线综合网| 99re热| 欧美日韩成人在线观看| 婷婷五月综合丁香久久| 亚洲乱码精品久久久久..| 亚洲天堂大香蕉| 99这里是精品| 色热久资源| 九九综合网色全集| 久久久潮喷-久久久九九-成人AV| 天天干天天拍| 人妻AV在线| 久久久精品人妻| 99精品爱| 五月天婷婷激情干干| 欧美婷婷日本| 超碰色女| 97人人操人人操人人操人人| 亚洲综合五月天婷婷| 激情伊人五月婷婷久久| 人妻操逼视频。| 4438成人电影| 丁香五月激情欧美| 久草婷婷网| 婷婷伊人| 日本色五月| 99精品国产热久久91色欲| 五月丁香六月婷婷久久久综合| 丁香婷婷五月天色综合| 色婷婷电影| 婷婷欧美综合| 色色五月天网站| 五月婷婷 激情按摩| 激情综合五月| www.91久久| 欧美日韩999| 影音先锋四区| 亚洲成人av在线| 婷婷色五月婷| 日本va欧美va国产激情| 日本成人噜噜噜| 久久婷婷五月免费视频| 99热6色| 亚洲激情综合免费| 夜夜骑天天玩天天日| 97好吊操| 99久久久国产精品免费蜜乳tv| 操逼福利视频| 色月视频| 丁香婷婷精品视频| 噜噜色五月| 亚洲成人AV在线播放| 五月婷在线影院| 欧美综合五月丁香六月婷| 婷婷五月天丁香社区| 五月天停停日日| 九九综舍久久| 五月丁香激情四射| 色五月综合网| 五月丁了香蕉综合| 久久婷婷六月| 加勒比色色| 久久伊人日日夜夜| 伊人色综在线| 激情图片五月天| 思思热精品在线视频| 99青青草| 思思久日精品视频| 俺去也五月| 女人被男人吃奶到高潮| 久久曰曰| 操91| 西西4r午夜剧场| 六月婷婷青青青视频| 久xxxx| 九九精品自拍| 99热99ai| 大香蕉院线| 天天插综合| 成人版视频在线观看| www久久久| 黑人糟蹋人妻HD中文字幕| 大香蕉综合视频在线| 日韩无码亚欧无码| 五月激情网站| 小视频在线亚洲| 色婷婷伦理| 五月婷婷丁香社区| 超碰人人操人人干| 国产成人精品一区二三区熟女在线| 激情婷婷丁香五月| 97热九九| 樱花99视频| 欧美成人精品一区二区| 五月丁香婷草| 久久人妻视频| 综合久久综合五月天婷婷| 色玖玖玖| 天天爱天天日| 夜夜撸天天操| 六月五月丁香五月欧美| 欧美丁香六月激情视频| 婷婷综合视频| 亚洲午夜AV| 婷婷中文综合网| 最新久久网址| 丁香五月天av| 超碰资源在线| 亚洲无AV在线中文字幕| 欧美日韩国产日本精品四虎网网站物| 这里只有精品日韩| 亚洲一区二区无码蜜乳av| 综合一区二区三区| 国产精品激情AV久久久青桔| 色婷婷无吗| 激情小说五月天| 天天日人人| 影音先锋91资源站| 内射在线CHINESE| 亚洲综合一区二区| 少妇婷婷五月天| 台湾无码A片一区二区| www.色五月| 夜夜大香蕉婷婷丁香| 色综合五月婷婷狠狠干| 亚洲综合丁香五月天| 色99热| 丁香8月手机综合| 99在线播放视频| 天天xxxxxx天天日| 九九激情| 大天天伊人| 狠狠五月天婷婷| 91九色国产熟女| 日产精品久久久久久久蜜臀| 久久天堂网| 日韩无码人妻一区二区三区综合| 超碰99久久| 日木WWW视频| 色九月| 色综合久久88色综合天天99| 无人区码一码二码三码医生系列| AV在线观看网站| 91色情播放| 色优久久| 人人操日| 亚洲色婷婷| 久久99人人| 五月婷婷激情四季| 成人一级片| 99自拍视频在线| 色色五月激情| 丁香5月综合啪啪| 99热最新网址| 99热销国产这里有精品| 热99热9| 亚洲五月天激情| 91在线日| 五月色色激情网| 91久久日日| 无码一区二区日韩| 五月丁香啪啪网| 久9精品| 丁香五月综合图片在线观看| 99热这里只有精品免费| 涩综合网| 五月婷婷丁香六月| 香蕉五月婷婷| 日日肏夜夜干| www。久久久久一b。Cc| 这里只有精品视频在线观看免费| 久久久大香蕉| 99色| 伊人五月天| 色综合播放| 五月丁香婷婷激情在线| 国产精品一区在线观看你懂的| 狠狠爱综合| 欧美成人日韩| 久草a片| 日日操天天操| 五月亭大香蕉| 99九九视频| 真实的国产乱XXXX在线91| 色播五月丁香综合| 国产AV一区二区三区最新精品| 无码人妻电影| 日本久久综合| www.婷婷五月| 丁香五月天堂网| www.色综合| 99在线观看| 亚洲中文字幕AV| www.99在线| 婷婷操逼| 丁香色婷婷| 五月婷视频久久| www.久久爱.com| 丁香五月综合久久| 日韩另类在线观看| 日本99在线视频| 久操激情| 激情AV| 色六月天天激情综合网| 拍真实国产伦偷精品| 色。 日日日| 国产肥白大熟妇BBBB视频| www.色窝| 操日本99| 激情五月少妇| 色婷婷五月影视| 中文久久婷婷| 99自拍网| 久久a热| 99在线观看这里都是精品| 欧美肉大捧一进一出免费视频| 五月天色婷婷av| 熟女强人妻一区二区三区四区无| 欧美激情五月| 激情丁香久久| 91丨九色丨丰满人妖| 久久三级视频| 97色色视频| 久热这里只有精品66| 极品人妻VIDEOSSS人妻| 欧美婷婷色五月| 99内射视频| 免费黄色AV| 久久婷婷五月天激情新地址| 激情九月婷婷| www.minyis.com【JT】币址百万U预算可预付QQ2101460746 | 91色综合久久| 九九热这里只有精品在线观看| 六月婷婷青青青视频| 日韩人妻无码精品| 丁香亭亭久久| 欧美日韩二区在线| 亚洲综合五月| 香蕉久久国产AV一区二区| 欧洲色| 五月婷婷综合精品| 91在线人| 成人精品在线| 管管補管管紱| 九九美女视频| 五月丁香777| 日逼免费视频 | 欧日美女Va| 婷婷色网| 久久香蕉婷婷五月天| 日本一区二区三区精品视频| 久草A片| 激情五月亚洲综合网| 一起操 91N.com| 五月色综合| 午夜无码精品色综合久久| 久久视频婷婷| 色激情五月天| 天天干天干| 97人人做| 日本人人超碰| 成人电影AV在线观看| 桃色激情婷婷伊人网| 亚洲另类毛片| 超碰在线91| 色欲一区二区三区精品A片| 五六月婷婷| 99久久偷拍视频| 色婷婷电影网| 99热在线只有精品| 久久在线视频只有这里有精品| 亚洲中文AV网站| 开心五月深爱五月| 青青草激情网| 色色综合日韩| 二级黄色毛片| 亚洲精品久久久久久久久久吃药 | 日韩综合天堂| 久久丁香综合香蕉| 综合网色| 色亚洲欧洲| 激情五月天啪啪视频| 丁香五月婷婷婷桃花影院| 激情六月天| 99热99干| 色五月婷婷激情| 色噜噜狠狠色综合伊人| 9久久精品视频| 97日韩无套内| 99亚洲精品视频| 婷婷五月激情天| 久久婷出差欧美色两性综合网| 亚洲网站999| 精品日本视频444| 色婷婷小说网| 丁香五月婷婷激情中文| 婷婷基地成人五月天| 色天使色婷婷| 久久婷婷五月综合网| 成人日韩欧美| www99在线观看视频| 婷婷瑟瑟五月天| 亚洲AV激情五月综合网| 大香蕉天堂| 一级性感毛片| 亚洲乱码日产精品BD| 婷婷在线视频| 五月婷在线| 五月丁香AV在线| 亚洲热手机在线观看| 中文无码婷婷| www.五月天色色色| 色情成人五月天| 中文字幕精品无码一区二区| 婷婷五月天小说网| 五月婷婷深深爱| 99er精品视频| 开心五月婷婷六月丁香| 天天艹天天综合网| 久久激情五月天| 99热第一页| 白度黄视频| 91夫妻视频| 97福利视频| 97在线视频观看| 亚洲AV日韩无码| 女人天堂 AV| 人人综合五月人人婷婷| 日本va网站| 99热99网| 欧美性二区| 久久久久婷婷| 99热在线中文字幕| 丁香五月婷婷偷拍| 任我肏视频精品| 日韩小视频在线99| 九九九九九九九九九九九九九九九九九九九在线视频 | 97亚洲精品| 碰99在线| 久cao香蕉影院| 99人妻碰碰久久久禁片| 被男人添B超爽视频| 婷婷综合激情| 丁香五月天激情视频| 日本三级中国三级99人妇网站| 色色色色色综合| 婷婷五月天久久久| 五月开心久久| 久热这里只有| 色婷婷亚洲婷婷| 婷婷综合激情| 九九热视频这里只有精品| 日本三级中国三级99| 五月丁香激情综合网| 五月丁香激情综合| 色玖玖| www.婷婷五月天| 日本片日本片祼观看网站在线看中文版网页在线看 | 凹凸7777操操操| 亚洲 25P| 亚洲激情 久久| 啪啪婷婷五月天激情| 久久五月婷综合网| 久久99色色| 亚洲激情五月婷婷日日| 互月天综合| 亚洲AV色婷婷人禽五月天| 丁香六月婷婷综合欧美| 丁香婷婷色五月激情综合| 欧美影院| www.五月婷婷久久.com| 激情www| 免费观看全黄做爰的视频| 亚洲视频在线网站| 超级碰碰碰久久网站| 大香蕉人人网| 日韩操逼大片| 五月丁香猫咪久久婷婷综合视频激情四射网入口 | 成片免费观看视频大全| 久久怡红院| 九九Av| 国产日韩欧美| 黄色AAAA韩国guochansanji| 婷婷丁香五月天大香蕉| 亚州操操| AV激情五月| 五月丁香在线精品| 色永久| 天天操天天操天天操天天操天天操天天操天天操天天操天天操 | 影院久久久| 9热视频在线观看| 狠狠舔| 丁香六月天AV| 五月天 另类图片| 97色色网| 色婷婷五月在线| 大伊香蕉精品视频在线| www.99操| 亚洲黄色精品| 丁香丁婷五月激情| 天天干天天射色综合| 99九九在线精品热动漫| 久久激情五月| 婷婷综合国产| 五月丁香六月婷婷啪啪| 国产夫妻操逼内射视频| 人人操人av| 五月天婷久精视频| 亚洲超碰在线| 久久九九思思| 99福利导航| 爱草视频在线观看| 欧美婷婷综合| 性色五月天| 国产毛片操B| 五月丁香啪综合| 婷婷久久五月天亚洲欧美国产日韩在线观看 | 夜夜爱爱亚洲| 国产成人av在线播放| 色五月成人在线| 色五月色图| 国产精品18久久久| 五月婷婷激情日本| 婷婷五月天激情网址| 色五婷婷| 欧美黄色AA片哗啦啦啦| 牛色色碰| 啪啪啪大香蕉| 九九热精品6| av狠狠操| 久久久.www| 青青草原中文字幕| 色小说五月天| 99色视频| AAA久久久AAA久久久AAA| 成人久久天天x资源站| 色偷偷五月天| 欧美叉叉叉BBB网站| 性生活视频98791| 婷婷五月婷婷五月天| 精品成人在线观看| 国产熟妇乱子伦hd| 激情小说五月天| 五月丁香六月婷婷在线观看| 婷婷五月天小说| av免费在线网站| 99热日本| 婷婷综合在线| 丝雨一区二区| 亚洲丁香五月美女| 丁香花色色网| 99资源人人| 国产精品噜噜在线视频| 丁香五月激情五月| 99久久九九视频| 婷婷在线精品| 九九热最新| http://www.com久久久精品一区| 超碰chaompinm| 亚洲婷婷免费| 无码少妇高潮喷水A片免费| 人妻人人操| 天天爽天天做| 久久精品一区二区三区四区| 91精品在线看| 狠狠摸狠狠摸| 91在线视频观看午夜福利| 天天综合亚洲综合网天天αⅴ| 亚洲色五月| 久久久久久久久久8888| 久一网站| 无码人妻一区| 色婷婷丁香女女| 激情综合五月激情17| 色婷婷综合影院| 丁香五月熟女| 九九婷婷五月天影视| 中文字幕 中文字幕明步| 久久五月天色婷婷| 天天色天天爱天天爱天天爱y| 亚洲视频在线观看| 成人看片网站| 国产精品国产| 99色日本| 日日想日日夜日日操| 熟妇无码乱子成人精品| 婷婷综合五月色播| 99国产欧美视频| 性色婷婷| 亚洲激情 久久| 狠狠干.com| 丁香五月香蕉| 久9久9热久热| 丁香啪啪| 天天射夜夜骑| 国产精品日日躁夜夜躁| 久久99网| 激情伊人五月婷婷久久| 日日夜夜亚洲一区| 激情综合五月天| 91色综合网| 日韩成人电影AV| 狠狠狠狠狠操| 亚洲xx网| 久久精彩免费视频| 呦呦视频无码播放| 五月婷婷狠狠久久| 色香欲综合| 五月天婷婷丁香视频| 一区二区aV电影免费看| 色五月色五天色情网| 性小说五月天| 99九九99九九九视频精品| 五月成人天| 99操视频| 99视频在线观看地址| 婷婷五月六月丁香| 操碰97| 久久九九激情五月天| 日韩久热| 婷婷六月色丁香视频在线观看| 91日婷婷在线| 337p大胆噜噜噜噜噜91Av| 欧美性生交XXXXX无码小说| 色色色色色网| 99视频内射三四| 五月丁香婷婷欧美色图视频五月丁香777电影 | 色婷婷五月天视频在线| 无码A片一区二区免费| 久热伊人| 伊人五月天久久| 狠狠干在线| 久久网日本| 这里只有精彩视频| 久热这里只有精品性色AV| 99久久久99久久91熟女| 婷婷五月深深的爱| 色婷亚洲| 超碰在线99| 五月婷婷av| 怡红院99| 成人色图情色成人网 www.5b5b5bcom 五月天 | 色色色在线免费视频| 五月丁香婷婷欧美色图视频五月丁香777电影| 淫荡综合网| 九九超日本| 亚洲精品影视| 日日夜夜狠狠婷婷色| 日日躁夜夜躁狠狠久久AV| 操射国产日本| 九九热婷婷| 岛国AV网| 五月永久激情| 狠狠色丁香久久综合婷婷亚洲成人福利| 国产成人99久久亚洲综合精品| 日韩成人电影在线播放| 99这里只有精品视频| 啪啪干伊人婷婷| yw.av| 亚洲av成人在线| 丁香六月 婷婷六月| 天堂网亚洲色图| 五月丁香性爱| 99思思在线视频| 九色99视频| 色婷婷超碰| 婷婷色五月综合丁香| 无码碰碰| 五月丁香无码| 久久ER视频com| 激情婷婷五月综合| www99在线观看视频| A一级操| 操比激情五月| 99自拍视频在线| 超碰99在线| 99色区| 欧美综合五月天婷婷tin| 色五月亚洲| 中文字幕丰满乱孑伦无码专区 | 99热精品在线观看| 国产成人va在线| 色五月偷偷| 国产又黄又爽又色的免费| 婷婷成人视频| www。狠狠干。com| 色婷狠狠| 激情五月天 婷婷| 五月婷婷六月婷| 午夜免费试看| 伊人激情网| 99热免费在线| 婷婷夜夜操| 六月丁香婷婷五月天| 久久丁香婷婷色情综合| 激情五月天色播| 日本在线视频手机播放五月婷| 久久99精品久久久| 日韩无码成人电影| www.操.com| 九九热这里有精品23| 亚州精品成人片| AV大香蕉| 五月天婷婷免费视频| 色欲人妻综合aaaaaaaa网| 丁香五月成人自拍| www.91色| 婷婷五月天六月丁香| 婷婷五月天无码视频| 七七九色| 久久综合26p| 婷婷综合激情| 女人天堂 AV| 99热这里只有精品在线免费| 五月婷婷日本| 91人久| 五月婷婷婷婷| 99re8在这里只有精品| 激情综合网亚洲色图| 久热这里只有精品6官网亚洲| 日韩av在线免费观看| 久久视9精| 九九在线视频| 狠狠干在线| 中文字幕,综合,91| 综合综合网| 亚洲婷婷月丁香五月| 色狠狠五月天| 中文无码婷婷|