日韩精品一区二区三区在线视频放-无码中文字幕V?一区二区-成年片免费观看视频-国内少妇人妻丰满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ī)器人開發(fā)工程師的復(fù)合型AMR移動(dòng)機(jī)器人控制系統(tǒng)完整工程實(shí)現(xiàn)聚焦激光SLAM導(dǎo)航、多體協(xié)同與人機(jī)交互集成解決智能物流、柔性產(chǎn)線中移動(dòng)底盤與機(jī)械臂一體化控制的實(shí)際開發(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和文檔說明整體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)目緣起從單一底盤到復(fù)合型AMR的挑戰(zhàn)去年接手一個(gè)倉(cāng)儲(chǔ)物流的自動(dòng)化升級(jí)項(xiàng)目客戶的需求很明確他們希望將現(xiàn)有的、只能沿著磁條或二維碼跑的AGV小車升級(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ī)劃路徑再通過一個(gè)集成的控制系統(tǒng)指揮底盤移動(dòng)和機(jī)械臂動(dòng)作最終通過一個(gè)直觀的界面讓操作員能輕松監(jiān)控和調(diào)度。這聽起來像是一個(gè)標(biāo)準(zhǔn)的“機(jī)器人操作系統(tǒng)”項(xiàng)目但實(shí)際一上手坑就來了。市面上成熟的方案如ROS生態(tài)固然龐大但對(duì)于這種需要深度定制、對(duì)實(shí)時(shí)性和界面交互有較高要求的工業(yè)項(xiàng)目有時(shí)顯得過于“臃腫”和“黑盒”。我們最終決定基于C和Qt框架從零開始搭建這套控制系統(tǒng)。核心模塊包括處理激光數(shù)據(jù)并實(shí)現(xiàn)定位建圖的SLAM模塊、驅(qū)動(dòng)底盤移動(dòng)的導(dǎo)航控制API、解析并執(zhí)行動(dòng)作的機(jī)械臂控制器、用于多機(jī)通信的網(wǎng)絡(luò)模塊、以及用Qt/QML構(gòu)建的圖形化監(jiān)控界面。整個(gè)項(xiàng)目打包后就是一個(gè)包含了所有源碼、依賴和配置的壓縮包即標(biāo)題中的那個(gè).zip文件。今天我就把這套系統(tǒng)開發(fā)中的核心設(shè)計(jì)、關(guān)鍵技術(shù)選型的思考以及那些踩過又填平的坑系統(tǒng)地梳理一遍。2. 系統(tǒng)架構(gòu)總覽模塊化設(shè)計(jì)與數(shù)據(jù)流在動(dòng)手寫第一行代碼之前定義一個(gè)清晰、松耦合的系統(tǒng)架構(gòu)至關(guān)重要。我們的核心目標(biāo)是高內(nèi)聚、低耦合確保底盤導(dǎo)航、機(jī)械臂控制、人機(jī)界面等模塊既能獨(dú)立開發(fā)和測(cè)試又能高效協(xié)同。2.1 核心模塊劃分與職責(zé)整個(gè)控制系統(tǒng)可以劃分為五個(gè)核心層數(shù)據(jù)自底向上流動(dòng)指令自上而下執(zhí)行感知與定位層Perception Localization核心組件2D激光雷達(dá)、SLAM算法庫如Gmapping、Cartographer或自研算法。職責(zé)實(shí)時(shí)采集激光點(diǎn)云數(shù)據(jù)通過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核心組件底盤控制API適配器、機(jī)械臂運(yùn)動(dòng)控制器。職責(zé)這是與硬件直接打交道的部分。底盤控制將規(guī)劃層生成的速度指令線速度v角速度w通過特定的通信協(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é)角度或末端位姿序列通過機(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)樗祟惪勺x、易于調(diào)試、且?guī)缀跛姓Z言都支持解析。網(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的圖形用戶界面。職責(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ì)象通過本地進(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)的路徑并開始生成實(shí)時(shí)的cmd_vel指令??刂茖拥妆P控制器接收cmd_vel通過底盤API驅(qū)動(dòng)輪子移動(dòng)。同時(shí)機(jī)械臂控制器接收到“準(zhǔn)備抓取”的指令開始運(yùn)動(dòng)到預(yù)抓取姿態(tài)。感知層在整個(gè)移動(dòng)過程中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是貫穿各層的“普通話”而網(wǎng)絡(luò)通信模塊是“郵差”確保了不同語言、不同進(jìn)程、甚至不同物理設(shè)備上的模塊能夠無縫對(duì)話。3. 核心基石激光SLAM的實(shí)現(xiàn)與底盤API集成SLAM和底盤控制是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通常是性價(jià)比最高的選擇。我們最終選擇了Cartographer原因如下精度與魯棒性Cartographer采用圖優(yōu)化Graph Optimization后端能有效閉環(huán)檢測(cè)累積誤差小建圖精度高適合構(gòu)建大型、一致性好的地圖。實(shí)時(shí)性其前端掃描匹配速度快能滿足AMR實(shí)時(shí)定位的要求??膳渲眯蕴峁┝素S富的參數(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通過nav_msgs/Odometry消息接收里程計(jì)數(shù)據(jù)。我們需要從底盤控制器或電機(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è)迭代過程。務(wù)必在同一個(gè)環(huán)境下使用相同的錄制數(shù)據(jù)包bag進(jìn)行反復(fù)測(cè)試和對(duì)比才能看出參數(shù)改變的真實(shí)效果。盲目調(diào)參只會(huì)浪費(fèi)時(shí)間。3.2 底盤導(dǎo)航API集成封裝與抽象不同品牌的AMR底盤其控制接口千差萬別有的提供ROS驅(qū)動(dòng)包有的提供C SDK有的只給一個(gè)串口協(xié)議文檔。我們的策略是定義統(tǒng)一的內(nèi)部接口然后為每種底盤編寫特定的適配器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ì)于一款通過CANopen通信的底盤我們需要實(shí)現(xiàn)CanopenChassisController類內(nèi)部使用CANopen庫如CANopenNode來發(fā)送PDO過程數(shù)據(jù)對(duì)象控制電機(jī)并接收SDO服務(wù)數(shù)據(jù)對(duì)象來讀取編碼器值計(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來獲取最新的里程計(jì)信息供給SLAM和導(dǎo)航算法使用。避坑指南線程安全底盤控制器的讀寫操作必須加鎖因?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)致底盤電機(jī)抖動(dòng)。最好在適配器內(nèi)部做一個(gè)簡(jiǎn)單的低通濾波或指令平滑處理。4. 上層應(yīng)用Qt/QML界面設(shè)計(jì)與網(wǎng)絡(luò)通信如果說SLAM和底盤控制是機(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)畫、多視圖切換Widgets的代碼變得臃腫且難以維護(hù)尤其是UI動(dòng)畫和復(fù)雜布局。于是我們決定向QMLQt Modeling Language重構(gòu)。為什么選擇QML聲明式語法UI布局和邏輯更清晰直觀。用QML描述“界面應(yīng)該是什么樣子”用C實(shí)現(xiàn)“后臺(tái)數(shù)據(jù)是什么”。強(qiáng)大的動(dòng)畫與狀態(tài)機(jī)原生支持各種屬性動(dòng)畫、狀態(tài)切換輕松實(shí)現(xiàn)平滑的機(jī)器人移動(dòng)動(dòng)畫、界面過渡效果。硬件加速渲染基于OpenGL的場(chǎng)景圖Scene Graph渲染地圖、大量機(jī)器人圖標(biāo)時(shí)性能遠(yuǎn)超Widgets。易于設(shè)計(jì)分離設(shè)計(jì)師可以使用Qt Design Studio工具設(shè)計(jì)UI開發(fā)人員專注于業(yè)務(wù)邏輯協(xié)作更順暢。重構(gòu)的核心QML與C的數(shù)據(jù)綁定QML界面需要實(shí)時(shí)顯示機(jī)器人位姿、地圖、任務(wù)列表等動(dòng)態(tài)數(shù)據(jù)。這些數(shù)據(jù)來源于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; // 通過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)更新位置無需手動(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ì)于地圖這類可能很大的圖片考慮分塊加載。4.2 網(wǎng)絡(luò)通信與JSON數(shù)據(jù)解析多機(jī)協(xié)同和遠(yuǎn)程監(jiān)控離不開穩(wěn)定高效的網(wǎng)絡(luò)通信。我們采用TCP長(zhǎng)連接作為主要通信方式以保證指令的可靠有序傳輸同時(shí)輔以UDP廣播用于心跳包和設(shè)備發(fā)現(xiàn)這類對(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é)、消息類型2字節(jié)、序列號(hào)2字節(jié)等信息。用于解決TCP的粘包/拆包問題。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是核心類。將socket讀寫放在獨(dú)立的線程避免阻塞主線程UI線程。JSON解析與生成Qt提供了QJsonDocument,QJsonObject,QJsonArray等類非常方便。// 解析收到的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); // 加上自定義消息頭后通過socket發(fā)送cmdData心跳與斷線重連客戶端定時(shí)如每秒向服務(wù)器發(fā)送一個(gè)簡(jiǎn)單的心跳包{msg_type: heartbeat}。服務(wù)器端如果超過一定時(shí)間如5秒沒收到某個(gè)客戶端的心跳則判定其離線清理相關(guān)資源??蛻舳藱z測(cè)到連接斷開后應(yīng)嘗試指數(shù)退避重連。數(shù)據(jù)一致性多線程環(huán)境下網(wǎng)絡(luò)接收線程、業(yè)務(wù)邏輯線程、UI線程都可能訪問共享的機(jī)器人狀態(tài)數(shù)據(jù)。必須使用互斥鎖QMutex或讀寫鎖QReadWriteLock進(jìn)行保護(hù)或者采用生產(chǎn)者-消費(fèi)者模式通過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ī)劃和與底盤的協(xié)同。5.1 機(jī)械臂控制集成我們集成的是一款六軸協(xié)作機(jī)械臂它通過Ethernet TCP提供了一套簡(jiǎn)單的API發(fā)送目標(biāo)關(guān)節(jié)角度或末端位姿位置姿態(tài)機(jī)械臂自行規(guī)劃軌跡并運(yùn)動(dòng)??刂颇J竭x擇關(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ī)器人底盤中心在地圖坐標(biāo)系下的位姿。機(jī)械臂安裝在底盤上兩者有一個(gè)固定的安裝偏移。我們需要定義一個(gè)“機(jī)械臂基坐標(biāo)系”相對(duì)于“機(jī)器人底盤坐標(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)過一系列變換最終轉(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庫或tf2如果借鑒ROS思想來處理這些三維空間變換。運(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)都通過發(fā)送一個(gè)目標(biāo)位姿給機(jī)械臂控制器并等待其反饋“到達(dá)目標(biāo)”信號(hào)來觸發(fā)下一個(gè)狀態(tài)。5.2 多設(shè)備協(xié)同作業(yè)與調(diào)度當(dāng)倉(cāng)庫里有不止一臺(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通過心跳包持續(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ù)之間的依賴關(guān)系按序分配給不同的AMR執(zhí)行。6. 開發(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 開發(fā)環(huán)境與工具鏈IDEQt Creator是不二之選對(duì)Qt項(xiàng)目支持最好特別是QML的語法高亮、調(diào)試和可視化編輯。對(duì)于純C后端邏輯VS CodeCMake Tools插件也是高效組合。版本控制Git。嚴(yán)格進(jìn)行分支管理如main穩(wěn)定版、develop開發(fā)版、feature/xxx功能分支。依賴管理使用CMake的FetchContent或find_package來管理第三方庫如PCL用于點(diǎn)云處理、Eigen用于矩陣運(yùn)算、yaml-cpp用于配置文件解析。將所有依賴的編譯方法和版本號(hào)寫入項(xiàng)目README.md。日志系統(tǒng)不要再用printf或qDebug了。集成一個(gè)像spdlog這樣的異步日志庫可以按級(jí)別info, warn, error輸出到控制臺(tái)和文件并支持滾動(dòng)歸檔對(duì)線上排查問題至關(guān)重要。6.2 調(diào)試技巧讓機(jī)器人“開口說話”數(shù)據(jù)錄制與回放這是調(diào)試SLAM和導(dǎo)航算法的神器。開發(fā)一個(gè)簡(jiǎn)單的工具將激光數(shù)據(jù)、里程計(jì)數(shù)據(jù)、速度指令等所有話題數(shù)據(jù)同步錄制到一個(gè)文件中可以自定義二進(jìn)制格式也可以用ROS的bag格式然后自己寫解析。當(dāng)線上出現(xiàn)問題時(shí)將數(shù)據(jù)包拿回來回放可以百分百?gòu)?fù)現(xiàn)問題場(chǎng)景反復(fù)調(diào)試算法參數(shù)??梢暬{(diào)試在Qt界面中除了顯示正式的地圖我們專門做了一個(gè)“調(diào)試視圖”可以實(shí)時(shí)繪制出原始的激光點(diǎn)云用散點(diǎn)圖。局部代價(jià)地圖用熱力圖顯示障礙物膨脹區(qū)域。全局路徑和局部規(guī)劃出的速度采樣空間用箭頭表示。這樣當(dāng)機(jī)器人卡住或撞墻時(shí)能一眼看出是感知問題、地圖問題還是規(guī)劃問題。遠(yuǎn)程調(diào)試與日志通過前面實(shí)現(xiàn)的網(wǎng)絡(luò)通信模塊讓機(jī)器人將重要的日志和內(nèi)部狀態(tài)如代價(jià)地圖、規(guī)劃路徑實(shí)時(shí)發(fā)送到PC上的調(diào)試客戶端。這樣機(jī)器人跑在現(xiàn)場(chǎng)我們?cè)谵k公室就能看到它的“內(nèi)心世界”。6.3 部署與穩(wěn)定性保障打包與安裝使用linuxdeployqt或自己編寫腳本將Qt程序及其所有依賴庫打包成一個(gè)可移植的文件夾或AppImage。配置文件如SLAM參數(shù)、地圖文件、網(wǎng)絡(luò)地址放在獨(dú)立的config目錄下。開機(jī)自啟與服務(wù)化在機(jī)器人上的Linux系統(tǒng)中將主程序配置為systemd服務(wù)。編寫一個(gè).service文件定義啟動(dòng)順序、依賴、崩潰后自動(dòng)重啟等。這比寫進(jìn)rc.local要可靠得多??撮T狗Watchdog在主程序中創(chuàng)建一個(gè)看門狗線程定期“喂狗”。如果因?yàn)樗梨i等原因主線程卡死看門狗超時(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)存泄漏?;剡^頭看開發(fā)這樣一個(gè)復(fù)合型AMR控制系統(tǒng)最大的挑戰(zhàn)不是某個(gè)算法有多難而是如何將眾多異構(gòu)的模塊感知、決策、控制、通信、UI有機(jī)地整合在一起并保證其穩(wěn)定、可靠、易維護(hù)。它要求開發(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
返回資訊列表
亚洲女毛多水多21P| 精品一二三区四视频| 日韩在线一区二区| 欧美情色亚洲| 欧美影音在线| 偷拍欧美激情| 99久久网站| jk白丝没脱就开始啪啪| 色欧洲| 曰韩香蕉97| 玖玖97综合| 久久久久久国产无码精品| 天天伊人| 国产情色在线| 麻豆久久久久久久久丝袜 | 91中文精品日韩欧美在线| 中国亚洲呦女专区| 免费亚洲国产精品久久一区| 免费网色网站| 久久久艹艹艹| 国产免费一区在线观看| 欧美另类精品xxxx| 日B操| 色欲久久99国产精品久久久久久| 97视频在线视频| 亚91亚洲网| 五月婷婷丁香| 五月天婷婷影院| www色日本| 国产一级不卡在线观看| 免费久久一级毛片大黄| yiqicaoav| 久99久视频精选| 性色av婷婷久久一区二区点复制| 精品成人亚洲午夜电影| 精品无码欧美三级| 大香蕉中文| 999热日韩精品| 国产精品久久久久久久久久久久久久久久 | 青娱乐日韩无码| 26uuu性| A一区片| 一区二区乱码福利| 久草这里只有精品| 日韩精品亚洲一二三| 久久久久久久久久久久久女过产乱-少妇高潮一区二区三区喷水-成人AV | 97超碰超| 男女啊啊啊啊啊| 99久re热视频精品98| 亚洲精品中文字幕一区在线视频 | 日韩激情中文字幕有码| 人人摸人人叼| 国产树林里野战在线看| 操逼逼中文字幕| 操逼操逼逼操操逼91| 亚洲 自拍偷拍 欧美| 襙一襙| 午夜性刺激视频免费观看| 久艹视频在线| 蜜臀一二三区| 色99久草| 大香交| www.婷婷| 欧美性爱另类综合| 五月丁香影视| 欧美亚洲丝袜人妻制服99| 五月丁香影院| 夜夜操天| 偷拍亚洲高清图片| 99re只有精品| av线电影| 超碰97久| 亚洲91色| 国产美女裸体秘 永久无遮挡| 天天做天天爱夜夜爽毛片试看| 9久在线视频只有精品| 一级毛片电影免费看| 99re这里只有精品9| 天天干嫩逼网| 自拍偷拍草一草| 国产强奸91| 变态综合色| 亚洲 欧美综合| 九九热三级片| 欧美精品成人在线播放| 亚洲精品成人激情在线| 综精品久久久aaaa| 久久久18禁| 国产精品久久久久久9999| 人妻喷水| 91天天综合网| 人妻丰满熟妇一区二区三| 日韩人妻中文视频| 欧美日韩999| 欧美精品成人亚洲| 日日黄色三级网站| 日本精品一区二区三| 久久久亚洲精品中文字幕人妻| 色妇综合网| A片大香蕉在线| 午夜精品久久久久久久久久蜜桃| 无码精品蜜桃一区二区三区ww| 六月激情婷婷| 亚洲国产综合久久久性感熟妇| 91骚妇| 日韩丨制服丨中文|在线| 情色大香蕉| 精品91| 一线黄色免费性爱片| 睡产熟女乱伦| 美女人妻色网站| WWW.加勒比人妻一区不卡.com| 伦理日韩国产久久| 成人a级高清视频在线观看| 一级特级aaaa毛片免费观看| 亚洲精品一区中文字幕乱码| 青青草在线视频欧美| 天天看高清麻豆| 青青草影视蜜久久| 国产无码成人无码| 欧美熟女操屄| 国产自产91区13区| 天天躁夜夜躁狠狠躁AV| 91这里只有精品| 国产 无码 一区二区| 人妻天天夜夜爽一区二区| 亚洲综合影片| 久久久久久大| 国产精品天干天干综合网麻豆| 日本黄色精品| 激情无码日韩| 久久这里精品国产99丫e6| 麻豆a'v电影| 2023天天操夜夜操| 久久精品99| 四虎884a| 丁香九月婷婷| 日本操BAV| 一区二区三区国产精产| 97色操| 日韩精品碰碰| 国产老熟女| 五月天久久人妻| 欧美色图小说综合| 思思热国产在线视频| 920日本午夜免费| 精吧天堂| 久久久久久久久久久免费精品| 色综合久| 欧美极品色| 欧美不卡在线一区二区| 大胆91| 蜜臀一二三区| 熟女乱伦A| 人妻熟女一区在| 亚洲污污网站| 亚欧免费| 亚洲熟妇乱女区二区三区| 九九九国产精品| 人人摸.人人色| 婷婷情色综合网| 色一射色一射| 91久热| 国产亚州高清国产拍精| 精久久久91| 97超碰久久| 91精品丝袜在线观看| 农村妇女精品一区二区| 啪啪性爱免费视频| 毛片视频白嫩| 日韩猛交| 五月婷婷六月色| 日韩一级欧美一级在线观看| 国产吞精a级片激情电影| 久久偷拍人| 精品91| 激情五月天色色| 国产超碰97| 久久直播国产| 97色妞| 精品日韩人妻精品一二三区| 91爱综合| 久草看看看| 婷婷亚洲五月***久久| 大香蕉一人在线| 啪啪视频免费在线观看| 色色五月天激情| 久久视频少妇美女| 国产探花精品在线| 都市激情人妻一区二区青青操视频| 九九综合九九综合| 麻豆久久久久久久久丝袜 | 国产精品天干天干综合网麻豆| 欧美成人免费在线观看| 久久鲁夜| 亚洲天堂中文字| 加勒比AV天堂| 国产 日韩 欧美 中文 另类,国产 欧美 另类 制服 变态,高清 日韩 欧美 中文,高 | 国产91影院| 超碰97精品在线| 国产91 丝袜在线播放00-百度| 久久伊人大香蕉| 色一情一乱一乱一区91Av| 久久久青草青青国产亚洲免观精品高清完整版_97久久综合区小说区图片区,国精品 | 免费国产视频| 97超碰色五月| 俞拍久久国应视频| 人妻精品视频一区二区| av影院十区| 人妻中文在线| 亚洲成人贴图| 精品99999久久久久久| 神马久久久久久| 久极品在线观看| 亚洲91网。| 99亚洲精品| 97爱爱影院| 国产精品亚洲高清在线| 伊人嫩草| 97自拍视频在线| 91熟女丨老女人| 亚洲日韩AV视色| 亚洲加勒比久久日本道| 91成人社区| 国产精品一级片在线看| 九九九九九九综合| 婷婷香蕉欧美在线一区二区三区| 成人精品在线免费视频| 黑丝日韩av丝袜av| 8050午夜少妇无码| 日本亚洲嫩草影院啪啪| 国产日本熟女顶级一区二区三区视频| 欧美精品久久久久久久丰满| 日日骚精品视频| 欧美性爱伊人| 欧美综合制服在线| 操逼操网| …亚洲黄色厕厕女女在线播…| 欧美综合第一| 美中日韩无码| 五十路熟女人妻一区二区在线观看| 91久热这里只有精品| 日日操免费视频| 丰满人妻一区| 六月色婷婷| 日B操| …中文字幕亚洲乱,97人妻无码费视…| 高清国产av无码| 揉揉揉夜夜| 在线人妻熟女一区二区三区四区五区| 亚洲av国产av综合av卡| 青青草狠狠撸| 色97| 91成人久久 | 韩国午夜理伦三级好看| 91丝袜美女视频| 午夜偷拍久久熟女| 久久久久白虎| 99黄页网站| 色色色综合网| 人妻啪| 蜜臀久久99精品久久久久久成人小说 | 99这里有精品视频| 人妻一二三区| 99热销国产这里有精品| 国产超碰在线一区| 天天日夜夜爽| 99国产在线 精品 视频| 91丝袜在线播放| 亚洲天堂人人妻| www.色婷婷.com| 国产亚洲精品A在线观看下载| 天天综合网亚洲综合网| 国产一在线观看| 亚洲色图欧美色18直播在线| 青青草视频久久久久| 欧美综合区| 国产99热| 欧美综合网站999| 亚洲中文字幕日产无码久久| 国产11页| 91精品啪在线观看国产城中村| 色悠久| 性九九九九九九| 久久久久9久久久久| 久久这里只精品99re66图| 日本人妻伦在线中文字幕| 蜜臀网址在线| 蜜屁Av| 亚洲人在线| www.婷婷| 黑人无码一区二区| 国产强奸乱伦xd| 99re69综合| 久久久中文| av在线一区二区三区| 综合久久少妇中文字幕| 色色97爱| 婷婷九月丁香| 97频视在线| 毛片17S| 夂久色| 欧美啪啪女女| 免费A V在线播放| 青娱乐淫乱1314| 精品少妇高潮久久| 欧美少妇内射| 特级大荫道BBwBBwBBW| 六月丁香久久| 精品伊人久久久大香线蕉小说| 国产91av在线播放| 另类亚洲一区二区三区| 欧美性爱一区二区| 啊啊啊啊好爽好舒服一区二区易域| 国产精品午夜精品| 久操视频在线| 国产丝袜高跟美女av免费观看| 日韩久久超碰色| 密桃99999| 综合色播| 五月丁香久久| 亚洲黑丝在线| 欧日韩不卡视.频| 九月丁香| 天天综合网站| 九九色热| 欧美亚性天堂| 亚洲中文字幕97久久精品少妇| 国内毛片免费h片在线| 亚欧高清在线| 中文字幕精品资源在线| 久久欧美性爱视频| 色婷婷丁香| 精品国产肉丝袜在线拍国语| 精品久久人妻成人网| 久久久久九九九| 日韩啊V| 2024年最新色情网站在线观看| 亚洲国产精品无石码久久 | 色99久草| 熟妇人妻丰满久久久久久久无码 | 大香蕉久| 黄片无码在线制服| 日韩不卡av一二三| 婷婷伊人綜合中文字幕| 亚洲欧洲偷拍一区| 嗯嗯嗯嗯啊啊啊好紧好大| 亚洲天堂东京热| 丁香五月偷拍| 97精品国产97久久久久久免费| 插入综合网| 色av中文字| 欧美中文字幕男人天堂久久精品 | 一区操逼日比视频| 日本激情免费大片| 免费av大片| 亚洲欧美国产其他二区| 99综合视频| 天天射影院| 高清不卡国产| 青青草成人视频在线观看二区| 欧美色图人妻| 精品少妇高潮久久| 亚洲牲交| 国产精品嫩草久久久久| 国模无码一区二区三区在线| 五月丁香网站| 蜜桃精久三区| 久久婷婷欧美| 99re6在线视频播放免费精品| 国产熟女无套内射| 粉嫩av久久一区二区三区| 日韩精品亚洲一二三| 亚洲天堂资源在线| 国产精品内射婷婷一级二| 午夜操逼不卡| 4399成人黄A片| 啊啊啊用力在线观看| 久久大线蕉一区| 久久久久人| 久久二| 免费精品国偷自产在线在线| 思思性爱| 日本韩国一本产品小视频日本韩国一本产品久久久产品小视频日本韩国一本产品久 | 男人的天堂一区三区| 亚洲成av人片色午夜乱码| 嗯嗯嗯好爽| 天天干天天日天天射黄色片| chaopen97久久| 国产精选视频| 100啪啪视频大全| 在线看片国产精品每日更新| 开心五月婷婷激情| 久久av色| 91久热| 国产一区二区三区高清视频| 综合熟妇一区二区三区| 亚洲欧美高清无码| 亚洲精品美女久久久久久久久| 91在线欧色| 劲爆欧美人妖三区91| 91日韩国产欧美亚洲另类精盘州至城都| 亚州熟女乱伦| 激情婷婷| 91撸色网 玖玖网 欧美| 色噜噜人妻av中文字幕| 日日97| 国产少妇与亚洲av| 亚洲熟伦熟妇AV无码春色| 欧洲小说色图视频另类| 亚洲成av人片色午夜乱码| 美女9118禁| 91婷婷伊人狠人| 激情四射婷婷四五月天| 校园春色亚洲| 在线欧美69V免费观看视频| 久久久九97| 五月婷亚洲精品天堂| 欧美 亚洲 另类 综合| 蜜臀精品1区2区| 青青草无码视频| 九九九九免费| 亚洲一区二区性爱电影| 青青草日本中文字幕 | 日本欧美中文字幕| 在线中文字幕极品av| 蜜桃久久久久久| 精品在线78| 可以在线观看的黄色网址| 国产又黄又爽| 国产亚洲综合欧美一区| 九九拍拍精品视频在线播放 | 91色久| 欧美后入视频| 久久在线观看免费视频| 激情99| 精品乱码在线观看| 国产Av超碰| 欧美不卡在线美女| 日韩内| 黄色网址在线免费观看| 亚洲第一页欧美| 香蕉精品二区二区| 人妻日日干| 校园春色亚洲欧洲| 久久久久久久久久久久97| 天天插夜夜操| 91嫩草欧美| 久久丝袜| 亚州男人天堂| 综合色色网| 另类成人首页一区| 99精品欧美一区二区三区桃色| 第二页中文字幕| 老妇女91| 五月天色图影视| 一卡二卡三卡| 强奸xx国产| 男人的亚洲天堂| 免费看黄片现成| 日本天天吊| 欧美 亚洲 在线| 色色综合网站| 亚洲第一页色网| 国内毛片免费h片在线| 国产一区二区在线播放,久久亚洲精品中文字幕第一区,亚洲精品在线中文字幕视频 | 日韩三级在线观看mp4| 欧洲久久一二线| 欧美国产精品久久九九| 日韩另类色图| 啊啊啊啊好爽好舒服一区二区易域| 色狠狠综合| 999色欧美中文字幕| 爆操无码| 黑人精品欧美一区二区蜜桃| 我要看免费韩日黄片| 午夜精品久久999热蜜桃介男人用| 国产亚洲日韩欧| 久久熟妇五十路一区| 97无码视频在线播放| 日本免费不卡二区| 亚洲欧洲自拍图片专区满春格| www.操| 粉嫩av平台| 好看的91视频| 岛国黄| 亚洲 欧美 综合 91| 国产 日韩 欧美 中文 另类,国产 欧美 另类 制服 变态,高清 日韩 欧美 中文,高 | 日本二三四区| 91少妇人妻| 大香蕉免费中文| 999综合网| 中文字幕 一区二区 亚洲无码| 色网站导航大全| 影音综合网| 天天日天天搞天天干| 国产视频第2页| 99久久久久久久久| 精品国产乱码久久久久久久| 欧美1727免费观看视频| 熟妇综合一区二区三区| 亚洲影院小综合| 操日韩第| 亚洲有薄码区久久在线一区| 婷婷大香蕉| 精品91| 有码色中文字幕在线观看| 在线无码网站| 97久久综合网| 亚州操操穴网| 久久无码成人| 夜夜骑日日| 亚州精人品大香蕉| 人人看人人插| 久久久少妇| 欧美日韩亚洲一区二区在线观看| 亚洲最新中文字幕免费| 中国91AV| 久久日本熟妇熟色高清| 国产这里只有精品| 国产高清成人mv在线观看| 亚洲风情在线观看| 天堂网 主播 亚洲| 亚洲图片 91| 强奸乱伦资源| 9国产超碰| 欧美78P| 九九热精彩视频| 色嘟嘟人妻天堂网| 亚洲AV成人无码久久精品播放| 欧美成人精品欧美一级乱黄一区二…| 久操九九九九九九九九九九九九九九九九九九九九九九九九九九九九 | 中文字幕123| 日本中文熟女视频| 深夜激情 | 大香蕉99热| 亚洲激情四射| 激情综合二| 日韩熟女操逼| 国产久久久久久| 超碰久草| 无码九九| 超碰97久久国| 色色综合97| 超碰在线974| 五月婷婷六月激情| 国产精品99久久久www| 一线黄色免费性爱片| 秋霞网无码| 91丝袜| 亚洲男人天堂网站| 男人天堂最新手机版在线青青草| 久久久久国产| 97色涩| 亚洲精品天天影视综合网 | 日本免费一区二区不卡 | rivers-china.com| 欧美高潮| 欧洲精品欧洲精品| 亚洲熟久久| 97精品国产手机| 精品久久久久,69国产成人精| 色色婷婷五月天| 3D污黄视频在线观看| 天天懆天天日| 中文字幕人成乱码熟女香港| 日本成人A片网站| 国产精品高清2021在线| 中文字幕日韩专区精品系列| 大JI巴好深好爽又大又粗视频| 亚洲熟女综合一区二区| 亚洲资源站| 久久97视频| 亚洲欧美综合图片| 人妻丝袜一区二区三区在线| 少妇淫妇久久久久久久| 久久久久久久| 97在线观看免费视频| 97亚洲综合| 欧美性爱精品七区| 欧美Aⅴ| 色在线亚洲视频www| 韩国一级AAA| 色yeye成人免费视频| 国产AV无码AV| 丁香六月啪| 一区二区你上我| 性色avv| 亚洲中文字幕日产无码久久| 超碰这里只有精品| 国产精品毛片| www.91视频网| 91国模| 香蕉国产精品麻豆亚洲欧美日韩| 偷拍三区| 新版天堂中文资源8在线| 色婷久久| 99999久久久久9国产精品| 久久综合精品一区二区三区| 综合激情97 | 美国aaaaa一级黄片| 精品伊人久久久大香线蕉小说| 中文字幕在线高清男人的天堂| 这里只有精品久久| 欧美熟妇精品黑人巨大一二三区| 欧美少妇高潮久久91| 亚洲在线综合| 中国人高清www色视频免费| 另类TS人妖一区二区三区| 亚洲色 国产 欧美 日韩| 色九九综合| 91丝袜美女| 97国产伦理| 91青青在线| 黄色免费一级在线毛片| 美女操逼福利视频| 久久精品小视频| 国产美女激情| 91精品国| 最新av中文字幕高清| 国产无码一二三区| 伊人国产av| 天堂精品一区| 免费观看网黄| 亚洲AV无码黄色强奸| 99视频内射三四| 久久精品视频久久久| 91色综合色| 亚洲色婷婷久久91| 大屁股xxxxx| 9999伦理视频| 国内一级精品| 国产精品自拍xxxx| 男人的天堂在线有码| 免费亚洲国产精品久久一区| 极品白嫩美少妇在地板上位骑射淫水泛滥| 国产不卡免费在线视频| 91人妻超碰| 热G综合热G中文| 人人做,人人操,人人摸| 婷婷五月丁香五月| 久久久噜噜噜久久人妻| 69av一区二区三区| 中文字幕一区av| 久久久久久久久久久久久女过产乱-少妇高潮一区二区三区喷水-成人AV | 日韩电影中文字幕| 男人天堂黄片| 嗯啊啊啊轻点视频| 国产美女自拍视频| av在线免费一区二区| 99r九九| 日本 情色 1区| 免费A V在线播放| 亚洲五区熟女| 中文字幕在线观看网址| 九九黄色网| 999九九九九国产动| 国模私拍一区二区三区神乳| 欧美熟妇视频| 一摸二插三插| 青椒国产97在线熟女| 色97| 人妻丝袜一区二区三区在线| 国产乱伦一二三区| 国产妇女精品视频青青草| 亚洲一区中文精品| 欧美日韩夜夜| 欧美日韩资源| 国产AV高清AV无码| 中文无线日韩一区| 在线一道啪| 伊人991| 一二三四视频中文字幕在线看| 天天插天天舔舔天天干| 999综合网| 天天影视色香色欲| 男人的天堂va在线| 爽 好舒服 无码刺激久久| 熟妇高潮精品一区二区三区下载| 国产美女销魂在线观看不卡| 蜜桃在线观看一区二区三区| 日本一区二区中文字幕久久| 蜜桃成人1区2区3区| 欧美综合网A| 久操不卡视频| 老司机香蕉| 五月香婷婷| 国产一区二区精品久久久不卡蜜臀| 日韩AV一起草| 中文字幕第7页| 99久热| 久久东京热久久| 神马福利久草| 国产乱伦搜索结果91P| 天天日日日射| 国产又黄又粗又猛大片| 天天综合影院91| 亚洲欧洲无码bt精品合集| 啊啊啊啊啊啊啊国| 99久久国产精品免费高潮| 欧洲中文字幕| 久久久久久69国产一区二区| 久久久久国产| 黄片不用下载在线观看| 久久精品电影在线| 伊人久久艹| …亚洲黄色厕厕女女在线播…| 黄色大片一区二区密桃丝袜| 秋霞操逼片| 亚洲无限观看| 大香蕉丝袜一级片| 97色亚洲| 久久精品国产99国产精品亚洲| 岛国视频一二三区| 欧美97日韩精品| 国产 日韩 另类 视频一区爱| 91制服丝袜| 欧美最婬乱婬爆婬性视频 | 美女久久久久久久久久久| 午夜久久无码1000合集| 9九九国产| 国产乱码久久| 天天弄天天操| 久久亚洲欧美一区二区三区-亚洲国产精品第一区二区 | 亚州操操穴网| 欧美日韩在线国产在线| 色约约一区=区三区| 欧美乱色| 脫衣舞一区二区三区| 91天美免费| 亚洲 欧美 另类 综合 偷拍| 日本Xx性爱| 60秒不遮不挡| 伦在线97| 成人五月香网在线| 国产日韩在线播放av| 97伦综合| 蜜臀久久在线视频| 久久女婷| 日韩熟女乱伦中出| 欧美日韩久久精品爱爱| 蜜臀久久久| 欧美成人精品A片免费一区99| 日韩精品色呦呦| 人妻夜爽夜夜爽| 少妇人妻无码| 日日夜夜狠狠| 日韩欧美tv一区二区在线观看| 东京太热男人的天堂久久久| 亚洲精品国产精品乱码不卡| 欧美色色色| 精品中文字幕第一页| 男人的天堂1024| 久久久禁| 蜜臀精品1区2区| 超碰人人色| 性爱免费视频成人| 1769成人国产精品视频| 国产精品白丝AV| 99久久综合| 韩国久久97| 国产做?爰片久久毛片?片美国| 久久久久亚洲熟妇熟女| 精精品人妻一区二区三区| 欧美色图人妻| 四季AV综合网址| 深夜操逼网| 欧美性爱另类综合| 久操网无码在线| 亚洲一区二区三区在线激情| 98超碰欧美| 亚洲91综合| 大香网伊人久久综合网eew| 欧美日日网| 志村玲子视频一区二区| 99久久久无码国产精品性男| 无码区蜜乳| 免费观看日本操逼视频| 成人国产二区三区在线,男女精品。| 好屌色综合| 97免费视频网| 69AV女优男人的天堂| 青青草日韩无码| 91色久| 少妇滛荡视频| 亚洲性爱无码乱伦av| 久久av一级av少妇av高潮| 中文AV制服乱伦| 蜜臀久久99精品久久久电影| 久草这里只有精品 | 怡红院久久老司机| 国产乱不卡| 精品无码一二三四区| 欧美日韩人人精品| 亚洲一区二区三区久久 亚洲一区二区| 中文字幕一区二区三区视频播放| 欧美一区二区观看在线| 伊人网综合在线视频| 噜噜噜亚洲精品| 欧美影音在线| 男人的天堂在线| 亚州综合图片| 性色乱AV一区二区| 67914在线精品观看| 91在线欧色| 天天综合精品| 免费观看欧美日韩操逼视频| 五月天色五月| 男人兔费天堂| 欧美午夜精品久久久久久超碰| 国产欧美美女免费观看视频| 国产白丝精品在线观看| 99999亚洲| 97精品久久| 在线亚洲 欧美 日本专区| 五月天婷婷在线看| 日本不卡五区| 亚洲无码视频免费在线观看网址!| 91亚州| 91啦人妻| 国产成年免费大片黄在线观看| 男人天堂黄片| a级成人毛片免费视频高清| 久久久555| 亚码人妻| 九X超碰| 久久国产99精品72福利| 国产一级不卡在线观看| 人妻一二三区| 日韩性爱长视频免费| 伊人大香蕉在线| 91成人精品在线播放| 黄色片大香蕉| 九九伊人网| 亚洲熟妇乱女区二区三区| 久久久久七视频| 天天插天天操天天摸天天射天天看| 久久色一区二区| 欧美淫乱视频| 一区二区三| 翔田千里无码中出中文字幕| 一级黄色性爱A级片| 欧日a| 狠狠狠狠狠干| 91嫩草欧美| 毛片麻豆91糖心精品毛情片| 亚洲欧美国产精品久久久久久久| 亚洲成人在线乱码色午夜| 亚洲无码一区成人免费午夜| 亚洲婷婷丁香在线| 国产一级操B视频| 色婷婷成人| 久久熟妇五十路一区| 磁力99AV| 操人妻丝袜高跟| 91激情综合| 久久久久99精品成人片蜜臀| 国产强奸乱伦无码视频| 免费簧片在线观看| 久操热| 麻豆精品A片免费观看| 91狠狠狠| 国产乱伦搜索结果91P| 五月天丁香婷婷综合网站| 日本一本一区二区三区四区五区欧美日韩中文字幕 | 91欧美长吊| 免费国产| 国产精品久久久久久亚洲色欲| 国产又操| 91网18| 99热一区二区三区四区| 亚欧无码线免费观看视频| 91在线精品| 色哟哟-国产专区| 青青草原香蕉日本Ap| 91色人妻| 天天爽天天爽| 国产第二页| 91久久久亚洲| 91超碰人人操| 91天天爱| 欧美人妻制服| 国产 无码 一区二区| 色婷婷aV一区二区三区麻豆综合| 欧美黑人168页欧美黑人167| 综合色一区三区二区| 三级激情网站| 国产成人资源| 大逼色网站| 国产区91柔拿会所技师| 男人天堂站| 人人操人人摸超碰| 国产 v乱码一区二| 97超级欧美| 色99999| 色婷婷六月| 国产女主播视频在线观看| 日本不卡五区| 丝袜大香蕉| 天堂精品一区| www.黄色在线| 欧美老妇女内射网址| 91狠狠综合网| 啪啪啪大香蕉| 超碰97.com| 久久精品国产亚洲AV无码电影 | 射丝袜高跟鞋99| 亚洲在线91| 久久婷婷视频| 超碰色大香蕉| 日韩激情中文字幕有码| 91欧美另类| 秋霞成人做爱| 久久久久久91香蕉国产| 日韩99999| 国产一区二区啪啪视频| 亚洲精品久久一区二区三区蜜桃臀| 两女互慰AV高潮喷水在线观看| 免费一级视频特黄色大片| 欧美最大综合网| 乱伦1色页| 欧美A√综合网| 欧美大波激情xxxx| 天天欧美色| 91女色| 99久热| 九九热视频在线观看| 人妻少妇色综合| 亚洲AV无码AV吞精久久久久| 美性中文综合网| 很黄很色的视频在线观看| 97干色天堂| 四虎午夜影院| 久操操| 97国产中文| 秋霞视频一区二区| 国产丝袜啪啪| 天天操天天插| 五十路熟女人妻一区二区在线观看| 欧美午夜精品久久久久久3D| 人妻熟女一区二区三区视频| 青青伊人这里只有精品| 91劲爆| 国产成人网址| 中韩中文字幕在线观看| 日本久久精品| 97AV在线观看| 欧美性暴力猛交XXXX| 国产日韩欧美中文在线播放| 久久超碰av在线| 日韩av不卡在线观看| 亚洲女优有码无码高清| 五月婷婷六月丁香| 99精品人妻| 国产性刺激| 五月天我淫我色av| 都市激情人妻一区二区青青操视频| 欧美成人一级免费电影| 97美日韩视频| 精品一区二区三区最新| 国产欧美成人第一页在线观看 | 天天干夜夜操一区二区| 国产又粗又又黄又猛| 国产无码精品久久久久久| 日韩天天本| 制服乱伦| 成人性爱免费播放| 亚洲 欧美 综合 91| 国产亚洲一黄| 影音先锋日本一区二区| 欧美一二级| 中字乱伦AV| 18禁止看精品中文字幕| 色偷综合| 天天射,天天操,天天爽-国内精品一区二区三区-成人AV | 欧美日韩亚洲天堂| 69av一区二区三区| 久久人妻无码毛片A片麻豆| www.zbzhongsen.com| 综合色一区三区二区| 日韩激情视频| 国产自偷自拍一区| 一级黄色性爱裸体视频| 在线中文AV| 天天综合色电影| 亚洲精品xxx| 久草在线| 日本韩国一本产品小视频日本韩国一本产品久久久产品小视频日本韩国一本产品久 | 极品出轨视频网站| 破处bbq| 国产乱人妻精品入口| 色综合一区二区三巨| 伦理片秋霞免费影院| 91碰碰| 日本精品88888888| 亚洲熟女国产综合另类| 亚洲综合成人网| 日韩性爱电影一区| 日欧操屄| 国产高清26uuu| 午夜精品久久久久| 日韩中文字幕精品一区在线| 天美传媒国产原创中文字幕亚洲欧美另类| 国产日韩欧美中文在线播放| 综合五月天| 亚洲青色欧美| 嗯嗯啊在线视频| 青青操综合网| 国产偷人伦激情在线观看| av影院十区| 精品人妻1237| 传媒免费一区二区三区| 亚洲成人在线资源| 久久专区| 秋霞无码av鲁丝片一区| 国产呦精品一区二区三区下载| 五月婷婷六月丁香| 中文字幕视频2区| 91精品少妇搡搡搡| 亚洲国产一区二区三区在线| 久久91精品国产9丨久久分亭| 亚洲图片 欧美电影| 伊人991| 99视频只有精品| 久久久久久电影| 国产视频第二页| 97精品97久久| 色性荡荡荡荡视频| 91站街按摩店老熟女熟女| 亚洲综合欧美| 一二三四区操操Av| 亚洲黄a三级三级三级看三级| 欧美天天谢综合网| 久久精品亚洲婷婷| 激情五月天婷婷| 国产亚热在线久久| 北条麻妃性愛视频| 大香蕉天天看妹子| 四虎永久在线精品免费网址 | 97se综合网| 人妻激情另类| AV九九| 色婷五月| 中日高清无码操逼视频| 韩国三级理论在线| 大色综合网| 九九视频黄色片| 国产精品国产精品国产| 人人妻人人爽一区二区三区| 夫妻AV网站| 欧美色图亚洲色,麻豆| 人妻无码久久一区二区三区免费| 精品美女在线视频| 成人老鸭窝人人在线视频| 男人下部插入女人下部 | 中文字幕在线免费观看 | 黑白配性爱AV成| 超碰在线综合97| 欧美色图亚洲色,麻豆| 1769一区二区| 亚洲双插| 婷婷五月天激情网| 男人的天堂99| 911av网站免费观看| 日韩av色图综合| 免费黄色片。| 青青草无码视频| 91色色色| 天天做天天爱| 亚洲人成色9999精品久久| 日韩免费在线观看不卡| 久久综合精品一区二区三区| 国产强奸乱伦欧美| 久久人妇| 国产免费一区二区在线A片视频| 精彩久久中文| 67194无码不卡| 97在线精品观看视频| 伊人国产av| 992视频一区| 国产亚洲日韩在线三区黑人| 男女香蕉一区二区| 久久久久成人蜜桃精品| 久久久精品电影| 亚洲91综合| 女优免费一区二区永久| 国产自制av蜜乳| 97操97干| 视频不卡中文字幕| 亚洲蜜乳av| 嫩草91| 欧美日韩欧美| 懂色aV一区二区天美传媒| 1769一区| a v网站在线播放| 丁香婷婷啪啪| 美腿色图| 欧美日韩人妻少妇 一区二区三区| 91天美免费| 17c嫩草51久久91嫩草| 国产一区二区三区久久久精品| 91精品久久久| 五月婷婷丁香| 久久蜜桃综合网| 久久精品91| 中文字幕熟女人妻丝袜| 久久国产免费激情视频| 色狠狠综合| 大香蕉99热| 综合熟妇一区二区三区| 欧美九九九| 欧美爱三级日韩久久| 国产1769在线| 老女人日韩美91| 青青草国产盗摄一二三区| 久久久涩| 国产无码高清操逼视频| 亚洲精品亚洲人成人网| 亚洲美欧999| 美女黄色91| 亚洲欧美日韩免费观看| 丁香六月东京热| 98一区二区精品| 大香蕉国产中文自拍| 一本色道熟妇| 一级乱伦网站| 91人妻素女| 人妻出轨一区二区三区| 偷拍亚洲情色| 韩三级a视频在线观看| 婷婷五月色| 久久九精品| 黄片视频观看| 99这里只有精品| 蜜桃狠狠色伊人亚洲综合 | 伊色综合天堂色97| 国产风韵犹存熟妇三区| 天天狂操夜夜狂日| 日韩性爱视频在线免费观看| 久久99午夜精品一区人妻| 青青草在线视频欧美| 91色婷婷综合久久中文字幕二区| 无码高清国产AV| 日韩丝袜人妻AV| 91情色在线| 国产色呦呦| 久久超碰大香蕉| 大学生美女口爆| 九九综合色| 视频黄站| 加勒比海成人视频网| 伊人色综合欧美| 九九热精品| 俺去啦俺来也久久综合| 97资源视频| 超碰免费在线| 亚洲欧洲无码97久久精品| 国产精品动态一区二区三区四四| 欧美春色| 思思热在线视频在线|