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

ARTICLE DETAIL

資訊詳情

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

MATLAB駕駛場(chǎng)景設(shè)計(jì)器彎道仿真全流程與參數(shù)調(diào)優(yōu)指南

MATLAB駕駛場(chǎng)景設(shè)計(jì)器彎道仿真全流程與參數(shù)調(diào)優(yōu)指南 MATLAB 里的駕駛場(chǎng)景設(shè)計(jì)器Driving Scenario Designer下文簡(jiǎn)稱 DSD是我這幾年做自動(dòng)駕駛彎道仿真的默認(rèn)起點(diǎn)。它不神秘本質(zhì)上就是一個(gè)帶道路編輯器的場(chǎng)景裝配臺(tái)你畫(huà)出中心線、拉出車道、擺上幾臺(tái)車、配好速度軌跡按下運(yùn)行就能看到車沿著你畫(huà)的線跑起來(lái)。真正卡住人的從來(lái)不是“按鈕在哪”而是“為什么這么點(diǎn)”——為什么中心點(diǎn)要多密、為什么速度剖面必須跟路徑點(diǎn)一一對(duì)應(yīng)、為什么仿真步長(zhǎng)稍大一點(diǎn)車就切出車道。下面我把自己反復(fù)折騰出來(lái)的一整套流程攤開(kāi)講從環(huán)境自查到代碼級(jí)拆解彎道怎么畫(huà)、速度怎么算、坑怎么填全部是可復(fù)制的東西。這篇內(nèi)容適合兩類人看剛接手駕駛仿真、需要在一小時(shí)內(nèi)跑出第一條彎道的新手已經(jīng)在用 DSD 但總被“車飛出去”“傳感器啥也測(cè)不到”“導(dǎo)出 Simulink 后場(chǎng)景不動(dòng)”折磨的同行。全文以 MATLAB 腳本為主線圖形界面只作為校驗(yàn)和兜底手段因?yàn)槟_本可以版本管理、可以參數(shù)化、可以批量跑這三點(diǎn)在真實(shí)測(cè)試流程里比“點(diǎn)得爽”重要得多。1. 先把工具的能力邊界摸清楚1.1 彎道為什么是仿真里最“貴”的場(chǎng)景直線段仿真幾乎沒(méi)有技術(shù)含量車速恒定、航向恒定、車道邊界平行任何一套邏輯都能跑出漂亮結(jié)果。彎道就不一樣了它同時(shí)把四個(gè)維度的復(fù)雜度擰在一起幾何上曲率隨弧長(zhǎng)變化車輛模型需要持續(xù)輸出橫向加速度感知上車道線從直線變成圓弧擬合算法要用二次或三次曲線去逼近控制上預(yù)瞄距離和前視點(diǎn)必須隨曲率調(diào)整否則純跟蹤算法會(huì)切內(nèi)道評(píng)價(jià)上橫向誤差、航向誤差、舒適性指標(biāo)全都跟曲率強(qiáng)相關(guān)。這就是為什么很多人直線跑得挺順一進(jìn)彎就原形畢露。DSD 在這方面提供的價(jià)值不是“畫(huà)個(gè)彎”而是把道路幾何、車輛運(yùn)動(dòng)學(xué)和傳感器模型綁在同一個(gè)時(shí)間軸上。你畫(huà)的中心線會(huì)被擬合成帶曲率連續(xù)性的道路車輛沿軌跡行駛時(shí)每一幀的位置、朝向、速度都是自洽的雷達(dá)和攝像頭模型拿到的也是同一套真值。這一點(diǎn)很關(guān)鍵——如果道路用一套坐標(biāo)、車輛用另一套坐標(biāo)、傳感器再用第三套你后面排查問(wèn)題會(huì)瘋掉。另一個(gè)容易被忽略的點(diǎn)是彎道對(duì)時(shí)步的敏感性。直線上車輛朝某個(gè)方向勻速走步長(zhǎng) 0.1 秒的影響無(wú)非是位置跳了一米彎道上同樣的步長(zhǎng)會(huì)讓航向角每次跳好幾度視覺(jué)上就是車在一格一格地“拐硬彎”傳感器打出去的光束也會(huì)跟著抖動(dòng)。所以彎道場(chǎng)景做得好不好很大程度取決于你對(duì)采樣率的把控而不是畫(huà)得多漂亮。1.2 圖形界面和腳本各自該干哪一半我見(jiàn)過(guò)不少人一上來(lái)就打開(kāi) App鼠標(biāo)拖著中心點(diǎn)一個(gè)個(gè)點(diǎn)點(diǎn)完發(fā)現(xiàn)想改半徑只能全部推倒重來(lái)。這屬于用錯(cuò)了工具的分工。我的習(xí)慣是探索性設(shè)計(jì)用界面可復(fù)現(xiàn)場(chǎng)景用腳本。第一次試某個(gè)彎道形態(tài)、想快速看看車道寬度和轉(zhuǎn)彎半徑比例是否合理打開(kāi)drivingScenarioDesigner拖兩下確實(shí)快但一旦形態(tài)確定立刻把中心點(diǎn)坐標(biāo)抄進(jìn)腳本后面所有迭代都在代碼里做。界面的另一個(gè)正確用法是反向校驗(yàn)。腳本跑出來(lái)的場(chǎng)景可以一鍵喂回 AppdrivingScenarioDesigner(scenario)把變量加載進(jìn)去你就能在圖形界面里看到道路邊界、車道線、車輛軌跡、傳感器覆蓋范圍疊在一起的樣子。有些問(wèn)題在命令行里看不出來(lái)比如兩條車道線在彎心處交叉、車輛軌跡貼著路緣擦過(guò)去圖形界面上一眼就能發(fā)現(xiàn)。這種“腳本生成 界面審查”的雙向流程比純界面或純腳本都高效。還有一個(gè)功能值得單獨(dú)提App 的 Tools 菜單里有一個(gè)針對(duì)道路和車輛時(shí)步的檢查項(xiàng)。它會(huì)把你的速度、采樣時(shí)間、道路曲率放在一起算一遍告訴你當(dāng)前配置下車輛每步移動(dòng)的距離是否超出了合理范圍。這個(gè)檢查我在項(xiàng)目里救過(guò)好幾次場(chǎng)——用高車速配 0.1 秒步長(zhǎng)時(shí)它會(huì)直接標(biāo)紅提示省得你后面花兩小時(shí)去查“為什么車會(huì)瞬移”。2. 動(dòng)手前的環(huán)境自查與最小驗(yàn)證2.1 工具箱、版本與常見(jiàn)依賴DSD 不是一個(gè)獨(dú)立產(chǎn)品它掛在自動(dòng)駕駛工具箱體系下同時(shí)依賴場(chǎng)景建模的基礎(chǔ)設(shè)施。裝環(huán)境時(shí)至少確認(rèn)這幾塊自動(dòng)駕駛相關(guān)工具箱提供drivingScenario、vehicle、trajectory、各類傳感器生成器、導(dǎo)航與地圖相關(guān)工具箱部分道路擬合和曲線工具在這里、以及基礎(chǔ)的 MATLAB 本體。如果你的流程要接 Simulink 做閉環(huán)那 Simulink 和對(duì)應(yīng)的場(chǎng)景讀取模塊也得在。版本差異是個(gè)真實(shí)的坑。同一個(gè)函數(shù)在不同年份的版本里參數(shù)名會(huì)變尤其是傳感器生成器那一塊屬性名和返回值順序調(diào)整過(guò)好幾次。我的經(jīng)驗(yàn)是先鎖定一個(gè)版本再寫(xiě)代碼把版本號(hào)寫(xiě)在腳本頭部注釋里別今天用新版本跑通、明天換臺(tái)機(jī)器用舊版本報(bào)錯(cuò)然后花半天懷疑人生。另外函數(shù)簽名不確定的時(shí)候別硬猜直接在命令行敲help 函數(shù)名看當(dāng)前這個(gè)版本到底怎么寫(xiě)的比在網(wǎng)上翻三年前的帖子靠譜得多。道路擬合部分需要說(shuō)明一下它的原理。DSD 在根據(jù)你給的中心點(diǎn)生成道路時(shí)用的是回旋線clothoid擬合也就是曲率隨弧長(zhǎng)線性變化的曲線。這個(gè)東西在公路設(shè)計(jì)里是標(biāo)準(zhǔn)做法——直線段曲率是 0圓曲線曲率是常數(shù) 1/R中間用回旋線過(guò)渡保證曲率連續(xù)。好處是車輛沿路行駛時(shí)方向盤(pán)轉(zhuǎn)角不會(huì)突變壞處是你給的中心點(diǎn)如果本身跳變很大擬合出來(lái)的道路可能偏離你預(yù)期的形狀。理解這一點(diǎn)你就知道為什么中心點(diǎn)不能隨手點(diǎn)了。2.2 三行代碼驗(yàn)證環(huán)境是否真的可用在正式畫(huà)彎道之前我建議先跑一個(gè)最小閉環(huán)確認(rèn)整條鏈路是通的。三行代碼就夠scenario drivingScenario(SampleTime, 0.05, StopTime, 5); road(scenario, [0 0 0; 50 0 0], Lanes, lanespec([1 1])); drivingScenarioDesigner(scenario);這三行的意思是建一個(gè)采樣時(shí)間 0.05 秒、總時(shí)長(zhǎng) 5 秒的場(chǎng)景鋪一條從原點(diǎn)出發(fā)、沿 x 軸方向長(zhǎng) 50 米的直路中心線左右各一條車道然后把它丟進(jìn)圖形界面里看一眼。如果界面正常打開(kāi)、道路顯示為兩條平行車道線說(shuō)明基礎(chǔ)環(huán)境沒(méi)問(wèn)題。這一步的價(jià)值在于把所有環(huán)境問(wèn)題前置。我見(jiàn)過(guò)太多次興沖沖寫(xiě)了兩百行彎道代碼一運(yùn)行報(bào)“函數(shù)不存在”才開(kāi)始排查是哪個(gè)工具箱沒(méi)裝。用最小用例先探路成本三十秒收益是后面省掉半小時(shí)。如果這三行都跑不通那問(wèn)題一定在環(huán)境層面跟你的彎道邏輯毫無(wú)關(guān)系方向很明確。順手再驗(yàn)證一下推演機(jī)制while advance(scenario) p pose(scenario.Actors(1)); fprintf(t%.2f x%.2f y%.2f\n, scenario.CurrentTime, p(1), p(2)); end這段用來(lái)說(shuō)明advance是怎么推進(jìn)時(shí)間的——每次調(diào)用把場(chǎng)景往前推一個(gè)采樣步長(zhǎng)返回 false 表示到StopTime了。后面所有的仿真循環(huán)都是這個(gè)骨架。3. 彎道場(chǎng)景的三層建模道路、車輛、傳感器3.1 道路層中心點(diǎn)密度決定了一切道路是場(chǎng)景的地基彎道尤其如此。核心接口是road(scenario, roadCenters, Lanes, lanespec([...]))其中roadCenters是一個(gè) N×3 的矩陣每行是一個(gè)中心點(diǎn)的 [x, y, z] 坐標(biāo)z 用來(lái)表達(dá)高程和橫坡。DSD 會(huì)按順序把這些點(diǎn)連成一條帶曲率連續(xù)性的中心線再按lanespec往兩側(cè)鋪車道。中心點(diǎn)密度這里有兩條經(jīng)驗(yàn)值。第一彎道上相鄰中心點(diǎn)的間距控制在曲率半徑的 1/10 到 1/5 之間。半徑 60 米的彎點(diǎn)間距 6 到 12 米比較合適。間距太大回旋線擬合出來(lái)的形狀跟你腦子里想的不一樣間距太小擬合會(huì)放大數(shù)值噪聲道路出現(xiàn)細(xì)微抖動(dòng)車輛的航向角跟著抖。第二直線段不需要這么密30 米一個(gè)點(diǎn)完全夠用因?yàn)橹本€曲率恒為零擬合結(jié)果沒(méi)有任何自由度。lanespec的參數(shù)形式是lanespec([左車道數(shù), 右車道數(shù)])。lanespec([1 1])是雙向兩車道lanespec([0 1])是只有右側(cè)一條車道。這里有個(gè)容易搞混的地方車道的左右是相對(duì)于中心線的前進(jìn)方向定義的右車道的中心線在中心線右側(cè)偏移半個(gè)車道寬默認(rèn)車道寬 3.6 米所以偏移是 1.8 米。如果你的車要跑在右車道正中間初始位置就不能放在中心線上。高程那一列別隨便填。很多人圖省事全部寫(xiě) 0平面場(chǎng)景下沒(méi)問(wèn)題但如果你想驗(yàn)證車輛在帶橫坡的彎道上是否會(huì)有姿態(tài)變化第三列就要按橫向坡率填。常規(guī)公路彎道超高在 2% 到 6% 之間半徑 60 米這種中速?gòu)澣?4% 比較常見(jiàn)。具體做法是讓外彎側(cè)比內(nèi)彎側(cè)高高差 車道寬 × 坡率。3.2 車輛層位置、朝向與速度剖面車輛用vehicle(scenario, Position, [x y z])創(chuàng)建能配置的包括尺寸、類別、初始朝向。位置坐標(biāo)是世界坐標(biāo)系下的米朝向是相對(duì) x 軸逆時(shí)針的角度弧度。初始位姿的坑在于它必須跟軌跡的第一個(gè)點(diǎn)一致。trajectory的行為是讓車輛從當(dāng)前位姿出發(fā)去追擊你給的路徑點(diǎn)如果第一個(gè)路徑點(diǎn)跟初始位置差了五米車輛會(huì)在第一步就瞬移到那個(gè)點(diǎn)上后續(xù)的軌跡全部錯(cuò)位。我踩過(guò)這個(gè)坑現(xiàn)象是車輛在起點(diǎn)閃一下然后整條軌跡看起來(lái)像整體平移了一段。真正決定彎道表現(xiàn)的是速度剖面。trajectory(actor, waypoints, speed)的第三個(gè)參數(shù)可以是標(biāo)量全程勻速也可以是與waypoints行數(shù)相同的向量每點(diǎn)一個(gè)速度。用向量的時(shí)候必須嚴(yán)格對(duì)齊行數(shù)多一個(gè)少一個(gè)都會(huì)報(bào)錯(cuò)這個(gè)報(bào)錯(cuò)信息還挺模糊的容易讓人卡住。速度剖面的設(shè)計(jì)原則是從橫向加速度約束倒推。車輛過(guò)彎時(shí)受到的橫向加速度近似為 a v2/R這個(gè)值直接決定乘客的舒適感。工程上取 1.5 到 2.5 m/s2 作為舒適上限超過(guò) 3 m/s2 就明顯不適了。所以給定半徑 R彎中允許的最大車速是 v √(a·R)。這個(gè)公式是整個(gè)速度設(shè)計(jì)的錨點(diǎn)后面具體算的時(shí)候會(huì)用到。3.3 傳感器層裝在哪、看多遠(yuǎn)傳感器模型不是必須的但彎道場(chǎng)景不加傳感器價(jià)值至少少一半。常用的兩個(gè)是雷達(dá)數(shù)據(jù)生成器和視覺(jué)檢測(cè)生成器。雷達(dá)的參數(shù)重點(diǎn)是安裝位置、視場(chǎng)角和量程。安裝位置用MountingLocation單位是米坐標(biāo)是相對(duì)車身、以車輛中心為原點(diǎn)的車身坐標(biāo)系x 向前、y 向左、z 向上。量產(chǎn)車的毫米波雷達(dá)一般裝在前保險(xiǎn)杠縱向 3 到 4 米、橫向 0、高度 0.4 到 0.8 米。視場(chǎng)角用FieldOfView格式是 [水平角, 俯仰角]角雷達(dá)通常水平 90 度、俯仰 10 到 20 度。視覺(jué)檢測(cè)器的關(guān)鍵參數(shù)是量程、檢測(cè)概率和誤檢率。量程要跟你的場(chǎng)景尺度匹配彎道半徑 60 米、總長(zhǎng)一百多米的話量程 60 米是個(gè)合理起點(diǎn)。檢測(cè)概率默認(rèn) 0.9 左右意味著每幀有 10% 概率漏檢如果你想驗(yàn)證跟蹤算法的魯棒性可以調(diào)到 0.7 制造壓力。彎道下傳感器有個(gè)特有現(xiàn)象內(nèi)彎側(cè)目標(biāo)被遮擋外彎側(cè)目標(biāo)提前暴露。這是幾何決定的雷達(dá)和攝像頭都一樣。如果你的場(chǎng)景里放了多輛車做評(píng)估時(shí)要意識(shí)到這個(gè)不對(duì)稱性——同一輛目標(biāo)車在彎道入口和彎道出口的檢測(cè)穩(wěn)定性可能完全不同別把它當(dāng)成算法的穩(wěn)定性問(wèn)題。4. 完整實(shí)操五分鐘搭出一條 90 度彎道4.1 第一步 用腳本生成中心線先定義基本幾何參數(shù)。我要的是一條從原點(diǎn)出發(fā)、走 30 米直線、然后左轉(zhuǎn) 90 度的彎彎道半徑 60 米。這幾個(gè)數(shù)字決定了整條路的位置。R 60; % 彎道半徑單位 m lineLen 30; % 入彎前直線長(zhǎng)度單位 m nLine 7; % 直線段中心點(diǎn)數(shù)量 nArc 10; % 彎道段中心點(diǎn)數(shù)量 % 直線段沿 x 方向y 恒為 0 sLine linspace(0, lineLen, nLine); ptsLine [sLine, zeros(nLine, 1), zeros(nLine, 1)]; % 彎道段圓心位于 (lineLen, R)從 θ0 轉(zhuǎn)到 θπ/2 theta linspace(0, pi/2, nArc); ptsArc [lineLen R*sin(theta), R - R*cos(theta), zeros(nArc, 1)]; % 拼接時(shí)去掉重復(fù)的接縫點(diǎn) roadCenters [ptsLine; ptsArc(2:end, :)];這段代碼的幾何關(guān)系值得說(shuō)清楚。圓心選在 (30, 60)起點(diǎn)是 (30, 60-60) (30, 0)正好接上直線段的終點(diǎn)終點(diǎn)是 (3060, 60) (90, 60)。參數(shù)方程用 sin 和 (1-cos) 的組合起點(diǎn)處切線方向是 x終點(diǎn)處切線方向是 y也就是標(biāo)準(zhǔn)的左轉(zhuǎn) 90 度。拼接時(shí)去掉ptsArc的第一個(gè)點(diǎn)因?yàn)槟且稽c(diǎn)和直線段最后一點(diǎn)完全重合重復(fù)的中心點(diǎn)會(huì)讓后續(xù)的弧長(zhǎng)計(jì)算出現(xiàn)零長(zhǎng)度段某些函數(shù)會(huì)直接報(bào)錯(cuò)。如果換成右轉(zhuǎn)、或者轉(zhuǎn) 45 度只需要改theta的范圍比如linspace(0, -pi/2, nArc)就是右轉(zhuǎn)。半徑和直線長(zhǎng)度改了圓心位置要跟著改這個(gè)是唯一的聯(lián)動(dòng)關(guān)系。4.2 第二步 鋪車道與擺車scenario drivingScenario(SampleTime, 0.02, StopTime, 25); road(scenario, roadCenters, Lanes, lanespec([1 1]));采樣時(shí)間我選了 0.02 秒比默認(rèn)的 0.05 更細(xì)。原因后面第 5 節(jié)會(huì)展開(kāi)簡(jiǎn)單說(shuō)就是彎道上每步位移要控制住不然航向角跳變明顯。lanespec([1 1])是雙向兩車道視覺(jué)上完整一些。接著擺車。為了讓車跑在右車道中心而不是壓著中心線先用中心點(diǎn)的法向量往外偏 1.8 米dx gradient(roadCenters(:,1)); dy gradient(roadCenters(:,2)); nor [-dy, dx] ./ vecnorm([-dy dx], 2, 2); % 單位法向量指向左側(cè) laneCenters roadCenters(:,1:2) - 1.8 * nor; % 右車道中心 laneCenters(:,3) 0;gradient算的是每個(gè)點(diǎn)處切線的差分近似[-dy, dx]旋轉(zhuǎn) 90 度得到法向。注意方向這個(gè)法向指向左側(cè)所以減去 1.8 才是右側(cè)車道中心。這個(gè)偏移用在整個(gè)路徑上而不是只偏起點(diǎn)——彎道里法向是連續(xù)變化的只偏起點(diǎn)會(huì)讓車輛越跑越往外。然后創(chuàng)建車輛并把初始位置設(shè)到路徑第一個(gè)點(diǎn)ego vehicle(scenario, ... ClassID, 1, ... Position, laneCenters(1,:), ... Length, 4.6, Width, 1.9, Height, 1.5);4.3 第三步 配軌跡與速度速度剖面按前面說(shuō)的橫向加速度倒推。我取舒適上限 1.5 m/s2半徑 60 米aLatMax 1.5; vCorner sqrt(aLatMax * R); % 約 9.49 m/s折合 34 km/h vEnter 14; % 入彎前車速m/s sDecelFrom 10; % 從弧長(zhǎng) 10 m 處開(kāi)始減速vCorner sqrt(1.5 × 60) 9.49米每秒大概 34 公里每小時(shí)。入彎前 14 米每秒50 公里每小時(shí)所以需要在直線段內(nèi)減速。按弧長(zhǎng)重采樣路徑點(diǎn)再逐點(diǎn)填速度s [0; cumsum(vecnorm(diff(roadCenters), 2, 2))]; sUniform linspace(0, s(end), 240); waypoints [interp1(s, laneCenters(:,1), sUniform), ... interp1(s, laneCenters(:,2), sUniform), ... zeros(numel(sUniform),1)]; speedProfile vCorner * ones(size(sUniform)); idx1 sUniform sDecelFrom; speedProfile(idx1) vEnter; idx2 sUniform sDecelFrom sUniform lineLen; speedProfile(idx2) vEnter (vCorner - vEnter) * ... (sUniform(idx2) - sDecelFrom) / (lineLen - sDecelFrom); trajectory(ego, waypoints, speedProfile);這里有兩個(gè)關(guān)鍵動(dòng)作。一是按弧長(zhǎng)等間距重采樣把原來(lái)疏密不均的中心點(diǎn)變成間隔均勻的點(diǎn)總長(zhǎng)約 124 米240 個(gè)點(diǎn)間距約 0.52 米這樣速度剖面在空間上的分布才是均勻的。二是速度向量長(zhǎng)度必須等于路徑點(diǎn)行數(shù)代碼里都用sUniform驅(qū)動(dòng)天然對(duì)齊。入彎的減速段是線性的實(shí)際車上會(huì)做成加加速度受限的 S 形曲線但用于仿真驗(yàn)證橫向控制線性減速已經(jīng)夠用而且更容易分析。4.4 第四步 運(yùn)行與可視化bep birdsEyePlot(XLimits, [-20 130], YLimits, [-40 100]); lp laneBoundaryPlotter(bep, DisplayName, 車道邊界); tp trackPlotter(bep, DisplayName, 自車, MarkerFaceColor, red); plotLaneBoundary(lp, scenario.LaneBoundaries); while advance(scenario) p pose(ego); tp(p(1), p(2), p(3)); drawnow limitrate end跑起來(lái)之后你應(yīng)該能看到車從原點(diǎn)出發(fā)沿直線跑 30 米在彎道入口減速然后貼著彎道內(nèi)側(cè)平穩(wěn)轉(zhuǎn)過(guò) 90 度。如果車輛在中途跳出車道或者航向角劇烈擺動(dòng)直接跳到第 6 節(jié)找對(duì)應(yīng)癥狀。5. 代碼逐段拆解與參數(shù)怎么算5.1 圓弧參數(shù)化與切線方向圓弧參數(shù)方程用的是(圓心 R·sinθ, 圓心_y - R·cosθ)這種組合而不是常見(jiàn)的(R·cosθ, R·sinθ)。這個(gè)選擇不是隨意的是因?yàn)楹笳咴?θ0 處的切線方向是 y起點(diǎn)朝向不對(duì)你還得額外加一個(gè)旋轉(zhuǎn)矩陣。用 sin 和 (1-cos) 的形式天然滿足“起點(diǎn)在原點(diǎn)方向、切線沿 x”的需求省去一堆坐標(biāo)變換。對(duì)于任意起始朝向的彎道更通用的做法是先算一個(gè)旋轉(zhuǎn)矩陣再作用到點(diǎn)上heading0 pi/6; % 起始朝向30 度 Rmat [cos(heading0) -sin(heading0); sin(heading0) cos(heading0)]; ptsArcRotated (Rmat * ptsArc(:,1:2));不過(guò)實(shí)際項(xiàng)目里我一般不用這套通用解因?yàn)閳?chǎng)景都是圍繞自車坐標(biāo)系搭建的讓自車從原點(diǎn)沿 x 出發(fā)后面所有幾何都能用最簡(jiǎn)單的表達(dá)式寫(xiě)。保持這個(gè)約定能省掉大量調(diào)試坐標(biāo)系的時(shí)間。還有一個(gè)細(xì)節(jié)trajectory計(jì)算車輛朝向是靠前后路徑點(diǎn)的差分所以路徑點(diǎn)的順序必須是從起點(diǎn)到終點(diǎn)單調(diào)推進(jìn)。如果你不小心把點(diǎn)排反了車輛會(huì)試圖倒著走或者干脆原地打轉(zhuǎn)。中心點(diǎn)拼接順序錯(cuò)了是新手常見(jiàn)的失誤癥狀是車輛在起點(diǎn)來(lái)回抽搐。5.2 弧長(zhǎng)重采樣為什么必須做不重采樣會(huì)發(fā)生什么你給的中心點(diǎn)可能是 7 個(gè)直線點(diǎn)加 10 個(gè)彎道點(diǎn)間距分別是 5 米和 10.5 米而速度向量如果按點(diǎn)數(shù)配每個(gè)點(diǎn)之間代表的空間距離完全不同。線性插值速度的話減速的“陡峭程度”就會(huì)隨點(diǎn)間距變化彎道入口那一段的減速度可能比你設(shè)計(jì)的大兩三倍。重采樣的本質(zhì)是把時(shí)間維度的設(shè)計(jì)轉(zhuǎn)換到空間維度。速度剖面本質(zhì)上是 s弧長(zhǎng)的函數(shù)只有等間距采樣速度曲線在空間上的斜率才有物理意義。cumsum(vecnorm(diff(...)))這段就是算累積弧長(zhǎng)然后interp1在弧長(zhǎng)域上做線性插值把原來(lái)不均勻的點(diǎn)映射到均勻網(wǎng)格上。采樣密度怎么定我給的經(jīng)驗(yàn)值是空間分辨率 0.5 米左右對(duì)應(yīng)總長(zhǎng) 124 米就是 240 個(gè)點(diǎn)。這個(gè)密度下60 米半徑的彎道每?jī)牲c(diǎn)之間的轉(zhuǎn)角約 0.5 度視覺(jué)上足夠平滑。密度再高收益不大反而增加計(jì)算量低于 0.3 米的間距就要注意數(shù)值噪聲了。5.3 橫向加速度反推限速這張表是我常用的速查取橫向加速度上限 1.5 m/s2彎道半徑 R (m)彎中限速 v (m/s)換算 (km/h)典型場(chǎng)景205.519.7停車場(chǎng)掉頭306.724.1城市小半徑路口508.731.2城市主干道轉(zhuǎn)彎609.534.2郊區(qū)匝道8011.039.4快速路匝道10012.244.1高速互通如果你的場(chǎng)景是驗(yàn)證緊急工況可以把上限提到 2.5 m/s2車速相應(yīng)提高約 29%因?yàn)?√(2.5/1.5) ≈ 1.29。但要注意此時(shí)車輛模型的輪胎側(cè)偏特性可能進(jìn)入非線性區(qū)仿真結(jié)果的參考價(jià)值會(huì)下降。反過(guò)來(lái)用也很有價(jià)值給定你希望跑的車速反推需要多大的半徑。比如驗(yàn)證某個(gè)彎道 60 km/h 的通過(guò)性v 16.7 m/s在 1.5 m/s2 約束下需要 R v2/a 278 米。這個(gè)數(shù)字一算出來(lái)你就知道60 km/h 過(guò) 60 米半徑的彎?rùn)M向加速度會(huì)到 4.6 m/s2屬于相當(dāng)激進(jìn)的工況。5.4 仿真主循環(huán)的時(shí)序控制采樣時(shí)間選 0.02 秒不是拍腦袋。判斷標(biāo)準(zhǔn)是單步位移量與彎道曲率的關(guān)系每步車輛前進(jìn)的距離 Δs v·Δt如果 Δs 大到讓離散化后的軌跡明顯偏離圓弧航向角就會(huì)出現(xiàn)階躍。拿彎中 9.5 m/s 算0.02 秒步長(zhǎng)對(duì)應(yīng) Δs 0.19 米圓弧上對(duì)應(yīng)的圓心角是 0.19/60 ≈ 0.18 度完全可以忽略。如果用 0.05 秒Δs 0.475 米轉(zhuǎn)角 0.45 度還湊合用 0.1 秒Δs 0.95 米轉(zhuǎn)角接近 1 度視覺(jué)上就能看出車輛“一格一格拐”。高速工況下這個(gè)差異更明顯——30 m/s 配 0.1 秒步長(zhǎng)單步走了 3 米彎道上基本沒(méi)法看。代價(jià)是計(jì)算量。0.02 秒步長(zhǎng)、25 秒場(chǎng)景就是 1250 步比 0.05 秒多了 2.5 倍。如果場(chǎng)景里有多個(gè)傳感器、每幀都要做檢測(cè)跑一次可能要幾十秒。我的折中方案是調(diào)試階段用 0.02批量回歸用 0.05前者保證可視化正確后者保證吞吐量。真要卡精度可以在彎道段動(dòng)態(tài)調(diào)整步長(zhǎng)但這就復(fù)雜了一般場(chǎng)景用不上。另外StopTime要留余量。按 124 米總長(zhǎng)、平均速度 10 m/s 估大約 12.4 秒能跑完我給 25 秒是有富裕的。如果StopTime設(shè)小了車輛跑到一半仿真就結(jié)束你可能誤以為是軌跡斷了。6. 踩坑實(shí)錄彎道仿真最常見(jiàn)的六類問(wèn)題6.1 車切出車道或“飛出去”這是最高頻的問(wèn)題原因通常有三個(gè)按出現(xiàn)頻率排序。第一路徑點(diǎn)順序錯(cuò)亂或存在重復(fù)點(diǎn)。拼接中心線時(shí)如果接縫點(diǎn)沒(méi)去重cumsum里會(huì)出現(xiàn)零長(zhǎng)度段interp1在這一點(diǎn)上會(huì)產(chǎn)生 NaN軌跡就斷了。表現(xiàn)是車輛在某個(gè)位置突然消失或跳到遠(yuǎn)處。檢查方法很簡(jiǎn)單跑之前打一行any(diff(s) 0)返回 true 就說(shuō)明有非遞增的弧長(zhǎng)。第二速度剖面長(zhǎng)度與路徑點(diǎn)數(shù)不匹配。這個(gè)報(bào)錯(cuò)通常直接報(bào)“向量長(zhǎng)度不一致”但如果你用了廣播機(jī)制不小心讓它跑通了速度就會(huì)錯(cuò)位到別的點(diǎn)上車輛會(huì)在彎心附近莫名其妙加速。第三車輛初始位姿與路徑首點(diǎn)偏離。前面提過(guò)偏離超過(guò)一兩米車輛就會(huì)瞬移。檢查方法是打印ego.Position和waypoints(1,:)對(duì)比差的應(yīng)該是零。還有一種“飛出去”是真的物理原因——速度太快軌跡函數(shù)算出來(lái)的轉(zhuǎn)向角跟不上。這時(shí)候車輛不是瞬移而是沿著切線方向沖出去路徑變成一條直線??吹竭@個(gè)現(xiàn)象先降速再談別的。6.2 傳感器檢測(cè)不到目標(biāo)傳感器返回空結(jié)果排查順序建議這樣走。先確認(rèn)調(diào)用時(shí)機(jī)傳感器生成器需要在advance之后、用當(dāng)前時(shí)刻的scenario.Actors調(diào)用如果你在循環(huán)外面調(diào)那永遠(yuǎn)拿到的是初始狀態(tài)。再確認(rèn)坐標(biāo)系MountingLocation用的是車身坐標(biāo)系不是世界坐標(biāo)系寫(xiě)錯(cuò)了傳感器就裝到車頂上或者車尾去了。然后是視場(chǎng)角。彎道場(chǎng)景里如果你的傳感器水平視場(chǎng)只有 30 度那內(nèi)彎側(cè)的目標(biāo)在很長(zhǎng)一段距離里都進(jìn)不了視野這是幾何決定的不是 bug。想驗(yàn)證這一點(diǎn)把視場(chǎng)角調(diào)到 120 度再跑一遍如果檢測(cè)突然出現(xiàn)了說(shuō)明就是視野問(wèn)題。最后是版本的返回值順序。不同年份的版本里視覺(jué)檢測(cè)器的返回值可能是[detections, numDetections, image]也可能是別的排列用之前help一下確認(rèn)別照著舊帖子抄。6.3 導(dǎo)出 Simulink 之后的斷層場(chǎng)景在腳本里跑得好好的導(dǎo)出成模型之后車不動(dòng)或者場(chǎng)景不變問(wèn)題通常出在這幾處。場(chǎng)景數(shù)據(jù)沒(méi)跟著模型走。導(dǎo)出時(shí)場(chǎng)景是保存成一個(gè)數(shù)據(jù)文件或工作區(qū)變量的Simulink 里的場(chǎng)景讀取模塊需要指向這個(gè)變量。如果你換了機(jī)器或者清了工作區(qū)模型找不到數(shù)據(jù)就會(huì)用默認(rèn)空?qǐng)鼍氨憩F(xiàn)就是路沒(méi)畫(huà)出來(lái)、車也不動(dòng)。采樣時(shí)間不匹配。模型里的求解步長(zhǎng)跟場(chǎng)景的SampleTime如果不是整數(shù)倍關(guān)系車輛位置會(huì)出現(xiàn)插值誤差彎道上表現(xiàn)為軌跡抖動(dòng)。建議把模型的固定步長(zhǎng)設(shè)成與場(chǎng)景采樣時(shí)間一致或者成整數(shù)倍。道路參數(shù)沒(méi)有同步。有些導(dǎo)出方式只把車輛軌跡帶過(guò)去道路幾何要單獨(dú)配置。這時(shí)候模型里車輛是沿著一條不存在的路在跑視覺(jué)上就是懸浮。檢查方法是在模型里把道路預(yù)覽打開(kāi)看邊界線是否顯示?,F(xiàn)象最可能原因快速驗(yàn)證車輛起點(diǎn)閃爍后整體偏移初始位姿與首路徑點(diǎn)不一致打印兩者差值彎道中車輛沿切線沖出速度超過(guò)曲率允許上限按 √(aR) 重算限速軌跡在某個(gè)位置斷裂路徑點(diǎn)重復(fù)導(dǎo)致弧長(zhǎng)非遞增any(diff(s)0)傳感器全程無(wú)檢測(cè)調(diào)用時(shí)機(jī)在循環(huán)外或視場(chǎng)過(guò)窄加大視場(chǎng)角重跑導(dǎo)出后場(chǎng)景空白場(chǎng)景數(shù)據(jù)未隨模型加載檢查模塊指向的變量彎道上航向角一跳一跳采樣步長(zhǎng)過(guò)大步長(zhǎng)減半觀察7. 從單車彎道走向多車交互與批量測(cè)試7.1 編排一輛對(duì)向車單車跑通之后加一輛對(duì)向車是驗(yàn)證感知和決策邏輯的下一步。做法是復(fù)制路徑生成邏輯把車道偏移反過(guò)來(lái)oppLane roadCenters(:,1:2) 1.8 * nor; % 左側(cè)車道 oppLane(:,3) 0; % 對(duì)向車從彎道出口往入口跑路徑需要反轉(zhuǎn) oppWaypoints flipud(oppLane); oppSpeed 8 * ones(size(oppWaypoints,1), 1); opp vehicle(scenario, ClassID, 1, Position, oppWaypoints(1,:)); trajectory(opp, oppWaypoints, oppSpeed);關(guān)鍵點(diǎn)是路徑必須反轉(zhuǎn)。對(duì)向車的行駛方向跟自車相反如果不翻轉(zhuǎn)它會(huì)從彎道出口倒著開(kāi)回入口雖然位置對(duì)但朝向完全錯(cuò)看起來(lái)像在倒車。翻轉(zhuǎn)之后還要檢查速度向量的長(zhǎng)度也跟著變這一點(diǎn)容易漏。時(shí)間上的編排更有講究。你想讓兩車在彎心交會(huì)還是錯(cuò)開(kāi)交會(huì)時(shí)機(jī)取決于兩車進(jìn)入場(chǎng)景的時(shí)間差。trajectory支持延遲啟動(dòng)可以在路徑前面補(bǔ)一段靜止點(diǎn)或者干脆調(diào)整初始位置。我一般用初始位置控制直觀一些把對(duì)向車的起點(diǎn)往遠(yuǎn)處挪讓它晚一點(diǎn)進(jìn)入交互區(qū)域。7.2 把場(chǎng)景參數(shù)化以便批量跑單次仿真說(shuō)明不了什么真正的價(jià)值在于跑一批參數(shù)組合。把整個(gè)搭場(chǎng)景過(guò)程包成函數(shù)是最省事的做法function scenario buildCurveScenario(R, vEnter, aLatMax, dt) if nargin 4, dt 0.02; end vCorner sqrt(aLatMax * R); ... % 內(nèi)部按前面的邏輯生成道路、車輛、軌跡 end這樣外層就能用嵌套循環(huán)掃參數(shù)results []; for R [40 60 80 100] for v0 [10 12 14 16] sc buildCurveScenario(R, v0, 1.5, 0.05); metric runAndEvaluate(sc); % 自己寫(xiě)的評(píng)估函數(shù) results [results; R, v0, metric]; end end評(píng)估函數(shù)里我通常記三個(gè)指標(biāo)最大橫向誤差車輛實(shí)際位置到車道中心線的距離峰值、最大橫向加速度從速度平方除以曲率算、航向誤差收斂時(shí)間從入彎到誤差穩(wěn)定在設(shè)計(jì)值以內(nèi)的時(shí)間。這三個(gè)放在一起基本能判斷某個(gè)控制參數(shù)在彎道上的適應(yīng)性。批量跑有個(gè)坑drivingScenario對(duì)象是有狀態(tài)的跑完之后不能直接復(fù)用必須重新創(chuàng)建。循環(huán)里每次都調(diào)buildCurveScenario就是因?yàn)檫@個(gè)別圖省事在循環(huán)外建一次然后反復(fù)advance。另外每次創(chuàng)建場(chǎng)景的隨機(jī)種子要固定傳感器模型里有隨機(jī)成分種子不固定的話同一組參數(shù)跑兩次結(jié)果不一樣你會(huì)誤以為算法不穩(wěn)定。我個(gè)人在實(shí)際操作中的體會(huì)是彎道仿真這件事八成的時(shí)間花在“把幾何和速度對(duì)上”兩成花在“看結(jié)果”。第一版場(chǎng)景能跑起來(lái)之后別急著加傳感器、加多車先把單車軌跡跑順、把橫向誤差曲線畫(huà)出來(lái)確認(rèn)車輛確實(shí)貼著車道中心走。這個(gè)基線穩(wěn)了后面加什么都是增量驗(yàn)證基線不穩(wěn)后面每加一個(gè)元素你都要重新懷疑一遍到底是誰(shuí)的問(wèn)題。
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
99ri精品视频在线观看| 婷婷丁香五月网| 亚洲男人的天堂婷婷色五月| 99视频在线观看网址| 夜夜躁婷婷AV| 婷婷成人五月天| 97操操网| 五月丁香综合在线| 天天爱天天做天天舔| 99久久丝| 色丁香影院| 色色五月婷婷久久| 色五月激情五月| 色婷婷在线视频观看| 久久九九九九| 五月天激情偷拍| 久热这里只有精品在线观看 | 最新高清无码专区| 欧美精品啪啪| 天天免费日日夜夜夜夜| 欧美色图天堂网| 99欧美| 五月婷婷丁香六月| 日本视频欧美观看免费| 丁香狠狠| 色婷婷888| 粉嫩AV久久一区二区三区| 久久丁香婷| 欧美在线视频免费播放| 丁香五月花婷婷开心| 9这里只有精品| 九九大香视频| 六月天婷婷| 色综合色色| 疯狂做受XXXX高潮A片| 潮汕成人AV片在线| 99热在线精品播放| 色欲色香伊人| 成人做爰高潮A片免费视频| 在线亚洲综合| 婷婷成人综合| 九九热这里只有精品5| 婷婷六月综合在线| 亚洲网视屏| 亚洲精品白浆高清久久久久久| 日韩欧美一级大黄网站| 久9免费视频| 五月丁香啪啪| 色婷五月| 色婷婷久久| 综合色色婷婷| 丁香五月花| 丁香五月婷婷Av| 久久综合激情五月天| 亚洲99精品欧美一区| 五月色婷婷影视在线电影| 激情婷婷丁香色五月| 婷婷五月天情色| 天天爽天天爽| 婷婷激情性爱| 天堂综合久久| 亚洲成人AV电影网| 激情亚洲色图片丁香综合| 影音先锋777xfplay色资源网站| 九九热在线观看视频| 五月天另类小说久久小说网| 五月色情婷婷开心五月色情| 五月丁香婷婷六月| 99在线视频播放| 天天日天天干天天插天天射| 五月婷婷六月天| 亚洲成人日韩无码精品| 欧美综合五月丁香五月天| 婷婷丁香色五月| 六月婷婷AV| 色综合色欲综合天天免费| 婷婷五月天视频亚洲| 五月丁香在线| 97干在线| 99久久99久久综合| 亚洲激情综合网| 99热这里只有精品4| 少妇人妻人伦A片| 久久九九综合| 综合久| 91窝窝| 久久综合丁香五月| 日本欧美在线| 日本 欧美在线| 色婷婷伊人| 91人人网| 五月丁香婷婷啪啪网| 伊人久久婷婷五月天激情四射| 激情久久久| 激情综合色婷婷啪啪六月天| www.五月天婷婷| 激情性爱五月天网页| 色综合色综合婷婷热| 色综合伊人网| 九月av| 韩国激情五月天综合网| 伊人热婷婷| 日夜夜久久| 超碰免费成人网站| 五月涩涩网| 成 人片 黄 色 大 片| 色婷婷手机在线| 啪啪激情网| 黑人熟妇一区二区三区| 激情丁香九九五月综合网| 一本婷婷丁香久久| 国产精品人人妻人人爽| 日韩视频女神99| 天天爽天天摸人妻综合网| 婷婷激情久久| 狠狠人妻久久久久久综合丁香| 丁香五月性| 97色在线| 99热这里有精品| 色爱99| 99热超碰在线| 国产精品人人妻人人爽| 嫩草极品| 精品人妻一区二区三区在| 超碰一区二区| 五月草视频| 超碰成人公开| 亭亭五月天黑人2014| A久久| 337p大胆噜噜噜噜噜91Av| 五月天婷婷黄色| 婷婷丁香18| 思恩热国产视频右线观看| 激情五月丁香五月| 一本道综合网| 91伦| 激情深爱综合网| 午夜不卡久久精品无码免费| 99re热视频这里只精品| 天综合日日夜综合7799| 五月婷婷激情| 色婷婷五月天激情久久| 淫视馆av三区| 久久伊人五月天| 美欧成人视频| 激情综合一| 热热久久精品视频| 艹B高清无码| 九九爱激情| 金品在线视频99| 日韩黄色电影| 久久久妻人人人| 亚洲人人操| 岛国av网| 欧美婷婷色五月网| 综合五月婷婷| www.五月激情红色| 日本久久人| 大香蕉综合| 人人亚洲| 激情综合网激情五月婷婷| 六月丁香社区| 色啪网| 天天干,夜夜爽| 国精产品一区二区三区| 色婷婷88| 色五月激情五月| 26uuu欧美激情另类| av在线观看网址| 亚洲熟女色| 播五月婷婷开心| 丁香综合日产精品久久| 超碰色色综合| 国色天香伊人狠狠色| 月色色综合婷婷网| 美女五月天| 丁香五月婷婷呀| 操精品9| 色老久久| 五月四色婷婷| 黄色精品五月婷婷| 狠狠干,狠狠操| 99热这里只有免费精品| 婷婷丁香社区网| 中文字幕 码精品视频网站| 深爱激情四射| 色欲五月婷婷| a性生活久久无| 丁香五月影视| 一级操逼内射在线视频| 色丁香五月婷婷婷| 人妖色AV色综合| 97天堂| 婷婷五月天资源| 免费婷婷| 激情五月狠狠喔| 97香蕉久久超级碰碰高清版| 综合六月激情婷婷| 色欲婷婷夜夜| 99噜噜| 国产精品人成A片一区二区| 五月婷婷在线综合| 成人婷婷色五月天| 青青草原亚洲天堂| 色色五月激情| 婷婷五月激情欧美大胆视频| 九九热精品视频| 五月色影院| 国产肥白大熟妇BBBB视频| 怕怕視頻| 欧美婷婷色五月网| 天天肏在线| 免费看欧美成人A片无码| 欧美性爱丁香五月| 五月婷婷xxx| 热久久精品视频网站| 开心激情站| 欧洲色| 欧美高潮9| 日本久久高清| 五月天国产婷婷精品视频在线| 97狠狠色| www.com在线操视频免费观看| 亚洲小电影在线观看黄999| 色色自拍视频网站| 日本狠狠干| 99热最新网址| 琪琪色影音先锋| 金桔一区二区ab地址| 天天草天天舔| 久久久天天啊| 日韩国产在线精品| 99re66热这里只有精品| 五月天综合在线观看视频| 99久久9| 超碰成人AV| peg 2区三区四区的| 色五月欧美| 色婷婷小说网| 高清国产AV| 就爱干 在线| 免费看成人747474九号视频在线观看| 亚洲成人AV高清字幕| 8区视频在线| 99热这里只有精品一区| 色婷五月天| 色天堂97| 婷婷丁香五月高清| 日本五月天激情| 婷婷九月色| 日日噜噜久久婷婷五月天| 免费色色色| 97人人做| 9久热在线视频| 99er6| 五月丁香激情婷婷| 久99精品视频| 97婷婷五月天| 99精品视频免费观看近期发布| 久久精品婷婷五月丁香| 五月婷亚洲精品| 中国操逼99| 超碰人人在线| 久久女人天堂| 超碰在线综合| 色婷婷成人| 日本欧美成人片AAAA| 狠狠干婷婷| 婷婷丁香五月亚洲综合网在线视频观看| 性爱久久| 99ri精品视频在线观看| 91成人电影| 涩涩激情五月婷婷| 激情五月天色婷婷综合| 丁香五月成人| 思思热思在线精品视频| 开心激情婷婷| 亚洲精品国产成人AV在线| 天天摸天天透天天舔| 亚洲爆乳无码精品AAA片蜜桃| AV在线中文| 人人摸人人澡人人| 另类视屏| 殴美综合激情五月天免费视频| 99视频在线观看地址| 久久无码激情视频| www夜夜| 国产精品色婷婷99久久精品| 婷婷五月综合啪| 国产女人十八水真多1| xx色综合| 国产真人做爰视频免费| www·五月天| 成人精品在线观看| www.sd-xiangsu.cpm| 国产成人综合网| 亚洲视频操| 性爱视频久久| 免费成片在线观看| 无码色| 99久久.www| 天天天天天天天操| 色九月丁香婷婷蜜桃在线观看| 思思热在线视频99| 一级视频网址| 天天爱夜夜爽| 日韩无码91| 26uuu亚洲| www.99精品日操伊人乱碰在线| 日日夜夜青青草| 少妇性按摩无码中文A片| 六月婷婷激情| 久久久噜噜噜久久人妻| 天天色综合色色色色色。| 五月丁香在线| 五月婷婷久久久| 香蕉综合在线| 欧美天天爽| 五月综合激情| WWW五月婷婷| 亚洲天堂久久| 久久婷婷五月激情网站| 99re久热| 超级碰碰91| AV操逼网| 99综合网| 激情都市五月天| 99久久9| 都市激情五月婷婷综合| 五月丁香花成人社区| 激情六月五月婷婷综合网| 欧美叉叉叉BBB网站| 好好干av| 丁香久久激情俄| www.亭亭五月天| 日本波多野结衣视频| 深爱五月网| 91大神在线免费看视频全集男男一起操| 五日激情综合| 少妇激情基地| 日本强伦片中文字幕免费看| 天天做天天摸| 女同激情久久av久久| 91精品综合久久久久久五月丁香| 天天爽天天弄| 91精品综合久久久久久五月天| 天天在线XXX| 婷婷九月在线| 五月丁香影视| 五月丁花色综合网| 午夜日韩久久久网站| 婷婷五月综激情| 噜噜狠狠| 欧美久久九九| 伊人婷婷色| 操碰99| 久久久噜噜噜久久人妻| 99精品在线下载| 91久久18| 久久东京热婷婷五月| 五月婷婷激情刺激| 超碰人人在线观看| 婷婷久月| 欧美性色五月天| 色色婷婷婷丁香五月天| 五月婷婷丁香大陆免费| 啪啪啪丁香五月| 99国产精品久久久久久久久久久| www.xtbsty.cn.com蜜乳AV| 色欲一区二区三区精品A片| 五月婷婷亞洲中文| 色色色欧美| 激情丁香五月婷婷| 婷婷五月丁香伊人| 日日爱678| 日韩乱轮AV| 婷婷爱婷婷| 丁香 久久| 久热这里| 婷婷五月天综合AV| 99在线观看视频蜜臀| 久婷婷视平| 五月丁香好婷婷A片网| 99在线爽| 黄色成人AV在线| 久久九九99| www开心激情网| 9福利性视频欧美| 婷婷久久五月天| 操操操AV| 五月丁香网av| 五月天另类图片区99| 大香网伊人久久综合| 色综合综合色| 色色五月婷婷| 婷婷丁香五月婷婷| 一本道综合网| 99热人人| 亚洲欧美日韩另类| 能看的AV| 精品久久9| va婷婷在线免费观看| 成人中文字幕在线| 色五月丁香91| 99精品综合| 综合一本道| 丁香婷婷综合激情五月色,开心五月丁香花综合网,激情综合五月亚洲婷婷,五月天 | 综合久久五| 91美女被操| 丁香五月婷婷天| 色色综合网站| 2015超碰| www.韩日视频| 免费看欧美成人A片无码| 97超碰在线免费观看| 第四色婷婷色五月| 欧美色五月| 色色色宗合网| 色噜噜狠狠色综无码久久合欧美| 天天爽天天爽| 日日狠狠久久偷偷四色综合免费| 色A网| www.日韩国产| 91综合视频在线| 天堂无码人妻精品AV一区| 大香蕉中文| 99视频精品全部免费观看| 婷婷伊人綜合中文字幕| 99热欧美偷拍| 六月婷婷操逼| 欧美搡BBBBB摔BBBBB| 色久女| 91人人爽久久涩噜噜噜| 第四色婷婷色五月| 夜夜骑日日操| www.色婷婷| 久久婷婷的综合色丁香五月| 婷婷五月丁香青青草在线| 婷婷五月天成人| 天堂久久婷婷| 婷婷五月天播播| 91人妻视频| 五月婷婷五月丁香综合| 婷婷五月小说色综合| 九九精品婷| 九九99九九精品免费| 五月天伊人网| 久久精品只有这| 免费观看的AV| 亚洲日韩26uuu| 26uuu视频欧美| 99在线69| 色综合久久综合中文综合网| 国精产品一区一区三区免费视频| 另类天堂| 中文字幕在线免费观看视频| 五月丁香六月成人| 婷婷午夜| 玖玖热视频| 色五婷婷在线视频| 五月天天天天天天天天天天天天天天天婷婷婷 | 女人天堂久久| 激情综合五| 色五月婷婷在线观看| 婷婷五亚洲| 开心五月婷| 五月色丁香国产在线视频| 另类亚洲视频| 小色小蛇伊人婷婷色香五月| 亚洲午夜一区二区| 在线资源av-超碰中文在线-成人AV | 日日爽夜夜爽| 大香蕉九九| 97操在线视频| 在线播放中文字幕| 五月激情婷婷丁香| 色婷婷久久| www.五月天婷婷| 91九色在线| WWW久久久| 91在线日| 日韩久热| 五月激情啪啪| 婷婷五月天激情小说| 日韩AAAAA| 天天干天天干天天干| 五月婷婷开心网| www.99热| 天天射影院| 日韩免费视频| 激情色五月天| 91九色在线观看免费| 毛v一区二区视频| 五月天基地| 六月丁香婷婷色狠狠久久| 性爱人人网| 91精品久久久久久久久久久久| 9 1在线视频| 久人操| 国产av基地| 色狠狠综合网| 久久精品色| 色色色99韩| 久久婷婷五月天激情| www.激情五月天com| 婷婷丁香在线播放| 五月婷婷六月丁香在线视频免费在线观看| 日本久久人人| 婷婷啪啪| 啪啪日本欧美| 射琪琪| AV在线大香蕉| 开心五月激情| 天堂草在线观| 先锋资源91| 色婷婷久久| 成功精品影院| 婷婷丁香久久网| 中文字幕欧美精品久久| 欧美日本黄色| 99热思思在线观看| 欧美爆乳一区二区三区| 桃色五月天| 欧美久久婷婷| 欧美私人家庭影院| 丁香五月婷婷久久久| 一起肏在线视频| 亚洲中文字幕AV| 日韩黄黄| 五月天综合视频| 91丨九色丨丰满人妖| 五月色婷婷综合| 国外亚洲成AV人片在线观看| 伊人青涩网| 丁香五月激情棕合| 69五月天视频| av性爱网站| 婷婷五月色激情欧美激情| 99热免| 五月婷婷爽爽爽| 丁香六月婷婷社区| 高清无码.com| 国产精品五月天婷婷| 婷综合| 亭亭五月丁香五月天激情| 国产精品色情AAAAA片软件| 狠狠色婷婷色| 好好干Av| 五月丁香婷婷俺| 极品另类| 国产又爽又猛又粗的视频A片| 九九九九成人| 密黄站| 婷婷开心激情五月激情网| 97久久久久| 欧美槡BBBB槡BBB少妇| 99在线视频观看| 美女精品一级不卡视频| 五月天婷婷爱丁香中文字幕| 伊人五月天| 欧美色五月| 婷婷五月天性爱视频| 六月丁香啪啪| 色色色9| 性色五月天| 九一九九黄色| 欧美久草在线日本一级特黄大片做受9在线观看韩国电影《两个女人》未删减-毛片 | 在线视频激情网站| 婷婷五月天伦理| 亚洲熟妇无码乱子AV电影| 亚洲爆乳无码精品AAA片蜜桃 | 99久.| 五月婷色啪| 91丨九色丨熟女|新版| 热思思九九| www.久久爱.com| 丁香五月婷婷亚洲另类| 91婷婷丁香| 天天肏视奸| 91婷婷丁香五月天免费视频网站| 激情五月婷婷六月丁香| av在线资源| 五月婷婷黄| 五五月五月| 午夜激情综合| 99久久久精品| 99久久九九| 丁香五月av在线| 99热在线看| 麻豆精品| 色狠狠色狠狠| 丁香色婷婷| 玖玖午夜视频| 人人干Av| 超碰在线人妻| 欧日韩成人| se99视频| 99丁香婷婷综合网| 99热这里都是精品| 婷婷六月啪啪| 丁香综合日产精品久久| 91色婷婷综合久久中文字幕二区| 激情综合五月婷婷六月丁香| AA片在线观看视频在线播放| 九九热在线观看6| 欧美这里只有精品| 蒲京久久无码视频| 激情五月天开心网丁香无码| 色情综合网| 婷婷久久在线| 五月婷婷福利| 国产精品涩涩涩视频网站| 五月婷婷AV| 人人干人人操人人摸| XX色综合| 激情综合婷婷| 99色精品| 五月丁了香蕉综合| 天天干天天射综合网| 日本一级黄色片。| 国产精典视频在线观看| 激情五月天婷婷五月天| 日韩国产AV播放| 思思热性操| 九九色逼| 91超碰人人操| 九色91视频| 在线视频99| 女人被男人吃奶到高潮| 五月婷婷色啪| 国产精品色色| 香焦网五月天| 国产avapp 网| 婷婷五月激情的图片| 丁香婷婷影院| 九九色情网五月天| 狠狠久综合| 亚洲字幕AV一区二区三区四区| 密黄站| 精品五月天| 91热在线| 日韩啪啪视频| 色V狠狠的干| 综合久久久| 亚洲视频国产一区| 色婷久| 99超碰人人| 四色五月婷婷| 97色视频网| 韩国天天婷婷| 在线色婷婷| 久久久久久久久久人妻| 男女啪啪视频久 9| 成人超碰Av| 超碰人人在线观看| 色婷婷裸体色性在线| 欧洲综合一区| 婷婷综合色播网| 9色天堂| 欧美国产一区二区三区| 色婷婷五月天无码视频| 五月丁香六月欧美综合网站| 日本视频欧美观看免费| 在线看片av| 91九色精品熟女内射| 婷婷亚洲综合| 五月永久激情| 十二区无码| 亚洲激情五月天| 七七九色| 大香蕉五月天| Va另类视频| 色都都狠狠色都都色综合色| pacopacomama 070722_670 素人奥様初撮りドキュメント 103 大久保純子 | 天天干-天天日| 精品综合网在线| 天天骑天天操| 中文激情网| 亚洲综合在线视频| 久久久久久丁香五月| www.91AV.COM| 欧美影院婷婷| 无码天天操| 嫩草视频。| 亚洲免费av在线| 五月丁香啪啪| 亚洲三A| 婷婷狠狠色| 婷婷五月天堂| 色偷偷AV亚洲男人的天堂| 丁香婷在线| 铁牛TV人妻| 思思热视频| 丁香五月天五码婷婷| 中文字幕+中文在线| 色色色国产| xx色综合| 丁香婷婷午夜| 激情五月天婷婷丁香| 久久有码| 九热视频精品| 99在线精品观看99| 天天操屄网| 丁香五月欧美激情| 成人国产欧美大片一区| 九九热精品视频| 五月天丁香六月综合| 99re欧美精品| 色综合天堂| 欧美天天综合网站上去吧| 丁香五月天社区婷婷| 色婷婷狠狠18禁| 五月丁香色狠狠干大屄| 久久伊人9| 五月丁香六月激情| 五月天婷婷视频小说| 国产色色在线| 九九综合五月欧美| 五月丁香六月激情| 激情丁香五月天图片| 99re6热在线精品视频播放速度 | 五月天五月色| 欧美99视频| 中文字幕精品无码一区二区| 五月婷婷九九热| 色色影院aaaav| www综合久久| 六月丁香婷婷综合在线| 天天日天天色| 综合一啪| 五月天播播综合| 婷婷五月激情小说| 久操热| 国产亚洲色婷婷久久99精品91 www.riverspirits.org www.hnnun.com www.changh | 老师高潮流白浆喷水的A片| 99热这里| 欧美久久一级内射wwwwww.| 五月丁香久久| 亚洲成片在线观看| 亚洲小电影在线观看黄999| 玖玖在线资源视频| www.刺激色网站www.| 亚洲五月天激情| 丁香五月成人| 色婷婷a三区麻| 99久久婷婷国产综合精品草原| 熟女激情五月天| 亚洲99激情| 中文字幕欧美久久| 婷婷激情久久| 夜夜躁爽日日| 四色99久久| 五月天开心成人网| 日韩在线视频中文字幕| 丁香婷婷影院| BBWCUCKOLD精品熟妇| 91无码视频| 国产午夜精品久久久观看| 新99色色色色色色| 日本美女上人| 69精品无码一区二区三区| 性做久久久久久久免费看| 欧美婷婷日本| XX色综合| 欧美性爱5月天天天看| se99高清无码| 久99热在线观看| 最新婷婷五月丁香| 黑人糟蹋人妻HD中文字幕| 日本一道久久| 五月丁香六月综合激情| 婷婷激情五月综合丁香社| 香蕉婷婷色五月| 夜夜资源站| 色色色9 9 9| www五月婷婷88导航| 五月婷婷色色| 婷婷金品综合视频| 色婷婷综合亚洲| 丁香五月天在线观看| 五月婷婷乱| 五月丁香好婷婷姑娘综合网| 丁香五月影院| 插逼综合网| 91精品丝袜久久久久久久久粉嫩| 亚洲狠狠丁香婷婷香蕉| 国产亚洲精品久久久久久郑州| 日韩欧洲亚洲| 91青娱乐青青草| 六月丁香社区| 色爱终和网| 欧美毛片www| 亚洲激情无码久久| 九九热只有这里精品| 91超碰在线观看| 国产成人在线不卡AV| 色九月综合网| 国产91在线视频| 万月丁香狠狠爱| 亚洲妇女熟BBW| 欧美在线视频99| 欧美激情VA永久在线播放| 亚洲色综合| 久久婷婷五月综合伊人| 丁香 亚洲 久久| 看片视频在线免费日产在线看| 97色色在线视频| 五月成人综合| 婷婷五月天成人综合网| 五月婷婷婷婷婷婷艺术| 色婷五月丁香久亚洲| 五月www| 亚洲 精品 综合 精品| 五月天婷五月天综合网小说首页-五月天激激婷婷大综合,婷婷亚洲综合五月天小说 | 丁香五月天啪啪| 97AV在线视频| 97操操操| 中文字幕在线日亚州9| 亚洲欧美婷婷五月色综合| 91碰| 激情丁香社区| 久热久| 激情综合啪啪啪| 九九这里只有精品在线视频| 国产片天天爽夜夜爽| 五月总合激情网| 精品99这里有| 婷婷97狠狠干| 欧洲亚洲免费视频区| 天天摸天天爽| 免费久久这里只有精品99| 久久 这里只有精品1| 日日噜狠狠色综合久久| 麻豆五月丁香婷婷| 丁香成人视频| 日韩色色视频| 六月撸婷婷| WWW久久久| www.婷婷五月| 色噜噜狠狠色综无码久久合欧美| 欧美经典片免费观看大全| 婷婷97狠狠成人网站| 男同91| 丁香五月婷婷老师网站| 开心久久网婷婷| 91丁香| 大香蕉久久久久| WWW,五月天| 五月天成人在线视频丁香| 色五月婷婷大| 五月丁香在线综合| 色婷婷五月天| 怡红院视频| 超碰狠狠操| 久久无码成人| 亚洲人人艹| 色欲五月婷婷| 青青草原中文字幕| 五月社区婷婷激情| 婷婷丁香成人五月天| 欧美激情综合色综合啪啪五月| 丁香五月首页| 91精品久久久久久综合五月天| 亚洲精品白浆高清久久久久久| 久久婷婷免费| 中文久久婷婷| 99er日韩| 久久只这里有精品| 99久在线精品99re8热| 殴美激情综合网| 五月婷婷久久综合| 丁香五月婷婷社区| 四月婷婷五月丁香| 丁香五月香蕉在线| 五月开心啪啪| 爱婷婷都市激情| 婷婷六月色开| 男女啪啪做爰高潮无遮挡| 丁香久久激情俄| 玖玖综合色| 激情网狠狠干| 亚洲视频色婷婷| 色五月婷婷丁香五月| 嫩草极品| 久操97| 99丁香五月婷| WWW,婷婷,COM| 久久久大香蕉| 内射干少妇亚洲69XXX| 秋霞av不能| 99热欧美| 99热777| 婷婷久久丁香五月| 丁香五月综合| 丁香婷婷五月人体| 五月丁香六月久久| 天天爽天天草| www.91久久| 久久精品无码一区| 大香线蕉伊人| 情五月亚洲婷婷| 激情欧美五月丁香| 五月丁香六月激情在线| OYIWbGcPu8H| 九九热99视频| 天天操,夜夜骑| 九九九热精品| 九九色婷| 九色婷婷| 激情性五月天免费小说视频| 97干在线视频| 日本色色视频| 91操碰| 色五XX| 色色色网站| 99热观看| 六月激情久久婷婷| 久久五月天婷婷| 五月天婷婷成人网| 殴美日韩成人| 丁香久色| 亚洲欧洲午夜成人精品av| 色婷婷成人做爰A片免费看网站| 久久九⑨| 婷婷基地成人五月天| 99热在线看| 极品人妻VIDEOSSS人妻| 日韩另类在线观看| www激情网| 丁香九月激情| 欧美日韩精品一区二区三区钱| 国产精品久久久99视频| 日日噜狠狠色综合久| 国产69久久久欧美黑人A片| 涩九九九九| 六月婷婷亚洲| 人妻少妇色综合| 成人网站高清无码| 五月婷婷丁香大陆免费| 在线看片av| 在线播放成人| 人人舔人人色人人高潮| 亚洲另类婷婷综合| wwww.色婷婷| 99热精品少| 午夜成人天堂久久无码日韩久久| 久久这里只有精品视频15| 秋霞黄色一级久久| 99视频九九热| 日本久久九| 婷婷五月综合婷婷| 丁香五月婷婷偷拍| 激情婷婷五月社区| 丁香狠狠| 色综合九九| 五月婷色丁香| 五月激激网w'w'w| 五月丁香综合| 91婷婷在线观看| 九九机热| 少妇被下春药玩弄A片| 久99热| 啪啪色区| 亚洲韩国日产综合AV| 极品 少妇 内射| 色婷婷狠狠| www99在线观看视频| 五月丁香亚洲综合| 大香蕉久久综合网| 久久6这里只有精品| 大香蕉久操| 久久综合色五月| 丁香综合网| AA片在线观看视频在线播放 | 激情5月婷婷狠狠干| 综合婷婷| 五月天婷婷网站888| 另类激情首页| 国产精品 的国产| 天天综合天天玩夜夜玩天天玩夜夜玩| 激情婷婷六月天| 丁香花五月天激情| 色日本综合| 日韩精品99久久| 色婷婷丁香香香蕉视频| 久在线88综合| 99激| www超碰| 亚洲五月天,激情视频| 99久久久久久| 91狠狠色丁香| 色亭亭五月天丁香综合AV - 百度 - 百度 | 天天爽在线视频| 激情久久久久久| 超碰在线观看9| 婷婷六月综合基地| 99九精品| 996er热| 99日视频在线| 亚洲欧洲中文日韩久久AV乱码| 五月丁香狠狠爱婷婷综合| 99久久er| 99原创自拍视频在线观看| 五月深爱婷婷| 亚洲亚洲人成综合网络| 久久视频婷婷视频| 国产精品VIDEOSSEX久久发布| 激情com| 成人片在线播放| 99re热视频这里只有综合亚洲| 人人综合久| 大香蕉久久草| 另类激情五月| 婷婷五月天黄色| 日韩婷婷| 婷婷色色网| 日日夜夜狠狠| 丁香亭亭久久| 99热最新网址| 色综合天天网| 欧洲电影在线观看免费版英语版| 夜夜操夜夜姧| 色色五月婷婷网| 久久婷婷色五月| 婷婷五月天大香蕉在线视频观看| www色婷婷com| 国产1区2区| 亚洲99在线| 综合色网站| 丁香激情网| 五月丁香婷婷色| 丁香五月 无码| 偷偷与邻居做爰完整视频| 婷婷天天婷婷天天澡| 九九热免费视频| 欧美天天搞| 久草性爱| av中文在线| 婷婷伊人| 思思热在线精品视频网站| www.金莲av| 99爱在线精品视频免费观看| 日本精品九九九| 婷婷射丁香| 色婷婷五月天av在线| 超碰免费在线| 99久久er| 91九九热| 九九色热| 九九99免费视频| 婷婷色影院| 丁香5月啪啪| 夜色.cnm| 综合伊人久久| 亚洲色色色色色色色色色| 开心五月婷婷| 亚洲丁香五月| 九九视屏| 色婷婷五月在线| 丁香五月天在线直播观看| 99色在线观看视频者| 五月婷在线观看| 久久停停超碰| 天天综合精品| 丁香婷婷综合激情五月色| 天堂网色色| 丁香婷婷色五月| 天天爽,天天操。| 美女被肏网站在线看| www,色婷婷| 色五月xxx| www99精品在线观看| 五月丁香六月激情| 婷婷综合激情| 久草热8精品视频在线观看 | 俺去啦综合网| 69久久99精品久久久久婷婷| 五月丁香色综合| 亭亭五月激情亚洲在线| www.com.色色| 99热手机在线精品| 开心色播色五月婷婷| 最新日韩久热免费视频看看| 狠狠干在线| 操丝袜视频影院导航| 9热在线观看| 六月色色| 婷婷噜噜| 99黄色性生活| 国产精品电| 99爱爱网| 亚洲婷婷月丁香五月| 久久艹网| 五月丁香六月天| 激情五月www| 婷婷激情九月| 欧美大片免费观看| 综合网啪| 精品无码色欲AV| 色五月,婷婷大香蕉| 深爱五月婷婷| 亚洲第一精品网站| 成人五月天综合网| 超碰成人影视| 99久久性爱| 伊人五月成人| 欧美A级网站| 九九99九九精品视频| 99色综合| 97婷婷五月天| 九九这里只有精品在线视频| 色九月丁香婷婷蜜桃在线观看| 91九九| 综合激情深爱| 99九九久久| 男人的天堂99| 这里只有精品视频在线| 天天色宗合| 天天搞夜夜叫| 天堂亚洲 在线| 99色视频| 日本久久人| 深爱激情久久| 亚洲成人免费在线| 精品国产a| 日本色色色| 国产精品色色| sewuyuejiqingwang| 激情综合在线观看| 97操碰98| 欧美激情VA永久在线播放| 79精品视频在线观看,| 五月激情综合激情五月| 亚洲婷婷丁香| 日本久久色| 丁香五月天电影| 婷婷综合五月| 五月婷婷干| aⅤ79成人片| 亚洲AV成人无码电影| 色狠狠色噜噜AV天堂五区| 亚洲永久免费| www.com五月天| 五月婷婷成人w| 9久精品视频| 色99免费视频中文| 草草夜夜操| 99国产在线| 色播播五月天| www.激情五月天com| 亚洲色9| 丁香六月婷婷综合欧美| 久久99大| AA片在线观看视频在线播放| 99精品久久久| 五月婷婷天| 婷婷五月精品在线| 在线国产精品色| 伊人久久大香线蕉av一区| 色亭亭九月| 欧美成人AAA片一区国产精品| 午夜色婷婷| 亚洲综合五月天婷婷| 婷婷五月色天| 激情网婷婷婷| 日本狠狠爽| 99热这里是精品| 99色在线观看视频| 伊人激情综合| 国产精产国品一二三在观看| 九九99久久| 九九热re99re6在线精品| 五月天五月天激情网| 青青草蜜臀| .操區COm| 国产成人网址| 97人人操| 婷婷刺激综合| 婷婷婷五月香蕉| 色色五月婷婷狠狠| 伊人五月婷婷| 91一起艹| 综合99视频| 97精品综合久久内射| 天堂美国久久| 97超碰婷婷五月天| www.夜夜操| 中文av网| 色婷婷久久| www.精品99| 97se视频在线| 热久精品| 丁香五月天激情免费在线观看AV777| 五月婷婷激清网| sewuyue第四色| 丁香五月婷婷丫| 激情综合青草| 在线五月婷婷小电影| 丁香五月婷婷啪啪啪| 亚洲av日韩无码| 五月激情射| 婷婷欧美激情| 色婷婷四色| 免费啪啪啪网站| 97人人操人人爽| 五月婷激情影院| 天天干天天操天天射| 色色色网站| 噜一噜在线| 色婷婷六月天| 丁香婷婷九月| 婷婷成人AV| 久艹大香蕉| 久久总和99| 精品女人九九九| 97色欧美| 色三级色三级| 99热9999| 开心五月激情网| 久久九九99| 五月天com| 91热爆在线| 色情成人五月天| CHINESE熟女老女人HD视频| 丁香婷婷综合激情五月色| 国产精品人成A片一区二区| 人妻体体内射精一区二区| 亚洲欧洲中文日韩久久AV乱码| 天堂伊人干| 99人人爽| 涩婷婷视频快播人妻| 免费看片操逼| 九九热在线99| 九九99九九99偷拍视频免费看| 在线中文字幕视频| 色综合夜夜| 色亚洲视频| 色情五月天首页| site:feetmall.com| 婷婷五月天在线综合| 激情婷婷六月天| 婷婷五月色综合| 国产成人网址| 久久99综合| 国产精品第一国产精品| 色五月丁香91| 五月天堂色色| 国产精品操| 超碰国产在线| 永久99免费视频网站| 三十路磁力链接| 人人操人人爱丁香五月| 亚洲这里只有精品| 中文色婷婷| 久久这里都是精品| 亚洲精品又粗又大又爽A片| 中国无码av| 色色色五月| 香蕉久久六月| 综合97五月| 丁香五月天婷婷中文| 色婷婷五月天小说| 播五月丁香三月婷婷| 五月激情视频| 99成人精品视频| 精品福利911|