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

ARTICLE DETAIL

資訊詳情

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

基于YOLOv5與MoveIt的垃圾分類機械臂系統(tǒng)設(shè)計與實現(xiàn)

基于YOLOv5與MoveIt的垃圾分類機械臂系統(tǒng)設(shè)計與實現(xiàn) 簡介計算機視覺與機器人控制的交叉應(yīng)用正在重塑智能分揀領(lǐng)域。深度學習目標檢測模型能夠?qū)ξ矬w進行實時定位與分類而運動規(guī)劃框架則為機械臂提供安全可靠的軌跡生成能力。YOLOv5作為輕量級檢測模型在推理速度與識別精度之間取得了良好平衡MoveIt作為ROS生態(tài)下的機器人運動規(guī)劃框架可高效完成運動學求解、碰撞檢測與路徑規(guī)劃。將二者結(jié)合可構(gòu)建“感知-決策-執(zhí)行”的完整閉環(huán)在垃圾自動分類、工業(yè)抓取、服務(wù)機器人等場景中具有廣泛的應(yīng)用價值。以一套基于YOLOv5和MoveIt的桌面垃圾分類機械臂項目為例系統(tǒng)介紹了從數(shù)據(jù)集構(gòu)建、模型訓練、手眼標定、URDF建模到狀態(tài)機集成的完整技術(shù)鏈路并針對實機調(diào)試中的識別混淆、坐標轉(zhuǎn)換誤差、規(guī)劃失敗等典型問題給出了具體解決方案為從事視覺機械臂開發(fā)的工程師和學生提供了一份可落地的工程實踐參考。 做這個項目的起因特別樸素實驗室樓下的垃圾分類督導員每天要拆開幾百個垃圾袋把塑料瓶、易拉罐、紙張、剩飯分門別類工作量巨大。當時正好在啃YOLOv5和MoveIt就想著能不能做一個長了眼睛的機械臂自動識別垃圾類別然后抓起來扔進對應(yīng)垃圾桶。斷斷續(xù)續(xù)折騰了三個多月整套系統(tǒng)跑通之后我把源碼、設(shè)計文檔、訓練好的權(quán)重和調(diào)試記錄整理成了一個壓縮包也就是你在標題里看到的那個分類機器人源碼設(shè)計文檔.zip。這篇博文就把整個項目從選型到落地、從原理到踩坑的過程梳理一遍給打算做類似視覺機械臂項目的朋友一個比較完整的參考。這個項目適合兩類人看一類是正在做機器人類畢業(yè)設(shè)計或競賽項目的學生YOLOv5MoveIt的組合覆蓋面廣、工程量適中、演示效果好另一類是剛接觸ROS和機械臂控制、想找一個完整案例把視覺和運動控制串起來的開發(fā)者。我會先講為什么選這套方案再拆解視覺模塊和機械臂模塊各自怎么實現(xiàn)然后是聯(lián)動和調(diào)試最后說說源碼和文檔怎么用以及后續(xù)可以怎么擴展。1. 為什么選YOLOv5MoveIt選型背后的真實考量很多人一上來就問為什么用YOLOv5不用YOLOv8為什么用MoveIt不用自己寫逆解這類問題其實沒有標準答案關(guān)鍵看項目約束條件。我這個項目的約束非常明確ROS Melodic環(huán)境下開發(fā)機械臂是自組裝的6自由度桌面臂算力平臺是帶GTX 1660Ti的筆記本目標物體是塑料瓶、易拉罐、廢紙團、果皮等常見垃圾識別類別一共四類。在這個前提下YOLOv5和MoveIt幾乎是當時最穩(wěn)的組合。1.1 視覺方案對比YOLOv5比傳統(tǒng)圖像處理和更重模型更合適傳統(tǒng)圖像處理方案我也試過比如用顏色閾值提取塑料瓶的藍色、用形狀匹配識別易拉罐的圓柱輪廓。效果在單一光照、單一背景的實驗室里還可以但只要把垃圾桶放到窗邊陽光一照顏色全飄誤檢率直接崩到?jīng)]法看。深度學習檢測模型對光照、角度、遮擋的魯棒性明顯更好而YOLOv5在速度和精度的平衡上剛剛好。為什么不選更重的模型當時也考慮過Faster R-CNN和YOLOv5x。Faster R-CNN在COCO上的mAP確實高一些但在筆記本CPU上跑一次推理要兩三百毫秒加上機械臂運動時間整個流程會拖得很長YOLOv5x同理權(quán)重文件150多MB前向推理速度快不到哪去。垃圾識別場景的物體類別不算精細不需要檢測出農(nóng)夫山泉還是怡寶只要能區(qū)分塑料瓶易拉罐這種大類YOLOv5s或者YOLOv5m的精度完全夠用而且推理時間能壓到20ms以內(nèi)給后面的機械臂規(guī)劃留出了充足的系統(tǒng)余量。還有一個很實際的原因YOLOv5的生態(tài)太成熟了。從數(shù)據(jù)標注到訓練、導出onnx、推理腳本網(wǎng)上有海量現(xiàn)成資料遇到問題搜一下就有解決方案。對于一個需要控制整體進度的項目來說選一個社區(qū)活躍度高的模型框架比單純追求指標上的一點提升重要得多。1.2 機械臂控制框架MoveIt在ROS生態(tài)中的地位與優(yōu)勢機械臂控制的方案選擇上我當時糾結(jié)過三條路一是用廠商自帶的SDK直接控制二是用ROS Industrial的插件三是用MoveIt。自組臂用的是舵機步進電機沒有廠商SDK所以第一條路直接pass。ROS Industrial的驅(qū)動鏈雖然成熟但主要面向工業(yè)機器人配置起來相當繁瑣而且對自組臂不友好。剩下MoveIt它其實不是一個控制庫而是一個運動規(guī)劃框架把運動學求解、碰撞檢測、路徑規(guī)劃、軌跡執(zhí)行這些模塊整合到了一起還提供了圖形化配置工具。也就是說我只需要提供機械臂的URDF模型MoveIt就能自動生成運動學求解器、規(guī)劃場景、執(zhí)行器接口然后用幾行代碼就能讓機械臂從A點運動到B點。MoveIt還內(nèi)置了多種規(guī)劃器比如OMPL里的RRT、RRTConnect、BKPIECE等。我實際用得最多的是RRTConnect原因后面細講。對ZERO基礎(chǔ)的人來說可能一下子理解不了MoveIt是框架這句話可以類比成Photoshop你不用自己寫圖像處理算法只需要通過它提供的界面和接口把素材拖進去選擇合適的工具就能處理圖像。MoveIt就是機械臂領(lǐng)域的Photoshop你負責提供模型和期望的目標位姿它負責算出一條無碰撞的軌跡。1.3 整體系統(tǒng)框架與數(shù)據(jù)流整個系統(tǒng)的物理組成其實很簡單一臺帶GPU的電腦一個RGB相機一臺6自由度桌面機械臂幾個對應(yīng)類別的垃圾桶。軟件層面分成三個模塊視覺識別節(jié)點YOLOv5推理、決策調(diào)度節(jié)點狀態(tài)機、機械臂控制節(jié)點MoveIt控制器。數(shù)據(jù)流是這樣的相機實時采集桌面畫面YOLOv5推理出畫面中垃圾的類別和像素坐標決策節(jié)點拿到檢測結(jié)果后根據(jù)預設(shè)的類別-垃圾桶映射表計算出機械臂的目標抓取位姿和投放位姿MoveIt規(guī)劃出從當前位姿到目標位姿的無碰撞軌跡發(fā)布給底層控制器執(zhí)行機械臂抓取垃圾后移動到對應(yīng)垃圾桶上方松開夾爪完成一次分類投放。這套流程聽起來直接但實際調(diào)試時每一步都有坑尤其是坐標轉(zhuǎn)換和狀態(tài)同步這兩個環(huán)節(jié)后面我會單獨拿出兩個章節(jié)重點講。2. 視覺識別模塊從數(shù)據(jù)集構(gòu)建到Y(jié)OLOv5模型部署的完整鏈路視覺模塊是整個系統(tǒng)里工程量最大、也最容易出問題的地方。網(wǎng)上很多人分享YOLO訓練教程大多是拿公開數(shù)據(jù)集跑一遍demo但到了自己采集數(shù)據(jù)、標注、訓練、部署就會發(fā)現(xiàn)各種意想不到的問題。我把這一整條鏈路拆成三個關(guān)鍵階段每個階段里面都標注了我認為最重要的細節(jié)。2.1 垃圾數(shù)據(jù)集的采集與標注細節(jié)垃圾數(shù)據(jù)集的第一個問題就是樣本不均衡。網(wǎng)上的公開垃圾數(shù)據(jù)集比如TrashNet塑料瓶和易拉罐的圖片非常多但果皮、廢紙團的樣本相對少。如果直接用這個數(shù)據(jù)集訓練模型對果皮的識別效果會很差。我的做法是自己采集了一部分真實場景數(shù)據(jù)把桌面背景、光照條件、垃圾形態(tài)都做了一次擴充。采集時我踩了一個很大的坑只采集了干凈、完整的物體忽略了真實垃圾往往有變形、壓扁、貼標簽、沾污漬等情況。比如一個壓扁的易拉罐角度稍微偏一點模型就認為是塑料瓶。后來我在采集中特意加入了殘缺、遮擋、堆疊、不同光照時段的樣本識別率才真正提上來。如果你也想做類似項目建議一開始就收集臟亂差樣本而不是商品展示圖樣本。標注環(huán)節(jié)用LabelImg格式選的YOLO的txt格式也就是每個目標一行包括類別id和歸一化的中心點坐標、寬高。這里有個細節(jié)標注框不要緊貼物體邊界。我一開始標注時為了框得準貼得很緊訓練出來的模型預測框在推理時經(jīng)常比實際物體小一圈導致機械臂抓取時定位偏上。后來我重新把標注框擴大到物體邊界外2%到5%左右問題才解決。原因是YOLO的預測框回歸在邊界處不穩(wěn)定稍微留一點余量可以讓框的中心點更準機械臂抓取中心位置也更可靠。2.2 模型訓練關(guān)鍵參數(shù)與調(diào)優(yōu)筆記我選的預訓練權(quán)重是YOLOv5s訓練了大概200輪batch size選16輸入分辨率640x640。官方默認的hyp.scratch.yaml里很多超參數(shù)直接可用但有兩個參數(shù)我單獨做了調(diào)整一是mosaic增強的概率保持默認0.7這個對垃圾這類小目標很有用二是fliplr水平翻轉(zhuǎn)我調(diào)到了0.2因為機械臂抓取時物體從相機視角看主要是正立和略帶旋轉(zhuǎn)的狀態(tài)太強的水平翻轉(zhuǎn)會引入不自然的視角。還有一個容易被忽略的參數(shù)image_weights。這個參數(shù)如果開啟采樣時會優(yōu)先選那些損失較大的圖片能緩解樣本不均衡。我在訓練后期開了它val集的mAP提升了大概2個百分點。不要小看這兩個點在垃圾識別這種類別間相似度較高的場景里mAP的微小提升可能就意味著某些易混淆類別能被分對。訓練過程中最需要盯的是PR曲線和混淆矩陣。我最初訓練的模型在易拉罐和塑料瓶之間頻繁混淆看混淆矩陣發(fā)現(xiàn)鋁罐在強光下的反光區(qū)域非常像塑料瓶的高光紋理。解決方法是采集數(shù)據(jù)時特意加入強反光樣本同時把亮度增強參數(shù)hsv_v調(diào)低從默認的0.4降到0.2避免模型把反光當成目標特征。調(diào)完訓練一輪后這兩類的混淆比例降了大概40%。2.3 實時推理的性能優(yōu)化TensorRT與模型輕量化訓練完的PyTorch模型直接跑推理在1660Ti上大概30ms一幀純看視覺是夠用的但一旦和MoveIt同時跑CPU、GPU爭搶資源整個系統(tǒng)的響應(yīng)延遲會明顯上升。為了給機械臂規(guī)劃留出余量我把模型導出成TensorRT的FP16 engine。導出流程網(wǎng)上資料很多但有幾個坑值得提醒一是YOLOv5官方倉庫的export.py在導出TensorRT時如果CUDA、cuDNN和TensorRT版本不匹配很容易報錯或者導出的engine體積異常。我最后用的組合是CUDA 10.2cuDNN 7.6.5TensorRT 7.1.3在2023年之后這個組合偏舊但穩(wěn)定性非常好。二是FP16的精度損失在垃圾識別里完全可接受我實測mAP只掉了0.8%推理時間從30ms降到了12ms。三是TensorRT的engine文件跟推理環(huán)境強綁定換一臺電腦必須重新導出沒法直接拷著用這個要提前在交付文檔里寫清楚。還有一個更輕量的優(yōu)化是降低輸入分辨率。640x640降到480x480推理時間從12ms降到7msmAP僅下降1.1%。在桌面固定抓取場景下物體距離相機很近YOLO在低分辨率下同樣能檢測到所以我覺得這個trade-off很劃算。最終部署時我選了480x480輸入這樣即使MoveIt規(guī)劃需要占用大量計算資源視覺端的幀率也能穩(wěn)定在25FPS以上。3. 機械臂控制模塊MoveIt運動規(guī)劃與抓取邏輯的實現(xiàn)機械臂控制是整個系統(tǒng)的執(zhí)行層任何識別上的誤差最終都會體現(xiàn)在抓不到或者碰倒物體上。MoveIt本身封裝了很多東西但用好它需要理解幾個核心概念URDF機器人模型、規(guī)劃組、運動學求解器、規(guī)劃場景和坐標系變換。3.1 機械臂URDF建模與MoveIt配置助手的使用自組機械臂沒有現(xiàn)成的URDF我是從零開始建的。建模時最重要的事情是把每個關(guān)節(jié)的運動范圍搞對。拿我用的MG996R舵機來說名義上是180度但實際PWM信號在500到2500微秒之間對應(yīng)的角度才穩(wěn)定超出這個范圍舵機要么堵轉(zhuǎn)要么抖動。我當時沒仔細測實際行程直接按180度建模結(jié)果MoveIt規(guī)劃的路徑經(jīng)常讓舵機到達物理極限執(zhí)行時咔咔響。后來用角度尺實測了每個關(guān)節(jié)的極限角度重新改URDF問題才解決。URDF建好后用moveit_setup_assistant生成MoveIt配置包。這個工具會引導你定義規(guī)劃組Planning Group、生成碰撞矩陣并檢查URDF的完整性。需要注意的是規(guī)劃組里必須把末端執(zhí)行器也就是夾爪單獨列成一個group后面做抓取時可以直接指定末端目標位姿否則MoveIt只控制機械臂本體夾爪的開合狀態(tài)沒法納入規(guī)劃。還有一個細節(jié)moveit_setup_assistant生成的默認碰撞矩陣采用的是相鄰連桿不檢查碰撞的自動碰撞矩陣。我原本以為這個就很可靠但實際有一個非相鄰連桿在特定姿態(tài)下會干涉比如大臂在抬高到某個角度時會碰到肩部的一個支架。所以我后來手動給這兩個連桿添加了碰撞對讓規(guī)劃器把它們視為不可碰撞才徹底避免了規(guī)劃出的路徑掃過自身支架的情況。3.2 抓取位姿估計與坐標變換TF的坑視覺檢測出來的是像素坐標機械臂要用的是機器人基座坐標系下的三維坐標。兩者之間的橋梁是TF樹。我這邊固定了相機在機械臂正上方大約70cm處要求相機坐標系camera_link到機械臂基座坐標系base_link的變換是固定的。這個變換可以通過手眼標定得到也可以直接通過精確測量安裝位置和角度推導出來。我當時圖省事想直接量尺寸算坐標變換結(jié)果誤差大到離譜。為什么相機安裝的俯仰角只要偏2度在60cm遠的桌面上位置誤差就能到3cm以上機械臂夾爪張開寬度才5cm直接抓空。后來老老實實做了手眼標定。用的事OpenCV的經(jīng)典張正友標定板配合eye-in-hand標定算法但這里的eye-in-hand其實是錯誤說法因為相機是固定的應(yīng)該是eye-to-hand。網(wǎng)上大量代碼把eih和eth混在一起我一開始照著eye-in-hand的流程走標定結(jié)果一直在跳查了半天才發(fā)現(xiàn)坐標系關(guān)系搞反了。標定流程總結(jié)下來就是機械臂帶著標定板或者相機帶著標定板看你用哪種方法移動到多個不同姿態(tài)采集標定板圖像并記錄各個姿態(tài)下機械臂末端位姿然后通過AXXB方程求解相機相對機械臂基座的變換。手眼標定的誤差非常依賴采樣數(shù)據(jù)的多樣性機械臂姿態(tài)變化范圍越大、標定板在圖像中的位置越分散標定結(jié)果越準確。我只做了一次旋轉(zhuǎn)角范圍較小結(jié)果誤差有5mm后來重新采集了30個姿態(tài)覆蓋不同高度和不同水平位置誤差穩(wěn)定在1.5mm以內(nèi)。3.3 運動規(guī)劃與避障基于實際場景的規(guī)劃器選擇MoveIt默認的規(guī)劃器是RRTConnect我一開始照默認用。RRTConnect的原理是同時從起點和終點生長兩棵樹直到兩棵樹相遇所以它在無障礙場景下規(guī)劃速度非???。但缺點是生成的路徑通常比較繞路徑平滑度差。機械臂執(zhí)行時會出現(xiàn)不自然的擺動速度控制也沒那么流暢。后來我測試了OMPL里的RRTstar和STOMP。RRTstar的路徑質(zhì)量明顯好但規(guī)劃時間動不動就幾秒在實時交互場景里太慢。STOMP需要配置代價代價函數(shù)調(diào)起來麻煩。最后我的方案是先讓MoveIt用RRTConnect快速規(guī)劃一條路徑然后對路徑做一步簡化再通過MoveIt的平滑處理模塊做軌跡重采樣最終的軌跡既快又平滑。這種快速規(guī)劃后處理的思路效果非常顯著機械臂運動過程中的抖動基本消除。規(guī)劃場景Planning Scene里的障礙物設(shè)置也是一個重要環(huán)節(jié)。如果你不告訴MoveIt桌面上哪里有障礙物它規(guī)劃時只考慮機械臂自身碰撞可能規(guī)劃出一條直接穿桌子的路徑。我在項目中把桌面、垃圾桶都作為固定障礙物加到了規(guī)劃場景里。做法是在節(jié)點的/planning_scene話題上發(fā)布CollisionObject消息幾何形狀用box表示加上對應(yīng)的位姿。這樣MoveIt規(guī)劃出的路徑會自然地繞過垃圾桶而不是把機械臂的手臂插進垃圾桶里。4. 視覺與機械臂的聯(lián)動系統(tǒng)集成的關(guān)鍵代碼路徑與狀態(tài)機視覺和機械臂單獨跑都能工作但把它們連起來才真正暴露問題。這一章重點講ROS節(jié)點怎么組織、坐標怎么轉(zhuǎn)換、狀態(tài)機怎么設(shè)計這些是系統(tǒng)能否穩(wěn)定跑通的關(guān)鍵。4.1 ROS節(jié)點劃分與消息通信設(shè)計整個項目我拆成了四個ROS節(jié)點camera_node負責讀取相機圖像發(fā)布sensor_msgs/Image和sensor_msgs/CameraInfodetection_node訂閱圖像用TensorRT engine做推理發(fā)布檢測結(jié)果自定義的消息類型trashDetectionArray包含類別、置信度、像素坐標和檢測框大小controller_node訂閱檢測結(jié)果做決策生成目標位姿調(diào)用MoveIt接口規(guī)劃并執(zhí)行運動gripper_node訂閱夾爪開合指令控制夾爪舵機節(jié)點之間用ROS話題通信好處是解耦清晰。detection_node和controller_node之間不需要等待函數(shù)調(diào)用檢測結(jié)果一發(fā)布控制節(jié)點就會觸發(fā)回調(diào)。調(diào)試時還可以用rostopic echo實時查看檢測數(shù)據(jù)非常方便。這里有一個設(shè)計細節(jié)值得說為什么不在detection_node里做坐標轉(zhuǎn)換而是把像素坐標直接發(fā)布出去因為detection_node不需要關(guān)心機械臂的坐標轉(zhuǎn)換參數(shù)如果相機換了安裝位置只需要在controller_node里修改變換關(guān)系視覺節(jié)點完全不用動。這種低耦合設(shè)計讓我在后期調(diào)整標定時省了大量時間。4.2 從檢測框到抓取點的坐標轉(zhuǎn)換流程檢測到目標類別后下一個問題就是抓哪里。我用最直接的辦法用檢測框的中心點作為抓取點在圖像上的投影。由于桌面上的垃圾主要是一個個平放或稍微傾斜的物體它們的抓取點大致在物體幾何中心。通過相機內(nèi)參將像素坐標轉(zhuǎn)為相機坐標系下的坐標再通過手眼標定得到的變換矩陣轉(zhuǎn)到機械臂基座坐標系下。公式上其實很簡單[X, Y, Z, 1]^T T_eye_to_base * [x_cam, y_cam, z_cam, 1]^T。但真正的問題是Z坐標怎么確定。相機是固定朝下的桌面就在一個固定的高度我直接設(shè)Z為桌面高度。這樣如果物體有一定高度取點會偏低但夾爪有足夠的容錯空間只要能抓住物體上半部分就行。另一個重要參數(shù)是抓取姿態(tài)。垃圾不具備固定朝向我用的是豎直向下的姿態(tài)夾爪末端朝向Z軸負方向垂直于桌面。這樣機械臂第五軸和第六軸的姿態(tài)是確定的只需要控制XY位置。實際上我測試過帶一點傾斜角度去抓取斜坡上的物體但成功率反而不如豎直抓取因為物體的實際朝向很難提前判斷。豎直向下抓取配合軟指夾爪對大多數(shù)扁平垃圾紙團、果皮和圓柱垃圾易拉罐都有不錯的適應(yīng)性。4.3 狀態(tài)機設(shè)計檢測、定位、抓取、投放的調(diào)度邏輯整個系統(tǒng)的核心邏輯是一個狀態(tài)機用Python實現(xiàn)狀態(tài)包括IDLE、DETECTED、REACHING、GRASPING、LIFTING、MOVING_TO_BIN、RELEASING、RETURNING。狀態(tài)之間的切換由MoveIt的回調(diào)和夾爪傳感器反饋觸發(fā)。這里我踩的坑是一開始沒有考慮到機械臂持續(xù)運動時的狀態(tài)同步。比如MoveIt執(zhí)行完REACHING狀態(tài)后需要夾爪閉合但夾爪閉合需要時間必須等夾爪完全閉合后才能進入LIFTING狀態(tài)。我最初用固定延時1秒結(jié)果機械臂上升太快把物體甩掉了。后來改成夾爪霍爾傳感器檢測到物體夾緊后再切換到下一狀態(tài)成功率一下子從70%提升到95%。狀態(tài)機還有一個關(guān)鍵點是超時和失敗處理。抓取不是每次都能成功比如物體太滑或者位置太偏。我給GRASPING狀態(tài)加了一個超時設(shè)定如果超過3秒還沒有檢測到夾緊信號狀態(tài)機就回到IDLE讓機械臂重新等待識別或調(diào)整目標點。否則機械臂會卡在原地整個系統(tǒng)就僵住了。5. 實機調(diào)試中踩過的坑與排查思路這一章是全文最想讓你仔細看的因為這些坑我都是在連續(xù)調(diào)試十幾個小時之后才找到根因的。每一類問題都值得拿出來單獨說。5.1 相機標定與手眼標定失敗的原因分析手眼標定失敗的最常見原因是數(shù)據(jù)采集不夠好而不是算法本身有問題。我第一次標定時機械臂只轉(zhuǎn)了10來種姿態(tài)而且標定板在圖像里的位置幾乎都在中間。標定結(jié)果每次運行都不一樣旋轉(zhuǎn)矩陣的方差特別大。后來我意識到手眼標定的核心是讓標定板在相機視野的不同區(qū)域都有足夠的約束姿態(tài)變化要足夠大才能解出穩(wěn)定的變換矩陣。另一個容易踩的坑是標定板角點的亞像素提取失敗。光照太強或標定板太舊時OpenCV的findChessboardCorners經(jīng)常返回False或者角點順序錯亂。解決辦法是把標定板放在陰影下并且事先做一次灰度歸一化。在采集時保持標定板平整不要彎折。否則標定出來的矩陣也會有明顯偏差。標定完成后一定要做一次交叉驗證把標定板放在桌面上幾個已知位置用機械臂末端去觸碰標定板上的特定角點對比兩個位置的實際坐標和通過標定矩陣換算出的坐標。如果誤差超過3mm就要重新標定。這套驗證流程看起來多花時間但能避免后面所有調(diào)試都在錯誤誤差前提下的浪費時間。5.2 MoveIt規(guī)劃失敗與碰撞檢測誤判的處理MoveIt規(guī)劃失敗最典型的報錯是Unable to solve the planning problem原因通常是目標位姿在機械臂的不可達區(qū)域之外。我畫了機械臂的工作空間包絡(luò)把所有目標抓取點都限制在包絡(luò)之內(nèi)但仍然有一小部分點規(guī)劃失敗。深入排查后發(fā)現(xiàn)原因是末端執(zhí)行器的默認方向太苛刻。我指定目標位姿時用了orientation constraint要求夾爪完全垂直于桌面但實際可達的抓取姿態(tài)會略微傾斜。后來我去掉了過于嚴格的方向約束只限定Z軸方向在正負5度范圍內(nèi)規(guī)劃成功率從85%提升到了100%。碰撞檢測誤判是指MoveIt認為某個路徑會碰撞但目測明明不會。這種情況多半是碰撞矩陣里包含了不該包含的碰撞對或者物體模型尺寸設(shè)置錯了。我用的是自組臂有些連桿的STL模型是從網(wǎng)上找的簡化版幾何形狀和實物有一定差異。比如末端夾爪的STL模型比實際夾爪長了一截導致MoveIt認為任何靠近桌面的抓取動作都會碰撞。解決辦法是直接簡化夾爪碰撞模型用一個圓柱體代替尺寸略小于實際夾爪給規(guī)劃器留一點冗余。5.3 實時性瓶頸排查CPU占用與推理延遲整個系統(tǒng)在運行時我用htop和nvtop監(jiān)控資源占用。發(fā)現(xiàn)MoveIt規(guī)劃時CPU單核占用達到100%而YOLOv5推理在GPU上只占60%但GPU內(nèi)存卻異常高導致顯存不足報警。排查后發(fā)現(xiàn)是TensorRT engine的輸入輸出buffer沒有釋放每次推理都重新分配內(nèi)存導致顯存泄漏。修正的方式是初始化時一次性分配好固定大小的buffer推理時只復制數(shù)據(jù)不重新分配。這一個小修改讓顯存占用從2.1GB降到了0.9GB長時間運行也不會再報錯。另一個瓶頸是ROS話題的傳輸延遲。默認的TCPROS在大圖像傳輸時會有幾百毫秒的延遲我通過設(shè)置roscpp的傳輸類型為UDPROS解決了這個問題。核心原理是UDP掉包重傳機制比TCP輕量適合圖像這種大流量實時性要求高的數(shù)據(jù)。實際測試下來圖像從相機到視覺節(jié)點的延遲從180ms降到了35ms這個提升對整個系統(tǒng)的實時響應(yīng)非常有幫助。6. 項目源碼與設(shè)計文檔的使用指引把源碼和設(shè)計文檔打包交付時我特意做了目錄整理和README說明因為我知道如果不寫清楚別人拿到這堆文件很容易卡在環(huán)境配置上。這里我也把源碼結(jié)構(gòu)和使用步驟大致講一下幫你少走彎路。6.1 源碼目錄結(jié)構(gòu)與關(guān)鍵文件說明壓縮包解壓后頂層目錄大概是這樣的trash_sorting_robot/ ├── README.md ├── src/ │ ├── vision/ │ │ ├── yolo_detector.py │ │ ├── export_tensorrt.sh │ │ └── weights/ │ ├── controller/ │ │ ├── state_machine.py │ │ ├── moveit_control.py │ │ └── gripper_control.py │ ├── calibration/ │ │ ├── hand_eye_calibration.py │ │ └── camera_calibration.py │ └── launch/ │ ├── system.launch │ └── moveit_plan.launch ├── docs/ │ ├── 設(shè)計文檔.pdf │ ├── 操作手冊.md │ └── 實驗數(shù)據(jù)記錄.xlsx └── requirements.txtvision/yolo_detector.py是視覺節(jié)點的核心文件里面包含了TensorRT engine的加載和推理邏輯。如果你沒有TensorRT環(huán)境也可以直接改成PyTorch推理但要注意修改輸入預處理的部分。controller/moveit_control.py封裝了MoveIt的所有接口包括設(shè)置目標位姿、執(zhí)行規(guī)劃、等待執(zhí)行完成等。controller/state_machine.py是完整的狀態(tài)機實現(xiàn)里面有一個TrashSortingStateMachine類你可以在__init__里修改垃圾桶對應(yīng)的類別列表比如把易拉罐對應(yīng)到可回收桶、紙團對應(yīng)到紙類桶。calibration/hand_eye_calibration.py是手眼標定腳本需要配合標定板使用。代碼里有詳細的注釋按步驟運行即可。6.2 環(huán)境部署步驟與ROS版本注意事項環(huán)境依賴寫在了requirements.txt里主要包括Python 3.6.9、PyTorch 1.7.1、TensorRT 7.1.3、OpenCV 4.5.2、ROS Melodic、MoveIt 1.0.3。這些版本組合我是實測過的如果完全照抄可以最大程度避免版本沖突。ROS版本這里重點說一下如果你用的是ROS NoeticUbuntu 20.04那么MoveIt版本是2.xAPI和Melodic下的1.x有一些差異主要的坑是moveit_commander的接口在Noetic下沒那么穩(wěn)定建議優(yōu)先使用MoveIt的C API。如果你仍然想用Python API需要切換到moveit_py包或者使用ROS2的moveit2。我這邊因為沒有ROS2的需求所以最終選擇了MelodicC接口組合穩(wěn)得很。在編譯過程中如果遇到moveit_ros_planning找不到的問題可以在安裝MoveIt時把ros-melodic-moveit和ros-melodic-moveit-ros-planning都裝全不要只裝核心包否則會缺失一些頭文件。6.3 設(shè)計文檔中不被注意但很實用的細節(jié)設(shè)計文檔里除了常規(guī)的需求分析、系統(tǒng)架構(gòu)、模塊設(shè)計還有三塊我覺得價值最大一是實驗數(shù)據(jù)記錄.xlsx其中原始記錄了不同光照、不同角度下識別成功率的具體數(shù)據(jù)比如在光照充足時四類垃圾的平均識別率是97.2%逆光時降到了88.5%這些數(shù)據(jù)可以幫你預判實際使用環(huán)境的表現(xiàn)二是機械臂末端夾爪的結(jié)構(gòu)設(shè)計圖紙我用了3D打印的軟性硅膠指套比硬塑膠夾爪對不規(guī)則垃圾的適應(yīng)性好很多設(shè)計文檔里有STL文件三是操作手冊.md里關(guān)于硬件上電順序的警告控制器必須先上電再啟動ROS節(jié)點否則機械臂會處于未使能狀態(tài)導致無法規(guī)劃。這些細節(jié)單獨看起來不起眼但都是我在實測中累積出來的經(jīng)驗如果你只是照著設(shè)計文檔的框架去做很可能忽略掉這些隱藏信息然后在某個環(huán)節(jié)卡住很久。7. 后續(xù)擴展與個人心得項目做到這個程度已經(jīng)能在實驗室穩(wěn)定演示了。但如果你有興趣往更實用方向走或者想把這套東西改造成更完整的系統(tǒng)我有幾個思路和一些發(fā)自肺腑的建議。7.1 從單分類到可回收資源分揀的升級思路目前的系統(tǒng)只能做一次抓一個的離散抓取吞吐量不高。想提升效率的話可以把視覺模塊升級為流式檢測多目標排隊也就是一次識別畫面里多個垃圾然后按優(yōu)先級逐個規(guī)劃抓取不需要每次抓完都重新識別整個場景。這樣能減少機械臂空等時間吞吐量理論上能提升50%以上。另外可以嘗試把識別類別擴展到更多細分比如把塑料瓶細分為PET、HDPE等材質(zhì)類型。這需要更多的數(shù)據(jù)樣本和更精細的模型但意義很大直接對接后端回收產(chǎn)業(yè)鏈。如果你對垃圾分類感興趣可以往細粒度材質(zhì)識別方向深挖這個方向目前公開數(shù)據(jù)集相對較少但也是實際需求比較旺盛的領(lǐng)域。機械臂部分也可以做動態(tài)抓取。目前桌面上的物體是靜止的如果你把物體放到一個緩慢轉(zhuǎn)動的轉(zhuǎn)盤上讓YOLOv5在運動過程中實時識別并預測抓取點MoveIt就需要和視覺聯(lián)動做在線軌跡規(guī)劃。這個復雜度會上升好幾個臺階但做好了就是一個完整的視覺伺服項目含金量很高。7.2 關(guān)于學習路徑的一些建議做這類項目最忌諱一上來就攤大餅把YOLO、MoveIt、ROS、標定、機械臂建模一起學很容易被勸退。我的建議是分三步走第一周先跑通YOLOv5官方訓練流程用公開數(shù)據(jù)集訓練一個模型重點理解模型接口和推理流程第二周用MoveIt控制機械臂到達固定點不做視覺理解TF和規(guī)劃流程第三周才開始把兩者串起來。每走一步都要確保自己能解釋清楚原理再進入下一步。還有一個小建議項目中出現(xiàn)問題時盡量自己通過rostopic echo、rosrun rqt_graph、rosrun rqt_tf_tree這些工具去定位而不是直接查代碼。因為很多問題出在運行時的話題連接或坐標系關(guān)系上看代碼看不出什么但一看TF樹和數(shù)據(jù)流就一目了然了。我用這套排查方法節(jié)省了大把時間。最后動手做永遠比看教程學得快。哪怕你的機械臂很簡陋、相機是幾十塊的USB攝像頭先把一個最簡單的識別-抓取-投放閉環(huán)跑通后面的優(yōu)化才有意義。真實項目里你學到的排錯能力才是完全不亞于技術(shù)本身的東西。本文還有配套的精品資源點擊獲取
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
欧美色久| 九九综合九| 丁J香六月首页| 婷婷区日本| 五月丁香啪啪综合| 狠狠五月天婷婷| 久久激情网| 激情久久久久久| 色婷婷成人网| 综合狠狠五月婷婷| 丁香五月婷婷综合激情啪啪啪| 一本道综合网| 丁香五月www| 538在线精品| 91一起操| 久久久天堂国产精品女人| 九九色影院| 五月天停婷基地| 无码色色| 五月丁香亭亭AV女优| 婷婷播5月| 五月天激情四射网站| 99ri精品在线| 九九热这里只有精品7| 日本久久天堂| 久久五月情| 日本色婷婷| 4438成人电影| 最近免费中文字幕大全高清大全1| 狠狠做五月| 成人丁香五月| 亚洲热久久| 激情性爱五月| 激情伊人六| 激情色五月天| 香蕉综合在线| 99在线观看免费精品视频| 综合天堂AV久久久久久久| 国产五月婷| 99热在线播放精品| 99爱在线视频| 热思思| 久久蜜臀婷婷| 五月天伊人久久久久| 欧美日韩成人免费在线| 99亚洲精品| 丁香婷婷少妇| 99大香蕉| 久久男人网婷婷| 9久热在线视频精品| 五月丁香影院| www.刺激色网站www.| 色五月成人| 婷婷九月激情| 婷婷五月综合色中文字幕| 99日本精品视频热| 日日干天天爽| 四色永久成人网站| 激情婷婷黄色五月| 深爱激情五月天| 丁香美女主播视频在线观看| 久久这里只精品66| 色五月综合97| 欧美性猛交99久久久久99按摩| 五月丁香六月情| 99亚色色色| 五月婷婷黄网站大全| 五月天婷婷社区| 五月激情日本在线| 五月丁香六月成人| 天堂久久久久天堂网| 亚洲九区| 99热免| 操操操www.com| 九 九九九AV| 99re在线观看| 婷婷激情在线| 精品无码视频| 日操五月婷| 亚洲五月激情| xxxx五月天色色| 九九热免费| 这里只有精品视频看看| 一起草无码视频| 婷婷综合av| 精品夜夜澡人妻无码AV| 六月丁香激情网| 婷婷五月天在线一区| 欧美成人无码高清一区二区三区| 激情宗合 激情宗合| 婷婷伊人中文字幕| 操逼视频一区| 六月婷婷色| 婷婷五月色亚洲| 成人天天爽| 婷婷激情五月视频| 变天就操逼婷婷五月| 国产精品99久久久久久久女警| 操逼视频一区| 亚洲性爱电影| 色婷婷久久| AV79| 5月丁香六月婷婷| 天天天天天天天干| 婷婷五月四狠狠| 五月激情射| 午夜天堂一区人妻| 女人高潮内射99精品| 超碰男人色| 色五月婷婷影院| 欧美综合激情五月丁香| 午夜 外网 精品 在线| 99热偷拍| 色五月婷婷青娱乐| 国产欧美大香蕉一区| 五月色网| 色五月天婷婷| 五月天社区| 精品久久人妻热| 丁香六月av| 91九色PORNY肉丝在线| 精品无码久久久久久久久| 大香蕉婷婷久久| 狠狠干夜夜干| 五月天婷婷激情| 久久在线人妻| 色99网站| 91丨九色丨白浆| 啪啪色区| 999激情视频| 五月天婷婷丁香| 五月婷婷综合潮喷| 亚洲视色| 婷婷丁香六月天| 五月天婷婷在线视频| 天天 青草 丝袜制服 在线| 欧洲亚洲免费视频9| 99啪| www.91久久| 亚洲色基地| 日韩熟女啪啪视频| 9久久精品视频| 五月婷婷综合性爱噜噜| 婷婷99中文字幕| 婷婷久久99| 91丁香婷婷综合资源| 91无码高清| 玖玖激情五月天| 人妻激情视频| 久鲁鲁色网 | 亚洲国产精品二二三三区| 五月丁香久久网| 1024人妻| 中文字幕日产A片在线看| 亚洲日韩乱码一区二区三区四区| 专区无日本视频高清8| av中文在线| 国产AV一区二区三区最新精品| 五月天综合在线网| 人人综合色| 久热久re| 激情五月综合网| 五月综合激情久久| 色性五月天| 思思99热这里只有精品6| 天天看片日日夜夜| 99热精品在线播放观看| 99精品视频网站| 国产精品视频免费看| 九九热只有精品| 欧美韩国日本| se99热久久一本| 婷婷久久99| 婷婷色一二三区波多野结衣| 精品久久9| 国产片天天爽夜夜爽| 五月婷婷综合社区| 五月情婷婷五月| 99热欧| 狠狠色情婷婷| 色99在线观看| 天天弄天天操| 九九色之九九色之88| 国产中文亚洲欧美日韩性交| 欧美日韩AAAA| 日本片日本片祼观看网站在线看中文版网页在线看 | 操逼三区| 欧美大肥婆大肥BBBBB| 玖玖色综合色| 97综合在线| 婷婷五月 丁香六月| 日本成人噜噜| 婷婷丁香18| 欧美在线ee日韩| 96精品久久久久久久久| 丁香五月六月激情| 色五月婷婷丁香五月| 超碰国产在线播放| 99热超碰在线| 五月婷婷在线视频| 天天射网站| 综合婷| www.99热视频| 能直接看的av网站| 大香蕉啪啪啪| 99日本黄站| 密乳视频| 这里只有精品久久| 久久与婷婷| 深爱五月天 开心网| 丁香六月综合| 人人操AV| 任你干嘛免费视频播放| 丁香五月天精品| www.成人婷婷综合| 欧美日韩中文国产一区发布| 操操日韩| 五月婷在线视频免费播放| 人妻精品在线| 婷色视频| 五月天婷婷中文字幕在线播放| 91热爆在线| 级人人91| 婷婷丁香久久五月综合| 国产成人AV在线播放| 日曰躁夜夜躁2026| 激情网站五月| 人妻啪啪啪| 51精品国自产在线| VA五月激情在线| 天天弄天天操| 欧美、日韩、中文、制服、人妻| 婷婷丁香五月天色区| 五月色色色| 六月丁香开心婷婷欧美| 天天天天做夜夜夜夜做| 亚洲妇女熟BBW| 99人人干人人| 色久丁香五| 丁香五月婷婷天激情| 99er6免费视频热播| 亚洲操B| 六月婷婷开心| 以及AA大片看看| 丁香六月婷婷久久综合八月| 日韩成人综合网| AV在线不卡网站| 五月婷婷综合色啪首页| www.婷婷五月天| 久久香视频| 爱婷婷五月| 婷婷久久五月天| 久9热| 91成人看片| 色原狠狠综合| 色色a| 久久99大| 亚洲成人在线五月天| 性爱激情综合网| 国产日批视频| 色婷婷99| 美欧成人视频| 婷婷五月天网| 99热加勒比| 99热久| 无码字幕中文| 色色色色色色色色网站| 五月天堂色色| 婷婷五月天高清无码| 久久久av久av久片一区二区| 国产日日夜夜操| 丁香婷婷久久 | 亚洲精品国产setv| 久久婷婷色| 婷婷五月综激情| 五月天社区婷婷丁香社区| 碰碰操91| 久热黄色| 伊人网欧美在线男人天堂五月丁香 | 99热这里只有精品在线免费| 激情五月天网| 五月丁香在线偷拍视频| 9久9久9久女女女九九九一九| 五月色情网| 亚洲精品白浆高清久久久久久| 日本天天综合| 婷婷WWW久久| 久久久久久丁香五月| 亚洲丁香婷婷| www99热| 日本97在线看片| 日本色色视频| 五月丁香A片| 五月婷婷丁香网| 国产色视频网站2| 九月婷婷激情| 婷婷色色网| 色五月激情综合网| 婷婷五月天资源| 超碰在线网站| 国产午夜一区二区三区| 我爱大香蕉| 日韩1区2区| 色婷婷六月天| 天天草天天摸| 黄色片区子| 99精在线| 五月熟妇婷婷久久| 久久久久五月丁香| 99在线观看视频| 99人人操人人操人人精| 五月婷婷性爱| 色爱亚洲| VA日本视频| 91操人人操| 天天天天天天噜| 人人插9| 第四色五月天| 人人妻久久妻| 精品视频这里只有精品| 亚洲图色五月天| 五月婷综合| 久久综合中文| 影音先锋AV资源男人站| 欧美在线视频99| 99久久综合网| 骚逼视频一区2区| 无码动漫av| 色色网站免费在线视频| 婷婷综合天堂| 热久久这里只有精品| www.夜夜.com| 99re热视频这里只有综合亚洲| 中文字幕欧美日韩VA免费视频| 六月合五月婷| 久久综合热17c| 久久久久97| 99人人干| 天天五月情| 色综合久久88色综合天天99| 国内精品免费一区二区2009| 婷婷99狠狠躁天天躁中| 婷婷五月丁香伊人网| 一区二区免费看| 欧美性色A片免费免费观看的 | av中文网站| 伊人久久综合| 亚洲乱码日产精品BD| 婷婷五月丁香香蕉| 久久婷婷青草五月天| 五月天成人综合| 四月丁香五月婷婷久久| 亚洲AAA| 69精品人人人人| 99热热这里只精品996小说| 色五月天综合| 9999久久久久| 久色88| 婷婷五月天色| 久久亚洲婷婷| 中文在线视频久1| 99热这只有| 狼人狠狠操| 亚洲AV免费在线| 五月丁香六月婷婷久久| 99热这只有| 激情综合99| 丁香五月婷婷国产av| 婷婷五月天激情影片| 亚洲婷婷在线播放十月| 九洲一级A片| 涩涩激情五月婷婷| 六月婷婷毛片| 五月婷激情| 狠狠色噜噜狠狠| 伊人狠狠色婷婷综合丁香一区| 久久小说| JAPANRCEP老熟妇乱子伦视频| 97婷婷狠狠| 色欲一二三| 婷婷区日本| 超碰成人在线观看| 丁香五月日韩| 亚洲无码成人| 色碰碰| av免费在线看不卡无毒| 办公室少妇激情呻吟A片在线观看| 99精品热| 欧美激情综合五月色丁香| 久久婷婷五月| 丁香五月影院| 激情婷婷五月久久| 性爱先锋AV| 婷婷五月情| 婷婷丁香社区| 97碰人人操| 婷婷色基地在线看 | 五月六月婷婷| 亚洲五月天伊人| 婷香五月网在线| 啊v视频在线观看| 婷婷丁香五月基地| 91九色精品女同系列| 天天摸天天日天天舔| 激情综合网五月在线播放| 91凹凸在线| 日本视频欧美观看免费| 色色色地址| 4438国产免费看| 欧美性交一区二区三区| 婷婷色在线播放| 99久99久| 色月丁| 狠狠色婷婷7777久综合| 五月婷婷丁香啪啪| 超碰成人在线观看| 日本a片网址| 91碰碰碰| www.99热国产| 97色色色色色色色色色色色色色| 国产Va视频| 亚洲色涩视频| 人妻久久久久久久久妻久久久久| 婷婷丁香人妻久久在线观看| 可以免费看AV网站| 天天天天天天天操| 婷婷五月av| 激情五月丁香亭亭| 亚洲av网站| 激情五月综合| 嫩BBB槡BBBB搡BBBB| 年轻的妺妺伦理HD中文| 日本婷色| 精品久久99码| 国产毛片精品一区二区色欲黄A片| 强壮公让我夜夜高潮A片视频| 91九色丨国产丨爆乳| 久久草中文日韩欧美| 九九RE视频在线精品| 熟女激情五月天| 亚洲色色色| 国产真人做爰视频免费| 操b视频在线观看一区二区| 欧美 日韩 成人| 玖玖综合网| 婷婷色五月综合丁香| 五月丁香婷中文字幕 | 人妻熟妇六区| 色五月婷婷基地| 丁香五月另类色婷婷麻豆| 99九九在线精品热动漫| 熟女人妻一区二区三区免费看 | 9 99免费视频| 丁香婷婷五月激情综合| 这里只有精彩视| 五月精品| 五月婷婷激情网| 天啪天啪天啪天啪| 婷婷伊人| 日本激情五月天‘| 婷婷综合久久| 另类激情五月| 久在线88综合| 国产婷婷综合在线免费视频| 91性高潮久久久久久久久| 久久激情综合| 婷婷五月丁香六月天亚洲综合| 性色视频| 色热久| 粉嫩AV久久一区二区三区| 色色五月综合| 夜夜骑日日操| 伊人色综合网| 一本色道久久88综合日韩精品| 婷婷五月六月| 色五月在线| 岛国AV网| PORNY九色9l自拍视频成人| 中文字幕日产A片在线看| 91pornav在线| 五月丁香久久激情网| 伊人9999| 丁香五月婷婷基地| 午夜丁香综合婷婷| 9999热这里只有精品| 8区视频在线| 国产3p露脸普通话对白| 成人做爰A片免费看网站找不到了| 久久99草五月婷婷| 日日日,com| 狠狠干,狠狠操| 欧美性爱一区| 国精产品一区一区三区免费视频| 国产午夜一区二区三区| 丝袜熟女一区二区三区| 婷婷丁香五月天大香蕉| 色色色综合| 色婷婷色| 九九sese| 丰满少妇猛烈A片免费看观看 | 国产精品久久99| 丁香六月综合激情| 色婷婷丁香中文在线播放| 色五月婷婷大香蕉| 色五月情| 九九热这里只有精品6| 亚洲色爱综合| 另类激情五月| 自拍偷窥99热| 五月丁香六月婷婷的女人| 国自产拍偷拍精品啪啪一区二区| 超碰在线人人| 激情五月五月五月婷婷| 9久视频| 超碰成人免费| 欧美Va婷色| 五月天基地| 五月六月丁香婷婷在线观看| 久热精品在看| 色色97丁香婷婷五月天| 婷婷D区| 久久五月综合| 五月激情婷婷丁香| 五月丁香久久网| 婷婷伊人网| 五月色丁香婷婷中文字幕| 五月色网| 久碰久| 婷婷五月天天| 少妇大叫太大太粗太爽了A片| 色99网站| 丁香六月色婷婷| 亚洲乱码在线观看| 国産精品| 婷婷五月丁综合| 色欲香综合网| renrencaoav| 国产67194| 色婷婷综合综合网| 婷婷五月天Av| 91操片| 啪啪视频99| 亚洲精品第一国产综合亚AV | 狠狠草在线观看| 五月婷六月天| 3www激情| 九九这里都是精品| 亚洲天天操| 五月丁香亚洲综合| 色99视频| 久综合| 日韩九九| 婷婷五月另类网站| 99免费热视频| 天天爽天天干| www99精品| 99久.| 91人妻PORNY九色大屁股| 亚州操逼网| 国产激情在线| 午夜成人综合| 婷婷在线精品| Se.婷婷五月天| 玖玖在线资源视频| 日韩激情婷婷五月天| 丁香婷婷免费| 五月开行婷婷色五月| 婷婷五月天另类视频| 五月丁香少妇网| 91大屁股| 可以看的AV| 国产成人av在线播放| 色播五月网| 久久久GOGO无码啪啪艺术| 麻豆观看夏晴子| 色婷婷精品视频在线播放| 欧美日韩精品一区二区三区钱| 丁香婷婷五月综合欧美另类| 亚洲色人妻| 色色婷| yazhou seshipin| 99热99这里有免费的精品| 久久人妻久久| 日日综合网| 26uuu国产| 99在线资源视频| 五月亭大香蕉| 亚州在线中文字幕| 五月天停停日日| av 一区三区四区| 久久久久99精品成人片| 久久精品系列| 疯狂做受XXXX高潮A片| 久草热8精品视频在线观看| 成人国产网| 五月丁香自拍| 热99热| 五月六月伦理| 色丁香五月婷婷| 性无码专区无码| 九月性爱网| 日韩成人av在线| 九九热99精品| 任我肏| 激情五月丁香五月色| 婷婷五月天大香蕉在线视频观看| 久久婷婷六月综合| 草逼大片| 欧美一级色| AV色色天堂中文| 九月激情综合婷婷| AⅤ色区| 久热 91| 超碰在线网站9| 亚洲一区二区无遮挡A片| 在线视频色五月| 噜噜狠狠色| 另类少妇人与禽zOZZ0性伦| 开心久久网婷婷| 激情深爱婷婷网| 色色色色色色色色色色色色色色,网站| 激情五月丁香五月| 丁香五月婷婷亚洲另类| www.狠狠操.co m| 久久狠狠高潮亚洲精品 天天摸夜夜摸夜夜狠狠摸| 色色婷婷综合网| 激情久久综合| 五月天婷婷色色首页| 五月天婷婷久久日| 婷婷丁香九月| 色色综合热| 97福利视频| 婷婷五月丁香五月综合网| 被强行糟蹋的女人A片| 亚洲99综合| 亚洲精品国产精品乱码视99| 日韩av一区二区在线/日产精品久久久 | 99热99热在线观看| 激情五月天综合网| 亭亭玉月丁香| 91精品人妻少妇无码影院| 婷婷色5月天在线。| 亚洲精品成人| 97色热| 天天干天天操天天拍| 九九成人视频| 色狠狠激情五月| 丁香九月激情| 色五月婷婷1| 伊人午夜综合色啪| 人人爽天天爽| www.91久久| 丁香五月成人| www亚洲无码| 九色色| 国精产品一区一区三区免费视频| 久久99久久99精品免观看粉| 青草热视频这里只有精品| 深爱五月天| 久久9热综合| 五月婷婷六月婷| 九九在线视频| 99精品这里只有免费视频 | 亚洲国产成人综合| 99热日韩| 久久九九综合| 91精品国产91久久久久青草| 色碰碰| 97色热| 欧美日比视频| 日韩美一级毛卡片| 思思久久青草热| 五月婷婷啪啪啪啪| 五月婷导航| 五月婷婷碰碰| 精品人妻久久久久| 亚洲色综久久五月| 天天狠狠六月婷丁香影院| 96色婷婷| www.99热在线| 色五月大| 婷婷丁香九月| 亚洲无码www| 色色日本欧美| 色一情一乱一乱一区91| 色婷婷综合亚洲| 日韩综合久久| 99碰碰| www。88热在线视频免费观看| 欧美性做爰大片免费看办公室| 青草性爱视频| 丁香婷婷成年| 婷婷五月av| 丁香五月天堂网AV| 99热青青草| 久久精品爱爱| 久久性爱99国产| aaa日韩| 操操日韩| 丁香五月大香蕉| 婷婷五月丁香狠狠| www,setingting| 79精品视频| 婷婷丁香综合| 五月天色五月| 五月婷丁香| 九九热欧美| 激情婷婷五月天网址| 免费视频1区| 性综合网| 深爱五月激情网| 五月婷性爱| 五月天开心婷婷激情网站| www.AV在线| www狠狠| 欧美性爱特黄一级aaaassss| 久久网址99热| 99色婷婷| 五月婷婷丁香综合网| 伊人热婷婷| 丁香五月激情综合| se99高清无码| 九久热| 超碰91在线| 日日肏夜夜干| 色六月婷婷| 69超碰在线| 强伦轩人妻一区二区电影| 99九九精品| 久综合4| 五月天婷婷社区| 久久色五月| 丁香婷婷狠狠97| 91九色国产熟女| 天天爽人人综合免费7799| 亚洲网站观看视频| 六月婷婷色综合| 色婷婷综合网| 最新国产AV| www.久久久久久久| 草做免费在线观看| 99色这里| 久久综合色五月| 嫩BBB槡BBBB搡BBBB| 免费看欧美成人A片无码| 狠色狠色狠狠色综合网| 人人操人人干AV| 国产精品成人AV在线观看春天| 思思热视频| 色婷婷五月天激情综合| 大香蕉免费9| 激情五月天天| 五月激情站| 欧美色性色好| 深爱激情四射| 色综天天综合| 人人性久久| 色婷婷播放| 欧美丰满熟妇BBB久久久| 五月天婷婷在线播放| 丁香五月AV在线| 五月婷婷,六月婷婷| 国产成人综合亚洲| 日韩成人免费电影| 国产精品香蕉| 色欲五月天| 一起草无码视频| 一区视频网站| 在线看av| 最近中文字幕大全免费版在线| 久9久9热久热| 淑女丝袜bi操逼123| 色婷五月| 大香蕉久久草| 日韩精品超碰在线观看| 9久热在线精品| 五月丁香六月激情| 99re在线观看| 亚洲综合久| 色五月欧美| 无码网站视频| 丁香六月婷婷综合在线| 99色丁香婷婷综合网| 超碰免费99| 色玖玖玖| 免费看欧美成人A片无码| 欧美精品99| 婷婷五月六月丁香| 丁香五月婷婷手机| 激情六月婷| www.俺去也com| 久久精品永久免费| 激情五月图| 综合久久婷婷五月丁香| 香蕉综合在线| 91综合色| 超碰色女| 99热主页日本| 91一起操| 亚洲午夜av| 色五月色情| 亚洲色频| 五月丁香趴趴| 婷婷五月在线| 六月激情丁香一道本7777| 天天射色五月天| 99人人爽| 婷婷综合五月| 桃色成人网| 亚洲第一成人无码A片| www.激情| 婷婷色色综合| 99A片| 欧美怡红院黄站| 性爱久久| 激情婷婷| 级人人91| 色噜噜五月丁香婷婷| 视频在线免费观看欧洲乱码| 欧美视频五区| 在线视频色五月| 激情深爱婷婷网| 天天激情综合| 色色婷婷综合网| 女高怪谈在线观看| 五月天开心色情网| 无码人妻电影| 超碰超碰在线| 久热九九| 疯狂做受XXXX高潮A片| 欧美美女视频| 日韩国产在线精品| 色久一| www.婷婷六月天| 亚洲成人一区| 18av天堂| www夜夜操comwww| 欧美天堂久久| 97人妻碰碰中文无码久热丝袜| 婷婷五月色| 182无码| 天天日夜夜欢| 色播五月丁香婷婷| 五月激情综合婷婷| 久久国产成人9999久久久久| 欧美在线视频免费播放| 五月婷婷开心亚洲无| 丁香六月爱综合| 五月婷婷丁香五月| 欧美久热| 亚洲精品国产熟女久久久| 亚洲免费电影2| 99色在线| 天天爽天天透天天爱| 欧美Va婷色| 天天色天天色天天色天天色天天色| 91久久婷婷人人澡草 | 成人午夜天| 色色三级视频| 99久高清视频| 91精品久久久久久77777| 99热免费网站| 五月丁香亭亭天天舔| 丁香九九九九| 五月天激情国产综合婷婷婷| 国产超碰人人| 五月天婷婷网站| 五月天婷婷视频30| www.91在线观看| av操逼网| 99re这里只有精品99| 五月婷婷色激情| 丁香五月婷婷色偷偷| 五月综合六月婷婷| 婷婷激情综合| 九九热内射| aaaaaa片| 亚洲综合五月| 亚洲熟妇AV乱码在线观看| 久久五月天影院| 精a品a视a频| 激情综合网五月婷婷| 亚洲成人免费电影| 伊人激情网| 国产精品久久在线观看技巧| 五月天天天色| 免费看欧美成人A片无码| 亚洲av综合网| 色综合色综合色综合色综合| 激情色播| 99久久玖玖| 日日噜狠狠色综合久久| 九九色图| 无码91中文字幕| 性色欲情 网站| 五月天五月婷五月激情网| 五月婷综合| 色婷婷91激情小说| 天天色综合色| 国产一级片| 影音先锋一区| 色婷婷亚洲婷婷| 亚洲中字AV电影在线网站| 日日干天天射| 免费亚洲婷婷五月| 婷婷色色宗合网| 九九热九九热精品| 激情综合网五月天| 五月婷婷中文字幕| 天天色99| 色综合色色色色| site:feetmall.com| 丁香五月天社区| 婷婷丁香人妻天久久| 色五月大| 久久婷视频| 成人色色视频| 综合欧美五月婷婷| 丁香五月天av| 日韩av手机在线观看| 五月天成人在线视频丁香| 99在线免费观看| www.久久久.com| 久久久大香蕉| 丁香婷婷五月六月久久| 丁香五月婷婷网| 停停六月 综合| 熟女激情网| 伊人干综合| 九色婷婷| 五月天综合久久| www.91色| 色五月在线观看| 婷婷五月天丁香| 天天综合色| site:wpjngj.com| 五月婷婷激情综合网| 国产精品久久..4399| 天干夜夜操| 色色色777| 六月丁香网| 亚洲天堂爱爱| 婷婷精品在线| 久久免费精品小视频| 久99视频在线观看| 久久精品99久久| 色亭亭五月天丁香综合AV - 百度 - 百度| 婷婷伊人网| 丁香五月在线视频| 狠狠爱深色婷婷综合| 六月婷婷网| 久综合| 超碰二区| 色狠狠色| 激情网开心网| 99色在线视频| 免费看无码视频A级| 丁香五月天论坛| 性色综合网| 九九热最新| 天天综合 99久久婷婷| 成人看片网站| 97久久久免费福利网址| 久久五月丁香婷婷| 婷婷激情五月天在线视频| 五月激情丁香啪啪| 婷婷精品性视频| 91丨九色丨熟女| 丁香五月自拍| 天天操天天操| 亚洲第二AV| 91丨九色丨熟女| 日韩成人无码人妻| 五月丁香婷婷综合网| 精品视频这里只有精品| 五月婷婷丁香91| 久热最新视频| 操日本三片99| 成人精品在线| 99精品视频免费观看,| 五月丁香婷婷五月色| 俺去也综合| 五月天婷婷三级黄| 欧在线一区| 五月色综合| 99热这里只有精品69| 肏日网在线看| 久久久久久久97| 五月天婷婷在线观看精品男人| 超碰99热在线观看| 69精品人人人人| 久久九九在线视频| 天天看A片| 岛国AAAV| 欧美日本va| 久久综合丁香五月| 久久五月热| 国产成人+综合亚洲+天堂| 婷婷四色五月| 五月天之色情综合网| 国产人妻人伦精品一区二区| 五月丁香六月色| 一根材五月婷成人| 人妻aV在线| 色无婷婷| 人妻操逼视频| 天天日天天干天天爽| 综合久久婷婷五月丁香| 色色色9 9 9| 欧美成人精品A片免费一区99| 五月天综合网| 丁香五月婷婷亚洲另类| 先锋资源婷婷| 婷婷色色网站| 亚洲中文乱字字幕在线永久| 丁香六月激情国产| 亚洲视频在线观看99| 婷婷久久内射| 日韩操人| 性色婷婷| 色婷婷色人人射| 超碰二区| 99热99思午夜精品| 黄网在线播放| 高清无码视频网址| 精品九九视频| 激情深爱五月婷婷| 夜色.cnm| 日本4399天堂中出| 99久久极情精品一区| 色五月涩涩婷婷| 色六月视频| 千人斩操逼| 噜噜色天天开心| 大香蕉九九热| 久久婷婷五月天大香蕉| 六月丁香久久| 亚洲精品亚洲人成人网| 激情五月婷婷| 久久99热这里只有精品23| 色色激情网| 99精品视频推荐| 一本到不卡高清DVD| 久草五月天| 欧美五月婷婷| 五月天天天天天天天天天天天天天天天婷婷婷| 亚洲男人的天堂婷婷色五月| 丁香色情五月天| www.婷婷| 人人插操| 青草青草视频2免费观看| 久久久人妻| 五月停停丁香| 婷婷五月丁香成人| 丁香五月大片| 欧美va视频不用播放器的va视频网| 久久新地址| 毛片新网地| 色婷婷五月天偷拍| 国产精品国产| 9 1在线视频| 国产中文字幕在线视频免费观看| 亚洲va久久久噜噜噜久久天堂| 蜜桃人妻无码AV天堂三区| 大香蕉九九| 久热久| 大香蕉人妻| 婷婷香蕉| 97精品自拍| 超碰人人在线| 九九re精品视频在线观看| 亚洲色99| 丁香五月婷婷基地| 婷婷五月丁香超碰| 日日日日操| 天天日夜夜拍| 婷婷娌伦网| 可以直接看的AV| 久久机热/这里只有精品| 五月天综合影院| 一级性爱视频| 五月婷婷色| 日韩三级高清无码| 婷婷综合视频| 久久久久久久人妻| 青青草原伊人网| 丁香 久久| 婷婷大乡焦噜噜| 综合99综合久久久久久久| 99re久久| 激情小说五月天| 丁香六月婷| 丁香婷婷天堂| 丁香五月 性爱| 日本英国美国欧美亚洲国产精亚洲日韩精品在线观看 | 97在线精品| 九九热超碰| 天天粽合合合合| 五月丁香少妇网| aaa日韩| 日日噜噜夜夜狠狠久久丁香五月| 五月花综合视频| 91九色国产熟女| 可以看的av| 影音先锋 萱萱| 碰97 久| 日本天堂久久| 91热久久| 久久只有精| 五月天激情婷婷| 婷婷五月色| 天天插天天插天天插天天插 | 婷婷五月成人色综合| 六月婷色六月| www.夜夜| 日韩九区| 九九一区| 91岛国片| 久久欧洲久久| 99er久久| 九月婷婷久久久| 97碰碰碰免费公开在线视频| 996re热精品视频| 99热精品观看| 我爱va亚洲va52| 五月婷婷天天| 97干在线视频| 九九色黄色| 久久综合爱| 五月婷婷无码专区| 26UUU欧美激情一区二区| 久热超碰| 婷婷色偷拍| 99热热九九| 亚洲色综合性| 亚洲欧美成人在线| 伊人网色婷婷五月天| 丁香九九九九| 五月伊人视频在线看| 色丁香五月婷婷| 一本道在线电影| 色综啪啪| 99色综合网| 99热这里精品| 五月天社区| 亚洲成人无码网站| 午夜青草资源| 激情五月天婷婷在线网址发给我| 五月丁香偷拍| 亚洲另类毛片| 丁香六月激情综合网| 91要啪| 婷婷亚洲在线| 色综合夜夜| 久久婷婷五月综合啪| 91se精品国产| 九九精品网站| 五月天精品| 5月丁香综合图区| 亚洲操操| 99热这里只有精品搜| 国产67194| 五月天久久www| 26uuu最新地址| 亚洲亚洲人成综合网络| 婷婷伊人网| 天天天操天天天日| 99视频只有精品| 97色色色| se99视频| 性按摩玩人妻HD中文字幕| 色情综合| 91久久电影| 国产性爱色| 丁香五月婷婷色综合基地| 97碰碰人人| 丁香五月激情月| 日韩久久这里只有精品| 亚洲婷婷免费| 五月丁了香蕉综合| 只有久久精品免费| 亚洲欧美婷婷五月色综合| 激情久久综合| 人人操人人干AV| 97色色综合| 激情六月综合| h在线看免费版在线看| 亚洲另类电影| 超碰99热精品| 久久99精品久久久| 天天爽日日爽夜夜爽| 精品欧美性爱超级爽| 丁香五月婷婷基地| 大香蕉人妻| 激情综合网五月丁香| 很很干夜夜干| 大香久久综合网| 五月天夜夜爱夜夜操| 国产片XXXXA片国语对白| 丁香五月激情天AV无码| 人妻久久久久久久| 9热视频在线观看| 殴美综合激情五月天免费视频| 五月婷久久综合| www.com五月天| 丁香五月婷综合| 丁香五月开心婷婷| 猫咪伊人AV| xxxx五月激情| 久久久97| 久鲁鲁色网| 狠狠狠狠狠| 丁香五月成人论坛| 日本猛少妇色XXXXX猛叫| 琪琪秋霞| 国产精品VIDEOSSEX久久发布| 99精品热视频只有精品10| 性爱久久| 五月天伊人av| 色香欲综合| 丁香五月天激情网址| 1024人妻| 丁香大香蕉| 五月花免费视频| 九九热视频网站| 丁香九月婷婷| 五月停停丁香| 九九伦子片| 色偷偷五月天| 丁香五月六月综合激情| 成人丁香五月| 亚洲色五月| 开心激情站| 五月婷婷丁香五月婷婷| 超碰京东热av男人的天堂| 中文字幕成人影视| 丁香婷婷婷五月综合色情| 久久天堂| 91久久1118| 日本va欧美va国产激情| 五月激情丁香久久综合网| 青柠影视免费高清电视剧| 大香蕉久久久久| 99激情| 亚洲综合色网站| 国产综合A片| 最新精品视频99| www.com在线操视频免费观看| 另类综合网| 色婷婷精品视频| 99riAV国产精品视频| 那里有AV网址| 97精品人人A片免费看| 亚洲色视频| www999日韩精品| 玖玖婷婷五月天| 婷婷精品在线| 激情久久综合网| 久久视频婷婷| 婷婷五月成人色综合| 99爱爱| 九九热视| 999久久久国产精品| 五月丁香啪| 99热亚洲精品66| 久婷五月|