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

ARTICLE DETAIL

資訊詳情

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

機(jī)器人操作系統(tǒng)SLAM導(dǎo)航:從架構(gòu)拆解到工程化實(shí)戰(zhàn)

機(jī)器人操作系統(tǒng)SLAM導(dǎo)航:從架構(gòu)拆解到工程化實(shí)戰(zhàn) 1. 機(jī)器人操作系統(tǒng)核心架構(gòu)與SLAM導(dǎo)航的全局拆解機(jī)器人操作系統(tǒng)這個(gè)詞剛?cè)胄械呐笥崖牭饺菀装l(fā)怵覺得是某種高深莫測(cè)的黑科技。其實(shí)把它理解成一個(gè)“機(jī)器人專屬的安卓系統(tǒng)”就通了——它不直接控制電機(jī)轉(zhuǎn)動(dòng)也不直接處理激光雷達(dá)的點(diǎn)云數(shù)據(jù)它干的事情是讓各個(gè)功能模塊能互相說(shuō)上話并且按照統(tǒng)一的節(jié)奏協(xié)同工作。一個(gè)典型的移動(dòng)機(jī)器人身上掛著激光雷達(dá)、深度相機(jī)、慣性測(cè)量單元、輪式編碼器、電機(jī)驅(qū)動(dòng)板這些硬件各自跑各自的如果沒有一套通信中間件把它們串起來(lái)那就是一堆昂貴的電子垃圾。機(jī)器人操作系統(tǒng)解決的正是這個(gè)“串起來(lái)”的問題而SLAM導(dǎo)航則是讓機(jī)器人在這個(gè)框架下真正“活起來(lái)”的核心能力。我接觸過不少?gòu)牧愦罱ㄒ苿?dòng)機(jī)器人平臺(tái)的項(xiàng)目發(fā)現(xiàn)一個(gè)很普遍的現(xiàn)象很多人把大量精力花在調(diào)參和跑通demo上卻對(duì)底層的數(shù)據(jù)流走向和坐標(biāo)變換邏輯一知半解。結(jié)果就是demo跑得挺歡一旦換了個(gè)場(chǎng)地或者傳感器型號(hào)變了整個(gè)系統(tǒng)就崩了。所以這篇內(nèi)容我打算換個(gè)講法不按常規(guī)的“安裝-配置-運(yùn)行”三步走而是從架構(gòu)設(shè)計(jì)的角度切入把SLAM導(dǎo)航這件事拆開了揉碎了講清楚。不管你是剛買了一套開發(fā)套件準(zhǔn)備入門的學(xué)生還是公司里被派來(lái)做移動(dòng)機(jī)器人原型的工程師只要跟著這個(gè)思路走一遍至少能少踩一半的坑。1.1 為什么選擇“通信中間件算法節(jié)點(diǎn)”的分層架構(gòu)機(jī)器人系統(tǒng)最忌諱的就是把所有邏輯寫在一個(gè)大循環(huán)里。我見過一個(gè)早期的項(xiàng)目主控程序里一個(gè)while循環(huán)先讀傳感器再算里程計(jì)然后跑一遍掃描匹配最后輸出速度指令整個(gè)流程串行執(zhí)行。這種寫法在傳感器少、算法簡(jiǎn)單的時(shí)候勉強(qiáng)能跑但一旦加入新的傳感器或者想換一種定位算法代碼就變成了意大利面條改一處崩三處。分層架構(gòu)的核心價(jià)值在于解耦通信層只管數(shù)據(jù)怎么傳算法層只管數(shù)據(jù)怎么算硬件驅(qū)動(dòng)層只管怎么跟板子打交道。這三層之間通過標(biāo)準(zhǔn)化的消息接口通信任何一層的改動(dòng)都不會(huì)波及其他層。具體到SLAM導(dǎo)航這個(gè)場(chǎng)景分層帶來(lái)的好處更加明顯。激光雷達(dá)的驅(qū)動(dòng)節(jié)點(diǎn)只負(fù)責(zé)把原始掃描數(shù)據(jù)打包成標(biāo)準(zhǔn)格式發(fā)出來(lái)它不關(guān)心這個(gè)數(shù)據(jù)是給建圖用還是給定位用。建圖節(jié)點(diǎn)訂閱掃描數(shù)據(jù)結(jié)合里程計(jì)信息構(gòu)建柵格地圖建完之后把地圖存下來(lái)。定位節(jié)點(diǎn)則訂閱掃描數(shù)據(jù)和已有地圖實(shí)時(shí)輸出機(jī)器人在地圖中的位姿。路徑規(guī)劃節(jié)點(diǎn)拿到位姿和目標(biāo)點(diǎn)算出一條可行路徑再把速度指令發(fā)給底盤驅(qū)動(dòng)。整個(gè)數(shù)據(jù)流是單向的、清晰的每個(gè)節(jié)點(diǎn)只做一件事。這種設(shè)計(jì)還有一個(gè)隱藏優(yōu)勢(shì)調(diào)試的時(shí)候可以單獨(dú)把某個(gè)節(jié)點(diǎn)的數(shù)據(jù)錄下來(lái)離線反復(fù)回放分析不用每次都把真機(jī)跑起來(lái)。1.2 SLAM在導(dǎo)航棧中扮演的角色與邊界SLAM這三個(gè)字母拆開就是同步定位與建圖聽起來(lái)是一件事實(shí)際上是兩件互相依賴的事。定位需要地圖作為參照建圖又需要知道機(jī)器人當(dāng)前在哪這就成了一個(gè)雞生蛋蛋生雞的問題。早期的解決方案要么假設(shè)機(jī)器人位姿已知比如用高精度外部追蹤系統(tǒng)要么假設(shè)環(huán)境特征已知比如在墻上貼反光板但這些限制在實(shí)際場(chǎng)景中往往不成立。SLAM的價(jià)值就在于打破了這個(gè)循環(huán)依賴讓機(jī)器人在完全未知的環(huán)境中一邊走一邊構(gòu)建地圖同時(shí)用正在構(gòu)建的地圖來(lái)修正自己的位置估計(jì)。但這里有一個(gè)容易被忽視的邊界問題SLAM輸出的地圖和位姿精度是有限的而且會(huì)隨著時(shí)間漂移。很多新手會(huì)拿SLAM建出來(lái)的地圖直接去做高精度測(cè)量或者指望它在長(zhǎng)走廊這種退化場(chǎng)景下也能保持厘米級(jí)定位這就不現(xiàn)實(shí)了。SLAM的本質(zhì)是一個(gè)概率估計(jì)過程它給出的是“最可能的位姿”和“最可能的地圖”而不是絕對(duì)真值。理解這一點(diǎn)才能在后續(xù)的導(dǎo)航調(diào)參中做出合理的取舍。比如在長(zhǎng)直走廊里激光掃描匹配在垂直于走廊方向上的約束很弱位姿估計(jì)會(huì)沿著走廊方向漂移這時(shí)候就需要引入慣性測(cè)量單元或者輪式里程計(jì)來(lái)提供額外的約束。2. 核心算法模塊的深度解析與實(shí)操要點(diǎn)把架構(gòu)理清楚之后接下來(lái)要啃的是每個(gè)核心模塊的具體實(shí)現(xiàn)。這部分我會(huì)按照數(shù)據(jù)流動(dòng)的順序從傳感器數(shù)據(jù)預(yù)處理開始一路講到路徑規(guī)劃的輸出把每個(gè)環(huán)節(jié)的關(guān)鍵算法、參數(shù)含義和實(shí)操中容易翻車的地方都過一遍。需要提前說(shuō)明的是下面提到的具體參數(shù)值都是基于常見差速輪式底盤和二維激光雷達(dá)的配置如果你的平臺(tái)是阿克曼轉(zhuǎn)向或者三維激光雷達(dá)數(shù)值需要相應(yīng)調(diào)整但背后的邏輯是通用的。2.1 傳感器數(shù)據(jù)預(yù)處理與時(shí)間同步激光雷達(dá)和慣性測(cè)量單元的數(shù)據(jù)到達(dá)時(shí)間往往是不對(duì)齊的激光雷達(dá)可能每100毫秒出一幀慣性測(cè)量單元每5毫秒出一組數(shù)據(jù)而且兩者的時(shí)間戳基準(zhǔn)可能還不一樣。如果不做時(shí)間同步就直接把數(shù)據(jù)扔給SLAM算法建出來(lái)的地圖會(huì)出現(xiàn)明顯的重影和扭曲。我習(xí)慣的做法是在驅(qū)動(dòng)層就把所有傳感器的時(shí)間戳統(tǒng)一到系統(tǒng)時(shí)鐘然后在SLAM節(jié)點(diǎn)里用一個(gè)時(shí)間窗口做近似同步。具體來(lái)說(shuō)對(duì)于每一幀激光數(shù)據(jù)找到時(shí)間戳最接近的慣性測(cè)量單元數(shù)據(jù)如果時(shí)間差超過閾值通常設(shè)20到30毫秒就丟棄這組數(shù)據(jù)或者做插值補(bǔ)償。輪式里程計(jì)的處理也有講究。很多底盤驅(qū)動(dòng)板輸出的里程計(jì)是累積脈沖數(shù)需要根據(jù)輪徑和編碼器分辨率換算成米和弧度。這里有一個(gè)容易忽略的細(xì)節(jié)輪距的測(cè)量誤差會(huì)直接導(dǎo)致角度估計(jì)的累積誤差。我實(shí)測(cè)過輪距標(biāo)定偏差5毫米機(jī)器人原地轉(zhuǎn)十圈之后角度誤差能到十幾度。標(biāo)定的方法很簡(jiǎn)單讓機(jī)器人原地旋轉(zhuǎn)整整十圈對(duì)比里程計(jì)輸出的角度變化和實(shí)際角度變化按比例修正輪距參數(shù)。這個(gè)步驟花十分鐘做一次后面能省掉很多調(diào)試時(shí)間。注意慣性測(cè)量單元的零偏和尺度因子也需要標(biāo)定尤其是低成本的消費(fèi)級(jí)慣性測(cè)量單元零偏隨溫度變化很明顯。如果SLAM過程中發(fā)現(xiàn)機(jī)器人靜止時(shí)地圖還在緩慢漂移大概率是慣性測(cè)量單元的零偏沒有補(bǔ)償。2.2 掃描匹配與位姿圖優(yōu)化的參數(shù)調(diào)優(yōu)掃描匹配是二維SLAM的核心它的任務(wù)是找到當(dāng)前激光幀相對(duì)于已有地圖或上一幀的最佳位姿變換。常見的算法有基于相關(guān)性的暴力搜索和基于梯度的迭代最近點(diǎn)方法。暴力搜索對(duì)初值不敏感但計(jì)算量大迭代最近點(diǎn)速度快但容易陷入局部最優(yōu)。實(shí)際項(xiàng)目中我通常采用混合策略先用里程計(jì)提供的初值做一次迭代最近點(diǎn)匹配如果匹配得分低于閾值再退回到暴力搜索在小范圍內(nèi)重新找。參數(shù)調(diào)優(yōu)方面有幾個(gè)關(guān)鍵值需要重點(diǎn)關(guān)注。搜索窗口的大小決定了算法能容忍多大的里程計(jì)漂移設(shè)得太小會(huì)導(dǎo)致快速轉(zhuǎn)彎時(shí)匹配失敗設(shè)得太大則計(jì)算量飆升且容易匹配到錯(cuò)誤的位置。我的經(jīng)驗(yàn)值是對(duì)于室內(nèi)環(huán)境搜索窗口設(shè)為0.3米和0.3弧度左右比較均衡。匹配得分閾值需要根據(jù)激光雷達(dá)的噪聲水平來(lái)定噪聲大的雷達(dá)閾值要相應(yīng)放寬否則會(huì)頻繁觸發(fā)重定位。還有一個(gè)容易被忽視的參數(shù)是地圖更新頻率更新太快會(huì)把動(dòng)態(tài)障礙物比如走動(dòng)的人刻進(jìn)地圖里更新太慢則無(wú)法及時(shí)反映環(huán)境變化。通常設(shè)為1到2赫茲比較合適。位姿圖優(yōu)化是在掃描匹配的基礎(chǔ)上做全局一致性調(diào)整。當(dāng)機(jī)器人繞了一圈回到起點(diǎn)時(shí)如果直接拼接地圖起點(diǎn)和終點(diǎn)往往對(duì)不上這就是累積誤差。位姿圖優(yōu)化通過檢測(cè)回環(huán)識(shí)別出當(dāng)前場(chǎng)景之前來(lái)過在回環(huán)約束下重新分配誤差讓地圖閉合?;丨h(huán)檢測(cè)的準(zhǔn)確性至關(guān)重要誤檢一個(gè)回環(huán)會(huì)把整張地圖拉變形。我通常會(huì)在回環(huán)檢測(cè)后面加一道幾何驗(yàn)證把當(dāng)前幀和候選回環(huán)幀做一次精細(xì)匹配如果匹配得分不夠高就拒絕這個(gè)回環(huán)。2.3 代價(jià)地圖構(gòu)建與路徑規(guī)劃算法選型代價(jià)地圖是導(dǎo)航棧里承上啟下的模塊它把SLAM輸出的柵格地圖轉(zhuǎn)換成規(guī)劃算法能用的形式。原始柵格地圖只有占用、空閑和未知三種狀態(tài)代價(jià)地圖在此基礎(chǔ)上疊加了膨脹層把障礙物周圍一定范圍內(nèi)的格子賦予較高的代價(jià)值這樣規(guī)劃出來(lái)的路徑會(huì)自然遠(yuǎn)離障礙物。膨脹半徑的設(shè)置需要匹配機(jī)器人的實(shí)際輪廓設(shè)得太小機(jī)器人會(huì)貼著墻走容易刮蹭設(shè)得太大則狹窄通道可能被完全堵死。我的做法是先按機(jī)器人外接圓半徑設(shè)置然后在實(shí)際測(cè)試中根據(jù)通過性微調(diào)。路徑規(guī)劃分全局和局部?jī)蓪?。全局?guī)劃負(fù)責(zé)從當(dāng)前位置到目標(biāo)點(diǎn)找一條粗略的路徑常用的算法有A星和迪杰斯特拉前者啟發(fā)式搜索效率更高后者在復(fù)雜環(huán)境下更穩(wěn)定。局部規(guī)劃負(fù)責(zé)在全局路徑的引導(dǎo)下結(jié)合實(shí)時(shí)障礙物信息輸出具體的速度指令常用的有動(dòng)態(tài)窗口法和時(shí)間彈性帶。動(dòng)態(tài)窗口法計(jì)算量小、響應(yīng)快但在狹窄空間容易震蕩時(shí)間彈性帶生成的軌跡更平滑但計(jì)算量較大。對(duì)于計(jì)算資源有限的嵌入式平臺(tái)我通常先用動(dòng)態(tài)窗口法跑通如果發(fā)現(xiàn)震蕩嚴(yán)重再考慮換時(shí)間彈性帶。規(guī)劃算法計(jì)算量路徑平滑度狹窄通道通過性適用場(chǎng)景動(dòng)態(tài)窗口法低一般容易震蕩開闊室內(nèi)環(huán)境時(shí)間彈性帶中高好較好復(fù)雜動(dòng)態(tài)環(huán)境模型預(yù)測(cè)控制高很好好計(jì)算資源充足3. 從零搭建SLAM導(dǎo)航系統(tǒng)的完整實(shí)操流程理論講得再多不動(dòng)手都是空的。這一部分我按照實(shí)際項(xiàng)目的推進(jìn)順序把從環(huán)境準(zhǔn)備到最終跑通導(dǎo)航的每一步都列出來(lái)包括具體的命令、配置文件的關(guān)鍵字段和調(diào)試方法。需要說(shuō)明的是下面的流程假設(shè)你用的是常見的差速輪式底盤和二維激光雷達(dá)其他類型的平臺(tái)在標(biāo)定和參數(shù)上會(huì)有差異但整體框架是一致的。3.1 開發(fā)環(huán)境搭建與依賴管理第一步是確定運(yùn)行環(huán)境。機(jī)器人操作系統(tǒng)有多個(gè)發(fā)行版本每個(gè)版本對(duì)應(yīng)的系統(tǒng)依賴和軟件包版本都不同。我的建議是選擇長(zhǎng)期支持版本社區(qū)維護(hù)周期長(zhǎng)遇到問題更容易找到解決方案。安裝方式上如果只是做算法驗(yàn)證用軟件源直接安裝最省事如果要做產(chǎn)品化部署建議從源碼編譯這樣可以針對(duì)特定硬件做優(yōu)化也方便裁剪不需要的模塊。依賴管理是新手最容易翻車的地方。機(jī)器人操作系統(tǒng)生態(tài)里的包依賴關(guān)系復(fù)雜不同包對(duì)同一個(gè)底層庫(kù)的版本要求可能沖突。我習(xí)慣用工作空間隔離的方式每個(gè)項(xiàng)目建一個(gè)獨(dú)立的工作空間用編譯工具管理依賴。編譯的時(shí)候注意并行度設(shè)置核心數(shù)少的老機(jī)器設(shè)太高反而會(huì)因?yàn)閮?nèi)存不足而卡死。還有一個(gè)細(xì)節(jié)如果同時(shí)安裝了多個(gè)版本的Python編譯腳本可能會(huì)鏈接到錯(cuò)誤的版本導(dǎo)致運(yùn)行時(shí)找不到模塊。解決辦法是在編譯前顯式指定Python路徑。# 創(chuàng)建工作空間 mkdir -p ~/robot_ws/src cd ~/robot_ws # 初始化工作空間具體命令取決于使用的構(gòu)建工具 # 編譯時(shí)指定并行任務(wù)數(shù)根據(jù)CPU核心數(shù)調(diào)整 # 如果內(nèi)存不足減少并行數(shù)提示編譯過程中如果遇到某個(gè)包反復(fù)失敗先單獨(dú)編譯這個(gè)包并查看完整錯(cuò)誤輸出不要盲目重試整個(gè)工作空間。很多時(shí)候錯(cuò)誤信息里已經(jīng)寫明了缺失的依賴或版本沖突。3.2 底盤與傳感器標(biāo)定實(shí)操底盤標(biāo)定是整個(gè)系統(tǒng)精度的基石。需要標(biāo)定的參數(shù)包括輪徑、輪距、編碼器分辨率和最大速度限制。輪徑的標(biāo)定方法是讓機(jī)器人直線行駛一段已知距離比如5米對(duì)比里程計(jì)輸出的距離和實(shí)際距離按比例修正輪徑參數(shù)。輪距的標(biāo)定前面提過原地旋轉(zhuǎn)十圈對(duì)比角度。這兩個(gè)參數(shù)標(biāo)定好之后里程計(jì)的精度能提升一個(gè)數(shù)量級(jí)。激光雷達(dá)的標(biāo)定主要是外參標(biāo)定也就是雷達(dá)安裝位置相對(duì)于機(jī)器人中心的平移和旋轉(zhuǎn)。對(duì)于二維雷達(dá)平移量影響不大但旋轉(zhuǎn)量尤其是偏航角對(duì)建圖影響很大。如果雷達(dá)安裝時(shí)沒有對(duì)準(zhǔn)正前方建出來(lái)的地圖會(huì)整體旋轉(zhuǎn)一個(gè)角度。標(biāo)定方法很簡(jiǎn)單讓機(jī)器人正對(duì)一面平整的墻壁在雷達(dá)數(shù)據(jù)中找到墻壁對(duì)應(yīng)的直線計(jì)算這條直線與機(jī)器人正前方的夾角然后在配置文件中補(bǔ)償這個(gè)角度。慣性測(cè)量單元的標(biāo)定包括零偏和噪聲參數(shù)。零偏標(biāo)定就是讓機(jī)器人靜止放置一段時(shí)間采集數(shù)據(jù)取平均值。噪聲參數(shù)可以通過艾倫方差分析來(lái)估計(jì)不過對(duì)于大多數(shù)室內(nèi)導(dǎo)航場(chǎng)景用默認(rèn)參數(shù)也能跑只是精度稍差。如果發(fā)現(xiàn)機(jī)器人靜止時(shí)位姿估計(jì)還在緩慢漂移優(yōu)先檢查慣性測(cè)量單元的零偏。3.3 建圖與定位的完整操作流程建圖階段的目標(biāo)是構(gòu)建一張干凈、準(zhǔn)確的柵格地圖。操作流程是啟動(dòng)底盤驅(qū)動(dòng)和雷達(dá)驅(qū)動(dòng)確認(rèn)數(shù)據(jù)正常發(fā)布啟動(dòng)SLAM建圖節(jié)點(diǎn)在可視化工具中觀察地圖構(gòu)建過程手動(dòng)遙控機(jī)器人遍歷整個(gè)環(huán)境注意控制速度不要太快轉(zhuǎn)彎時(shí)放慢遍歷完成后保存地圖。這里有幾個(gè)實(shí)操細(xì)節(jié)值得注意遍歷時(shí)盡量走閉合回路這樣回環(huán)檢測(cè)才能發(fā)揮作用避免在人多的時(shí)候建圖動(dòng)態(tài)物體會(huì)被刻進(jìn)地圖如果發(fā)現(xiàn)地圖某處明顯扭曲不要勉強(qiáng)保存退回去重新走一遍那一段。定位階段是在已有地圖的基礎(chǔ)上實(shí)時(shí)估計(jì)機(jī)器人位姿。啟動(dòng)定位節(jié)點(diǎn)后需要給機(jī)器人一個(gè)初始位姿估計(jì)通常是在可視化工具中用鼠標(biāo)拖拽一個(gè)箭頭指向機(jī)器人在地圖中的大概位置和朝向。初始位姿越準(zhǔn)定位收斂越快。如果初始位姿給得太離譜定位可能收斂到錯(cuò)誤的位置。定位過程中可以通過觀察粒子云的分布來(lái)判斷定位質(zhì)量粒子云越集中說(shuō)明定位越可信粒子云發(fā)散則說(shuō)明定位不確定。階段關(guān)鍵操作常見問題排查方法建圖遙控遍歷環(huán)境地圖重影檢查時(shí)間同步和標(biāo)定建圖保存地圖地圖扭曲檢查回環(huán)檢測(cè)是否觸發(fā)定位設(shè)置初始位姿定位不收斂重新給更準(zhǔn)的初始位姿定位實(shí)時(shí)監(jiān)控粒子云發(fā)散檢查環(huán)境是否退化3.4 導(dǎo)航參數(shù)配置與實(shí)車調(diào)試導(dǎo)航參數(shù)配置是最后一步也是最考驗(yàn)?zāi)托牡囊徊健H忠?guī)劃器的參數(shù)相對(duì)固定主要調(diào)整規(guī)劃頻率和路徑平滑權(quán)重。局部規(guī)劃器的參數(shù)需要根據(jù)機(jī)器人動(dòng)力學(xué)特性來(lái)調(diào)包括最大速度、最大加速度、最大角速度等。這些參數(shù)設(shè)得太保守機(jī)器人行動(dòng)遲緩設(shè)得太激進(jìn)則容易震蕩甚至失控。我的調(diào)參順序是先設(shè)一個(gè)保守值確保安全然后逐步提高速度上限直到機(jī)器人開始出現(xiàn)輕微震蕩再回調(diào)10%作為最終值。實(shí)車調(diào)試時(shí)建議先用小范圍測(cè)試比如讓機(jī)器人從一個(gè)房間走到另一個(gè)房間觀察它在直道、彎道和狹窄通道的表現(xiàn)。如果發(fā)現(xiàn)機(jī)器人在某個(gè)位置反復(fù)震蕩先檢查代價(jià)地圖的膨脹層是否把通道堵死了再檢查局部規(guī)劃器的軌跡評(píng)分權(quán)重是否合理。如果機(jī)器人貼著障礙物走說(shuō)明膨脹半徑設(shè)小了。如果機(jī)器人走到一半停下來(lái)不動(dòng)可能是全局路徑被動(dòng)態(tài)障礙物擋住了需要檢查局部規(guī)劃器的避障邏輯。注意調(diào)試導(dǎo)航參數(shù)時(shí)一定要有人在場(chǎng)隨時(shí)準(zhǔn)備急停。我見過不止一次因?yàn)閰?shù)設(shè)錯(cuò)導(dǎo)致機(jī)器人全速撞墻的情況輕則撞壞外殼重則燒毀電機(jī)驅(qū)動(dòng)。4. 常見故障排查與性能優(yōu)化實(shí)戰(zhàn)記錄跑通基本流程只是第一步真正體現(xiàn)功力的是遇到問題能快速定位并解決。這一部分我整理了實(shí)際項(xiàng)目中遇到過的典型故障按照現(xiàn)象、可能原因、排查步驟和解決方案的結(jié)構(gòu)來(lái)組織方便你遇到類似問題時(shí)快速對(duì)照。4.1 建圖質(zhì)量問題的排查思路建圖重影是最常見的故障表現(xiàn)為地圖上同一面墻出現(xiàn)兩條或多條平行的線條。根本原因通常是位姿估計(jì)不準(zhǔn)導(dǎo)致不同時(shí)刻的激光幀沒有對(duì)齊。排查時(shí)先看時(shí)間同步確認(rèn)激光數(shù)據(jù)和里程計(jì)數(shù)據(jù)的時(shí)間戳是否對(duì)齊再看標(biāo)定檢查輪徑和輪距是否準(zhǔn)確最后看掃描匹配參數(shù)搜索窗口是否太小導(dǎo)致匹配失敗。我遇到過一次重影問題排查了半天發(fā)現(xiàn)是慣性測(cè)量單元的安裝方向配置錯(cuò)了導(dǎo)致角速度符號(hào)反了機(jī)器人轉(zhuǎn)彎時(shí)位姿估計(jì)往反方向跑。地圖扭曲通常出現(xiàn)在長(zhǎng)走廊或大房間場(chǎng)景表現(xiàn)為直線變彎、直角變銳角。這是累積誤差導(dǎo)致的如果回環(huán)檢測(cè)沒有觸發(fā)誤差就無(wú)法消除。排查時(shí)先確認(rèn)機(jī)器人是否走了閉合回路如果沒有閉合回路扭曲是正常的只能通過提高里程計(jì)精度來(lái)緩解。如果走了閉合回路但回環(huán)沒觸發(fā)檢查回環(huán)檢測(cè)的搜索半徑和匹配閾值是否設(shè)置得太嚴(yán)格。還有一種情況是地圖上出現(xiàn)大量散點(diǎn)噪聲這通常是動(dòng)態(tài)障礙物或者雷達(dá)噪聲導(dǎo)致的。如果散點(diǎn)集中在某個(gè)區(qū)域可能是那個(gè)區(qū)域有玻璃或鏡面反射激光雷達(dá)在鏡面上會(huì)產(chǎn)生虛假回波。解決辦法是在建圖時(shí)避開這些區(qū)域或者在代價(jià)地圖中把這些區(qū)域標(biāo)記為不可通行。4.2 定位丟失與重定位策略定位丟失的表現(xiàn)是機(jī)器人在地圖中的位置突然跳變或者粒子云完全發(fā)散。常見原因有三個(gè)一是環(huán)境特征太少比如在空曠的走廊或大廳里激光掃描匹配沒有足夠的約束二是動(dòng)態(tài)障礙物太多比如周圍全是走動(dòng)的人激光數(shù)據(jù)被遮擋嚴(yán)重三是初始位姿給得太離譜定位算法收斂到了錯(cuò)誤的位置。應(yīng)對(duì)定位丟失我通常采取分層策略。第一層是預(yù)防在建圖時(shí)盡量選擇特征豐富的環(huán)境避免在長(zhǎng)走廊和空曠區(qū)域建圖。第二層是檢測(cè)實(shí)時(shí)監(jiān)控定位置信度指標(biāo)一旦低于閾值就觸發(fā)重定位流程。第三層是恢復(fù)重定位時(shí)先在全局范圍內(nèi)撒粒子然后根據(jù)激光匹配得分逐步收斂。如果全局重定位也失敗最后的辦法是讓機(jī)器人原地旋轉(zhuǎn)一圈用不同角度的激光數(shù)據(jù)來(lái)匹配。提示如果機(jī)器人經(jīng)常在同一個(gè)位置定位丟失說(shuō)明那個(gè)位置的環(huán)境特征確實(shí)不足可以考慮在那里貼一些反光標(biāo)記或者放置一些特征明顯的物體來(lái)增強(qiáng)定位穩(wěn)定性。4.3 導(dǎo)航震蕩與路徑規(guī)劃異常處理導(dǎo)航震蕩表現(xiàn)為機(jī)器人在原地左右搖擺或者沿著路徑來(lái)回移動(dòng)。根本原因是局部規(guī)劃器在多個(gè)候選軌跡之間猶豫不決每次選擇都偏向不同的方向。解決辦法是調(diào)整軌跡評(píng)分權(quán)重增加對(duì)路徑一致性的懲罰讓規(guī)劃器傾向于選擇與上一步方向相近的軌跡。另外降低最大角速度也能有效減少震蕩但會(huì)犧牲轉(zhuǎn)彎靈活性。路徑規(guī)劃異常還包括規(guī)劃失敗和路徑繞遠(yuǎn)。規(guī)劃失敗通常是目標(biāo)點(diǎn)被障礙物包圍或者代價(jià)地圖把目標(biāo)點(diǎn)標(biāo)記為不可通行檢查目標(biāo)點(diǎn)是否在膨脹層內(nèi)部即可。路徑繞遠(yuǎn)可能是全局規(guī)劃器的啟發(fā)式權(quán)重設(shè)得太低導(dǎo)致搜索范圍過大適當(dāng)提高啟發(fā)式權(quán)重可以讓規(guī)劃器更傾向于直奔目標(biāo)。故障現(xiàn)象可能原因排查步驟解決方案建圖重影時(shí)間不同步/標(biāo)定不準(zhǔn)檢查時(shí)間戳和輪距參數(shù)重新標(biāo)定/調(diào)整同步閾值地圖扭曲累積誤差/回環(huán)未觸發(fā)確認(rèn)是否閉合回路提高里程計(jì)精度/放寬回環(huán)閾值定位丟失環(huán)境特征少/動(dòng)態(tài)干擾查看粒子云分布增強(qiáng)環(huán)境特征/分層重定位導(dǎo)航震蕩軌跡評(píng)分不合理觀察候選軌跡變化調(diào)整評(píng)分權(quán)重/降低角速度規(guī)劃失敗目標(biāo)點(diǎn)被障礙物包圍檢查代價(jià)地圖重新選擇目標(biāo)點(diǎn)/調(diào)整膨脹半徑4.4 計(jì)算資源優(yōu)化與實(shí)時(shí)性保障SLAM導(dǎo)航對(duì)計(jì)算資源的需求不低尤其是在嵌入式平臺(tái)上CPU和內(nèi)存都很緊張。我遇到過因?yàn)橛?jì)算資源不足導(dǎo)致建圖頻率跟不上機(jī)器人移動(dòng)速度地圖出現(xiàn)大片空白的情況。優(yōu)化思路有幾個(gè)方向降低激光雷達(dá)的采樣率比如從每秒40幀降到20幀對(duì)建圖精度影響不大但計(jì)算量減半減小地圖分辨率從5厘米降到10厘米內(nèi)存占用和計(jì)算量都能顯著下降關(guān)閉不必要的可視化模塊可視化工具本身很吃資源調(diào)試完成后應(yīng)該關(guān)掉。還有一個(gè)容易被忽視的點(diǎn)是消息隊(duì)列的長(zhǎng)度。如果某個(gè)節(jié)點(diǎn)的處理速度跟不上數(shù)據(jù)發(fā)布速度消息隊(duì)列會(huì)不斷積壓最終導(dǎo)致內(nèi)存耗盡或者數(shù)據(jù)延遲越來(lái)越大。解決辦法是合理設(shè)置隊(duì)列長(zhǎng)度對(duì)于實(shí)時(shí)性要求高的數(shù)據(jù)比如激光掃描隊(duì)列長(zhǎng)度設(shè)為1到2即可舊數(shù)據(jù)直接丟棄對(duì)于不能丟的數(shù)據(jù)比如地圖更新隊(duì)列可以設(shè)長(zhǎng)一些但要監(jiān)控積壓情況。5. 系統(tǒng)擴(kuò)展與多場(chǎng)景適配的進(jìn)階思路基本系統(tǒng)跑通之后下一步就是考慮怎么讓它適應(yīng)更多場(chǎng)景。室內(nèi)導(dǎo)航和室外導(dǎo)航的差異很大二維激光雷達(dá)和三維激光雷達(dá)的SLAM方案也完全不同。這一部分我分享一些擴(kuò)展思路包括多傳感器融合、多樓層地圖管理和動(dòng)態(tài)環(huán)境適應(yīng)都是實(shí)際項(xiàng)目中驗(yàn)證過可行的方向。5.1 多傳感器融合提升定位魯棒性單一傳感器總有局限性激光雷達(dá)在長(zhǎng)走廊退化視覺在紋理缺失區(qū)域失效慣性測(cè)量單元有累積漂移。把多種傳感器融合起來(lái)取長(zhǎng)補(bǔ)短是提升定位魯棒性的有效手段。最常見的融合方案是激光雷達(dá)加慣性測(cè)量單元激光提供絕對(duì)位置約束慣性測(cè)量單元提供高頻的姿態(tài)變化兩者通過擴(kuò)展卡爾曼濾波或者因子圖優(yōu)化融合。實(shí)測(cè)下來(lái)融合之后的定位在快速轉(zhuǎn)彎和短暫激光遮擋場(chǎng)景下明顯更穩(wěn)定。視覺和激光的融合是另一個(gè)方向。視覺可以提供豐富的紋理信息幫助在激光退化場(chǎng)景下維持定位。但視覺對(duì)光照變化敏感晚上或者光線劇烈變化時(shí)可能失效。我的做法是把視覺定位作為輔助只在激光定位置信度低的時(shí)候啟用并且用激光定位的結(jié)果來(lái)約束視覺的尺度漂移。這種松耦合的方式實(shí)現(xiàn)簡(jiǎn)單效果也夠用。5.2 多樓層與大地圖管理方案單層地圖跑通之后多樓層場(chǎng)景是繞不開的坎。多樓層地圖管理的核心問題是樓層切換時(shí)的定位初始化。我的方案是每個(gè)樓層維護(hù)一張獨(dú)立的地圖樓層之間通過樓梯或電梯連接。機(jī)器人到達(dá)樓梯口時(shí)先保存當(dāng)前樓層的位姿切換到目標(biāo)樓層的地圖然后通過樓梯區(qū)域的激光匹配來(lái)初始化目標(biāo)樓層的位姿。如果樓梯區(qū)域特征不足可以在樓梯口貼一些人工標(biāo)記輔助定位。大地圖管理還有一個(gè)內(nèi)存問題。一張幾百米見方的地圖如果分辨率是5厘米柵格數(shù)量會(huì)非常龐大加載和查詢都很慢。解決辦法是用分層地圖結(jié)構(gòu)全局用低分辨率地圖做粗略定位局部用高分辨率地圖做精細(xì)匹配。這樣既保證了全局一致性又控制了內(nèi)存占用。5.3 動(dòng)態(tài)環(huán)境下的長(zhǎng)期建圖與更新靜態(tài)地圖在動(dòng)態(tài)環(huán)境里用久了會(huì)越來(lái)越不準(zhǔn)比如家具挪了位置、墻上掛了新畫、走廊里多了個(gè)柜子。長(zhǎng)期運(yùn)行的機(jī)器人需要具備地圖更新能力。我的做法是定期比如每周讓機(jī)器人重新遍歷一遍環(huán)境用新數(shù)據(jù)更新地圖。更新時(shí)不是簡(jiǎn)單覆蓋而是用貝葉斯方法融合新舊數(shù)據(jù)對(duì)于多次觀測(cè)到變化的區(qū)域才真正修改地圖避免因?yàn)橐淮闻既坏恼趽蹙驼`改地圖。動(dòng)態(tài)障礙物的處理是另一個(gè)層面。導(dǎo)航過程中遇到走動(dòng)的人或移動(dòng)的推車局部規(guī)劃器需要能夠?qū)崟r(shí)避讓。動(dòng)態(tài)窗口法本身就有一定的動(dòng)態(tài)避障能力但對(duì)于快速橫穿的障礙物反應(yīng)可能不夠及時(shí)。我通常會(huì)在代價(jià)地圖中增加一個(gè)動(dòng)態(tài)層把檢測(cè)到的動(dòng)態(tài)障礙物以較高代價(jià)標(biāo)記出來(lái)并且預(yù)測(cè)其短期運(yùn)動(dòng)趨勢(shì)讓規(guī)劃器提前做出避讓動(dòng)作。注意動(dòng)態(tài)障礙物的預(yù)測(cè)不要做得太復(fù)雜簡(jiǎn)單的勻速模型在大多數(shù)室內(nèi)場(chǎng)景下就夠用了。過于復(fù)雜的預(yù)測(cè)模型不僅計(jì)算量大而且一旦預(yù)測(cè)錯(cuò)誤反而會(huì)導(dǎo)致更糟糕的避讓行為。5.4 從原型到產(chǎn)品的工程化考量原型跑通和產(chǎn)品落地之間還有很大的距離。工程化需要考慮的問題包括系統(tǒng)啟動(dòng)的自動(dòng)化不能每次都手動(dòng)敲一堆命令異常狀態(tài)的監(jiān)控和恢復(fù)比如某個(gè)節(jié)點(diǎn)崩潰了要能自動(dòng)重啟日志系統(tǒng)的完善出問題的時(shí)候能回溯分析還有硬件層面的防護(hù)比如電機(jī)堵轉(zhuǎn)保護(hù)、電池低壓報(bào)警等。我踩過的一個(gè)坑是忽略了系統(tǒng)啟動(dòng)順序。底盤驅(qū)動(dòng)還沒就緒導(dǎo)航節(jié)點(diǎn)就開始發(fā)速度指令結(jié)果指令被丟棄機(jī)器人不動(dòng)。后來(lái)加了一個(gè)啟動(dòng)狀態(tài)機(jī)確保所有節(jié)點(diǎn)按依賴順序啟動(dòng)并且互相之間有心跳檢測(cè)任何一個(gè)節(jié)點(diǎn)異常都能被及時(shí)發(fā)現(xiàn)。這個(gè)改動(dòng)看起來(lái)簡(jiǎn)單但讓系統(tǒng)的穩(wěn)定性上了一個(gè)臺(tái)階。還有一個(gè)經(jīng)驗(yàn)是版本管理。機(jī)器人操作系統(tǒng)生態(tài)更新很快今天能跑的配置明天可能就因?yàn)槟硞€(gè)包升級(jí)而失效。我的做法是把整個(gè)工作空間用版本控制工具管理起來(lái)包括配置文件、啟動(dòng)腳本和標(biāo)定參數(shù)。每次升級(jí)依賴之前先打標(biāo)簽出問題可以快速回滾。這個(gè)習(xí)慣在團(tuán)隊(duì)協(xié)作中尤其重要能避免很多“在我機(jī)器上能跑”的扯皮。最后分享一個(gè)關(guān)于參數(shù)配置的小技巧。所有可調(diào)參數(shù)不要寫死在代碼里而是放在獨(dú)立的配置文件中并且給每個(gè)參數(shù)加上注釋說(shuō)明含義和取值范圍。這樣調(diào)參的時(shí)候不用翻代碼直接改配置文件重啟節(jié)點(diǎn)就行。更進(jìn)一步可以把常用場(chǎng)景的參數(shù)組合保存成不同的配置文件比如“狹窄通道模式”和“開闊區(qū)域模式”切換場(chǎng)景時(shí)直接加載對(duì)應(yīng)的配置省去反復(fù)調(diào)參的時(shí)間。
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
激情性爱五月| 婷婷五月天综合亚洲| 99热这只有| 久久图色4| 五月婷婷香| 99免费视频久久| 色色热99| 丁香五月影院| 免费无码毛片一区二区A片| 中文字幕人妻熟女在线| 免费观看全黄做爰的视频| 九九精品免费| 亚洲色色色| yellow视频在线观看91| 开心激情婷婷| 五月深爱激情网| 超碰日日操| 五月色婷婷中文字幕| 99热在这里只有精品| 综合色播| 九九综合久久| 丁香五月综合激情久久潮喷| 99这里有精品久久97| 亚洲婷婷视频| 色六月天| 伊人久久婷婷| 色色丁香婷婷五月天| 永久热91| 婷婷五月天性爱视频| 婷婷伊人综合中文字幕| 久久99精品久久久| 色五月开心五月激情五月| 99er精品视频| 黄色热99| 色婷婷丁香五月| 狠狠色大香蕉| va中文资源在线观看| 丁香六月成人| 99在线精品免费视频| 人人操婷婷| 伊人影音无码一区二区三区| 天天插天天插| 色5月婷婷色| w婷婷五月婷婷w| 丁香五月天AV在线| 99性爱无码| 99无码精品| 99热有精品在线观看| 亚洲偷| 九九热99精品| 五月丁香婷婷中文网| 变天就操逼婷婷五月| 97香蕉碰碰人妻国产欧美| 精品久久久久久久人妻| 91丁香色| 亭亭五月激情亚洲在线| 五月天成人手机在线视频| 五月天啪啪| 亚洲超碰在线| 色日本五月天| 999久久久国产精品| 99色在线视频观看| 色五月首页| 五月婷婷黄| 婷婷开心激情五月激情网| 狠狠精品干练久久久无码中文字幕 | 熟妇内谢69XXXXXA片| 久久五月天大美女| 在线看片h站| 91欧美| 五月色情婷婷| 亚洲乱码日产精品BD在线观看| 99热热这里只精品996小说| 九九这里只有精品在线视频| 人五月天婷婷喷水| 991国产精选视频在线播放下载| 久久久婷婷五月亚洲97号色| 狠狠精品干练久久久无码中文字幕| 丁香婷婷五月综合影院| 西西4r午夜剧场| 五月婷婷色播| va中文资源在线观看| 激情 久久 婷婷| 婷婷亚洲欧美丁香五月| 婷婷色婷婷亚洲成人| AV片在线观看| 99热成人精品网站| 丁香六月色香蕉视频| av大片在线| 狠狠人妻久久久久久综合丁香| 91聚色综合网| 在线观看视频1区| 综合一本道| 九九99久久| 九九视频免费| 青996青| 免费无码毛片一区二区A片| 色J香五月天| 久久婷婷色综合| 久久久亚洲精品一区二区三区浴池| 久久婷婷成人综合色怡春院| 一级A片天天操夜夜操| 人人操97| 97人碰人操| 婷婷导航| 91凹凸在线| 激情WWW| 激情综合色婷婷啪啪六月天| 久久丁香社| 欧美顶级少妇做爰HD| 国产精产国品一二三在观看| www.9797国产| 久热成人| 国产成人av在线| 这里只精品热在线18| 依人大香蕉| 极品九九九九九九| 亚洲啪啪网| 丝雨一区二区| 激情婷婷网| 久久38视频| 五月色综合| 韩国天天婷婷| 丁香五月综合激情啪啪| 久久这里只有精品无码| 婷婷五月天激情综合网| 五月丁香激情综合欧美| 五月天精品综合在线| 六月激情婷婷综合| 思思久久96热在精品国产,| 婷婷色色丁香五月天| 色综合色综合色综合| 国产色香蕉精品五夜婷| 婷婷五月天激情电影| 五月婷av| 99综合一区| anquye伊人| 丁香色五月 97干| 丁香五月在线伊人| av 一区三区四区| 色月视频| 五月丁香激情综合| 97香蕉久久超级碰碰高清版| 丁香五月天激情视频| AA久久| 日韩婷婷| 九色亚洲| 亚州精品色情无码A片| 久久丁香| 亚洲综合激| 激情五月丁香综合网站| 伊人狠狠综合| 色婷婷av在线观看| 婷婷激情六月| 丁香五月天久久| WWW、日本色丁香、co m| 亚洲黄色av网站| 九九婷婷综合| 婷婷丁香熟女| www.婷婷五月天| 超碰九色| 日日噜狠狠色| 欧美性猛交99久久久久99按摩| 婷婷五月综合丁香久久| 99久久五月丁香野外| 开心五月婷| 久久五月丁香六月婷| 婷婷丁香五月综合| 成人无码精品1区2区3区免费看| 国产成人亚洲综合亚洲| 婷婷五月天精品| 亚洲av综合网| wwww.9免费视频| 成人色图情色成人网 www.5b5b5bcom 五月天| 五月婷婷影院| 激情都市五月天| 亚州色婷婷| 天天日色情| 人妻激情视频| 亚洲丁香五月在线观看| 大香蕉天堂| 91小黄书网址在线观看| 欧美日韩999| 在线综合亚洲欧美65| 狠狠综合网| 婷婷色播综合五月| 99碰超| 免费看欧美成人A片无码| 久久香蕉婷婷| 五月丁六月香av| www.亭亭五月天| 秋霞A V毛片| 亚洲中文字幕在线观看| 综合五月天亚洲婷婷| 播五月,色五月,开心五月播放器| 丁香五月婷婷激情中文| 激情五月天无人视频在线| 欧美三级A做爰在线观看| 草草色情综合网| 婷婷十月丁香| 日欧一片内射VA在线影院| 伊人春天av| 99久久久久久www| 天天日P天天射P| 日日干综合| 五月开心网| 99re资源在线视频导航| 五月丁香六月婷婷开心网| 五月婷色丁香| 五月天久久婷婷| 五月天开心色色网| 色综合天天天天做夜夜| 五月天堂婷婷| 久久丝袜婷婷| 这里只有精品日韩精品| 色五月在线综合| 色五月婷婷丁香五月| 丁香伍月婷电影全集| 国产在线另类五月婷婷| 色色色五月天婷婷| 久操大| 99热在线99| 夜夜嗨一区二区三区直播内容| 热99国产精品| 久久综合66| 久久在这里99| 日韩人妻无码一区二区| 国精产品一区一区三区免费视频| 超碰狠狠操| 年轻的妺妺伦理HD中文| 天天久| 91干在线视频| 99操| 熟女激情网| 五月综合激情婷婷六月色窝| 99热精品一区| 五月开心啪啪| 婷婷性福五月天| 青996青| 97碰| 韩日在线熟女| 亚洲日韩久久婷婷伊人| 九色无码| 男人天堂亚洲综合| av在线免费网站| 激情五月天婷婷丁香| 婷婷午夜综合| WWW.久久.COM| 色九月激情综合网| 亚洲9久久精品| 激情床戏| 大地9中文在线观看免费高清| 热这里| www.色擼擼.com| 色九月| 色情婷婷| 女高怪谈在线观看| 五月丁香婷婷婷激情爱爱| 99热这里全是精品| 亚洲成人无码免费| 人人操人人爰人人一天天碰夜夜拍夜夜爽-中国A级毛片天天看天天谢… | 婷婷久久视频| 成人综合视频网址| 日本色色色| 丁香五月婷婷深爱综合激情| 男人先锋久久| 久草婷婷网| 色噜噜97视频在线观看| 久久九九热视频| 99热大片| 五月天狠狠网站| 天天狠狠色噜噜| ztEJj| 五月天伊人| 五月婷婷深深爱| 婷婷五月天VI| www.玖玖婷婷在线| 人人操9| 日韩狠狠色| 五月婷婷激情四月| 2020久久婷婷五月| 玖玖伦理电影| 操99| 久操人妻| 六月婷婷香蕉| 激情久久婷婷| 99人人干人人操| 亚洲操逼片| www.色窝| 一级二级香港秋霞欧美欧美秋霞| 婷婷五月天色网久| 亚洲成人综合在线| 国产操碰| 东北婷婷五月天| 五月丁香性爱| www婷婷| 玖玖资源站中文| 亚洲天堂亚洲色色色| 99久久五月天| 五月婷网| 色综合爽| 就是色婷婷五月亚洲色| 开心五月婷婷激情网| 久久大香蕉视频| 久久婷婷人人| 久久ER视频com| 欧洲激情五月天婷婷| 五月开心婷婷网| 99久久婷婷| 久久精品99| 97干在线免费| 婷婷九月综合| 黄色AAAAA| 色噜噜五月天| 狠狠做深爱婷婷久久综合一区| 99操逼| 5五月综合网亚洲| 五月色色激情网| 丁香激情婷婷网| 思思久久99热| 亚洲AV人人操| 婷婷五月天成人网站| 99热精品超碰| 欧美成人无码高清一区二区三区| 91人碰| 六月丁香成人| 日日操日日干| 另类激情五月天| 9久热在线视频精品| 久久92| 伊人超碰| 天堂二区| 欧美va国产va| 激情综合在线观看| 最近中文字幕大全免费版在线 | 9 1 A v久久久| 91精品无码| 九色PORNY9l原创自拍| 激情五月天噢美| 99久久9| 色五月大香蕉婷婷| 九九综合久久| 我爱大香蕉| 高清激情av在线观看| 黄色AAAAA| 91啪啪视频| 大香蕉丁香| 欧美日韩成人高清在线| 久久五月丁香六月婷| 五月天久久91| 综合网五月| 亚洲一二三网| 俺五月| 久久作爱| 久久91久久精品久久| 碰97 久| caopeng超碰| 五月婷婷乱| 色吧综合网| 久久3p| 再次出发二| 操一操干一干| 欧美色色色| 激情五月天在线观看婷婷| 亚洲激情五月| www.99久久久久99| 丁香六月啪| 色五月综合| 午夜色色色极品视频| 丁香六月色婷婷欧美| 日韩aaaaa| 亚洲成人日韩无码精品| 五月天激情综合网俺也去| 91狠狠色丁香婷婷综合久久| 天天色月| 国内一级片| 六月婷婷网站| 五月天色综合| 99综合免费视频| 色亚洲婷婷| 免费看欧美成人A片无码| 色综合九九色综合88| 色婷婷五月天成人网| 99国产精品久久久久久久久久久| 午夜青草资源| www,setingting| 深爱激情av| 婷婷久久五月| 99碰碰| 在线视频激情网站| 天天久久狠狠色综合| 欧美va在线| 黄色91在线观看| 婷婷午夜综合| 久久久妻人人人| 美女婷婷激情亚洲| 欧美三日本三级少妇三99| 大香蕉五月丁香| WWW久久久| 狼人久草| 五月丁香影视| 五月天婷婷久色| 日本久久色| 婷婷五月天福利| 色婷婷yy久| 就是色婷婷五月亚洲色| 天天射天天插天天干| 色婷婷五月天激情在线播放| 久久婷婷网| 丁香色色网| 中文字幕丰满孑伦无码专区| 精品久久人妻| 久久婷婷六月综合| 黄色99视频| 五月天综合在线网| 丁香六月 婷婷六月| 操碰99| 大香蕉久热| 丁香六月爱综合| 91精品婷婷国产综合| 人人操人人爱丁香五月| 六月婷婷无码观看| 国产成人99久久亚洲综合精品| 青青草原中文字幕| 国产69久久久欧美黑人A片| 人人爽亚洲| www.99色| 超碰人人操| 五月婷中文字幕| 青青草婷婷综合五月| 开心丁五月| 国产精产国品一二三在观看| 国产成人+综合亚洲+天堂| 99男人的天堂| 色综合大香蕉| 先锋影音男人的天堂AV| 丁香激情五月天| 天天摸天天肏| 天天干天天干天天干| 五月丁香WWW| 久99久视频免费观看| 色呦呦在线| 天天干天天干天天| 天天日婷婷| 日本精品在线噜噜噜| 狠狠色噜噜狠狠狠狠综合| 久久亚洲婷婷| 六月丁香啪啪啪| 五月亭亭六月天| 六月婷婷日| WWW、日本色丁香co m| 婷婷久久五月天| 超碰碰碰碰| 五月丁香777| 五月婷综合| www.日韩艹| 久久久思思热| 婷婷成人av| 婷婷五月丁香欧洲| 五月婷婷性爱| 五月在在观看| 99热在线观看精品免费| 在线色色| 婷婷十月丁香| 天天操夜夜肏| 色色无码| 韩日AV片| 婷婷五月天成人在线视频| 日本 欧美在线| 麻豆精品| 丁香五月天堂| 欧美草久久五月天91| 激情久久五月网| 丁香五月社区| 99精品无码| 丁香五月社区| 五月天激情综合网| 97人人干| 99热99色| 97香蕉碰碰人妻国产欧美| 狠狠综合网| 成人做爰A片免费看网站找不到了| 婷婷在线中文字幕| 欧美日韩国产一区二区| 五月婷婷影| WWW.99热| 丁香五月色| 色色欧美色色| 玖玖资源站国产| 性欧美日本| 操操操www.com| 五月婷婷天| 丁香婷婷五月| 成人无码髙潮喷水A片| 伊人9在线| 五月丁香综合啪啪| 狠狠操狠狠操AV| 国产精品美女久久久久AV超清| 六月丁香婷婷综合狠狠爱夜夜爱| 五月婷婷co.m| 久色婷婷200| 玖玖在线视频| 日本色色网站| 色婷婷19| 26uuu丁香婷婷五月| 日本激情综合| 日本欧美在线| 狠狠插狠狠插| 伊人久热91网| www。狠狠干。com| 色丁香婷婷| 99九九在线视频| 丁香六月婷婷色播| 久青操| 最近免费中文字幕大全高清大全1| www色五月| 久久综合激情| 99热婷婷| 毛片毛片毛片毛片| 色婷婷手机在线| 五月天开心色情网| 另类五月婷婷| 天天综合天综合| 色五月婷婷激情| 97色片| 五月天久久婷婷| 99色网站| 亚洲精品九九| 国产婷婷五月天| 丁香五月 激情文学| 九九激情视频| 亚洲va日| 亚洲九九夜夜| 欧美三级A做爰在线观看| 乱乱av| 99内射视频| 久久机热这里只有精品免费视频| 婷婷美女精品视频| 92久久| 国产精品18久久久| 天堂色婷婷| 深爱网深爱综合网| 玖玖在线| 激情影院69| 五月婷婷深深的爱| 99ri精品在线| 国产99久| 色五月综合在线| 九九热99精品在线| 日本99热| 婷婷五月天丁香激情| 综合亚洲六月婷婷在线| 狠狠色狠狠色综合日日91| 91久久九久久九久久九久久九久久| 婷婷视频网| 亚洲一区二区无遮挡A片| 亚洲五月天天| 激情五月综合网| 色约约视频一区二区三区四区五区 | av操B网站| 在线成人网站| 五月第四色| 伊人综合网站| 超碰在线91| 深爱激情综合| 九久热| 狠狠擼综合| 一婬一伦一区二区三区| 免费色色色| 九九99精品视频| 久久婷婷五月综合色区| 另类综合激情| 精品色色| 激情五月丁香综合蜜桃| 俺去也五月| 国产精品视频| 色天堂A| 伊人影院久久网| 五月天婷婷激情小说| 色999;丁香五月| 婷婷色影音天| 激情综合网激情五月欧美| 人人爱操| 热久久思思热思思| 九九在线视频| 天天做天天双| 午夜无码熟熟妇丰满人妻 | WWW.桔色成人.COM| 久久婷婷六月天| 狠狠综合网| 99精品视频免费在线播放| 丁香激情久久| 亚洲成人在线播放| 久久久久人妻网址| site:esunnet.com| 欧美成人精品A片免费一区99| 久久激情综合| 先锋影音av色五月天资源站| 丁香婷婷丁香五月欧美人| 亚洲欧美成人在线| 伊人超碰| 久久密臀婷婷| 丁香五月影院| 多精窝99在线视频| 看黄的网站18禁| 精品久久99| 国产亚洲99| 99激情视频| 婷婷六月丁香开心深深爱| 97天堂| 国产精品色一哟哟| 艹色18p| WWW.桔色成人.COM| 五月天婷婷激情四射综合| 久草五月天| 九月久久婷婷| 牛牛碰免费| 欧美精品啪啪| 99热9| 激情五月婷婷中文字幕| 美女91一起草| 九九色热| 超碰AV在线| 99这里都是精品| 丁香婷婷在线| 色婷婷久久天天性爱| 97人妻碰碰中文无码久热丝袜| 婷婷色播色五月五色五月天色妇| 婷婷五月天综合亚洲| 国产无人区大片| 99热免费精品热久久66| 久久99久久99精品,久国产,久久精品免费,99久在线,久久久久国产精品免费网站,9 | 五月天大香蕉| 日日射天天射| 国产精品视频免费看| www.99视频| 天天干天天做| 婷婷狠狠五月综合| 婷婷丁香五月天色色| 五月天成人免费视频| 99视频精品全部免费观看| 九九99香蕉在线视频播放| 五月婷婷五月天| 激情文学五月丁香六月婷婷| 激情小说五月天社区丁香 | 最新久久网址| 伊人综合网站| 青青草轻轻操| 激情九九这里只有精品| 欧美日韩99| 五月婷婷影视| 这里只精品| 亚洲av网址| 国产乱人偷精品人妻A片| 99色精品| 无码天天操| 激情性爱五月| 九九成人视频| 色婷婷69| 国产综合网在线| 丁香五月婷婷激情小说| 亚洲综合999| 99色嘟嘟精品网站| 五月天婷婷色色| 丁香五月天婷婷激情| 婷婷丁香五月天在线视频| 亚洲无码yw| 99热综合| 久久激情视频| 婷婷综合激情五月综合| 婷婷五月天视| 丁香五月综合高清在线| 99玖玖在线视频| 成人AV播放| 九九久久精品| 日本色色网| 天天色天天操天天射| 99精品热视频| 色噜噜狠狠色综无码久久合欧美| www.av骚货| 蜜乳.comcom| 丁香五月激情六月欧亚激情综合导航| 超碰资源在线| www.无码com| WWW.五月com| 在线中文AV| 精品国产乱码久久久久夜深人妻| 夜夜撸日日操| 农村熟妇高潮精品A片| 开心五月婷婷激情| 久久东京热婷婷五月| 伊人五月综合网| 夜夜骑天天操| 九九这里有精品| 久久久久丁香婷婷五月天| 狠狠色五月| 91综合在线视频| 1999天天操夜夜操| 99色在线观看视频| 成人天天爽| 男人天堂伊人五月丁香| 亚洲Va成人| 99热综合在线| 丁香五月天人体| 精品九九在线观看视频| 九九视频精品在线免费| 天天摸天天高潮天天爽| 毛片毛片毛片毛片| 婷婷激情六月| 亚洲无码成人| 极品少妇高潮啪啪AV无码| 八戒青柠影视剧在线观看| 99ER热精品视频| 九月丁香久久网| 天天综合网~91| 久久人妻超碰一区| 五月天丁香啪啪啪啪| 成人午夜在线视频| www.91在线观看| 五月丁香婷婷色| www.色九月| 曰曰久久| 99re热在线视频| 国产一级片| 能看的av网站| 韩国不卡AC视频| 五月天AV大香蕉| 综合久久婷婷| 另类小说婷婷色| 五月丁香六月成人| 狠狠综合| 色吊丝av中文字幕| 女同激情久久av久久| 99热20| 久1色色| 日本熟女内射| 色久九| 国产看真人毛片爱做A片| 婷婷五月娱乐在线| 色婷婷无吗| 五月天婷婷综合久久| 99re热视频| 国产激情在线| 99国产精品久久久久久久久久久| 亚洲激情Av| 亭亭五月丁香综合欧美| 五月天激情偷拍| 五月丁香婷婷六月| 思思热这里只有精品| 99热网站| 天天操精品| 第2色五月婷| 天天做天天爱天天做| 九九热这里| 成人在线免费网址| 天插天啪天啪天啪| 超碰国产在线| 丁香花婷婷五月天| 六月丁香射婷婷欧美色图片| 思思久久96热在精品国产,| 日韩黄色电影| 日韩专区五月天婷婷丁香| 婷婷色网站| 婷婷六月五月天综合| 五月婷婷,六月丁香| 色婷婷基地| 国产26uuu视频| 五月天六月色| 日操熟女| 99久久99热| 丁香五月婷婷基地| 五月婷婷狠狠久久| 五月天婷婷色播在线网| 九九精品综合| 1024在线观看免费视频| 五月天婷婷自拍图片在线观看| 九色啦蜜臀| 久久婷婷五月综合色丁香花| 九九热亚洲中文在线观看免费| 久草大| 国产4P视频精品五区| 婷婷综合网伊人| 99久久婷婷| 国产激情久久久| 99狠狠色| 午夜爱爱网站| 日本99色| 久久五月天激情婷婷| 九九视频热| 欧美性生交XXXXX无码小说 | 五月天综合在线| 五月激情丁香啪啪| 97好吊操| 日韩AV中文在线观看| 夜夜人妻五月天| 亚州色色色| 丁香五月1页| 久热九九| 永久无码色| 六月色色| 天天爱天天做天天日| 大香蕉99热| 久久丝袜婷婷| 色天五月天在线观看视频| 91成人看| 5月婷婷6月六月丁香| 国产综合A片| 婷婷狠狠色| 99免费在线视频| 久色| 久久久久这里都是精品| 99久在线精品99re8| 99久久精| 超碰九九热| 99天堂网| 玖玖在线资源视频| 色狠狠色噜噜AV天堂五区| 色综合久久伊伊婷婷五月| 天堂呦 呦百度搜索-百度搜索| 好好干av| 亚洲色区17| 日本五月天网站| 久久五月丁香综合| 99精彩视频| 久天综合| 免费精品99| 日韩六十路91性交电影| www.99精品日操伊人乱碰在线| www夜夜操wwwcon| 亚洲网站观看视频| 人妻操逼视频| 337p大胆噜噜噜噜噜91Av| 伊人青草成人| 激情人妻蜜夜系列区| 亚洲va欧洲va国产va不卡| 色婷婷色五月综合| 久久xxxx| 另类小说五月天激情| 久久99免费视频网站| 日本一级| 欧美综合激情五月丁香| 色噜噜狠狠狠狠色综合久欧美| 日本色五月婷婷| 一逼色综合| 国产精品18久久久| 婷婷五月另类网站| 五月开心久久| 青青草国产亚洲精品久久| 五月丁香六月日逼| 极品嫩草| 天天干天天干天天干天天干天| www.激情五月天com| 黑人无码一区| 99久久久| 99热这里只有精品最新| 色狠狠综合| 成人做爰A片免费看网站找不到了 国产露脸150部国语对白 | 五月婷婷婷婷| 国产丁香五月天婷婷| 9久久狠狠的| 九九热视频在线观看| 99er这里只有精品| 99热欲| 日韩视频99| www.99成人视频| 婷婷丁香射射| www久久99| 噼里啪啦在线观看免费完整版视频| 色天天综合| 亚洲视99| 亚洲视频无| 深夜男女福利刺激影院一区| 欧美性爱特黄一级aaaassss| 伊人狠狠丁香婷婷综合尤物| 任你艹| 桃色激情网| 天天在线天天综合网色| 91九色大屁股| 中文字幕日产A片在线看| 日韩人妻无码精品| 午夜美女人啪最红院| 综合伊人久久| 九九婷婷五月天| jiZZdr| 成人在线综合| 激情五月,激情综合网| 日韩六六久久电影| 综合激情五月四射婷婷| 色五月婷婷综合在线| 69凹凸成人综合网| 五月色综合| 久久婷婷伊人| A片一曲| 亚洲五月停停| http://www.sd-xiangsu.com/| 久久99最新| 免费看片在线观看| 久久五月婷综合| 第九色区av天堂| 五月丁香狠狠爱| AV性爱网| 婷婷五月天色播| 激情九月婷婷| 色婷婷综合中心| 伊人青草成人| 国产xxxxx在线观看| 欧洲不卡视频| 那里有AV网址| 久热91| 91九色在线| 亚洲AV综合在线观看| 激情综合区| 97在线刺激| 丁香伊人网| 激情综合在线观看| 亚洲av网站在线观看| 影音先锋偷偷色男人站| 99在线视频观看| 野外99热| 无码yw| 久久免费操| 超碰成人在线观看| 久久99久久99久久99人受| 亚洲视频99| 天天色激情| 亚洲最大视频| 玖玖五月| 天天操加勒比| 久久丁香五月天| 操一区| 久久精品一区二区三区四区| 六月婷婷中文字幕| 天天做天天爽| 综合色图婷婷| 五月天综合色| 伊人干综合| 这里只有精品偷拍| 色播五月丁香综合| 天天日天天草| 色五月激情综合网| 日本久久天堂| 国产成人精品一区二区三区视频| 不卡的AV网站| 黄色成人AV在线| 9精品视频在线| 97超碰综合| 欧美激情丁香五月天久久婷婷一区| 久久6这里只有精品| 色综合色色| 日韩999| JAPANRCEP老熟妇乱子伦视频| 在线观看欧美3区| 久99综合婷婷| 丁香婷婷免费| 日日噜噜夜夜狠狠久久丁香六月| 秋霞电影理论| 俺去也婷婷| 伊人啪啪网| h在线看免费版在线看| 色五月婷婷7777| 丁香五婷婷| 97色天堂| 天天摸天天舔天天爽| 十月丁香九月婷婷综合| 欧美色色色| 伊人爱爱日本| 1024成人在线观看| 亚洲俩性性爱图片久久第六页| 色久激情在线| 丁香久久久| 色色激情| 97碰碰九九视频| 久久久999精品| 色五月丁香网| 亚洲六月婷婷| 亚洲成人在线在线| 可以免费观看的av网址| 五月开心深爱激情网| 久热婷婷| 97色综合| 婷五月天天| 亚洲激情网| 久久婷婷五月天丁香| 色婷婷丁香| 久久人妻熟女一区二区| 久久婷婷夜| 欧美激情丁香五月天久久婷婷一区| 夜夜躁爽日| 天天插天天干| 亚洲综合视频网| 五月丁香六月停停| 色中色综合| 欧美三级级99久久| 色五月婷婷激情五月| 丁香激情五月| 9久久久久| 丁香五月六月激情久久| 亚洲国产精品VA在线看黑人| 亚洲另类婷婷综合| 思思热高清在线观看| 青草视频在线观看视频| www.婷婷六月天| 天天干天干| 日噜噜色| 天天噪夜夜爽| 丁香婷婷激情| 丁香六月婷婷激情综合| 丁香五月成人婷婷| 五月丁香狠狠爱婷婷综合| 久操人妻| 婷婷大乡焦噜噜| 精品视频网| 激情综合网 激情五月天| 色婷婷六月| 97操在线视频| 超碰免费成人| 亚洲小电影在线观看黄999| 久久这里有| 欧美婷婷丁香五月| 天堂草在线观| 天天干狠狠| 亚洲 视频 导航 一区| 婷婷激情社区| 国产FREESEXVIDEOS性中国| 色情综合网| 国产免费一区二区在线A片视频| 九九热视频在线观看| 色五月婷婷狠狠撸| 免费亚洲婷婷| 91oumei| 丁香婷婷色九月| 色五月自偷自拍婷婷婷婷| 性综合网| 久久ri精品视频| 日日夜夜噜噜爽爽| 国产伦亲子伦亲子视频观看| 五月丁香美女| 婷婷丁香无码专区| 天天插天天插天天日| 五月天最新网| 人妻丰满精品一区二区A片| 丁香六月色婷婷欧美| 久久丁香五月婷婷| 欧美三级欧美一级| 激情综合网五月| 99视频| 婷婷五月丁香综合人妻| 91在线操| 99热这里只有精品1025| 91超碰在线观看| 丁香97综合| 婷婷丁香激情| …亚洲黄色在线播放日韩、av中文a…| 亚洲国产99| 久久天堂网| 日韩AAAAA| 国产精品久久在线观看技巧| 婷婷五月天淫荡| 婷婷成人五月天成人文学小说| Av免费网站在线| 亚洲色模骚货| 五月婷婷七月丁香| 色色婷婷五月天| WWW.激情| 五月婷婷丁香日韩在线| 亚洲综合激情五月| xxxx久| 五月天另类激情在线| 五月婷婷久久爱| 伊人超碰在线| 日韩 中文 欧美| 婷婷日在线观看| 任你躁XXXXX麻豆精品| 婷婷综合爱| 色噜噜狠狠色综合网| 99r这里| 五月丁香六月婷婷啪啪| 成人av免费观看| 丁香婷婷久久综合在线| 888久久久| 久久99综合网| 天天做综合网色综合| 亚洲精品中文字幕成人片| 久久精品4| www.色婷婷。com| 少妇性BBB搡BBB爽爽爽视頻| 可以免费看的AV网站| 丁香五月婷婷色| 五月婷婷色在线| 精品久久99码| 五月亭亭开心网| 怕怕av| 97干欧美| 123日本不卡在线| 久久曰曰| 91久操| 丁香亚洲色综合| 丁香五月综合婷婷| 亚洲这里只有精品| 日本色噜| 人人操AV| 亚洲欧洲另类| m色激情网| 思思久久网| 丁香五月天激情四射网络不好| 国产精自产拍久久久久久蜜| 狠狠狠狠狠狠| 五月丁香成人| 丁香五月天激情网址| AV色色天堂中文| 色色操| 色呦呦美女| 亚洲视频a| 五月婷久久久| 丁香六月丁香婷婷激情| 欧美久热| 丁香五月天激情免费在线观看AV777| 久久婷婷综合网| 激情婷婷22月间| www热久久yy9| 中文国产五月天| 久久婷婷五月国产色综合激情| 欧美精产国品一二三区| 91熟妇大香蕉| 国内熟女黄色系列| 97香蕉碰碰人妻国产欧美| 久久人妻视频| 欧美婷婷综合| 天天成人丁香美女AV| 狠狠人人| 99日本精品视频热| 五月天婷婷丁香花| 色九月丁香婷婷蜜桃在线观看| 婷婷操久久| 开心深爱激情网| 天天日天天做天天操| 五月婷婷之六月丁香| 另类在线| 操B视频在线播放| 激情丁香五月天图片| 婷婷五月丁香五月天| 三级成人网站| 亚洲激情99| 99 re视频一区| 五月丁香毛片| 亚洲激情四射色| 大香蕉五月婷婷| 亚洲综合色色色| 狠狠狠狠狠狠色| 97人人干| 色婷婷综合久久久久| 三级99热| 丁香五月六月综合激情| 午夜激情四射影院| 日韩色色视频www| 狠狠色综合777| 五月色丁香| 91热网址| 亚洲成人丁香花| 精品亚洲国产成AV人片传媒| www.99色| 九九爱激情| 人人综合色| 亚洲成人另类| 91丨人妻丨国产丨丝袜| 激情婷婷在线| 99热线观看9| 中文字幕激情综合| 五月婷在线影院| 99人人干人人| 综合久久高清| 五月丁香怕怕综合| 五月的婷婷六月丁香| 六月天六月婷| 99re6久热只有精品6在线直播| 99亚州综合精品成人网| 五月开心婷婷| 天天射色五月天| 四色五月婷婷| 日日干日日| 中文字幕在线不卡| 五月婷婷激情性爱| 婷婷中文字幕网| 人人爱国产| 91美女被操| 大香蕉九九| 第四色五月天| 五月婷婷久久综合| 五月激情小说| 丁香久久九九99| 在线成人网站| 天天综合色丁香| 最新热中文字幕| 思思热在线精品视频网站| 曰曰久久| 九九婷婷五月天影视| 丁香五月激情性色郤| 五月丁香六月在线欧美| 狠狠色婷婷丁香六月| 五月 婷婷 成人| 色五月欧美| 天天爱天天操| av在线婷婷| 九热久| 99在线er热| 91精品久久久久、久五月天| 亚洲中文字幕AV| 无码日本精品XXXXXXXXX | 婷婷五月天午夜激情影院| 91成人视频| 亚洲激情.com| 黄色激情五月天| 思思热在线播放| 96精品国产综合久久久久久| www.91.com黄| 六月婷婷私欲| 五月天婷婷伊人| 日日干日日| 五月婷婷丁香网| 五月天婷婷一起草| 丁香六月情| 可以看的AV| 熟女色色一区二区| 婷婷99中文字幕| 五月丁香婷婷啪啪| 涩涩婷婷五月| www.色五月.com| 99综合97| 看婷婷五月天网| 五月天综合在线| 熟妇人妻中文字幕无码老熟妇| 香蕉网婷婷| 婷婷综合激情五月中文字幕| 婷婷精品综合| 成人精品视频99在线观看免费| 大香蕉欧美在线| 日韩性爱无码| 99在线观看视频蜜臀| 色五月五月婷婷| 粉嫩AV久久一区二区三区| 99riAV国产精品视频| 人妻无码精品一区| 丁香五月天激情综合| www九月婷婷| 日日噜噜久久婷婷五月天| 极品另类| 五月丁香在线观看国产| 丁香婷婷精品视频| 欧美狠狠色| 真实的国产乱XXXX在线91| 14色综合婷婷| 欧洲第一久色| 91碰视频| 玖玖婷婷免费| 99re在线观看视频| 婷婷五月激情天| 国产日产亚洲系列最新| 草操网| 国产精品大香蕉| 大伊香蕉精品视频在线| 九九热在线观看6| 久久99热精品a片在线观看| 99综合| 天天色播| 26uuu成人网| 久久色婷婷|