欧美成人午夜精品久久久,国产?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
返回資訊列表
色久综合天天做视频| 婷婷香香五月| 女婷久久| 亚洲五月天,激情视频| 久久婷婷网| 丁香九色不卡aaa| 成人做爰A片免费看网站找不到了| 99激情视频| 婷婷激情四射| 99在线免费视频| 色五月天激情| 天天综合网亚洲综合网| 天堂AV在线看| 天天做天天爱天天爽| 婷婷五月天六月丁香| 天天色天天| 思思热视频在线| 五月亭亭开心网| 五月婷婷免费在线视频| 任你爽免费视频| 色色a| 欧美日本另类| 五月丁香婷婷综合| 粉嫩AV久久一区二区三区| 深爱婷婷网| 天天操天天操天天操天天操天天操| 精品免费99| 91操碰| 亚洲乱码w在线观看| 熟女人妻一区二区三区免费看| 91九色中文字幕女在线观看| 大香蕉视频婷| 97碰碰人人| 99热国产| 人人干人人操人人摸人人做| 五月丁香六月香香蕉| 成人网站在线观看视频| 五月丁香久久久日婷婷久久婷婷日| www.婷婷五月| 丁香婷婷十月| 5月婷婷六月丁香| 免费AV在线网址| 特级操b片| 久操热线| 天天爽爽日日做做| anquye五月| 国产VA亚洲VA96| 激情亭亭五月| 免费黄色片子| 九色视频九色九色91jiuseshipin| 99热最新国内| 99在线视频精品| www.激情五月天。com| 777.色色| 九九久久网| 日本色99| 国产全是老熟女太爽了| 69精品无码一区二区三区| 综合视频久久| 五月婷综合性中心| 综合一区二区三区| 欧美性生交XXXXX无码小说| 啪啪九九色| 日韩成人综合| 天堂AV三级| 伊人久久婷婷五月天激情四射| 久久久精品色色色| 99热综合| 人人操婷婷| 婷婷五月丁香五月| 欧美 色婷婷| 91九色欧美| 天天肏夜夜肏| 天天综合网亚洲网站| 激情av在线| 天天操夜夜操| 热久91| 密乳Va| 超碰99在线| 26UUU精品一区二区c〇m| 丁香五月婷婷五月天| 玖玖资源在线视频| 99啪视频在线观看| 日韩黄黄| 婷婷丁香18| 久热这里只有| 久久久久婷 | 亚洲色婷婷五月| av久热| 免费看欧美成人A片无码| 人妻中文av| 四虎成人精品永久免费AV九九| 日操五月婷| 夜夜做夜夜愛| 天天日天天爽| 九九 激情 网| A网在线欧洲| 91黄址| 色色色九九九五月婷婷| 色色色激情网| 婷婷99狠狠躁天天躁| 精品无码99| 91狠狠综合久久久久久| 99er热精品视频| 日日夜夜狠狠婷婷色| 中文av网站| 九九精品99| 天天碰夜夜操| 俺也去在线久久精品23欧美综合视频网站,丰满人妻一区二区三区在线视频53,丰满 | 亚洲熟妇AV乱码在线观看| 99久久精品亚洲综合| 日韩99色| 色色五月婷婷| 五月天婷婷久草丁香| 日日天天操| 久久综合婷婷五月| 91久女| 五月丁香六月色| 五月亭亭六月激情| 五月婷婷啪啪| 超碰人人99| 五月婷婷co.m| 色婷婷www| 五月深情久久| 国产1区2区| 五月婷丁香久久久| 五月天激情网图片| 五月天激情啪啪| 91人妻视频| 五月丁香啪啪网| 91xxxx九色| 大香蕉伊人久久| 五月婷婷,六月丁香| 99只有精品| yazhochengrenavwang| 最新精品视频99| 六月丁香啪啪| 另类婷婷丁香| 99久久9| 亚洲AV网址| 天天爽综合| 这里只有精品免费| 中文字幕在线不卡| www999日韩精品| www.com在线操视频免费观看| 另类图片激情五月天| 成人av在线网站| 久久香视频| 天干干夜夜操| 这里只有精品久久| 欧美在线骚货| 激情五月婷婷| 97色色色色色色色| 天天爽天天| 久操大| 激情五月婷| 婷婷.com| 婷婷五月天免费| 天堂成人A片永久免费网站 | 色七七九九| 色婷婷影视99| 日韩99精品| 大香蕉220| 久久6这里只有精品| a网站免费观看| 最新日韩久热免费视频看看| 日日爱699| 精品香蕉99久久久久网站| 婷婷基地成人五月天| 91狠狠综合久久| 99riAv1国产在线观看| 免费视频这里只有精品| 琪琪色综合网站| 色色婷五月天| 熟惀91九色在线| 五月婷婷视频啪啪美女| 极品少妇XXXX精品少妇偷拍| 欧美色播综合在线观看| 成人做爰高潮A片免费视频| 久久亚洲网| 99热这里只有精品99| 婷婷丁香五月麻豆| 五月开心激情| 五月天天综合网色婷婷| 丁香婷婷在线| 国内9l视频自拍老熟女九色| 99视频这里只有精品10| 亭亭玉月丁香| 九九热精品视频在线观看| 岛国资源站| 日韩色色视频www| 级人人91| 五月天开心激情综合网| 狠狠色噜噜色狠狠狠综合色| 国产毛片操B| 婷婷五月天Av| 亚洲国产无线乱码在线观看| 婷婷综合| 91无码视频| CAOBIBI| 六月丁香成人| 五月婷婷亞洲中文| 丁香五月天黄色片| 五月婷婷久久网| 成人在线观看国产| 色婷婷免费观看| aa久久| WWW.HENHENL.| www.超碰在线| 98色花堂98t.R| 碰人人97| 五月天婷婷爱| 激情小说之五月| 91re色综合视频| 五月深爱婷婷| 91色性感五月婷婷丁香| 五月天婷婷激情小说电影| 亚洲操B视频| 久久婷婷内射| 中文字幕丰满乱孑伦无码专区| 五月天精品| 五月天色婷婷视频| 色停停影院五月天| 色碰碰| 亚洲高清在线| 国产亚洲精品久久久久苍井松| 五月天婷婷午夜丁香| 天天干天天插| 五月婷视屏在线观看| 伊人久久大香线蕉综合网站| 五月天激情图片| 色婷婷综合久久久久| 亚洲精品婷婷| http://www.lingjunshare.com/ | 五月婷婷免费| av免费在线网站| 丁香五月91| aa久久| 在线不卡视频| 99免费视频网| 99久久99九九99九九九| 96自拍视频九色在线观看| 婷婷五月天激情五月天深爱五月天| 人人爱操| 婷婷狠狠久久| 色婷婷色五月综合| 婷婷六月啪啪| 嫩草AV久久伊人妇女超级a| xxxx五月天色色| 女同激情久久av久久| 婷婷五月成年人| 六月婷综合| 开心五月激情网| 日本综合久| 精品久久久91久久影视网| 激情六月一二| 五月婷婷婷综合网| 亚洲亚洲人成综合网络| 婷婷五月在线观看| 激情婷婷人妻| 亚洲免费av在线| 91九色精品熟女内射| 丁香六月天婷婷开心综合| 七七色综合| 丁香婷婷六月男男| 丁香女人五月天| 99热亚州综合| 五月天色不卡| 五月色丁香视频精品| 4399亚洲视频| 丁香五月激情图片婷婷| 色婷婷综合网站| 亚洲综合色丁香婷婷六月| 狠狠综合色网| 久久久久久人妻| 婷婷五月色情天| 久热9| 丁香五月天大香蕉啪啪| 色综合激情| 五月天色视频| 久久婷婷青草五月天| 国产亚洲精品AAAAAAA片| 婷婷情色五月天| 亚洲中文字幕在线观看| 色噜噜97视频在线观看| 婷婷深爱网| 久久99久久99精品免观看粉| 国内一级片| 99riAV国产精品视频| 综合性视频99| 九洲一级A片| 国产黄大片在线观看画质优化| 婷婷五月丁香欧洲| 九热在线这里有精品6| 亚洲热久| 精品欧美一区二区三区久久久| 99热精品99| tingtingzonghewang| 日本欧美国产| 99草在线免费观看视频| 欧美美女视频| 丁香激情五月| 人妻自慰高清合集| www。狠狠干。com| 啪色综合| 婷婷六月久久| 亚洲乱码日产精品BD| 色久丁香五| 久婷婷久草| 97操操操| 久久久欧美精品sm网站| 久cao香蕉影院| 深爱激情综合网| 婷婷综合在线| 狠狠操狠狠做| 人人爱天天摸摸天天爱| 7超碰自拍| 97搞在线| 99国产在线| 婷婷爱综合| 六月丁香av| 狠狠色中色| 狠狠干夜夜干| 亚洲在线操| 激情五月丁香六月综合AVXXXX| 侠女刀之记忆电影在线看免费| www.色9| 丁香五月激情图片婷婷| 99re6在线视频精品免费| 五月狠狠| 婷婷六月啪啪| 激情婷婷五月天日本系列| 麻豆科斗777| 丁香婷婷91在线观看视频| 1024AV视频| 国产毛片精品一区二区色欲黄A片| 亚洲视频五区| 99久久国产宗和精品1上映| 中国丰满熟女A片免费观| 亚洲色五月天| 久草热在线视频| 色九亚洲| 综合网色| 玖玖热视频| 九九99精品视频在线观看| 国产综合激情五月久久| 啪啪啪综合网| 日韩大片艹艹| 97狠狠碰| 久久爱综合| 日韩在线看AV| 99这里热| 夜夜躁爽日日| 婷婷久久综合久色| 五月天天丁香婷婷| 色吧五月婷婷| 99爱欧美| 国产又色又爽又黄又免费| 亚洲中文字幕AV| 九九精品亚洲| 五月婷婷久草在线视频综合| 色99在线观看| 碰97久久| 六月婷久久| 久久婷婷夜| 在线超碰91| 丁香五月婷婷欧美成人色图| 99久久終合| 操草草草| 91日本在线免费| 丁香五月激情啪啪综合| 国产熟妇乱子伦hd| 亚洲三A| 国产亚洲精品久久久久久牛牛| 天天日夜夜爽| 丁香五月天啪啪| 狠狠操天天干| 天天干天天干天天干| 国产一级片| 国産精品| 99玖玖在线视频| 亚洲综合五月天婷婷丁香| 婷婷五月天国产在线播放| www.亭亭五月天| 九九热视频免费| 亚洲综合狠狠艹| 99re在线观看视频| 色五月在线| 婷婷六月丁香激情综合| Jh7Uf088VHafNm| 婷婷无码视频| 激情网婷婷五月天| 色99视频| 五月第四色| 99爱视频| 操操操97| 色原狠狠综合| 六月丁香激情综合网| 亚洲无码yw| 日韩黄在免| 东京热五月婷婷| 亚洲亚洲人成综合网络| 99久久国产宗和精品1上映| 五月天狠狠| 婷婷综合在线| 色丁香久久久| 少妇高潮A片无套内谢麻豆传| 综合色图婷婷| 99小视频在线观看| 精品无码人妻一区| 人妻内射一区二区在线视频| 人妻久久久久久| 99热在线观看| 欧美成人精品三区综合A片| 中文字幕无码人妻少妇免费视频| 天天综合网~91| 久久综合五月| 亚洲色情久久| 天天爽天天爽夜夜爽| 午夜色丁香| 亚洲日日日| 成人在线日韩欧美| 丁香六月在线| 午夜无码熟熟妇丰满人妻| 婷婷在线日韩综合| 久七香蕉| 开心五月天激情网| 日本三级99人妇网站| 五月婷婷色白丝| 8区视频在线| 91日韩在线| 日本色婷婷综合| 欧洲亚洲激情五月天在线| 日日夜夜狠狠操| 14色综合婷婷| 国产乱妇无乱码大黄AA片| 成人无码精品1区2区3区免费看| 亚洲久久天堂| 婷婷色在线播放| 色婷婷狠狠| 五月丁香婷婷久久| 丁香五月天综合| 久久久中文| 国产精品日本一区二区在线播放 | 色播五月婷婷五月| 亚洲欧美综合7777色婷婷| 97色碰| 五月婷婷黄色网址| 9热久久| 五月婷婷综合激情| 亚洲 五月 婷婷 成人| 久久精品系列| 亚洲熟妇AV乱码在线观看| www.99操.com| 婷婷五月天成人| 五月情婷婷五月| 国产婷婷五月天| 五月婷婷色影院| 俺也去色| 2020日日干| 六月丁香成人| 色色网站| a网站免费观看| 免费播放AV| 精品久热| 婷婷丁香五月高清| av在线观看免费| 国产精品激情AV久久久青桔| AV电影在线播放| 色逼综合网| 91|九色|动漫| 激情五月丁香激情综合网| se影音资源在线观看| 九九婷婷网五月天| 日韩野外 无套| 日本久久超碰| 色婷婷激情视频| 丁香五月天电影| 丁香五月综合| 久草a片| 超碰99在线| 操逼福利视频| 五月天激情久久| 国产精产国品一二三在观看| 亚洲六月婷婷| 色综合久久88色综合天天| 欧美黄色AA片哗啦啦啦| 国产婷婷久久| 好吊丝aV| 超碰AV在线| AV片在线观看| 五月天激情黄色小说在线观看| 色色欧美色色| 婷婷五月天伊人| 国产亚洲色婷婷久久99精品91 www.riverspirits.org www.hnnun.com www.changh | 性视频久久| 欧美性爱五月天| 日韩免费99| 影音先锋 91工厂| 91色操| 超碰一区二区| 激情综合五月色在线| 五月激情网站| 欧美激情 日韩无码 婷婷 五月天| 激情影院内射| 久久曰曰| 伊人色五月| 成人小说 五月天 婷婷| 婷婷美女精品视频| 亚洲av网站在线观看| 久久九九思思| 五月丁香综合网色欲| 丁香五月人妻| 亚洲色图啪啪| 亚洲九九99精品视频在线播放| 99操| 久青操| 狠狠激情五月天| 激情五月天小说网| 九九色欲网| 丁香五月婷久久| 免费观看全黄做爰的视频| 任你草| 9九色首页| 久久五月天激情| 精品婷婷五| 99狠狠| 日本V在线观看不卡视频网站| 啊V视频在线观看| 久久爱婷婷| 五月Huangsewang| 九九色逼| 五月婷精品| 一起操 91N.com| 久久在线人妻| 99成人| 97人人超| 激情综合网五月丁香| 五月丁香婷婷99| 热久久视频99| www久| 激情久久综合| 日韩狠狠色| 五月丁香婷婷99| 日日爽天天| 成人αV视频免费观看| 六月婷婷之青青草| 婷婷五月天av| 五月婷俺去也| 色婷婷六月天在线| 丁香五月在线看| 丁香六月中文| 成人五月天丁香婷| 久综合九综合99| 第四色五月婷婷| 五月天天天色| 婷婷丁香综合在线| 俺去也在线www色官网| 婷婷在线免费| 97热久久五月婷婷| 九月停停| 狠狠搞狠狠操| 五月天丁香久久综合| 成人AV综合在线| 久久思思99| 激情五月婷婷六月丁香| av在线播放网站| 五月天色婷婷视频| 秋霞AV吧| 少妇久久诱惑视频| 亚洲三级无码| 亭亭五月激情亚洲在线| 久久婷婷青青| 色婷婷丁香五月综合| 依人大香蕉在钱1| 五月天夜夜爱夜夜操| 万月丁香狠狠爱| 天天成人综合视频| 久久人妻超碰一区| 国产另类综合| 九九成人电影婷婷| 婷婷五月天亚洲图片| 免费操超碰| 99热这里有精品| 99精彩视频| 俺去也综合| 久久久中文| 日日天天干| 色色综合网站| 五月亭亭六月色| 狼人久草| 婷婷丁香人妻| 搡BBBB搡BBB搡五十| 3pAV| 色综合久久88色综合天天99| 超碰在线超碰| 激情网婷婷婷| 久久A区B区| 日本激情五月| 六月丁香啪啪| 九九精品热| 久热这里| 亚洲看av的网站| 思思视频精品| 久婷婷婷| 婷婷五月天涩涩| 色私五月婷婷| 99热只有精品在线观看| 可以免费看av网站| 丁香五月婷婷深爱综合激情| 狠狠色五月激情| 丁香五月性爱| 五月婷婷六月丁香综合视频在线| 大香蕉啪啪啪| 人人插9| 激情綜合網址| 9.1综合网| 亚洲电影在线观看| 五月丁香亚洲综合| 98永久精品| 九九激情网| 色视频2025| 欧美特大片黄| 六月丁香婷婷综合在线| 棕合影院色色| 色婷婷久久| 日亚二欧美| 欧美影院婷婷| www久久五月com| 狠狠xx| 深爱激情综合| 99视频这里有精品| 91干在线视频| 九九干视频| 婷婷九月激情网| 婷婷色九月| 丁香婷婷五月激情综合| 婷婷五月天美女| 99亚洲天堂| 天天 日综合| 色日本五月天| 久久综合激情| 国产精品扒开腿做爽爽爽A片唱戏 亚洲爆乳无码精品AAA片蜜桃 | 久色网址| 亚洲视频在线观看99| 超碰在线视屏| 狠狠爱激情网| 看逼中文字幕| 婷婷WWW久久| 99re在线观看| 亚洲熟妇无码乱子AV电影| 久久丁香婷| 狠狠干综合网| 爱草视频在线观看| 99免费偷拍视频| 五月天婷婷色播| 五月天激情丁香| 日韩九区| AA片在线观看视频在线播放| 丁香五月停停av| 亚洲午夜Av| 五月丁香六月激情视频| 影音先锋xfplay资源男人网| 综合激情九月婷婷,激情综合婷婷中文字| 99久视频| 热99re| 最新av在线观看| 丁香五月欧美婷婷综合| 草草操操| 六月丁香影院| site:xmssd.com| 丁香五月 激情文学| 99热这里只有精品9| 丁香五月婷婷激情蜜桃| 丁香花五月天激情| 91干婷婷| 精品人妻一区二区三区四区不卡在| 99久久久国产精品免费蜜乳tv| 婷婷四色五月| 综合久久狠狠| 久久香蕉网| 五月婷婷AV| 亚洲色情免费网| 色色色在线观看| 亚洲欧美日韩VIP| 91色在线/日韩| 色五月婷婷天天操夜夜操| 美女黄频aⅴ视频| 91av传媒高清在线视频网| 欧美婷婷日本| 色色 亚洲| 热久久思思热思思| 天天综合 99久久婷婷| www.91五月| 激情综合五| 五月色综合| 五月天激情网页| 人人爽天天莫| av无码电影| 色婷婷很很丝袜| 丁香婷婷六月男男| 丁香五月,激情五月,深爱五月| 婷婷五月播| 婷婷五月天毛片| 日本一级淫| 色色色网站| www,com,五月色色| 五月丁香龟婷婷| 国产成人VA| 丁香五月天网站| 99伊人婷婷在线| 日韩青青| 五月激情综合网| 亚洲精品国产成人AV在线| 五月丁香天堂网| 99热这里有精品24| 日日日,com| 九热电影av| 九月婷婷在线视频| 91啪啪视频| 九九热99视频| www,超碰| 五月色婷婷综合| 欧美综合五月丁香六月婷| 久久久久婷婷五月热综合| 综合久久97| 色999;丁香五月| 色噜噜狠狠色综| 国产欧美精品AAAAAA片| 五月丁香综合| 99热国产| 欧洲亚洲免费视频9| 亚州性爱99| 五月丁香网中文字幕| 噜综合| 97色久| 日韩在线99| 色五月婷婷伊人| 操b视频在线观看一区二区| 婷婷丁香色五月天| 婷婷色情 | 九九综合| 五月激情小说| 日日干日日| 久操热| 亚洲激情五月| 狠狠干综合| 色啪综合| 婷婷色影院| 五月丁香婷中文| 亚洲成人高清在线| 丁香五月综合激情啪啪| 丁香五月天激情免费在线观看AV777| 激情小说婷婷小说| 天堂婷婷五月在线| 九九国产精视频| 性爱综合网| av中文在线| 99re在线视频精品,这里只有精品18,| 激情综合网站| 日韩美女在线视频19| www.久操| 亚洲欧美国产A片免费观看| 色五月婷婷91在线| 91超级碰人人操| 99热伊人综合| 狠狠狠狠狠狠草| 99操网站| 久久区区一二三av| 91 九色 入口| 九九人人自拍| 婷婷伊人综合中文字幕| 五月激情综合网| 99久扒热| 91久久| 激情丁香五月天综合| 婷婷五月丁香综合亚洲 | 九月丁香婷婷| 天天操夜夜爽天天操| 久久婷婷视频| 天天操天天爱天天日| 蜜乳9188| 激情五月伊人婷婷| 色久婷婷五月| 久久在这里有精品| 久久这里只有精品无码| 日日夜夜天天爽| www.99成人视频| 五月丁香六月婷婷综合网站 | 国产偷人爽久久久久久老妇APP| 伊人综合网站| 另类五月激情| 欧美六月婷婷| 久久久久激情网| 91超碰在线观看| 九热视频| 久久久久综合激动五月天| 夜夜骑日日操| 艾小青av| 婷婷网五月天| 中文字幕不卡+婷婷五月| 色五月激情| 国产精品久久久久久久久久| 欧美情色一区| 青青999| 超碰在线观看9| 婷婷内射视频在线| 激情五月,色五月| 丁香六月 人妻| 久热视频这里只有精品68| 日日夜夜婷婷| 超碰女人天堂| 婷婷丁香六月| 亚韩精品视频1区| 日本久久99久久| 久久综合婷婷| 五月丁香啪啪啪啪| 99热在这里只有精品| 99精品视频偷拍| 91热99| 五月天婷婷久久| 99热xx| 成人午夜免费电影| 丁香五月天在线视频| 米奇影视资源婷婷狠狠色激情欧美五月丁香| 久久欧洲综合网| 九九视屏| 人妻啪啪啪| 色色色香蕉五月婷| 婷婷综合av| av在线中文| 99无码免费视频| 激情丁香六月| 婷婷狠狠97| 91日本在线观看| 99re资源在线视频导航| 婷婷五月天黄色网址| 九九碰九九爱97超碰| 成人网丁香五月| 五月丁香网站| 天天做天天爱| 色综合99无码 | 狠狠 久久| 欧美色图天堂网| 色欲五月天| 婷婷五月天播播| 99无码精品| 婷婷五月综合基地| 久热综合| www.爱操com.| 婷婷激情社区| 久久98| 亚洲熟妇AV乱码在线观看| 加勒比久热| 无码四色色色| 日韩欧美骚货| 超碰操网| 99热国产在线| 五月天激情图片| 色五月婷婷五月久久| 精品人妻伦一二三区久久| 日日噜噜夜夜狠狠久久丁香五月| 天天干天天日蜜臀av| 99大香蕉| 狠狠色 综合色区| 亚洲网视屏| 久热re视频在线观看网站| 九月丁香亭亭| 噜噜噜精品欧美成人在线观看| 成人网在线视频| 中文字幕无码人妻少妇免费视频| 天天透天天干| 久久久久久天天日天天爱| www.五月丁香| www.五月天| 激情五月天啪啪| 日日操,日日爽| 99干日本| 婷婷伊人综合| 久久婷婷激情五月天一区二区| 五月婷婷丁香综合网| 色色色免费视频| 丁香色情五月综合激情| 色五月丁香总合网| 五月婷婷五月| 国产偷人爽久久久久久老妇APP| 丁香六月| 五月天婷婷黄色| 五月天天天色| 日本黄色精品| 国产丁香五月天婷婷| 99色综合网| 亚洲AV久久久久久久久久久久久久久久 | 国精产品久久| 色色网五月激情| 激情av在线| 久久99综合网| 色婷视频| 九九综合| 亚洲丁香五冃97色| 99色在线观看视频| 日日操夜夜爽白洁| 丁香五月开心婷婷| 中文字幕av久久爽一区| 婷婷伊人五月天| 婷婷五月综合色小姐小说| 丁香五月婷婷久久久| 色色色婷婷五月| 成人国产欧美大片一区| 69热在线| 影音先锋天天日| 五月婷A V在线| 婷婷五月天视| 亚洲成人一区| 超碰高清在线| 久久人妻乱子伦| 五月婷六月丁香| 亚洲天堂啪啪| 亚洲天堂婷婷丁香| 奇米网大香蕉| AAAA亚洲| 激情五月丁香亭亭| 五月婷婷基地| 99视频在线观看视频| www色五月| 婷婷丁香五月欧美人| 99热在线精品播放| 成人免费黄色短视频| 色色网91| 六月激情婷婷色| 狠狠狠狠狠草| 色5月婷婷| 操一操干一干| 亚洲无码性爱| 激情五月综合久久| 五月丁香激情综合欧美| 婷婷无码五月天| 99性爱| 狠狠综合区| 色婷婷六月激情| 国产无人区大片| 国产精品色| 9 9热这里有精品| 亚洲中文无码成人| 六月天婷婷| 亚洲亚洲人成综合网络| 六月丁香婷婷综合狠狠爱夜夜爱| 这里只精品| 综合网狠狠| 五月涩涩网| 97夫妻超碰| 五月婷婷伊人网| 丁香五月香蕉| 亚洲欧洲国产精品| 人人97碰| 婷婷99热| 婷婷丁香九月| 超碰电影在线播放| AVDV久久| 成人资源在线| 五月天婷久精视频| 欧美搡BBBBB摔BBBBB| 色色婷婷色色| 色播五月天天| 99久在线精品99re8热| 婷婷六久久| 丁香五月激情婷婷视频| 深爱婷婷丁香五月激情| 天天色亚洲| 九月婷婷激情久久| 亚洲欧洲自拍图片专区五月天| 欧美在线视频免费播放| 草草夜夜操| 九九热这里只有精品首页| 国产色色视频| 国产又黄又爽又色的免费| 中文字幕AV在线播放| 亚洲最大视频| 伊人婷婷福利网| 激情五月天婷婷久久久久久久久久久| 婷婷操婷婷干婷婷射| 99视频这里有精品| 五月六月婷婷激情网| 五月丁香好婷婷A片网| 97操碰在线97| www,婷婷五月天777me,com| 思思久久精品| 色五月婷婷在线| 五月天网站亭亭| 风流少妇A片一区二区蜜桃| AV网站免费在线| 99热无码首页| 久久婷婷九月国产精品| 99精品这里只有免费视频| 日韩啪啪视频| 99热热这里只精品996小说| 在线综合网| 亚洲岛国电影| 久机视频这只有精品| 五月婷婷六月丁香首页| 99超级碰碰| 色色色色色色色色五月先| 大香蕉520| site:901-07.com| CHINESE熟女老女人HD视频| 五月丁香婷婷婷婷综合网| 99热8在线| 色五月激情五月天| 丁香9月婷婷| 亚洲激情五月婷婷日日| 色婷婷五月综合| 热99这就是精品视频| 欧洲色| www.精品99| 激情五月色播五月| 激婷网| 色黑鬼导航| 97色啪| www.99精品日操伊人乱碰在线| 99精品在线观看视频| 99久久er| 大地9中文在线观看免费高清| 九九99热久久精品66中文字幕| 六月婷婷之青青草| 97久久精品| 午夜丁香 婷婷| 丁香色播五月天| 五月天综合视频| 婷婷综合中文| 五月天天堂久久| 日日操,夜夜撸| 九九九九这里只有精品| 亚洲色情久久| 天天碰夜夜操| 天天做天天爱| 婷婷五月天渟渟| 色色色综合网| 99久久婷婷国产综合精品草原| 中文无码婷婷| 五月天激情在线视频| 色婷婷av综合网| 夜夜久久综合网| 色综合色综合婷婷热| 大香蕉天堂| 99九精品| 五月丁香激情综合啪啪| 一区二区免费看| 丁香五月激情啪| 9操在线| 丁香五月色情| 日本女va| av在线播放网站| 婷婷中文字暮| 天啪色| 激情六月丁香| 婷婷色婷婷亚洲成人| 久久六月综合| 免费99情趣网视频| 九九热青草| 五六月丁香激情视频| 99国产97在线,| 欧美va在线观看| 激情综合99| 日日夜夜狠狠| 日韩无码人妻一区二区三区综合 | 俺去啦综合网| 伊人影院久久网| 天天综合精品| 91久久久久久久久18| 大香蕉九九| 五月丁香 啪啪啪| 色婷婷五月综合色婷婷| 丁香激情五月天| 日韩成人网址| 中国女人做爰A片| 色婷婷五月天天天干天天操天天爽| 月丁香久久久| 在线观看亚洲视频影院| 久久综合激情五月天| A片试看120分钟做受图片| 欧美成人性爱网| 五月天堂婷婷| 少妇熟女视频一区二区三区| 色婷婷狠狠| 色色色在线免费视频| 亚洲超级碰| 欧美性生交XXXXX无码小说| 六月丁香中文字幕| 久久综合天天综合| 啪啪啪综合网| 夫妻超碰在线| 无码激情AAAAA片-区区| 色婷婷88| 久久久区区一久久久久久| 婷婷涩五月| 熟女人妻一区二区三区免费看| 激情综合网,婷婷| 九九热内射| 色色五月天丁香| 综合欧美五月婷婷| 婷婷中文综合网| √天堂资源在线人妻熟女| 99精品视频在线6| 人妻免费网站| 色丁香五月天| 婷婷五月成人有| 久久九九精彩| 色色色色欧美| 久热这里只有精品99re| 深爱激情丁香| 五月丁香色婷婷婷基地| 久久综合九九| 九九热精品6| 五月天·www·com| 九月丁香欧美综合| 性按摩玩人妻HD中文字幕| 亚洲综合成人网| 欧美黄色AA片哗啦啦啦| 亚洲色爽| 99操久久| 激情婷婷五月综合| 国产亚洲成AV人片在线观黄桃| 大香蕉久久婷婷精品综合| 国产精品久久久60086| 思思久久网| 色色色婷婷| 99热超碰人| 五月丁香六月在线| 天堂综合久久 | 99久久综合狠狠综合久久| 五月婷婷丁香五月| 五月天网站免费欧美| 四色女婷婷| 狠狠色丁香综合| 日本啪啪网| bukadeavzaixian| 黄网在线免费| 狠狠综合| 综合久久婷婷| 五月丁香五月婷婷在线观看| 色婷婷丁香特级性爱视频| 天天曰夜夜爽| 亚洲在线综合| 亚洲亚洲人成综合网络| 日韩视频99| 亚洲第一色色色| 99九九中文字幕视频| 亚洲亚洲人成综合网络| 99热1| 日本在线噜噜| 丁香五月电影| 久热在线观看视频9| 开心激情五月天网| 天天天天操| 欧美日韩AAAA| 热99精品视频| 深爱五月天 开心网| 99热99成人| 五月婷婷黄色| 六月撸婷婷| 99久免费视频| 欧美人人草草| 大香蕉久久综合网| 成人美女网| 婷婷综合激情| 丁香色婷婷| 99精品视频偷拍| 五月丁香六月婷婷啪啪| 欧美狠狠草| 五月丁香色婷婷色| 五月丁香亭亭电影久久| 五月丁香在线观看| 久久人人妻| 色狠狠综合| 久久亚洲网| WWW.99视频| 久久婷婷电影| 精品人妻一区二区三区在| 五月丁香黄色视频| 日本色色网站| 天天射色五月天| 狠狠88综合久久久久噜噜噜| 97操碰视频| 熟美女麻豆| 99热草草| 99在线精品免费视频| 九九视频在线| 婷婷六月色开| 美国十月色婷婷在线观看| 亚洲va在线| 九九爱看亚洲| 日韩抽插操逼| 久鲁鲁色网 | 综合激情五月丁香9999久久精| 9有码中文| 狠狠爱婷婷色| 1024久婷| 久久大国产香蕉| 精品一二三区久久AAA片| 天天爽天天| 天天爽天天| 国产成人99久久亚洲综合精品| 国产精品视频免费看| 第四色五月天| 99热99热在线| 激情五月色综合| 色播丁香婷婷五月激情| 九九操综合网| www.操逼comm| 大波美女VA网站| 另类图片激情五月天| 成人婷婷桔色| 色五月天天在线观看资源站| 国产亚洲99| 精品成人在线观看| 婷婷激情六月综合| 亚洲无码11| 久久久婷丁香五月天激情综合| 五月丁香成人| 亚洲最大在线| 色五月xxx| 久热最新视频 | 蜜桃人妻无码AV天堂三区| 专区无日本视频高清8| 五月桃花网综合| 久久久久9久无码视频| av人人操| 狠狠干综合网| 激情网第九色| 美女天天艹人人爽| 爱草视频在线| 开心激情网五月| 激情久久久久久久久| 日韩啪啪视频| 婷婷六月天| 丁香五月之久操视频| 久久五月天丁香| 色五月天丁香婷婷| 久久机热这里只有精品免费视频 | 国产69久久久欧美黑人A片| 国产古装妇女野外A片| 色吧婷婷五月亚洲| 久久色吧| 五月婷婷与六月丁香图片激情| 五月婷丁香| 91啪级电影| 五月色天情| 99精品一二三四视频| 色婷婷香蕉| 中文字幕成人版| 涩涩婷婷五月| 操操碰| sewuyuejiqingwang| 99热97| 99热伊人| 99久久99久久综合| 91人人人人人| 婷婷之玖玖| 99热超碰| 婷婷丁香五月天亚洲| 九九热精品| 99热欧美| 婷婷综合玖玖五月| 99操中文视频| 丁香五月狠狠综合欧美| 综合婷婷五月天|