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

ARTICLE DETAIL

資訊詳情

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

從零構(gòu)建復(fù)合型AMR控制系統(tǒng):SLAM、Qt界面與多機(jī)協(xié)同實(shí)戰(zhàn)

從零構(gòu)建復(fù)合型AMR控制系統(tǒng):SLAM、Qt界面與多機(jī)協(xié)同實(shí)戰(zhàn) 簡(jiǎn)介本資源是一套面向工業(yè)自動(dòng)化與機(jī)器人開(kāi)發(fā)工程師的復(fù)合型AMR移動(dòng)機(jī)器人控制系統(tǒng)完整工程實(shí)現(xiàn)聚焦激光SLAM導(dǎo)航、多體協(xié)同與人機(jī)交互集成解決智能物流、柔性產(chǎn)線中移動(dòng)底盤(pán)與機(jī)械臂一體化控制的實(shí)際開(kāi)發(fā)難題。壓縮包含612個(gè)文件主體為18個(gè)C源文件如navserver.cpp、manager.cpp、545個(gè)索引文件idx、7個(gè)QML界面組件、11個(gè)頭文件及3個(gè)可執(zhí)行程序輔以JSON配置、Qt項(xiàng)目文件.pro、UI定義.ui和文檔說(shuō)明整體6.18MB結(jié)構(gòu)清晰模塊劃分明確——涵蓋導(dǎo)航API封裝、機(jī)械臂運(yùn)動(dòng)學(xué)控制、Qt/QML雙模界面、基于TCP/UDP的網(wǎng)絡(luò)通信及JSON協(xié)議解析等核心層。已有84人學(xué)習(xí)下載提供從底層驅(qū)動(dòng)集成到上層可視化交互的全棧代碼參考包含多設(shè)備任務(wù)調(diào)度邏輯、SLAM定位數(shù)據(jù)流處理路徑及QML動(dòng)態(tài)綁定實(shí)現(xiàn)細(xì)節(jié)是深入理解AMR系統(tǒng)軟硬件協(xié)同設(shè)計(jì)的高價(jià)值實(shí)踐樣本。1. 項(xiàng)目緣起從單一底盤(pán)到復(fù)合型AMR的挑戰(zhàn)去年接手一個(gè)倉(cāng)儲(chǔ)物流的自動(dòng)化升級(jí)項(xiàng)目客戶(hù)的需求很明確他們希望將現(xiàn)有的、只能沿著磁條或二維碼跑的AGV小車(chē)升級(jí)成能在復(fù)雜動(dòng)態(tài)環(huán)境中自主導(dǎo)航、并且能協(xié)同機(jī)械臂完成“取-放”作業(yè)的復(fù)合型移動(dòng)機(jī)器人。這個(gè)需求背后是典型的從“自動(dòng)化”到“智能化”的跨越。傳統(tǒng)的AGV路線固定換個(gè)貨架位置就得重新貼條柔性極差。而我們要做的是基于激光雷達(dá)和SLAM算法讓機(jī)器人自己認(rèn)識(shí)環(huán)境、規(guī)劃路徑再通過(guò)一個(gè)集成的控制系統(tǒng)指揮底盤(pán)移動(dòng)和機(jī)械臂動(dòng)作最終通過(guò)一個(gè)直觀的界面讓操作員能輕松監(jiān)控和調(diào)度。這聽(tīng)起來(lái)像是一個(gè)標(biāo)準(zhǔn)的“機(jī)器人操作系統(tǒng)”項(xiàng)目但實(shí)際一上手坑就來(lái)了。市面上成熟的方案如ROS生態(tài)固然龐大但對(duì)于這種需要深度定制、對(duì)實(shí)時(shí)性和界面交互有較高要求的工業(yè)項(xiàng)目有時(shí)顯得過(guò)于“臃腫”和“黑盒”。我們最終決定基于C和Qt框架從零開(kāi)始搭建這套控制系統(tǒng)。核心模塊包括處理激光數(shù)據(jù)并實(shí)現(xiàn)定位建圖的SLAM模塊、驅(qū)動(dòng)底盤(pán)移動(dòng)的導(dǎo)航控制API、解析并執(zhí)行動(dòng)作的機(jī)械臂控制器、用于多機(jī)通信的網(wǎng)絡(luò)模塊、以及用Qt/QML構(gòu)建的圖形化監(jiān)控界面。整個(gè)項(xiàng)目打包后就是一個(gè)包含了所有源碼、依賴(lài)和配置的壓縮包即標(biāo)題中的那個(gè).zip文件。今天我就把這套系統(tǒng)開(kāi)發(fā)中的核心設(shè)計(jì)、關(guān)鍵技術(shù)選型的思考以及那些踩過(guò)又填平的坑系統(tǒng)地梳理一遍。2. 系統(tǒng)架構(gòu)總覽模塊化設(shè)計(jì)與數(shù)據(jù)流在動(dòng)手寫(xiě)第一行代碼之前定義一個(gè)清晰、松耦合的系統(tǒng)架構(gòu)至關(guān)重要。我們的核心目標(biāo)是高內(nèi)聚、低耦合確保底盤(pán)導(dǎo)航、機(jī)械臂控制、人機(jī)界面等模塊既能獨(dú)立開(kāi)發(fā)和測(cè)試又能高效協(xié)同。2.1 核心模塊劃分與職責(zé)整個(gè)控制系統(tǒng)可以劃分為五個(gè)核心層數(shù)據(jù)自底向上流動(dòng)指令自上而下執(zhí)行感知與定位層Perception Localization核心組件2D激光雷達(dá)、SLAM算法庫(kù)如Gmapping、Cartographer或自研算法。職責(zé)實(shí)時(shí)采集激光點(diǎn)云數(shù)據(jù)通過(guò)SLAM算法進(jìn)行環(huán)境地圖構(gòu)建Mapping和機(jī)器人自身的實(shí)時(shí)定位Localization。這是整個(gè)系統(tǒng)自主性的基礎(chǔ)其輸出的機(jī)器人位姿x, y, theta和環(huán)境地圖是后續(xù)所有決策的依據(jù)。決策與規(guī)劃層Decision Planning核心組件導(dǎo)航算法模塊、任務(wù)調(diào)度器。職責(zé)接收上層界面或調(diào)度系統(tǒng)下達(dá)的目標(biāo)點(diǎn)或作業(yè)任務(wù)結(jié)合當(dāng)前位姿和地圖進(jìn)行全局路徑規(guī)劃如A*、D*算法和局部實(shí)時(shí)避障如DWA、TEB算法。規(guī)劃出的是一條安全的、可執(zhí)行的路徑Path或速度指令cmd_vel。執(zhí)行與控制層Execution Control核心組件底盤(pán)控制API適配器、機(jī)械臂運(yùn)動(dòng)控制器。職責(zé)這是與硬件直接打交道的部分。底盤(pán)控制將規(guī)劃層生成的速度指令線速度v角速度w通過(guò)特定的通信協(xié)議如CAN、串口、EtherCAT和廠商提供的API轉(zhuǎn)換為電機(jī)驅(qū)動(dòng)器的具體控制指令。機(jī)械臂控制解析作業(yè)任務(wù)如“抓取A點(diǎn)物料放置到B點(diǎn)”進(jìn)行逆運(yùn)動(dòng)學(xué)求解和軌跡規(guī)劃生成關(guān)節(jié)角度或末端位姿序列通過(guò)機(jī)械臂控制器如Modbus TCP、EtherNet/IP驅(qū)動(dòng)機(jī)械臂執(zhí)行。通信與協(xié)同層Communication Coordination核心組件網(wǎng)絡(luò)通信模塊TCP/UDP、JSON數(shù)據(jù)解析器、設(shè)備狀態(tài)管理器。職責(zé)負(fù)責(zé)系統(tǒng)內(nèi)部模塊間以及多臺(tái)AMR之間的數(shù)據(jù)交換。我們選用JSON作為統(tǒng)一的數(shù)據(jù)交換格式因?yàn)樗祟?lèi)可讀、易于調(diào)試、且?guī)缀跛姓Z(yǔ)言都支持解析。網(wǎng)絡(luò)模塊負(fù)責(zé)建立連接、打包/解包JSON數(shù)據(jù)狀態(tài)管理器則維護(hù)所有設(shè)備的實(shí)時(shí)狀態(tài)如位置、電量、任務(wù)狀態(tài)是實(shí)現(xiàn)多機(jī)協(xié)同作業(yè)和防碰撞的基礎(chǔ)。人機(jī)交互層HMI核心組件基于Qt和QML的圖形用戶(hù)界面。職責(zé)為操作員提供可視化監(jiān)控和操控界面。需要實(shí)時(shí)顯示地圖、機(jī)器人位置、機(jī)械臂狀態(tài)、任務(wù)隊(duì)列并提供地圖編輯、目標(biāo)點(diǎn)設(shè)置、急停、任務(wù)下發(fā)等交互功能。2.2 數(shù)據(jù)流驅(qū)動(dòng)以一次“取貨”任務(wù)為例假設(shè)操作員在界面上點(diǎn)擊貨架A點(diǎn)下達(dá)“取貨”指令。系統(tǒng)內(nèi)部的數(shù)據(jù)流是這樣的界面層將“取貨”指令和目標(biāo)坐標(biāo)(x_A, y_A)封裝成一個(gè)JSON任務(wù)對(duì)象通過(guò)本地進(jìn)程間通信如信號(hào)槽或網(wǎng)絡(luò)Socket發(fā)送給決策層。{ task_id: pick_001, type: pick, target: {x: 1.5, y: 2.3, theta: 0.0}, arm_action: grip }決策層任務(wù)調(diào)度器接收J(rèn)SON解析出目標(biāo)點(diǎn)。導(dǎo)航模塊結(jié)合當(dāng)前SLAM提供的位姿和地圖計(jì)算出一條通往A點(diǎn)的路徑并開(kāi)始生成實(shí)時(shí)的cmd_vel指令。控制層底盤(pán)控制器接收cmd_vel通過(guò)底盤(pán)API驅(qū)動(dòng)輪子移動(dòng)。同時(shí)機(jī)械臂控制器接收到“準(zhǔn)備抓取”的指令開(kāi)始運(yùn)動(dòng)到預(yù)抓取姿態(tài)。感知層在整個(gè)移動(dòng)過(guò)程中SLAM模塊持續(xù)工作用最新的激光數(shù)據(jù)修正機(jī)器人位姿并將更新后的位姿反饋給決策層實(shí)現(xiàn)閉環(huán)控制。協(xié)同層網(wǎng)絡(luò)模塊會(huì)持續(xù)將機(jī)器人的狀態(tài)位置、速度、任務(wù)進(jìn)度廣播給其他AMR或中央服務(wù)器。如果系統(tǒng)中還有其他機(jī)器人它們的狀態(tài)管理器會(huì)根據(jù)此信息進(jìn)行動(dòng)態(tài)避障或任務(wù)排隊(duì)。抵達(dá)與執(zhí)行機(jī)器人到達(dá)A點(diǎn)附近后決策層通知機(jī)械臂執(zhí)行精確抓取動(dòng)作。抓取完成后可能再觸發(fā)一個(gè)“放置”任務(wù)數(shù)據(jù)流再次循環(huán)。這個(gè)架構(gòu)的關(guān)鍵在于JSON是貫穿各層的“普通話(huà)”而網(wǎng)絡(luò)通信模塊是“郵差”確保了不同語(yǔ)言、不同進(jìn)程、甚至不同物理設(shè)備上的模塊能夠無(wú)縫對(duì)話(huà)。3. 核心基石激光SLAM的實(shí)現(xiàn)與底盤(pán)API集成SLAM和底盤(pán)控制是AMR移動(dòng)能力的左右腿缺一不可。這一部分我們深入技術(shù)細(xì)節(jié)。3.1 2D激光SLAM的選型與集成要點(diǎn)對(duì)于室內(nèi)倉(cāng)儲(chǔ)場(chǎng)景2D激光SLAM如Gmapping、Hector、Cartographer通常是性?xún)r(jià)比最高的選擇。我們最終選擇了Cartographer原因如下精度與魯棒性Cartographer采用圖優(yōu)化Graph Optimization后端能有效閉環(huán)檢測(cè)累積誤差小建圖精度高適合構(gòu)建大型、一致性好的地圖。實(shí)時(shí)性其前端掃描匹配速度快能滿(mǎn)足AMR實(shí)時(shí)定位的要求。可配置性提供了豐富的參數(shù)文件.lua可以針對(duì)不同的雷達(dá)型號(hào)如SICK、Hokuyo、國(guó)產(chǎn)雷達(dá)、機(jī)器人運(yùn)動(dòng)模型進(jìn)行精細(xì)調(diào)優(yōu)。集成中的核心步驟與坑點(diǎn)數(shù)據(jù)接口適配Cartographer期望的激光數(shù)據(jù)是sensor_msgs/LaserScan格式這是ROS中的消息格式。但我們是非ROS系統(tǒng)所以需要自己實(shí)現(xiàn)一個(gè)數(shù)據(jù)適配層。核心是定義一個(gè)結(jié)構(gòu)體包含angle_min,angle_max: 雷達(dá)掃描的起始和結(jié)束角度弧度。angle_increment: 角度增量。range_min,range_max: 有效測(cè)距范圍。ranges: 一個(gè)浮點(diǎn)數(shù)數(shù)組存儲(chǔ)每個(gè)角度對(duì)應(yīng)的距離值。timestamp: 數(shù)據(jù)時(shí)間戳至關(guān)重要用于與里程計(jì)數(shù)據(jù)時(shí)間同步。 我們需要從雷達(dá)的原始數(shù)據(jù)包通常是串口或網(wǎng)口數(shù)據(jù)中解析出這些字段并填充。里程計(jì)融合純激光SLAM在長(zhǎng)走廊、玻璃墻等特征稀少的環(huán)境容易失效。必須融合輪式里程計(jì)Odometry信息。Cartographer通過(guò)nav_msgs/Odometry消息接收里程計(jì)數(shù)據(jù)。我們需要從底盤(pán)控制器或電機(jī)驅(qū)動(dòng)器讀取編碼器脈沖計(jì)算并發(fā)布機(jī)器人的位姿Pose和速度Twist。這里的關(guān)鍵是坐標(biāo)系對(duì)齊和時(shí)間同步。里程計(jì)和激光雷達(dá)的數(shù)據(jù)必須在同一時(shí)間基準(zhǔn)下并且知道兩者在機(jī)器人上的安裝位置關(guān)系TF變換。參數(shù)調(diào)優(yōu)實(shí)戰(zhàn)Cartographer的參數(shù)文件是成敗的關(guān)鍵。幾個(gè)最容易踩坑的參數(shù)num_subdivisions_per_laser_scan將一幀激光數(shù)據(jù)分成多少份進(jìn)行處理。對(duì)于高速移動(dòng)的機(jī)器人分多份可以提高實(shí)時(shí)性但會(huì)損失一些精度。我們通常設(shè)置為5-10。num_range_data用于進(jìn)行掃描匹配的歷史幀數(shù)。太大會(huì)增加計(jì)算量太小可能匹配失敗。室內(nèi)環(huán)境一般120-150足夠。occupied_space_weighttranslation_weight,rotation_weight這些是優(yōu)化器的權(quán)重影響閉環(huán)檢測(cè)的強(qiáng)度。如果發(fā)現(xiàn)建圖時(shí)閉環(huán)總是失敗或產(chǎn)生扭曲需要調(diào)整這些權(quán)重。注意調(diào)參是一個(gè)迭代過(guò)程。務(wù)必在同一個(gè)環(huán)境下使用相同的錄制數(shù)據(jù)包bag進(jìn)行反復(fù)測(cè)試和對(duì)比才能看出參數(shù)改變的真實(shí)效果。盲目調(diào)參只會(huì)浪費(fèi)時(shí)間。3.2 底盤(pán)導(dǎo)航API集成封裝與抽象不同品牌的AMR底盤(pán)其控制接口千差萬(wàn)別有的提供ROS驅(qū)動(dòng)包有的提供C SDK有的只給一個(gè)串口協(xié)議文檔。我們的策略是定義統(tǒng)一的內(nèi)部接口然后為每種底盤(pán)編寫(xiě)特定的適配器Adapter。定義抽象控制接口class ChassisController { public: virtual ~ChassisController() default; // 初始化連接 virtual bool connect(const std::string config) 0; // 發(fā)送速度指令 virtual bool setVelocity(double linear_x, double linear_y, double angular_z) 0; // 獲取里程計(jì)信息 virtual bool getOdometry(double x, double y, double theta, double vx, double vy, double vtheta) 0; // 獲取傳感器狀態(tài)如 bumper, battery virtual ChassisStatus getStatus() 0; // 急停 virtual bool emergencyStop() 0; };實(shí)現(xiàn)具體適配器例如對(duì)于一款通過(guò)CANopen通信的底盤(pán)我們需要實(shí)現(xiàn)CanopenChassisController類(lèi)內(nèi)部使用CANopen庫(kù)如CANopenNode來(lái)發(fā)送PDO過(guò)程數(shù)據(jù)對(duì)象控制電機(jī)并接收SDO服務(wù)數(shù)據(jù)對(duì)象來(lái)讀取編碼器值計(jì)算里程計(jì)。集成到導(dǎo)航循環(huán)導(dǎo)航算法模塊如自己實(shí)現(xiàn)的DWA局部規(guī)劃器每計(jì)算出一個(gè)cmd_vel就調(diào)用chassis_controller-setVelocity(cmd_vel.linear.x, 0.0, cmd_vel.angular.z)對(duì)于差分驅(qū)動(dòng)機(jī)器人linear.y為0。同時(shí)在一個(gè)獨(dú)立的高頻線程中持續(xù)調(diào)用getOdometry來(lái)獲取最新的里程計(jì)信息供給SLAM和導(dǎo)航算法使用。避坑指南線程安全底盤(pán)控制器的讀寫(xiě)操作必須加鎖因?yàn)閟etVelocity可能由導(dǎo)航線程調(diào)用而getOdometry可能由SLAM或狀態(tài)發(fā)布線程調(diào)用。超時(shí)與重連網(wǎng)絡(luò)或串口通信可能中斷。必須在setVelocity和getOdometry中實(shí)現(xiàn)超時(shí)機(jī)制并在檢測(cè)到斷連后嘗試自動(dòng)重連同時(shí)向上層報(bào)告錯(cuò)誤狀態(tài)。指令頻率與平滑直接發(fā)送高頻、跳變的cmd_vel可能導(dǎo)致底盤(pán)電機(jī)抖動(dòng)。最好在適配器內(nèi)部做一個(gè)簡(jiǎn)單的低通濾波或指令平滑處理。4. 上層應(yīng)用Qt/QML界面設(shè)計(jì)與網(wǎng)絡(luò)通信如果說(shuō)SLAM和底盤(pán)控制是機(jī)器人的“小腦”和“四肢”那么Qt界面和網(wǎng)絡(luò)通信就是它的“大腦皮層”和“神經(jīng)系統(tǒng)”負(fù)責(zé)高級(jí)的決策、交互和協(xié)同。4.1 從Qt Widgets到QML的重構(gòu)之路項(xiàng)目初期我們使用傳統(tǒng)的Qt Widgets快速搭建了功能界面。但隨著功能增加如地圖動(dòng)態(tài)渲染、機(jī)器人模型動(dòng)畫(huà)、多視圖切換Widgets的代碼變得臃腫且難以維護(hù)尤其是UI動(dòng)畫(huà)和復(fù)雜布局。于是我們決定向QMLQt Modeling Language重構(gòu)。為什么選擇QML聲明式語(yǔ)法UI布局和邏輯更清晰直觀。用QML描述“界面應(yīng)該是什么樣子”用C實(shí)現(xiàn)“后臺(tái)數(shù)據(jù)是什么”。強(qiáng)大的動(dòng)畫(huà)與狀態(tài)機(jī)原生支持各種屬性動(dòng)畫(huà)、狀態(tài)切換輕松實(shí)現(xiàn)平滑的機(jī)器人移動(dòng)動(dòng)畫(huà)、界面過(guò)渡效果。硬件加速渲染基于OpenGL的場(chǎng)景圖Scene Graph渲染地圖、大量機(jī)器人圖標(biāo)時(shí)性能遠(yuǎn)超Widgets。易于設(shè)計(jì)分離設(shè)計(jì)師可以使用Qt Design Studio工具設(shè)計(jì)UI開(kāi)發(fā)人員專(zhuān)注于業(yè)務(wù)邏輯協(xié)作更順暢。重構(gòu)的核心QML與C的數(shù)據(jù)綁定QML界面需要實(shí)時(shí)顯示機(jī)器人位姿、地圖、任務(wù)列表等動(dòng)態(tài)數(shù)據(jù)。這些數(shù)據(jù)來(lái)源于C后端。我們采用Q_PROPERTY和Q_INVOKABLE機(jī)制建立綁定。創(chuàng)建數(shù)據(jù)模型C// RobotModel.h class RobotModel : public QObject { Q_OBJECT Q_PROPERTY(QPointF position READ position NOTIFY positionChanged) Q_PROPERTY(double orientation READ orientation NOTIFY orientationChanged) Q_PROPERTY(QString status READ status NOTIFY statusChanged) public: QPointF position() const { return m_position; } // ... 其他getter signals: void positionChanged(); void orientationChanged(); void statusChanged(); private: QPointF m_position; double m_orientation; QString m_status; // 通過(guò)SLAM/網(wǎng)絡(luò)更新數(shù)據(jù)的函數(shù) void updatePose(double x, double y, double theta); };在QML中綁定與顯示// MapView.qml import QtQuick 2.15 Item { // 將C的RobotModel實(shí)例注入到QML上下文 property var robotModel Canvas { onPaint: { var ctx getContext(2d); // 繪制地圖... // 繪制機(jī)器人位置綁定到robotModel.position var robotX robotModel.position.x * scaleFactor; var robotY robotModel.position.y * scaleFactor; drawRobot(ctx, robotX, robotY, robotModel.orientation); } // 當(dāng)C中positionChanged信號(hào)發(fā)出時(shí)觸發(fā)重繪 Connections { target: robotModel onPositionChanged: canvas.requestPaint() } } }這樣只要C后端的updatePose被調(diào)用例如從SLAM線程并觸發(fā)了positionChanged信號(hào)QML界面上的機(jī)器人圖標(biāo)就會(huì)自動(dòng)更新位置無(wú)需手動(dòng)調(diào)用任何更新UI的函數(shù)。QML性能優(yōu)化點(diǎn)使用Loader動(dòng)態(tài)加載對(duì)于復(fù)雜的、非立即需要的組件如任務(wù)詳情面板使用Loader進(jìn)行按需加載減少初始化時(shí)間。避免在QML中做復(fù)雜計(jì)算將密集計(jì)算如路徑點(diǎn)平滑、坐標(biāo)轉(zhuǎn)換留在C端QML只負(fù)責(zé)渲染。圖片資源處理將UI中用到的圖標(biāo)、圖片進(jìn)行壓縮并使用Qt的資源系統(tǒng).qrc進(jìn)行管理。對(duì)于地圖這類(lèi)可能很大的圖片考慮分塊加載。4.2 網(wǎng)絡(luò)通信與JSON數(shù)據(jù)解析多機(jī)協(xié)同和遠(yuǎn)程監(jiān)控離不開(kāi)穩(wěn)定高效的網(wǎng)絡(luò)通信。我們采用TCP長(zhǎng)連接作為主要通信方式以保證指令的可靠有序傳輸同時(shí)輔以UDP廣播用于心跳包和設(shè)備發(fā)現(xiàn)這類(lèi)對(duì)實(shí)時(shí)性要求高、允許少量丟失的數(shù)據(jù)。通信協(xié)議設(shè)計(jì) 我們?cè)O(shè)計(jì)了一個(gè)簡(jiǎn)單的應(yīng)用層協(xié)議消息頭 JSON消息體。消息頭固定長(zhǎng)度如8字節(jié)包含消息體長(zhǎng)度4字節(jié)、消息類(lèi)型2字節(jié)、序列號(hào)2字節(jié)等信息。用于解決TCP的粘包/拆包問(wèn)題。JSON消息體承載實(shí)際數(shù)據(jù)。一個(gè)典型的狀態(tài)上報(bào)消息體{ msg_type: robot_status, robot_id: AMR_001, timestamp: 1698301234567, data: { pose: {x: 1.23, y: 4.56, theta: 0.78}, velocity: {linear: 0.5, angular: 0.1}, battery: 85.5, state: moving, current_task: pick_001 } }在C中的實(shí)現(xiàn)要點(diǎn)使用Qt網(wǎng)絡(luò)模塊QTcpSocket,QTcpServer,QUdpSocket是核心類(lèi)。將socket讀寫(xiě)放在獨(dú)立的線程避免阻塞主線程UI線程。JSON解析與生成Qt提供了QJsonDocument,QJsonObject,QJsonArray等類(lèi)非常方便。// 解析收到的JSON QByteArray data tcpSocket-readAll(); QJsonParseError error; QJsonDocument doc QJsonDocument::fromJson(data, error); if (error.error QJsonParseError::NoError) { QJsonObject obj doc.object(); QString msgType obj[msg_type].toString(); if (msgType robot_status) { QJsonObject dataObj obj[data].toObject(); QJsonObject poseObj dataObj[pose].toObject(); double x poseObj[x].toDouble(); double y poseObj[y].toDouble(); // ... 更新內(nèi)部狀態(tài)模型進(jìn)而觸發(fā)UI更新 } } // 生成要發(fā)送的JSON QJsonObject cmdObj; cmdObj[msg_type] navigation_goal; cmdObj[goal] QJsonObject{{x, goalX}, {y, goalY}, {theta, goalTheta}}; QJsonDocument cmdDoc(cmdObj); QByteArray cmdData cmdDoc.toJson(QJsonDocument::Compact); // 加上自定義消息頭后通過(guò)socket發(fā)送cmdData心跳與斷線重連客戶(hù)端定時(shí)如每秒向服務(wù)器發(fā)送一個(gè)簡(jiǎn)單的心跳包{msg_type: heartbeat}。服務(wù)器端如果超過(guò)一定時(shí)間如5秒沒(méi)收到某個(gè)客戶(hù)端的心跳則判定其離線清理相關(guān)資源??蛻?hù)端檢測(cè)到連接斷開(kāi)后應(yīng)嘗試指數(shù)退避重連。數(shù)據(jù)一致性多線程環(huán)境下網(wǎng)絡(luò)接收線程、業(yè)務(wù)邏輯線程、UI線程都可能訪問(wèn)共享的機(jī)器人狀態(tài)數(shù)據(jù)。必須使用互斥鎖QMutex或讀寫(xiě)鎖QReadWriteLock進(jìn)行保護(hù)或者采用生產(chǎn)者-消費(fèi)者模式通過(guò)Qt的信號(hào)槽機(jī)制默認(rèn)是隊(duì)列連接安全地將數(shù)據(jù)從網(wǎng)絡(luò)線程傳遞到主線程。5. 機(jī)械臂運(yùn)動(dòng)控制與多設(shè)備協(xié)同邏輯讓AMR移動(dòng)到目標(biāo)點(diǎn)只是第一步讓它的“手”機(jī)械臂完成精準(zhǔn)作業(yè)才是價(jià)值閉環(huán)的關(guān)鍵。這一部分涉及運(yùn)動(dòng)學(xué)、軌跡規(guī)劃和與底盤(pán)的協(xié)同。5.1 機(jī)械臂控制集成我們集成的是一款六軸協(xié)作機(jī)械臂它通過(guò)Ethernet TCP提供了一套簡(jiǎn)單的API發(fā)送目標(biāo)關(guān)節(jié)角度或末端位姿位置姿態(tài)機(jī)械臂自行規(guī)劃軌跡并運(yùn)動(dòng)。控制模式選擇關(guān)節(jié)空間控制直接發(fā)送六個(gè)關(guān)節(jié)的目標(biāo)角度。優(yōu)點(diǎn)是簡(jiǎn)單但難以控制末端執(zhí)行器的精確軌跡。笛卡爾空間控制發(fā)送末端執(zhí)行器的目標(biāo)位置(x, y, z)和姿態(tài)通常用歐拉角rx, ry, rz或四元數(shù)表示。更直觀適合“點(diǎn)到點(diǎn)”的抓取放置作業(yè)。我們主要采用這種模式。坐標(biāo)變換核心這是最容易出錯(cuò)的地方。機(jī)械臂控制器有自己的坐標(biāo)系基坐標(biāo)系而AMR的SLAM系統(tǒng)輸出的是機(jī)器人底盤(pán)中心在地圖坐標(biāo)系下的位姿。機(jī)械臂安裝在底盤(pán)上兩者有一個(gè)固定的安裝偏移。我們需要定義一個(gè)“機(jī)械臂基坐標(biāo)系”相對(duì)于“機(jī)器人底盤(pán)坐標(biāo)系”的變換關(guān)系一個(gè)平移向量(install_x, install_y, install_z)和一個(gè)旋轉(zhuǎn)安裝角度。當(dāng)AMR移動(dòng)到一個(gè)抓取點(diǎn)其在地圖中的位姿為(robot_x, robot_y, robot_theta)。那么機(jī)械臂末端需要到達(dá)的目標(biāo)點(diǎn)在地圖坐標(biāo)系中的坐標(biāo)需要經(jīng)過(guò)一系列變換最終轉(zhuǎn)換到機(jī)械臂自身的基坐標(biāo)系下才能發(fā)送給機(jī)械臂控制器。計(jì)算公式簡(jiǎn)化忽略Z軸和姿態(tài)地圖目標(biāo)點(diǎn) - 機(jī)器人坐標(biāo)系 - 機(jī)械臂基坐標(biāo)系 - 機(jī)械臂末端坐標(biāo)系在實(shí)際代碼中我們使用Eigen庫(kù)或tf2如果借鑒ROS思想來(lái)處理這些三維空間變換。運(yùn)動(dòng)流程封裝我們將一次抓取動(dòng)作封裝成一個(gè)狀態(tài)機(jī)狀態(tài)1預(yù)抓取位姿機(jī)械臂運(yùn)動(dòng)到一個(gè)高于目標(biāo)點(diǎn)的安全位置。狀態(tài)2下降末端垂直下降到抓取高度。狀態(tài)3抓取控制末端執(zhí)行器如氣動(dòng)夾爪閉合。狀態(tài)4提升攜帶物體抬升到安全高度。每個(gè)狀態(tài)都通過(guò)發(fā)送一個(gè)目標(biāo)位姿給機(jī)械臂控制器并等待其反饋“到達(dá)目標(biāo)”信號(hào)來(lái)觸發(fā)下一個(gè)狀態(tài)。5.2 多設(shè)備協(xié)同作業(yè)與調(diào)度當(dāng)倉(cāng)庫(kù)里有不止一臺(tái)AMR時(shí)就需要協(xié)同。我們實(shí)現(xiàn)了一個(gè)簡(jiǎn)單的集中式調(diào)度系統(tǒng)運(yùn)行在控制中心的服務(wù)器上。任務(wù)隊(duì)列與分配調(diào)度器維護(hù)一個(gè)全局任務(wù)隊(duì)列。當(dāng)有新任務(wù)如“從A運(yùn)到B”時(shí)調(diào)度器根據(jù)一些策略如最近距離、當(dāng)前負(fù)載、電池電量將其分配給一臺(tái)空閑或最合適的AMR。交通管制防碰撞這是多機(jī)協(xié)同的核心安全需求。我們采用“虛擬軌道預(yù)約鎖”的簡(jiǎn)單策略。路徑規(guī)劃每臺(tái)AMR在收到任務(wù)后向調(diào)度器上報(bào)其規(guī)劃出的全局路徑。沖突檢測(cè)調(diào)度器檢查所有AMR的規(guī)劃路徑如果發(fā)現(xiàn)兩條路徑在相近的時(shí)間會(huì)占用地圖上同一格或相鄰格設(shè)置一個(gè)安全距離則判定為沖突。解決沖突最簡(jiǎn)單的策略是讓后出發(fā)的AMR等待或者為優(yōu)先級(jí)高的AMR重新規(guī)劃路徑。調(diào)度器會(huì)向相關(guān)AMR發(fā)送“在某個(gè)路徑點(diǎn)等待”或“修改路徑”的指令。狀態(tài)同步所有AMR通過(guò)心跳包持續(xù)向調(diào)度器上報(bào)其精確位置和速度調(diào)度器以此作為沖突檢測(cè)的實(shí)時(shí)依據(jù)。協(xié)同作業(yè)流程對(duì)于需要多臺(tái)AMR配合的復(fù)雜作業(yè)如一臺(tái)取貨另一臺(tái)在流水線接應(yīng)調(diào)度器會(huì)將一個(gè)復(fù)雜任務(wù)拆分成多個(gè)子任務(wù)并定義子任務(wù)之間的依賴(lài)關(guān)系按序分配給不同的AMR執(zhí)行。6. 開(kāi)發(fā)、調(diào)試與部署實(shí)戰(zhàn)經(jīng)驗(yàn)理論設(shè)計(jì)最終要落到代碼和實(shí)際運(yùn)行中。這部分分享一些讓項(xiàng)目從“跑通”到“穩(wěn)定”的關(guān)鍵經(jīng)驗(yàn)。6.1 開(kāi)發(fā)環(huán)境與工具鏈IDEQt Creator是不二之選對(duì)Qt項(xiàng)目支持最好特別是QML的語(yǔ)法高亮、調(diào)試和可視化編輯。對(duì)于純C后端邏輯VS CodeCMake Tools插件也是高效組合。版本控制Git。嚴(yán)格進(jìn)行分支管理如main穩(wěn)定版、develop開(kāi)發(fā)版、feature/xxx功能分支。依賴(lài)管理使用CMake的FetchContent或find_package來(lái)管理第三方庫(kù)如PCL用于點(diǎn)云處理、Eigen用于矩陣運(yùn)算、yaml-cpp用于配置文件解析。將所有依賴(lài)的編譯方法和版本號(hào)寫(xiě)入項(xiàng)目README.md。日志系統(tǒng)不要再用printf或qDebug了。集成一個(gè)像spdlog這樣的異步日志庫(kù)可以按級(jí)別info, warn, error輸出到控制臺(tái)和文件并支持滾動(dòng)歸檔對(duì)線上排查問(wèn)題至關(guān)重要。6.2 調(diào)試技巧讓機(jī)器人“開(kāi)口說(shuō)話(huà)”數(shù)據(jù)錄制與回放這是調(diào)試SLAM和導(dǎo)航算法的神器。開(kāi)發(fā)一個(gè)簡(jiǎn)單的工具將激光數(shù)據(jù)、里程計(jì)數(shù)據(jù)、速度指令等所有話(huà)題數(shù)據(jù)同步錄制到一個(gè)文件中可以自定義二進(jìn)制格式也可以用ROS的bag格式然后自己寫(xiě)解析。當(dāng)線上出現(xiàn)問(wèn)題時(shí)將數(shù)據(jù)包拿回來(lái)回放可以百分百?gòu)?fù)現(xiàn)問(wèn)題場(chǎng)景反復(fù)調(diào)試算法參數(shù)??梢暬{(diào)試在Qt界面中除了顯示正式的地圖我們專(zhuān)門(mén)做了一個(gè)“調(diào)試視圖”可以實(shí)時(shí)繪制出原始的激光點(diǎn)云用散點(diǎn)圖。局部代價(jià)地圖用熱力圖顯示障礙物膨脹區(qū)域。全局路徑和局部規(guī)劃出的速度采樣空間用箭頭表示。這樣當(dāng)機(jī)器人卡住或撞墻時(shí)能一眼看出是感知問(wèn)題、地圖問(wèn)題還是規(guī)劃問(wèn)題。遠(yuǎn)程調(diào)試與日志通過(guò)前面實(shí)現(xiàn)的網(wǎng)絡(luò)通信模塊讓機(jī)器人將重要的日志和內(nèi)部狀態(tài)如代價(jià)地圖、規(guī)劃路徑實(shí)時(shí)發(fā)送到PC上的調(diào)試客戶(hù)端。這樣機(jī)器人跑在現(xiàn)場(chǎng)我們?cè)谵k公室就能看到它的“內(nèi)心世界”。6.3 部署與穩(wěn)定性保障打包與安裝使用linuxdeployqt或自己編寫(xiě)腳本將Qt程序及其所有依賴(lài)庫(kù)打包成一個(gè)可移植的文件夾或AppImage。配置文件如SLAM參數(shù)、地圖文件、網(wǎng)絡(luò)地址放在獨(dú)立的config目錄下。開(kāi)機(jī)自啟與服務(wù)化在機(jī)器人上的Linux系統(tǒng)中將主程序配置為systemd服務(wù)。編寫(xiě)一個(gè).service文件定義啟動(dòng)順序、依賴(lài)、崩潰后自動(dòng)重啟等。這比寫(xiě)進(jìn)rc.local要可靠得多??撮T(mén)狗Watchdog在主程序中創(chuàng)建一個(gè)看門(mén)狗線程定期“喂狗”。如果因?yàn)樗梨i等原因主線程卡死看門(mén)狗超時(shí)可以觸發(fā)系統(tǒng)重啟或執(zhí)行安全恢復(fù)流程如發(fā)送急停指令。性能監(jiān)控在程序中集成簡(jiǎn)單的資源監(jiān)控定期輸出或上報(bào)CPU、內(nèi)存占用率。如果發(fā)現(xiàn)內(nèi)存緩慢增長(zhǎng)可能就有內(nèi)存泄漏。回過(guò)頭看開(kāi)發(fā)這樣一個(gè)復(fù)合型AMR控制系統(tǒng)最大的挑戰(zhàn)不是某個(gè)算法有多難而是如何將眾多異構(gòu)的模塊感知、決策、控制、通信、UI有機(jī)地整合在一起并保證其穩(wěn)定、可靠、易維護(hù)。它要求開(kāi)發(fā)者不僅要有扎實(shí)的軟件工程功底設(shè)計(jì)模式、多線程、網(wǎng)絡(luò)還要對(duì)機(jī)器人學(xué)運(yùn)動(dòng)學(xué)、SLAM、控制理論有切實(shí)的理解。這個(gè)項(xiàng)目讓我深刻體會(huì)到在工業(yè)應(yīng)用里一個(gè)能穩(wěn)定運(yùn)行在復(fù)雜環(huán)境下的“系統(tǒng)”其價(jià)值遠(yuǎn)大于某個(gè)炫酷但脆弱的“算法”。本文還有配套的精品資源點(diǎn)擊獲取
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
久月婷婷| 成人综合伍月天| 九九九九综合| 亚洲综合在线伊人婷| 99热这里只有精品1025| 精品99这里有| 黑人巨粗进入警花疼哭A片| 天天噜天天插| 内射综合网| 九九色大香蕉| 天天操夜夜操| 色婷婷亚洲在线| 波多野结衣不卡AV| 欧美激情VA永久在线播放| 色婷婷影音| 久久五月天婷婷| 九九精品系列| www.超碰在线| 五月婷婷之六月丁香| 欧美日韩精品人妻狠狠躁免费视频| 日本人妻丁香婷婷久久寝取熟女五月| 精品热九九| 五月婷婷色激情| www.久9| 亚洲色频| 色色综合成人网| 99热精品网| 色婷五月天| 九九在线免费观看| www99xxxx五月丁| 久久美女五月天| 99在线视频免费| 日韩狠狠色| 五月天婷婷基地| 五月婷婷激情| 激情六月综合| 99狠狠色| 少妇真实被内射视频三四区| 这里只有精品在线免费视频| 日本女人久久| 伊人综合网站| 综合啪啪| wwwxxx五月婷婷小说| 中文字幕av网站| 99热在线中文字幕| 激情五月丁香在线观看直播| 人人干99| 久久视频在线视频| 丁香婷婷五月色成人网站| 操操碰| 少妇被下春药玩弄A片| 性生活久久人妻| 日本毛片内射| 99精彩视频网站在线| 99热九九热| 国产成人网址| 狠干综合| 久久精品A片777777| 天天操婷婷| 色婷视频| 婷婷丁香五月激情密臀av| 91丨九色丨熟女丰满| 国内裸舞二区| 黄色片精品| 国自产拍偷拍精品啪啪一区二区| www夜夜| 狠狠色婷婷| 天天综合区| 亚洲AV综合在线观看| 美女100%露全身无挡网站| 91精品国产综合久久蜜芽解析速度| 亚洲精品色| 亚州欧美国产久精国产99综合视频| 日本久久九| 丁香六月婷婷综合| 中文久久婷婷| 天天综合社区| 亚洲人妻一区二区| 3pAV| av在线免费播放| 精品久9| 超碰久热| 99狠狠色| 丁香五月偷拍| www.sezonghe| 热99只有精品| 狠狠操天天操综合| 国语对白性爱视频播放| 久er免费视频| 六月丁香综合| 99热天堂| 激情九色| 91天堂网综合| 人人操大| 久久久99精品免费观看| 久久久婷婷| 丁香五月最新地址| 色五月婷婷亚洲最大| 婷婷丁香第一页| 99久久久久| 停停五月丁香| 丁香六月亭亭久久综合| 色宗合久久五月婷婷| 超碰9| 另类国产欧美视频| 一级韩国产精品毛| 8050一级网| 99这里只有| 五月天激情小说| 日日做天天操夜夜爽| 婷婷丁香色五月亚洲| 九九婷婷综合| 亚洲AV成人片无码网站| 亚洲中文字幕AV| 激情婷婷五月少妇| 538任你爽视频不一样的| 97人人操人人拍| 色婷婷成人做爰A片免费看网站| 丁香久久| 99热综合| 九九性视频| 97干在线| 色色色热| 99超超碰| 五月色亭丁香| 婷五月天六| 99热草草| 97碰碰在线观看视频| 综合激情四射一theav| 精品爱欲五| 91久热| 久久这里有精品| 天天搞天天色综合| 日韩无码专区| 99性视频| 精品二区| 激情国产五月| 色播色丁香五月| 99精品久久久久久| 亚洲黄色av网站| 97热超碰| 五月丁香婷中文| 九九综合伊人| 久9无码视频| 九九精品热播| 国产伦理精品高清在线观看网站一区二区 | 一起草无码视频| 五月天婷婷色色| 五月色综合网欧美网| 97碰在线视频| 婷婷色系婷色| 色五月婷婷激情| 婷婷色六月| 色婷婷精品视频| 影音先锋一区| 丁香六月啪啪| 99热人人操人人操| 超碰AV在线| 香蕉婷婷| 丁香五月综合亚洲| 狠狠干,狠狠操| 五月丁香色婷婷色| 久久这里有精品| 大香蕉综合| 国产欧美精品AAAAAA片| 五月丁香六月婷婷的女人| 国产肏屄大片| 狠狠人人| 伊人五月综合网| 國語久久婷| 亚洲色综合| 丁香六月综合激情| 在线91日韩| 色天堂A| 天天骑日日爽| 99热这里只有精品18| 亚洲精品永久久久久久| 丁香五月天之婷婷影院| 丁香婷婷影院| 色狠狠综合| 99在线视频精品| 综合久久人妻| 中文字幕黄色片| 97操在线| 黄网在线播放| 丁香桃色网| 97久久久久| 国产午夜精品AV一区二区麻豆| 婷婷五月丁香成人网| 久Se视频在线观看| 玖玖精品视频99| 99啪99| 欧美成人精品A片免费一区99| 狠狠爱丁香婷| 色色综合成人网| 亚洲色色精品| 五月婷婷色| 一本到不卡高清DVD| 婷婷五月激情网| 久草热久草在线视频| 91九色 熟| 99热伊人| 99乱视频| 激婷网| 日本激情91| xx色综合| 9久精品视频| 少妇高潮呻吟A片免费看软件| 玖玖婷婷五月| 欧美va欧美va差| 99精品在线| 热热色色五月天婷婷| 99在线精品视频| 激情五月婷婷在线区| 99热精品观看| 涩涩五月天| 婷婷色婷婷| 色婷婷色五月综合| 丁香婷婷久久综合在线| 色播五月婷婷| 五月天婷婷激情网| 激情综合国产| 人人综合91网| 色婷婷五月天天天干天天操天天爽 | 九月婷婷综合| 久9视频免费播放| 99er6免费视频热播| 精品女人九九九| 丁香婷婷五月份| 日本不卡中文字幕| 丁香五月先锋| 黄页免费一级视频懂色| 婷婷射图五月天| 91婷婷| 夜夜大香蕉婷婷丁香| 日本成人噜噜噜噜噜| 久99久视频| 欧美性交一区二区三区| 狠狠搞亚洲| 69精品人人人人人人人人人| 夜夜操夜夜爽| www.minyis.com【JT】实力收量可预付QQ2101460746 | 五月丁香亭亭AV女优| 99爱最新免费视频在线观看| 天天日天天爽| 六月丁香五月激情亚洲AV| 4399人妻无码久久久| 久操香蕉| 丁香九月婷婷色| 男女啪啪做爰高潮无遮挡| 色婷婷中文在线| 婷婷五月天亚洲| 婷婷丁香久久网| 男人综合网| 五月综合视频| 777久久精品| 亚洲操b| 91超级碰在线| 五月丁香久久网| ′久久99一| 欧美丁香婷婷五月天| 91碰人人| 色婷婷婷婷五月天| 亚洲免费电影2| 99热99色| 日韩无码91| 五月婷婷六月丁香在线视频| 亚洲成人av在线观看| 天天cha成人综合网| 五月天激情网图片| 安息电影在线观看完整版| 激情开心五月天| 色色丁香| 九九热精品在线| 五月丁香五月丁香| 99人妻碰碰久久久禁片| 六月天丁婷婷| 六月丁香天堂| 99九九在线观看免费| 99爱爱网| 精品久热| 精品无码色| 欧美日韩二区在线| 草逼大片| 日本三久久| 成人电影在线免费试看| 激情四射五月天| 狠狠插狠狠操| 狠狠操天天操综合| 爆乳熟女-区二区三区| 五月激情综合美女久久| 九九大香视频| 色色色热热热| 五月噜噜| 99玖玖人人| 情色婷婷五月天| 九色PORNY9l原创自拍| 激情五月六月婷婷| 天天摸夜夜爽天天做| 操大屄五月天视频| 中文字幕,综合,91| 国产操碰| 久久久99精品免费观看| 色欲一二三| 在线不卡中文字幕| 日本va欧美va国产激情| 五月婷庭丁香在线| 一区二区三区四区牛| 99精品在线观看视频| 欧美色五月| 亚洲精品V天堂中文字幕| 青青草视频福利| 色情开心五月| 开心激情婷婷| 婷婷五月天电影网| 激情久久四色| 免费成人中文字幕| 久久综合爱| 色综合色欲综合天天免费| 区欧美日韩成人| 超碰人人99| 日韩色色色99| 9色免费网| 久久九九网| 国产精品噜噜在线视频| 亚洲无码激情| 欧洲第一无人区观看| 日日噜狠狠色| 激情另类综合| 色色色色色五月丁香| 五月婷婷六月激情| 亚洲六月色| 亚洲AV成人精品日韩在线播放| 99网| 色噜噜狠狠色综合日日| 伊人超碰| 久久98| 成人精品视频99在线观看免费| 精品久久艹| 那里有AV网址| 色色九九五月天 | 校花娇喘呻吟校长陈若雪视频| 色J香五月天| 男女99免费视频| 婷婷综合丁香| 操骚货在线| 五月天婷婷丁香| 高潮毛片遮挡费高一百度| 9在线9在线婷婷在线国产| 99热这| 丁香六月婷婷综合在线| 99无码免费视频| 五月丁香婷婷婷激情爱爱| 成 人片 黄 色 大 片| 少妇性按摩无码中文A片| 五月久久噜噜| 久久精品视频99| 久久久久久久91| 色婷久久| 色色综合网络| 日本熟女一区二区| 青青操avbb| 五月婷婷六月丁香玖玖玫瑰91| 国产精品国产成人国产三级| 激情五月天色网站| 九九激情视频| 色天天综合| 久久WW| 97操资源婷婷| 高潮毛片又色又爽免费| 思思热在线视频精品| 色五月欧美| 激情婷婷五月色| 啊V视频在线观看| 国内久久久精品99| 欧美一级a | 99操无码视频观看| AV免费在线网站| 日本韩国视频在线观看社区免费的9| 亚洲色久| 欧美色99| 九热免费视频| 色五月婷婷老师| 综合激情深爱| 婷婷六月激情啪啪| 亚洲色婷婷99一9|| 色五月之第四色| 超碰成人在线观看| 伊人五月婷婷| 色婷婷久久综合久色综| 五月丁香色婷基地综合久久| 九九亚洲无码| 九色无码| 婷婷五月天AV在线| 大香蕉Av在线| 九九人人看| 丁香五月婷婷激情中文| 丁香五月 无码| 婷婷六月丁香五月图区| 婷婷丁香中文字幕| 久99婷婷色综合| 亚洲va综合va国产va中文| 日本久久综合| 99精彩视频| 色情五月综合婷婷| 婷婷五月天成人| 97资源欧美日韩大香蕉超碰一区| 久热黄色| 亚洲人妻AV| 另类视频五月天| 这里只有精品视频免费在线观看| 亚洲va国产va天堂va综合va| 噜啊噜在线| 99热这里只有精品4| 五月天激情无码专区| 爱婷婷五月| www色中色综合| 久热网站| www.99热精品| 五月婷婷av| 婷婷亚洲综合| 狠狠综合网| 思思热在线| 丁香五月手机在线| 天天干天天爽| 日本在线观看99| 国产av天天插天天操天天爽| 五月天久草| 狠狠综合色网| 天天射综合网站| 五月丁香婷婷福利| 婷婷狠狠五月综合| 色噜噜五月天| 大香网伊人久久综合| 天天干夜晚夜操| 婷婷中文字幕| 婷婷五月天电影网| 精品一区久热| 91chinese 在线| 91操在线视频| 丁香五月另类小说在线阅读| 久久综合激情婷婷激情| 天天日夜夜爽| 99色在线| 伊人超碰在线| 任你爽免费视频| 26uuu美女三级视频| 六月丁香婷婷天堂| 五月丁香五月婷婷| 99爱视频在线观看这里只有精品| 成人亚洲精品久久久久| 五月婷婷黄色毛片| 天天做天天爱天天摸| 欧美综合激情五月丁香| se99视频| 天天操天天操天天操天天操天天操天天操天天操天天操天天操 | 操操自拍| 26uuu日韩| 六月色婷婷| 大香蕉丁香五月| 成人AV中文字幕| 婷婷成人网五月天| 国产午夜精品久久久观看| 99在线精品视频| 婷婷五月激情丁香| 琪琪狠狠干| 色色五月天网站| 无码天天操| 色在线视频网2025| 97五月天| 玖玖婷婷婷丁香五月| 婷婷丁香五月激情综合站_久久五月丁香激情综合_开心五月综合激情综合五月_婷 | 久久99热这里只频精品6学生| 夜夜爽天天爽| 91综合在线观看| 色狠狠综合| 丁香五月人妻熟女| 五月婷婷与六月丁香图片激情| 久久精品99国产精品日本| 五月色婷丁香| 青草网在线观看| 六月天丁婷婷| 任你草| 色色色五月| 激情综合网丁香| 色五月婷婷五月丁香五月| 天天搡日日搡aaaaⅩ| 免费观看全黄做爰的视频 | 久久国产高清| 久久久精久人妻| 99热爱爱干干日| 三十熟女| 婷婷五月成年人| 激情五月天婷婷在线网址发给我| 亚洲乱码日产精品BD| 97热精品| 天天干天天干天天干天天干天| 99精品亚洲| 色欲五月丁香| 五月综合777| 欧日韩成人| 香港九九六区八区99| 色色五月婷婷| 在线观看亚洲视频影院| 九九久久色| 人人操Av| 免费视频99| 成人在线视频男人的天堂4399| 99久久这里只有精品免费官网| 婷婷色五月开心五月| se色婷婷视频| 久久人妻乱子伦| 九九自拍网| 五月婷婷丁香网| 色99综合视频| 在线理论片| 大香蕉av在线| 超碰色综合| 婷婷综合干| 开心五月综合激情综合五月| 99热国品| 九九爱这里只有精品| 三级黄网站| 亚洲色综久久五月| 91婷婷五月天嫩女| 色色草97| 欧美日韩AAA| 美女被操一区二区| 久久久区区一久久久久久| 99久久婷婷| 国产日比| 99精品久久| 国产精品视频免费看| 欧美婷婷精品激情| 久久精品日| 直接看的AV| www.91热久久| 蜜桃五月天色| 婷色影院| VA婷婷亚洲| 99精品偷自拍| 五月丁激情| 欧美在线干| 888精品福利地址| 亚洲综合五月天| 99成人网一区| 五月丁香啪啪| 婷婷五月天av网| 婷婷色婷婷| 天天插天天玩天天干| 狠狠色丁香99| 国产一级黄色影片,| 五六月丁香激情视频| 亚洲亚洲人成综合网络| 综合色综合| 香蕉久日夜| 永久AⅤ1| 婷婷成人在线| 在线观看亚洲视频影院| 久久停停超碰| 操骚货在线| 精品婷婷五| 99久热| 五月婷五月婷伊人伊人五月婷| 婷婷激情社区| 亚洲综合新99视频| 爱99干99| 婷婷五月天亚洲综合网| 五月丁香日逼| 超碰97干| 丁香五月六月久久综合 | 一级操逼大片| 天天狠狠干| 色噜久| 色五月激情| 亚洲小视频免费播放| www.婷婷六月天| 色在线五月天免费| 亚洲综合五月天婷婷| 日本玖玖在线| 色婷婷五月综合| 91porn一起草| 激情五月婷婷视频一区二区三区| 99热久只有| 日本女色人人| 婷婷六月亚洲综合| 婷婷丁香六月| 九八Av| 人草人人| 五月停亭六月,六月停亭的英语 | 涩五月婷婷| 亚洲人妻一区二区| 色综合色婷色基地| 一本久道综合色婷婷五月| 五月婷六月综合在线观看| 婷婷D区| 综合图片色色| 婷香五月网在线| 大香蕉色婷婷伊人在线| 99爱视频| 欧美成人无码一区二区三区| 久久日本wwww色| 激情综合区| 99久久综合网| 开心五月婷婷综合在线精品素人| 天天日,天天插| 激情五月丁香激情综合网| 九月大香蕉| 人妻久久久久久久| 久久这里有精品视频| 97碰碰在线看视频免费| 99热国品| 五月婷婷啪啪网| 99精品视频在线| 色一情一乱一乱91Av| 丁香五月天婷婷激情| 丁香五月激情婷婷| 九九RE视频在线精品| 丁香五月天天久久综合小说| 欧美精品99| 激情五月婷婷综合网| 六月婷婷香蕉| 人人色人人弄人人操| 亚洲精品视频电影| 天天爱天天做天天爽| 五月丁香婷婷综合久久| 亚洲婷婷五月草久| 97色女人在线| 97午夜一区二区| 婷婷欧美激情综合| 午夜电影网VA内射| 国产婷婷色五月| 99综合成人视频在线观看| 五月天久久久| 久久看婷婷| 99福利视频| 精品久久99码| 色婷婷丁香社综合| 久久精品国产精品| 亚洲色五月| 99看片| 俺来也综合网精品一区| 国产亚洲网站在线| 91 久热| 搡BBBB搡BBB搡18| 亚洲五月停停| 人人人操97| 九九视频网| 三级毛片7979| 无码人妻一区二区一牛影视| 国产成人精品一区二三区熟女在线| 婷婷丁香九月| 99精品热| 天天狠狠干| 亚洲激情免费久久| 五月丁香激情综合网| 综合精品99| 色综合综合综合| 欧美久热| 五月天开心激情综合网| 丁婷婷五月天在线播放| 欧美狠狠地| 婷婷六月插屄激情| 婷婷五月天播| 丁香五月婷婷六月婷婷| 超碰99热精品| 9热在线视频| 婷婷综合久久综合| 草草色情综合网| 五月天综合网| 六月婷婷五月丁香| 99热精品在线| 51XX午夜影福利| 久热一本| 久久WW| 久热伊人9| 日本人妻久久| 91啦丨九色丨刺激中文| 激情 久久 婷婷| 亚洲精品久久久无码| 97碰在线视频| 中文字幕在线日亚洲9| 91超碰人人操| 婷婷综合激情| AV在线中文| 影音先锋一区| 激情综合区| 久久色婷婷| 九九99九九99九九99视频网| 日本一级| 国产一级片| 97色婷婷| 久久久中文| 丁香五月天激情综合| 丁香六月婷婷久久综合| 五月丁香久久| 亚洲V国产V欧美V久久久久久| 中字幕视频在线永久在线观看免费| 丁香六月啪啪| 五月天激情小说网| 亚洲最大成人综合网720P| 激情五月天色播| 九九色精品| 天天综合色| 人人操AV| 色五月亚洲| 日本综合久久| 欧美日综合| 欧美精品中文字幕亚洲专区| 影音先锋 萱萱| 丁香五月桃花在线激情综合| 99热精品超碰| 91AV婷婷| 丁香综合伊人| 五月天激情网页| 欧洲免费视频色| 五月之婷婷| 日日噜狠狠色| www.97碰碰com| 激情四射五月天| 丁香五月电影| 亚洲正能量欧美| 久久99精品久久久久久青青AR| 日本天堂免费99| 老司机日日夜夜青草| 亚洲激情av| 日韩AV免费电影在线播放| 亚洲成AV人片在线观看| 久婷婷五月综合欧美| 大香蕉久操| 丁香五月天婷婷久久| 色五月丁香伊人| 欧美激情综合色综合啪啪五月| 亚洲精品视频在线| 国产伦亲子伦亲子视频观看| 香蕉中文在线| 丁香五月激情六月欧亚激情综合导航| 丁香五月亚洲无码| 99热日| 99热精品在线观看| 99热欧美精品| 狠狠色性| 91丨九色丨白浆| 亚洲精品一区无码A片| 婷婷狠狠狠爱| 99自拍网| www·五月天| 天天色天天操天天射| 五月天综合色| 香蕉五月婷婷| 国产色色在线| 久久久五月婷婷| 色综合大香蕉| 91av传媒高清在线视频网| 亚洲成人av在线播放| 九九热免费观看视频| 这里只有精品免费| 国产精品大香蕉| 91精品综合久久久五月天| 亚洲综合在线伊人婷| 五月开心深深爱激情综合| 97AV在线视频| 亚洲av电影在线| 国产亚洲在线观看| 五月婷在线视频免费看| 婷婷五月色| 色婷婷综合电影| 天天看片日日夜夜| 五月综合激情| 日韩AV免费看| 九月婷婷久久| 成人中文网| 婷婷色五月丁香六月欧美啪| 中文字幕色色| 99ER热精品视频| 婷久久| 日韩在线五月天婷婷| 大香蕉啪啪网| 婷婷色色五月天| 91人无码久久久久久| 色婷婷精品小视频| 97人人超| 亚洲午夜一区二区| 丁香综合网| 99无码| 五月丁香| 久久精典| 91啪啪网| 六月激情婷婷| 国产免费一区二区三州老师F1…… | www.色五月| 任你爽精品免费视频6| 欧州色色| 超碰人人摸AV| 99这里只有精品在线| 九月丁香| 婷婷激情五月天7| 五月天婷婷久久| 亚洲熟女乱色综合亚洲网站| 狠狠做婷婷| 天堂网操| 色色色色色色色色色色色色色色,网站| 中文字幕丰满孑伦无码专区| 欧美成人无码一区二区三区| 另类激情中文| 91操人| 91久久久久久久| 色婷操逼| 超碰人人色| 91超碰九色| 色五月色五天色情网| 九九综合色综合| www.99精品在线| 亚洲视频国产一区| 在线观看免费狠狠色丁香香综合| 97伊人综合婷婷| 色色网站| 97自拍99| 操日视频| 九色视频91疯狂| 国产激情AV| 久操热线| 五月天激情视频| 99在线观看亚洲| 激情婷婷五月天| 99热在这里只有免费精品| www.久久| 亚洲XX日本| 五月天丁香婷婷久久九| 欧美激情五月| 啪啪色激情五月天| 网站免费一站二站| 国产脫衣舞一区二区三区| 9色在线视频| 色婷婷综合网| 婷婷久久综合| 天天做天天要天天爽| 亚洲无码 图片区| 丁香五月综合在线视频| 五月天婷婷色色首页| 久久视频婷婷| 久久丁香五月婷婷| 91碰碰碰| 丁香婷婷伊人| 日韩大片艹艹| 五月丁香六月香香蕉| 中海油常州环保涂料有限公司| 九九碰九九爱97超碰| 五月丁激情| 婷婷色狠狠| 香蕉人在线香蕉人在线 | 日本一级特黄大片AAAAA级| 亚洲精品国产成人AV在线| 欧美群妇大交乱婬网| 无码免费人妻A片AAA毛片西瓜| 可以免费看的av网站| 色色丁香色五月| 亚洲第一黄网| 少妇激情五月婷婷| 男女av免费看| 97热这里精品在线视频| 99视频这里只有免费精品| 亚洲字幕AV一区二区三区四区| 思思精品热在线| 99re久热只有精品6在线直播.com| 狠狠狠狠狠狠狠狠| 九九成人精品| 97热久久五月婷婷| 99热精品在线在线| 欧美日本一区二区三区| 色五月婷婷自拍| 激情五月天色色网| 人人草人人爱手机视频看看| 丁香久月婷| 色情成人五月天| 激情黄色五月天| 人人爽欧美婷婷久久久五月丁香| 亚洲精品视频在线| 婷婷五六日| 亚洲成人中文字幕| 色婷婷综合网站| 99久久er| 一区视频网站| 欧美韩国日本| 亚洲综合五月天| 区区久久妻| 9l视频自拍九色9l黑人| 91久久综合亚洲鲁鲁五月天| 97涩涩丁香五月天| 99超碰在线观看| 五月丁香六月婷| 精品成人a v无码内射| 超碰免费99| 久久婷婷午夜| 超碰在线人妻| 婷婷激情欧美| 久操大| 免费观看全黄做爰的视频| 97五月天| 色婷婷五月丁香在线观看| 97超碰欧美中文字幕| 免费视频无码| 操人妻视频91| 色9色| 日韩xx在线| 中文成人在线| 五月丁香亭亭操逼| 欧美一区二区三区不卡影视| 99热1| 国产婷伊人| 婷婷色导航| 《》【无码】想被搞到爽AV应募而来的超M素人 西纯子 10musume-011723-01 | 色色9 9| 色五月琪琪| 思思精品热在线| 玖玖爱伊人| www.韩日视频| 久久久GOGO无码啪啪艺术| 天天日天天摸| 色婷五月天网站| 丁香五月天啪啪| 国产女生爱爱AA| 午夜成人片400| 99欧州偷拍视频| 欧美婷婷五月丁香| 色婷激情网| 啊V视频在线观看| 99碰在线视频| 成 人片 黄 色 大 片| 色综合com| 996日日爱| 99久久国产宗和精品1上映 | 五月丁香六月在线| 亚洲精品色| 久久久久久五月天| 99这里有精品免费| 91色色色| 97超碰色| 婷婷综合性爱网| 色噜噜婷婷| 五月停停999| 天天操天天操天天操天天操天天操天天操天天操天天操天天操 | 九九成人| 久久丁香五月婷婷| www.婷婷| 这里只有精品免费视频| 天天拍夜夜爽| 婷婷激情五月天在线视频| 五月婷婷三级| 婷婷人妻激情| 久久久噜噜噜操操操| 99在线精品免费视频| 色综合五月天| 丁香五月电影| 色婷婷中文在线| 亚洲婷婷五月| 亚洲成人在线五月天| 亚洲性爱日韩无码| 人人干人人操人人摸人人做| 国产精品久久99| www久久99| 九九青草热| 嫩草视频观看| 色蜜婷婷| 婷婷综合另类| 青青操丝袜美腿| 嫩草视频| 影音先锋男人站,影音先锋男人色资源网,影音先锋AV最新资源站,影音先锋AV资源 | 91久女| 亚洲欧美在线观看| 国产真实乱了老女人视频| 99色在线| 东京热免费视频| 亚洲免费看片| 天天干天天做| 五月天综合| 狠狠操综合| 久久九九99| 夜夜操天天干| 五月婷婷中文字幕| 99久在线精品99re8| 玖玖婷婷五月天| 99免费在线| 99亚州综合精品成人网| 99热精品在线播放| 天天干天天干天天干天天干天| 成片免费观看视频大全| 九九操操| 五月天桃色深爱网| 九九亚洲| 大战熟女丰满人妻AV| 婷婷五月在线影院| 久婷婷视平| 嫩草视频| 97碰人人操| 香蕉婷婷色五月| 丁香六月婷婷开心| 丁香六月婷婷综合激情欧美| 丁香婷婷五月激情综合| 天天综合天天做天天综合| 操操操av| 99热这里只有精品50| 久久久精品色色色| 色五月婷婷色五月婷婷色五月婷婷| 久久免片| 亚洲综合无码| www.久久| 香蕉久久国产AV一区二区 | 开心五月婷| 色五月婷婷很很操| 欧美综合123区| 久久大香蕉| 亚洲精品又粗又大又爽A片| 99燥99日| 五月综合丁| www色色com| 欧美va亚洲va| 丁香五月成人在线| 96丁香六月婷婷蜜桃综合久久| 大香蕉99| 99热免费| 激情综合丁香| 欧美性爱中文字幕| 丁香六月婷婷缴情欧美| 婷婷香五月| 天天天在线观看| 天天影院色| 成人做爰A片免费看视频| 97色一二三| 久热人妻| 激情五月天综合图片小说网站| 五月天激情AV| 日韩成人网址| 国产精品久久久久久久久久| 国产第99页| 亚洲欧洲另类| 激情都市五月天| 91九色精品| 婷婷丁香社区| 亚洲av无码影院| 五月丁香久人妻中文| 激情综合五月色丁香婷婷 | av网址在线| 婷婷99视频在线| 一二区成人电影| 99这里精品| 欧美这里只有精品| 丁香六月婷婷久久综合| 99热国产在线| 色啪影院| 五月天电影网| 97人人射| 九九亚洲天堂| 欧美日韩成人在线网站| 激情婷婷人妻| 婷婷五月激情六月| 中文字幕无码人妻少妇免费视频| 欧美日韩国产一区二区| 激情五月天婷婷免费观看| 五月综合激情视频在线| 国产毛片精品一区二区色欲黄A片| 热久免费视频9| 欧美噜噜免费观看| 五月天亚洲综合网| 99性爱视频| 成人网页在线观看| 色婷婷综合中心| 999久久久国产精品| 青青草视频免费观看| 色欲九区| 伊人狠狠综合| 五月丁香在线观看| 五月丁香婷婷啪啪网| 99热99思午夜精品| 99热免费精品| 91啦丨九色丨刺激中文| 99久久99久久综合| 直接看的AV| 51精品国自产在线| 日韩综合天堂| 草做免费在线观看| 99热思思| 91黄址| 啪啪六月婷婷| 久青草影院| 久久天堂网| 五月丁香激情欧洲啪啪| 丁香五月电影| 久久9久| www.日日夜夜.com| 少妇AB又爽又紧无码网站| 啪啪99| 99无吗| 狠狠婷婷综合| 99热九九这里只有精品10| 婷婷五月天情色| 欲求不满的人妻| 色婷婷影音| 激情小说婷婷| 婷婷久久五月丁香| 激情小说五月天| 久久久aaa| 五月激情丁香五月宗合| 色偷偷综合| 亚洲操B视频| 婷婷六月激情综合| 色欲AVV| 久久性爱网站| 亚洲综合五月天婷婷| 亚洲小电影在线观看黄999| 丁香色婷婷五月天| 国自产拍偷拍精品啪啪一区二区| 九九热只有这里精品| 色五月首页| 精品久久婷婷| 激情五月婷婷五月丁香五月开心五月| 久久九九热38| 五月综亚洲| www.激情| 99热网站在线观看| 91久热| 国产欧美日韩性爱| 91超碰九色| 9精品在线| 丁香激情五月| 婷婷五月精品中文字幕| 五月天婷婷综合| txt五月激情四射网综合俺也来了| 性天天中文网| 大鸡巴伊人网| 激情五婷网| 91人人爱| 激情网综合| 天天久久婷婷| AV天堂婷婷五月天| 天堂在线伊久| 欧美激情综合色丁香婷婷五月天 | 色啪网| 激情综合婷婷| 中文字幕在线免费观看视频| 色99自拍| 97干97色| 日本色频| 青青草激情网| 久久综合激情五月天| 任你草| 99惹| 嫩草极品| 婷婷激情五月天在线| 97丁香视频| 欧美成人色婷婷| 色婷婷激情四射视频| 激情床戏| 婷婷丁香五月天婷婷| 色色色色网| 99爱在线| 五月婷婷综合在线亚洲视频| 人妻久久久久久久久久| 五月婷激情影院| 久久免费操| 五月丁香婷婷基地| 婷婷久久欧美| 超pen个人视频97| 日夜夜久久| 9久久AV| 丁香九九九九| 这里只有精品偷拍| 亚洲亚洲人成综合网络| 亚洲熟妇AV综合网五月丁香伊人| 亚洲欧洲中文日韩久久AV乱码| 九热精品| 综合五月婷婷| 色色亚洲无码| 99久久国产综合精品五月天喷水\| 老司机伊人| 激情图片99| 热九九精品| 亚洲综合丁香五月| 碰人人97| 九九色图| 激情综合青草| 色色五月天 亚洲| 99成人| 伊人干综合| 国产精品久久久久久妇女6080| 国产婷婷五月天| 久久看婷婷| 99热免费观看| 丁香九月婷婷色| 97色在线观看视频| 天天舔天天爽| 亚州性爱99| 久久五月激情综合| 少妇被躁爽到高潮无码文| 丁香婷婷十月| 99在线免费视频| 国产婷婷色综合AV蜜臀AV| 五月婷婷天| 五月 成人 婷婷| 99在线精品免费视频| 国产激情综合五月久久| 99这里有精品视频3| 天天揷综合网| 九九干视频| 五月激情视频网| 伊人九九综合| 婷婷亚洲综合| 五月丁香淫淫婷婷婷| 丁香五月婷婷狠狠色| 婷婷九月久久| 色五月激情| AA片在线观看视频在线播放| 九九成人视频| 久久久性爱网| 日本一級黃色一級片| 超碰97干| 婷婷娱乐丁香综合网| 色 噜噜 九月 婷婷| 婷色五月天| 久热只有精品| 亚洲色五月天在线| 九九热在线99| 少妇高潮呻吟A片免费看软件| 99热这里是精品| 五月天婷婷六月| 色综合色婷色基地| 大香蕉综合| 99热这里都是精品| 六月丁香五月激情网| 九热...av| 男人的天堂婷婷色五月| 亚洲精品国产成人AV在线| 色五月丁香五月婷婷五月成人网| 九九热这里只有精品7| 秋霞九九无码| 日本色色网| 婷婷五月综合网| 天天干com| 色综合网上班开心婷婷久久| 99re青青草| 天堂婷婷综合| 天天干夜晚夜操| 精品久久久人妻| 深爱五月中文字幕| 九九热九九| 99九精品| 日韩AC在线免费观看| 69精品人人人人| 涩婷婷五月天在线精品视频| 激情五月天网页| 天天玩天天摸| 亚洲色婷婷五月天| 97久久综合网| 伊人综合网站| 九九香蕉网| 国产精品色婷婷AV综合色色| 五月婷伊人| 噜噜噜噜噜在线| 色播播婷婷| 91久久人人操| 北京熟妇搡BBBB搡BBBB| 亚洲精品国产成人AV在线| 开心五月天激情网| 啪到高潮激情丁香五月| 丁香婷婷少妇| 综合激情啪啪|