欧美成人午夜精品久久久,国产?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
返回資訊列表
婷婷六月五月天综合| 婷婷丁香五月六月激情| 狠狠爱激情网| 伊人影院久久网| 五月开心网| 精品人妻伦一二三区久久| 色情五月天首页| 99爱99操| 超碰熟女拍拍| 一区三区视频有限公司| 三十熟女| 丁香五月性爱| 99热99色| 五月婷天天搞视频| 婷婷玉月丁香五月在线视频| 丁香五月丐人妻| 精品99在线| chaopeng在线人人| 热91久| 综合色色婷婷| 偷拍91九色| 丁香网五月天激情| 婷婷丁香水多多视频| 三级片AAA久久久AAA久久久AAA| 久久性操| 激情六月色| 在线观看玖玖资源免费观看| 久久综合热17c| 五月婷婷啪啪啪| 狠狠综合色网| 丁香五月婷婷久久久| 91919191919久久成人视频| 色偷偷五月天| 久久综合丁香激情五月| 97操操操| 色播五月天激情| 另类五月激情| 九九热经典视频在线观看| 欧美激情xxxXX| 国产67194| 殴美日韩成人| 情一色一乱一伦一91A| 第四色色六月色综合| 婷婷五月天在线观看| 色色网站| 九九热精品视频| 九九操操| 色综合久久44| 综合啪啪| 五月婷婷开心网| 婷婷五月天激情基地| 99性感视频| 激情婷婷五月黑人| 婷婷六月激情丁香| 操丝袜视频影院导航| 色色综合日韩| 色国产五月| 五夜婷婷| 色性综合| 开心五月激情| 女人天堂av| 婷婷色五月婷婷姐妹| 久久99综合| 五月丁香激情四射| 亚洲国产成人在线| 久久九九99| 亚洲AV成人精品日韩在线播放| WWW色色色COm| 色停停香蕉视频| 丁香五月激情综合| 欧美一级毛卡片无码| 国产欧美性成人精品午夜| 色色色五月婷婷| 婷婷六月天| 五月婷婷开心网| 五月婷婷片| 五月丁香大香蕉| 日本三级日本三级99| 九九亚洲综合| 色五月激情婷婷| 99婷婷| 婷婷久久网| 亭亭色网| 思思热在线播放| 9久久精品| 久久婷婷精品| 丁香五月性| 思思re99视频在线观看| 色情综合| 少妇高潮呻吟A片免费看软件| 精品国产一区二区三区四区阿崩| 热99色| 丁香九月色| 黃色三级三级三级三级 qixing300.shrkbk.com www.jinbozs.com tianmiaosw.com | 色婷婷狠狠| 欧美久热| 狠狠干综合| 99热精品在线| se色婷婷视频| 综合久久综合五月天婷婷| 婷婷丁香六月天激情四射网| 亚洲有码在线视频| 另类专区在线| 狠狠操之狠狠操| 99热在线里有精品| 五月天激情子轮| 伊人AV五月婷| 天天综合网站| av在线资源| 色综合天天| 国产精品国产成人国产三级| 99热草草| 97在线日本| 国产激情在线| 五月天丁香啪啪综合| 激情播丁香| 99爱免费在线视频| 色播五月天激情| 国产激情在线| 欧美日韩aaa| 日本人妻伦在线中文字幕| 五月天婷婷色| 天天干,夜夜爽| 欧美啪啪9| 久久五月天网| 九九99免费理论| 思思99久久| 婷婷五月18永久免费视频| 婷婷久久免费| 亚洲成人AV一区在线观看| 91操屁股| 婷婷五月天视频小说| 99re最新地址| 婷婷 伊人 久久| site:ornaments52.com| 视频免费精品免费精品免费精品免费精品免费精品免费精品免费99 | 人人干99| 亚洲9久久精品| 五月激情丁香啪啪| 婷婷丁香五月av| 丁香涩涩爱| 国产成人综合网| ji'qi'luan'ren'lun| 婷婷五月激情中文字幕| 精品久久9| 亚洲区视频| 色婷婷丁香五月天| 婷婷五月精品中文字幕| 婷婷色综合| 99热大| 欧美成人在线观看| 中文人妻主播久久| 99啪99| 日本啪啪视频HD| 99久re热| 五月情色天| 色色国产| 亚洲在线操| 快色t v在线入口| 亚洲久久激情| 国产人妻777人伦精品HD| 色综合九九色综合88| 人妻操操色| 激情丁香五月天| 久久99精品久久久久久三级| 9l视频自拍九色9l视频在线观看| 久婷久婷激情肉| 婷婷开心综合人妻小说网址| 99欧美精品99日本精品| 同性gv国产精品一区二区| 婷婷人人操| 狠狠色五月| 亚洲综合五月| 日韩在线观看网址| 91啪级电影| 色综合区| 超91热| 五月停停大香蕉| 五月天色图| 美女精品一级不卡视频| 91嫩草国产线观看亚洲一区二区| 精品三区影院| 午夜不卡成人一区二区| 色五月婷婷亚洲| 亚洲深喉AV| 天天色综和网| 五月激情在线| www,婷婷五月天777me,com| 极品人妻VideOssS人妻| 成人五月天丁香| 精品久久人妻热| 天天色色天天| 五月丁香婷婷激情| 国产免费av在线| 少妇人妻凹凸视频| 日本123区日韩欧美不卡在线看| 五月丁香啪啪综合网| 国产3p露脸普通话对白| 九九九精品视频免费观看| 久久性爱视频| 99热在线这里| 婷婷五月黄色激情在线| 丁香五月天91| 色综合久久99色| www.五月天色色.com| 综合久久9| 婷婷导航| 67194中文字幕| 我爱大香蕉| 玖玖99免费视频| 免费看欧美成人A片无码| 99综合自拍| 五月丁香啪啪啪| 激情图片婷婷| 大香蕉天堂| 丁香六月综合激情| 婷婷五月电影院| 亚洲丁香花色| 日韩黄色电影| 战争与艾拉电影免费观看| 性爱五月婷| 九九热在线观看视频| 日本在线wwww| 五月婷婷六月色| 九九久久99| 五月丁香视频色色| 另类少妇人与禽zOZZ0性伦| 亚洲人妻一区二区| 狠狠色噜噜狠狠狠狠综合| 日韩无码色色| 狠色狠色综合久久| 99 频99热国里只有精品| 99久99久| 五月天大香蕉| 一丁香五月天月AV| 丁香六月成人网| 丁香狠狠色婷婷| 伊人高清无码| 国产精品美女| 四月婷婷五月色综合| 最新国产AV| 色色射| 99热这里只有国产精品| 99小视频在线| 亚洲 视频 导航 一区| 免费做A爰片77777| 91久久久久久久| 五月久久亚洲| 无码激情精品色婷婷久久久久| 久久九网| 高清无码网址| 99精品综合| 婷婷综合成人| 狠狠色成人影片| 亚洲欧洲99| 性爱五月婷| 色婷五月| 日本久久人| 婷婷丁香在线播放| 丁香五月激情婷婷激情| 色五月丁香激情视频| 色综合区| 久久五月婷| 九九热视频99| 99热99色| 再綫Av免费視品| 久久久18| www999日韩精品| 91怕怕网| 婷色天堂| 一区=区操屄高清大全av| 91操操| 五月人妻婷婷| 99愛国产| 激情丁香五月天| 天天xxxxxx天天日| 五月激情婷婷在线| 日本九九视频| 97精品综合| 五月天六月婷婷电影| 婷婷综合网站| 九月婷婷色色| 婷婷五月亚洲综合| 色必久悠悠影院| 色热久资源| 国产精品久久99| 五月天激情黄色小说在线观看| 天堂在线伊久| 日本久久超碰| 就99这里只有精品| 成人性爱精品视频| 五月亭亭网成人在线视频| 婷婷综合网站| 99久久网站| 国产小精品| 8区视频在线| 五月丁香婷婷综合| 综合久久99| 天天日天天操心| 天天爽天天操| 九月婷婷激情久久| 丁香婷婷六月天| 欧亚洲在线高清视频| 只有精品视频在线观看| 噜一噜免费视频| 天天干天天日天天插| 精品九九视频在线观看| 99热日| 色优久久| 99热午夜精品| 久久女人天堂| 六月婷婷在线| 97影院一级片| 久久97久久99久久综合欧美| 99综合熟女| 丁香六月开心| 激情五月天影院| 99热欧美| 潮汕成人AV片在线| 久久亚洲无码| 嫩BBB槡BBBB搡BBBB视频| 亚洲久热无码| 婷婷五月天精品| AV网在线| 激情五月婷黄版| 99爱免费视频在线观看| 婷婷香蕉| 国自产拍偷拍精品啪啪一区二区| 激情熟女网| www.丁香五月| 欧美五月婷婷| 丁香五月天AV在线 | 天天影视天天爽天天草| 成人做爰A片免费看视频| 国产色香蕉精品五夜婷| 婷婷黄色五月天在线视频| 丁香美女主播视频在线观看| 丁香六月婷| 天堂网色婷婷| 综合网五月天123| 97精品欧美91久久久久久久| 1024AV视频| 欧美三级欧美一级| 久久99网| 天天久久婷婷| 99热这里在线精品| 日日撸夜夜操| 丁香五月天社区婷婷| 日本妈妈乱| www天天色天天射| 久/久精品99看9| 婷婷五月激情欧美| 丁香五月激情网| 亚洲熟妇AV乱码在线观看| 婷婷九月综合| 久久Xx| 丁香五月中文字幕色播| 婷婷五月电影院| 日本色五月| 久久九网| 亚洲第一色色色| 午夜色婷婷| 久久一伦| 综合一本道| 久久在线视频免费观看| 婷婷5月天av| 久久人人看| 97热久久| 91操片| 五月综合丁| 五月丁香人妻| 婷婷五月丁香成人网| 久热这里这里有精品| 亚洲av成人在线| 久大香蕉| 婷婷中文字幕| 五月婷婷开心色伊人| 久久婷婷五月| 精品色情一区二区三区四区| 中国丰满熟女A片免费观| 樱花99视频| 亚洲激情五月| 五月色婷婷影视在线电影| 五月婷深深爱激情网| 婷婷五月天AV| 开心五月婷婷五月| 成人短视频在线观看| 五月天激情综合网站| 六月色色| 99在线观看亚洲| 丁香啪啪| 婷婷五月丁香综合人妻| 色婷婷丁香社综合| 久九色| 婷婷在线综合| 婷婷激情综合网| 九九九九这里只有精品| 91九色熟女| 9l视频自拍九色9l视频自拍九色9l社区| 五月天婷婷Av| 婷婷月综合| 中文字幕 码精品视频网站| 99热综合网| 操97免费超级视频| 久久伊人五月天| 很操日本7| 97久久婷婷色| 五月婷久久| 99在线免费视| 99热在线观看99| 亚洲六月色婷婷| wwwss在线观看| 中文中文在线| 插插插色综合网| 婷婷五月花.97| 欧美成人A片AAA片在线播放| 97婷婷色| 大香蕉久久久久久久久| 亚洲视频99| 国产操碰| www色五月天| 99综合成人视频在线观看| 97色片| 丁香五月大片| 亚州操操| 久久久久久婷| 色色丁香| 婷婷丁香亚洲色综合91| 天天在线久久综合| 久久婷婷五月综合激情国产| 五月天激情色色| 欧美日韩一区二区三区四区| 亚洲精品乱码久久久久99| 丁香五月婷综合| 五月婷婷六月丁香激情| 久久久久久综合88| 无码少妇高潮喷水A片免费| 婷婷性爱五月天| 激情婷婷五月亚洲| 美女黄频aⅴ视频| 五月婷婷影院| 2014天天爽| 五月婷婷婷色| 99精品国产热久久91色欲| 色五月91| 夜色综合网| 熟妇人妻中文字幕无码老熟妇| 综合色色婷婷| 思思热久热| 琪琪理论片| 丁香五月天堂亚洲社区| 伊人激情AV一区二区三区| 天天日天天舔| 六月丁香综合| 激情五月婷在线精品| 99热这里只有精品1025| 久久大香免费| 思思热在线播放| 色五月AV| 五月丁香激情综合久久| 开心婷婷五月天电影院| 91综合在线视频| 日本婷婷激情四射中文字幕在线观看| 99噜噜| 99精吕视频在线观看了| 色五月天在线| 99热这里只有精品国产免费| 99热资源在线| 欧美啪啪五月天| 2015在线中文字幕| 婷婷五月色播放| 婷婷五月综合网| 激情欧美五月丁香| 五月丁香花伦理电影| 激情五月婷婷综合网| 成人在线不卡| 久久久五月天| www.五月天婷婷| 丁香五月激情婷婷| 99热国产在线| 天天干狠狠| 久色视频| 婷婷丁香五月激情密臀av| 新激情婷婷| 成人中文网| 国产婷婷色综合AV蜜臀AV| AVDV久久| 国产精品天天狠天天看| 婷婷在线日韩综合| 亚洲无AV在线中文字幕| 色香蕉婷婷| 婷婷涩五月| 天天摸天天舔在线视频| 久久丁香五月婷| 91麻豆国产三级精品福利在线观看 | 少妇AB又爽又紧无码网站 | 在线综合网| 久久亚洲激情五码| 99热免费| 另类少妇人与禽zOZZ0性伦| 激情五月影院| 草一草avb| 五月婷婷六月丁香综合| 色永久| 五月婷婷六月丁香在线视频| 色噜噜狠噜噜视频| 五月天婷网| 激情小说视频图片| 99热精品在线播放观看| 欧美激情 日韩无码 婷婷 五月天| 色啦啦视频| 婷婷酒色网| 亚洲电影中文字幕| 99在线观看精品| 色婷婷影视99| 九九热99精品| 天天日天天插天天操| 亚洲中文乱字字幕线在永久| 五月婷婷丁香色播网| 丁香五月婷婷五月天| 99色丁香婷婷综合网| 五月精品免费XXX| 婷婷五月情| 九九热经典视频在线观看| Www.激情| 五月天播播中文字幕 | 久久久久久久久久久久久久久久久精典| 国产成人精品一区二三区熟女在线| 欧美日韩欧美| 五月婷婷激情| 99久久国产宗和精品1上映| 色五月综合网站| 国产精品久久..4399| av久热| 五月丁香综合久久| 26UUU欧美激情一区二区| 人人操AV| 久久91久久精品久久| 久久婷婷色色| 婷婷五月天久久| 丁香婷婷影院| 国产免费av在线| 五月天激情网址| caobi四区| 婷婷另类开心| 五月天天天天天天天天天天天天天天天婷婷婷 | www.99精品视频| 丁香色啪综合| 亚洲天堂久久| 原琪琪色影院| 婷婷丁香黄色| 大香婷婷| 人人爱干人人爱草| 日本三级中文字幕| 丁香色情五月综合激情| 狠狠色综合777| 激情四射网| 在线五月婷| 99热这里只有99| 久久在线人妻| av国产精品| 99熟女| 色小说五月婷婷| 99视频在线观看欧| 大陆肏屄视频| www.夜夜操.com| 性热视频99精品| 六月天丁婷婷| 91热久久| 久久婷婷五月综合色奶水99啪| 色情一区二区播放| 99热网站| 九九热这里只有精品5| 丁香五月日啪| 欧美日综合| 91seav| 91碰碰视频| 亚洲中文字幕在线观看| 神马欧美精| 久久开心五月天激情| 黄网在线免费观| 六月色日韩| 色中色综合| 丁香婷婷五月天激情四射| 婷婷五月天网| AV色婷婷| AV在线大香蕉| 99精品免费| 午夜丁香婷婷| 午夜福利8055| 噜噜噜久久| 中文字幕网站在线观看| 九九热手机在线视频| 亚洲愉拍99热成人精品| 99er免费在线观看| 婷婷五月久久| wwwC0maV五月花| 成人片在线播放| 婷婷久久亚洲| 中文字幕永久在线| 99色啊| 久草热8精品视频在线观看| 久久久性爱网| 亚洲六月婷婷| 国产在线黄色| 成人在线视频网| 五月激情丁香五月宗合| 噢美99| 婷婷五月成人| 一起肏在线视频| 97资源欧美日韩大香蕉超碰一区| 色欲色香综合网站| 婷婷97碰碰| 人人草碰| 色欲色香综合网| 色的色综合| 超碰妻人人| 97五月天| 九色激情网| 99超级碰免费视频| 五月天激情小说婷婷基地| 操逼五月天| m色激情网| 五月久久网| 色欲色香综合网| 五月婷成人网| 婷婷五月天丁香激情| 五月综合无码| 丁香五月网络网络| 涩涩激情五月婷婷| 可以看的av| 九九日本视频| 亚洲一区二区 成人网站戴套| 亚州精品久久久久AV无码| 亚洲网在线观看| 九九色播五月丁香| 久久久久久久五月婷婷六月丁香综合,开心激情综合网 | 99爱爱网| 亚州美女| 免费看欧美成人A片无码| 天天开心天天色| 91久女| 天天插天天插天天插天天插| 99热思思久| 婷婷五月天福利| 五月天伊人综合| 天天日天天做天天舔| 免费亚洲婷婷| 99热只有| 99热精品在线| 99久在线精品99re5热视频| 少妇被躁爽到高潮无码文| 26uuu精品国产| 99热久久日本| 99精品视频网| AV操逼网| 99热这里只有精品8| 另类婷婷丁香| 色五月婷婷综合在线| 日本啪啪网| 五月天婷婷丁香六月| 91色吧网| 久久五月丁香| 婷婷色婷婷| 天天久| 五月亭亭六月色| 任你操精品免费| 69天堂99| 国产AV影片| 国产亚洲99久久精品| 综合另类视频| 综合久久久| 人人爱人人摸人人澡| 色五月激情五月丁香五月婷婷啪啪综合 | 亚洲精品一区中文字幕乱码| 91操人| 九九色播五月丁香| 能看的av网站| 四虎婷婷五月天| 99成人网一区| 99精品自拍| 成人中文字幕在线| 久久久婷婷五月天| 天天综合精品| 99激情| 99久久这里只有精品| 亚洲五月天综合| 婷婷五月激情的图片| 免费色婷婷| 激情综合九| 色婷婷小说网| 五月天全国最大成人网| 五月天婷婷色播在线网| 婷婷五月丁香高清无码| 性爱动图国产麻豆一区二区三区| 色综合女人99| 99热66| 无码网| 婷婷五月天黄色| 日韩高清成人| 五月丁香琪琪| 婷婷97碰碰| 天天操天天插天天射| 激情五月丁香六月综合AVXXXX| 婷婷色五月在线视频| 人人干av| 成人 在线 日韩| 久久只有18视频| www.91在线观看| 欧美噜一噜| 站长推荐无码播放| 日本九九网| 国产成人AV在线| www.99热日韩.com| 五月丁香激情片| 99色色网站| 五月丁香婷婷无码A∨| wwww.9免费视频| 婷婷五月丁香香蕉| 超碰成人av| 97色 五月天丁香| 91视频久久久| 久久香视频| 久久久国产精品黄毛片| 精品人妻伦九区久久AAA片| 欧美成人精品A片免费一区99| 综合狠久久| 激情婷婷五月在线合集| 9久热在线视频精品| 欧亚洲在线高清视频| 激情六月五月婷婷综合网| 五月天电影网| 任你爽精品免费视频6| av中文在线| 久久婷五月影院| 青青草轻轻操| 99久久亚洲国产| 亚洲黄色影视| 亚洲天堂色| 婷婷丁香五月基地| 激情综合五月激情17| 婷婷色五月天色| 激情五月天色色| 婷婷播播五月天| 激情五月天综合图片小说网站| 五月婷婷丁香六月在线| 99爱视频| 五月天六月色| 色婷婷色五月丁香| 久久激情综合| 《久久综合九色综合97婷婷| 激情五月天色婷婷| 天天日天天舔| AV在线免费观看不卡| 91丨九色丨白浆秘| 五月天色社区| www婷婷色| 久鲁鲁色网 | 色久综合| 9999热精品| 人妻在线中文字幕久久| 五月天大香蕉| 久久五月丁香| 亚韩在线视频| 欧美性爱中文字幕| 美女丁香五婷婷| 另类婷婷五月天啪帕帕| 婷婷激情综合网| 任你爽视频| 激情小说五月天| 丁香色色色| 久久与婷婷| 色色无码| 亚洲xx网| 亭亭玉月丁香| 狠狠狠狠青草| 久播影院免费观看电视剧大全最新网| 欧美色男人网站| 天天色伊人| 激情综合久久| 五月天婷基地| 五月天激情综合| 超碰国产在线| 色激情五月| 综合久久婷婷| 婷婷精品在线| 九洲一级A片| 久草性爱| 五月丁香综合在线| 香蕉人在线香蕉人在线 | 色婷婷综合丁香五月天| 日本五月婷婷| 91干网| 欧美啄木乌丝袜人妻系列| 久久九九热re6这里有精品| 少妇人妻凹凸视频| 91日在线视频| A久网| 五月天婷婷色综合| 五月天婷婷视频30| 亚洲岛国电影| 97丁香五月| 日本A片一区| 丁香六月婷婷综合欧美| 激情婷婷99| 天天久综合| 色射7856五月天激情四射| 99爱视频在线| 超碰9在| 人人操人人爰人人一天天碰夜夜拍夜夜爽-中国A级毛片天天看天天谢… | 伊人久久大香线蕉AV最新午夜| 欧美五月丁香| 综合九九中文字幕| 婷婷五月天基地| 色很久综合| 另类激情综合| 日本99在线| 97碰免费视频在线| 91操操| 99久久这里只有精品| 丁香五月婷婷狠狠色| 欧美激情综合色综合啪啪五月| 丁香六月天AV| 欧美电影在线观看| 91大屁股| 九色激情| 天天色色天天| 99综合熟女| 久久性操| 俺来也综合网精品一区| 夜夜操狠狠操| 欧美成人网婷婷综合在线| 北条麻妃伊人| 极品人妻VideOssS人妻| 久久久.COM| 无码色色色| 中文字幕丁香五月| 久久丁香网| 天天干,夜夜爽| 丁香婷婷啪啪| 欧美成人精品三区综合A片| 99热这里有精品2| 国产中文字幕在线视频免费观看| 精品网站:999WWW| 99色色热热| 国产精品久久久久久久久久| 亚洲激情免费视频| 国产资源在线视频| 夜夜操天天干| 97色伦另类图片小说视频| 久久久久九九九九视屏小说88| 五月丁香网站| 大香蕉综合网| 熟女人妻视频| 人人摸人人摸| 97香蕉碰碰人妻国产欧美| 五月丁香久久| 九月丁香五月婷婷| 99热综合色图| 91久久久久久久久18| 婷婷五月色丁香在线看| 婷婷性爱视频在线| 欧美人妻一区二区| 色婷五月丁香久亚洲| 国产色香蕉精品五夜婷| 91viP在线看| 成人色情五月天婷婷丁香| 99视频日韩| 91九色丨国产丨爆乳| 全网最新网黄大秀直播高清,主播国产录屏在线| 九九婷婷五月天| 天天干天天操天天爽| 99在线观看| 操老逼综合网| 99综合网| 婷婷五月色花丁香社区| 97伦乱| 色七七九九| 五月丁香综合网色欲| 中文超碰视在线| 丁香婷婷五月色成人网站| 99这里只有精品国产| 九九在线91| 五月丁香综合啪啪| 激情丁香网| 97碰免费精采视频| 五月天大香蕉| WWW五月| 九热视频| 热99视频精品在线| 夜夜资源站| 亚洲狠狠狠色婷婷综合激情久久久| 综合 蜜月 婷婷| 色情婷婷五月天| 丁香网五月天激情| 99在线播放视频| 影音先锋男人女人| 婷婷内射视频在线| 色婷婷五月天天天天天天天天天| 99热全是精品| www.超碰在线| 玖玖资源在线视频| 99热免费网站| 婷婷国产五月天17c| www夜夜| 婷婷色av| 亚州精品色情无码A片| 久热99中文字幕| 五月婷婷六月天| 五月婷婷免费| 97婷婷狠狠| 国产婷伊人| 99热亚洲| 人人做人人看人人摸| 婷婷伊人综合中文字幕| 国产,欧美,学生妹,视频| 超级碰碰碰97免费| 精品人妻久久久| 熟女网站久久| 久久久婷婷五月天| 色情五月综合婷婷| 性天天中文网| 五月丁香婷婷爱激情综合网| 中文字幕精品推荐免费在线观| 婷婷丁香五月天激情| 欧美成人网99网| 开心五月天私房婷婷| 墨西哥毛片内射精| 日日日日日| 夜夜骑天天操| 综合久久丁香婷婷,五月婷婷六月丁香,开心激情综合网,六月丁香在线观看,婷婷丁 | 综合www色| 99热这里有精品| 国产.亚洲.欧洲视频在线| 涩涩婷婷五月| 婷婷五月av| 婷婷激情综合色五月久久91| 日本一级一级一级一级| 激情九色| 天天干天天玩天天夜天天射天天操天天日蜜臀少妇 | 伊人丁香六月婷婷| 超级碰碰碰碰视频| 人人色人人弄人人操| 亚洲精品成人| 天天草比天天爽| 丁香婷婷综合五月天| 亚洲性视频| www九九免费视频| 色播五月网| 色色a| 五月丁香婷中文字幕| WWW久久久| 久久六月综合| 亚洲精品又粗又大又爽A片| 丁香六月啪啪啪| 五月婷婷开心综合| 六月综和久久| 97视频久久| 一起操 91N.com| 亚洲情综合五月天| 中文字幕永久在线| 五月婷婷在线视频观看| 九九免费在线视频| 成人做爰A片免费看网站找不到了| 色青五月天| 日韩限制级大尺度黑料泄密大尺度视频一区二区在线观看 | 五月丁香怕怕综合| 国产av影片| 久久久久视剧HD| 伊人激情AV一区二区三区| 九九热99视频| 五月婷婷丁香俺日污视频| 艳妇野外情欲放荡HD| 香蕉国产2013| 日日干夜夜撸夜夜骑| 91久久1118| 99热一本久道| 五月婷婷影视| 九九色精品| 久久久五月五丁香| 婷婷五月天在线综合| 国产va在线视频| 亚洲av免费在线| 2005天天干天天1| αv中文字幕在线观| 亚洲综合五月| 综合久久高清| 天天天久久人人人合| 超碰AAAAAAV| 国产VA播放| 丁香五月婷婷亚洲综合精品| 久久青青日本视频| 97luluse| 内射干少妇亚洲69XXX| 99精品在线观看视频| 五月丁香婷草| 五月丁香六月情| 五月精品免费XXX| 九九热九九热精品| 色啪影院| 成人毛片在线免费观看| 四季日韩AV无码综合| 夜夜嗨一区二区三区直播内容| 婷婷五月丁香五月| 开心五月深爱五月| 另类激情五月天| 激情狠狠丁香月| 午夜理论片最新午夜理论剧| 99日韩| 久久久久久久久久久44| 婷婷9月天| 99热热热99精品婷婷| 九九热最新| 99re在线观看| 碰碰女| 五月天狠狠色| 色五月综合在线| 少妇人妻综合色6699| 五月婷婷免费视频| 日韩无码一区二区三区四区| 超碰狠狠操| 色人久夂| 五月婷婷综合影院| 亚洲蜜乳AV| 激情五月天。| 青柠影视免费高清电视剧| 欧美日韩99| 色婷婷狠狠| 欧洲亚洲免费视频9| 五月婷婷日| 国产三级秋霞| 婷婷色av| 成人精品99| 婷婷5月开心6月| 激情五月天婷婷久久久久久久久久久| 99精品在线| 翔田千里 50岁 无码| 182TV亚洲| 午夜成人综合| 91啪啪啪啪| 99色免费在线观看| 国产亚洲成人综合| H亚洲| 一本婷婷丁香久久| 色涩视频久久| 1024国产在线| 久久综合婷婷激情| 97超碰,人人舔,人人操,人人摸| 亚洲亚洲人成综合网络| 成AV人片一区二区三区久久| 五月激情在线| 大香蕉伊人久久| 激情五月综合| 色五月婷婷网| 日本一级一级一级一级| 婷婷丁香六月天| 亚洲婷婷五月天| 国产精品国产成人国产三级| 99视频内射三四| 五月天激情国产综合婷婷婷| 婷婷五月天av| www.色婷婷| 亚洲久热| 国产精品第一国产精品| 一起草AV| 在线观看免费视频| 精品国产AV色一区二区深夜久久| 大陆极品少妇内射AAAAAA| 免费看欧美成人A片无码| 九九视频在线观看视频6| 日韩中文字幕| 99婷婷狠狠成为人免费视频| 亚洲狠狠爱婷婷| 日本精品人妻无码77777| 成人片黄网站色大片免费毛片| 色婷婷成人做爰A片免费看网站 | 午夜 外网 精品 在线| 婷婷五月丁香高清无码| 草AV9999| 色综合日日| 九九综合久久| 丁香色婷婷| 五月天成人综合| 日本99在线视频| 亚洲在线操| 5月丁香啪啪啪| 久久久久9| 色婷婷五月综合| 国产真实乱了老女人视频| 丁香五月大香蕉在线99| 欧美三级视频| 色99视| 狼人婷婷综合| 久久婷丁香五月| 97人人草| 日本va欧美va精品发布视频| 激情婷婷五月色| 五月开心激情网| 亚洲成人婷婷| 久久人人九| 九九99免费视频| 久久久久9| 欧美成人AAA片一区国产精品| 久久久天堂国产精品女人| 五月丁香久久久| 人人超碰99| 亚洲小电影在线观看黄999| 天堂久久精品| 888精品福利地址| 婷婷狠狠五月综合| 99色最新在线视频网站| 婷婷久久丁香| 精品人人操| 五月丁香激情综合| 色狠狠色噜噜AV天堂五区| www.丁香黄色五月天人与| 99久高清视频| WWW,五月| 成人五月天婷婷| 五月天婷爱综合| 婷婷综合五月天亚洲综合| 9l视频自拍九色9l视频在线观看| 激情五月综合网| 欧美顶级少妇做爰HD| 婷五月天影院| 激情AV中文| 日本久久天堂| 亚洲性爱干干| 免费视频这里只有精品| 激情图片婷婷丁香五月| 激情五月天电影| BBWCUCKOLD精品熟妇| 婷婷天堂综合网| 欧美日本黄色| 99这里是99在线视频| 9999色色色色| 亚洲VA口| 亚洲热视频在线| 校花娇喘呻吟校长陈若雪视频| www.91AV.com| 激情黄色小说色五月| www.天天色综合| 五月婷婷深爱六月| 国产色色视频| 天天干天天干天天操| 99国产精品久久久久久久久久久 | 免费观看欧美成人AA片爱我多深| 日日夜夜亚洲一区| 久久久99免费视频| 五月婷婷五月丁香综合| 思思热国产在线| 色色综合激情| 丁香五月婷婷啪啪| 色情网综合| 激情四射婷婷色色色| 一级性爱视频| 99色亚洲| 玖玖爱伊人网| 婷婷丁香五月天影院 | 中文字幕成| 久久久人妻人伦| www国产亚洲色婷婷com| 操九色| 99色色网| 99久久婷婷综合| 91色婷婷综合久久中文字幕二区| 狠狠色情婷婷| 五月天开心激情综合网| 思思热视频在线观看| 婷婷影院A成人| 九九热在线99| 美女va| 五月婷婷色激情| 97久久超碰| 曰韩五月丁香色婷婷无码| 国产资源在线视频| 99这里只有免费的小视频在线观看| 色色色色色色色色综合网| 久热久| 五月激情四射网站| 91综合色| 五月丁香999| 丁香五月综合在线视频| 久久久中文| 婷婷丁香五月天综合在线日韩| 大香蕉中文| 色五月av伊人| 99色视频| 中文字幕日产A片在线看| 午夜成人在线免费视频| 高清无码.com| 婷婷六月丁香欧美视频在线| 天天影院色| 97婷婷丁香五月综合| 9久热| 亚洲天码视频www蛋播视频| 亚洲av骚货| 91久久人人操| 97人人草| 岛国AV网| 97人人超| 五月婷婷丁香大香蕉| 久久五月婷婷电影| 日韩视频99| 色综合色综合网| 婷婷久久18| 久热这里有精品视频| 97色色网| 日本精品人妻无码77777| 伊人婷婷综合| 五月开心婷婷| 四色永久成人网站| 日操夜操天天操不卡| 热99国产精品| 中文乱子伦视频| 丁香六月啪| 9久久精品视频| 96性爱视频| 久久久久久久97| 色色色com| 久久久人妻人伦| 五月花在线观看视频| 中字幕视频在线永久在线观看免费 | 成人无码髙潮喷水A片| 五月丁香色综合| 激情综合婷婷| 超碰99在线观看| 日韩AV在线免费| 九九免费视频在线| 色五月亚洲| AV大片在线播放| 婷婷色导航| 天天激情欧美美女| 疯狂做受XXXX高潮A片动画| 综合久久高清| 五月丁香基地| 午夜丁香婷婷| 五月天丁香成人社| 国产一级婬片毛片| 思思热精品在线视频| 五月天丁香欧美激情| 激情五月婷婷伊人| 天天射综合网站| 欧美婷婷色五月网| 色国产五月| 婷婷综合色色| 亚洲色频| 人人干天天操五月丁香| 啊v视频在线观看| 日韩AV一区二区三区| 丁香花五月天| 97操在线视频| 99热www| 襙比视频| 99精品综合| 色www.con| 婷婷丁香色五月久久88| 色播五月婷婷| 激情六月丁香| 91婷婷五月天嫩女| 国产精品A成V人在线播放| 超碰人人色| 99爱视频| a毛片二逼wwwwwwwwww| 热热久久精品视频| 欧美精品999|