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

ARTICLE DETAIL

資訊詳情

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

基于ROS的雙UR10機(jī)械臂協(xié)同控制:從Gazebo仿真到真機(jī)部署

基于ROS的雙UR10機(jī)械臂協(xié)同控制:從Gazebo仿真到真機(jī)部署 簡(jiǎn)介機(jī)器人協(xié)同控制是工業(yè)自動(dòng)化中的重要方向雙臂系統(tǒng)相比單臂在搬運(yùn)、裝配等場(chǎng)景下具有顯著效率優(yōu)勢(shì)。在ROS框架中多機(jī)械臂協(xié)同面臨模型配置、運(yùn)動(dòng)規(guī)劃與碰撞避免等核心挑戰(zhàn)。通過(guò)URDF/Xacro建立統(tǒng)一的雙臂模型借助MoveIt進(jìn)行多規(guī)劃組管理并使用Gazebo完成仿真驗(yàn)證能夠有效解決雙臂避碰的任務(wù)需求。該類(lèi)技術(shù)可廣泛應(yīng)用于分揀、打螺絲、長(zhǎng)物體協(xié)同搬運(yùn)等場(chǎng)景。本文基于UR10實(shí)例詳細(xì)介紹了從仿真搭建、運(yùn)動(dòng)規(guī)劃到真實(shí)機(jī)器人接入的完整實(shí)現(xiàn)過(guò)程為雙臂協(xié)同控制的工程落地提供參考。 做雙機(jī)械臂系統(tǒng)這件事最開(kāi)始是因?yàn)橐粋€(gè)分揀場(chǎng)景的需求單臂的效率不夠雙臂又能協(xié)同配合。真正動(dòng)手才發(fā)現(xiàn)把兩臺(tái)UR10放到同一個(gè)ROS控制框架里難度并不是簡(jiǎn)單乘以2而是在仿真、規(guī)劃、通信、安全上的全面升級(jí)。這個(gè)項(xiàng)目最終交付了一套完整方案在Gazebo里可以跑的雙UR10仿真以及能連接兩臺(tái)真實(shí)UR10并完成雙臂協(xié)同控制的代碼和文檔。如果你也準(zhǔn)備做類(lèi)似的雙臂項(xiàng)目這篇文章可以省下你至少兩周的踩坑時(shí)間。我這里的核心做法是用ROS Noetic作為主控系統(tǒng)URDF/Xacro建模雙臂Gazebo做仿真驗(yàn)證MoveIt做運(yùn)動(dòng)規(guī)劃真實(shí)UR10通過(guò)ur_robot_driver接入。整體思路是先仿真后真機(jī)同一套任務(wù)腳本可以在兩種模式下切換。這篇文章會(huì)把架構(gòu)、仿真搭建、雙臂避碰、真機(jī)接入、代碼組織、典型坑位全部拆開(kāi)講清楚。1. 雙機(jī)械臂系統(tǒng)的整體架構(gòu)與選型邏輯1.1 為什么是雙機(jī)械臂而不是兩臺(tái)獨(dú)立單臂很多人一開(kāi)始會(huì)覺(jué)得雙機(jī)械臂不就是兩臺(tái)單臂放一起嗎各跑各的不就行了。真做起來(lái)就發(fā)現(xiàn)不是那么回事。兩臺(tái)獨(dú)立單臂最大的問(wèn)題是彼此不知道對(duì)方在干什么。規(guī)劃時(shí)沒(méi)有把對(duì)方當(dāng)作障礙物分揀任務(wù)中很容易撞到一起。更重要的是如果任務(wù)本身需要雙手配合比如搬運(yùn)長(zhǎng)物件、左右同時(shí)擰螺絲那單靠獨(dú)立指令根本同步不起來(lái)。所以我從需求層面就先明確了這套系統(tǒng)需要統(tǒng)一的狀態(tài)樹(shù)、統(tǒng)一的TF坐標(biāo)關(guān)系、統(tǒng)一的任務(wù)調(diào)度入口。在這個(gè)基礎(chǔ)上雙機(jī)械臂的控制可以解釋為“兩個(gè)規(guī)劃組 一個(gè)共享規(guī)劃場(chǎng)景 一個(gè)協(xié)調(diào)任務(wù)節(jié)點(diǎn)”。這樣左臂和右臂都有獨(dú)立的運(yùn)動(dòng)規(guī)劃能力但它們的碰撞空間會(huì)實(shí)時(shí)同步給對(duì)方。這是雙臂系統(tǒng)和“兩臺(tái)單臂拼在一起”的本質(zhì)區(qū)別。1.2 系統(tǒng)組成和版本選型我的主力環(huán)境是Ubuntu 20.04 ROS Noetic。為什么沒(méi)有一開(kāi)始就上ROS2因?yàn)閁R10的成熟驅(qū)動(dòng)、MoveIt與Gazebo的聯(lián)調(diào)資料在Noetic上最全。如果你準(zhǔn)備用ROS2也可以遷移但UR10生態(tài)里Noetic依然是相對(duì)穩(wěn)的選擇。如果只是為了仿真學(xué)習(xí)Ubuntu 22.04 ROS2 Humble MoveIt2也能走通但下文以Noetic為例。系統(tǒng)組成包括機(jī)器人本體兩臺(tái)UR10工作半徑約1.3米有效載荷10公斤。仿真環(huán)境Gazebo 11加載雙UR10的URDF模型。運(yùn)動(dòng)規(guī)劃M(mǎn)oveIt OMPL兩個(gè)規(guī)劃組分別管理左臂和右臂。底層控制仿真里用ros_control gazebo_ros_control插件真實(shí)機(jī)器上用ur_robot_driver提供的手腕驅(qū)動(dòng)接口。視覺(jué)/外圍工作臺(tái)上的模擬目標(biāo)物、可選的RGB-D相機(jī)、夾爪模型。這套組合在實(shí)際測(cè)試中非常順因?yàn)槊恳徊蕉加鞋F(xiàn)成的ROS包可以拼。UR10相關(guān)的ur_description和ur_robot_driver是官方維護(hù)Gazebo的ros_control生態(tài)也穩(wěn)定。我不建議從零手寫(xiě)底層關(guān)節(jié)控制浪費(fèi)時(shí)間且容易出安全問(wèn)題。1.3 信息流和節(jié)點(diǎn)劃分從頂層看系統(tǒng)的數(shù)據(jù)流是這樣的雙臂協(xié)調(diào)任務(wù)節(jié)點(diǎn)負(fù)責(zé)拆解任務(wù)把左臂目標(biāo)位姿和右臂目標(biāo)位姿分別發(fā)給兩個(gè)MoveIt動(dòng)作客戶(hù)端每個(gè)MoveIt規(guī)劃組在收到目標(biāo)后從planning scene里讀取當(dāng)前環(huán)境并把對(duì)側(cè)臂的關(guān)節(jié)狀態(tài)當(dāng)成動(dòng)態(tài)障礙物規(guī)劃完成的軌跡通過(guò)FollowJointTrajectory動(dòng)作接口發(fā)給Gazebo控制器或真實(shí)UR10控制器。關(guān)鍵的話(huà)題和服務(wù)大致如下名稱(chēng)類(lèi)型作用/arm_left/joint_statessensor_msgs/JointState左臂關(guān)節(jié)狀態(tài)反饋/arm_right/joint_statessensor_msgs/JointState右臂關(guān)節(jié)狀態(tài)反饋/arm_left/move_groupmoveit_msgs/MoveGroupAction左臂規(guī)劃請(qǐng)求入口/arm_right/move_groupmoveit_msgs/MoveGroupAction右臂規(guī)劃請(qǐng)求入口/arm_left/follow_joint_trajectorycontrol_msgs/FollowJointTrajectoryAction左臂軌跡執(zhí)行/arm_right/follow_joint_trajectorycontrol_msgs/FollowJointTrajectoryAction右臂軌跡執(zhí)行/planning_scenemoveit_msgs/PlanningScene共享規(guī)劃場(chǎng)景同步這樣的設(shè)計(jì)讓雙臂之間解耦又通過(guò)planning_scene共享環(huán)境能有效避免碰撞。任務(wù)調(diào)度節(jié)點(diǎn)反而很簡(jiǎn)單只負(fù)責(zé)規(guī)劃目標(biāo)和等待執(zhí)行結(jié)果。2. Gazebo仿真環(huán)境的搭建與驗(yàn)證2.1 雙臂URDF模型的組織方式在Gazebo里讓兩臺(tái)UR10同時(shí)出現(xiàn)的第一個(gè)坑就是URDF里的link和joint名字不能重復(fù)。如果你直接把官方ur10.urdf.xacro復(fù)制兩份就會(huì)出現(xiàn)兩個(gè)base_link導(dǎo)致TF樹(shù)直接沖突。我采用的做法是把單臂模型寫(xiě)成一個(gè)xacro宏調(diào)用兩次再用不同的名前綴包裹。例如左臂的所有l(wèi)ink叫l(wèi)eft_upper_arm_link右臂叫right_upper_arm_linkjoint同理。下面的xacro片段思路很典型xacro:macro namedual_ur10 xacro:include filename$(find ur_description)/urdf/ur10_macro.xacro / xacro:ur10_macro prefixleft_ joint_limitedtrue/ xacro:ur10_macro prefixright_ joint_limitedtrue/ /xacro:macro這里面最關(guān)鍵的是prefix參數(shù)。ur_description自帶的宏本身支持加前綴相當(dāng)于把整棵TF子樹(shù)的命名空間都隔開(kāi)了。不過(guò)需要注意某些link名稱(chēng)如果不通過(guò)參數(shù)傳入可能會(huì)漏掉前綴。初始化完成之后我會(huì)用rosrun tf2_tools view_frames.py生成TF樹(shù)檢查一遍確保left_base_link和right_base_link都掛在同一個(gè)world下。我把左右臂安裝在同一個(gè)水平底座上兩臂底座間距大約1.5米。這樣既留出了重合工作區(qū)又不會(huì)讓機(jī)械臂在待機(jī)位就互相干涉。底部框架用一個(gè)固定的world_link表示底座高度0.8米方便放置臺(tái)架。2.2 ros_control控制器配置要讓Gazebo能真正執(zhí)行MoveIt規(guī)劃的軌跡URDF里必須有transmission標(biāo)簽并且加載gazebo_ros_control插件。仿真控制我采用的是JointTrajectoryController因?yàn)镸oveIt的FollowJointTrajectory動(dòng)作直接能對(duì)接。每個(gè)關(guān)節(jié)需要設(shè)置合適的PID一開(kāi)始我直接用默認(rèn)參數(shù)結(jié)果Gazebo里關(guān)節(jié)抖得厲害后面把P降到80D提高到1.5左右才穩(wěn)定下來(lái)。一個(gè)典型的controllers.yaml長(zhǎng)這樣arm_left_joint_trajectory_controller: type: position_controllers/JointTrajectoryController joints: - left_shoulder_pan_joint - left_shoulder_lift_joint - left_elbow_joint - left_wrist_1_joint - left_wrist_2_joint - left_wrist_3_joint gains: left_shoulder_pan_joint: {p: 80.0, i: 0.5, d: 1.5} left_shoulder_lift_joint: {p: 80.0, i: 0.5, d: 1.5} left_elbow_joint: {p: 60.0, i: 0.5, d: 1.2} left_wrist_1_joint: {p: 30.0, i: 0.2, d: 0.8} left_wrist_2_joint: {p: 30.0, i: 0.2, d: 0.8} left_wrist_3_joint: {p: 20.0, i: 0.2, d: 0.5}右臂類(lèi)似。注意控制器名稱(chēng)里的arm_left前綴要和MoveIt配置里對(duì)應(yīng)的action命名空間一致否則MoveIt找不到執(zhí)行器。2.3 場(chǎng)景建模和初始位姿仿真場(chǎng)景里我在兩臺(tái)機(jī)械臂之間放了一個(gè)金屬臺(tái)架臺(tái)架高度大概0.9米臺(tái)面上放幾個(gè)模擬工件。這樣稍后測(cè)試規(guī)劃避碰時(shí)機(jī)械臂不會(huì)單純?cè)谧杂煽臻g瞎動(dòng)而是真的有環(huán)境約束。初始位姿設(shè)置也很講究。左臂和右臂的home點(diǎn)我都設(shè)置在靠近底座兩側(cè)、略微抬高的位置六軸角度大約接近“待機(jī)折疊”狀態(tài)。目的是在Gazebo剛啟動(dòng)時(shí)就讓雙臂遠(yuǎn)離相互碰撞區(qū)同時(shí)避免重力作用下關(guān)節(jié)突然下沉導(dǎo)致仿真崩壞。設(shè)置初始位姿可以直接在spawn模型時(shí)通過(guò)-J參數(shù)傳也可以發(fā)布一份joint_states讓robot_state_publisher刷新。2.4 跑通第一個(gè)雙臂仿真測(cè)試仿真啟動(dòng)的順序是先啟動(dòng)Gazebo世界再啟動(dòng)robot_state_publisher和ros_control控制器最后啟動(dòng)MoveIt。一個(gè)常用的launch組合類(lèi)似這樣roslaunch dual_ur10_gazebo gazebo_world.launch roslaunch dual_ur10_moveit_config moveit_planning_execution.launch sim:true等Gazebo穩(wěn)定后先在RViz里給左臂定一個(gè)工作臺(tái)上方的目標(biāo)位姿規(guī)劃并執(zhí)行。如果左臂能平滑到達(dá)再給右臂定一個(gè)對(duì)稱(chēng)位姿雙臂同時(shí)執(zhí)行。我第一次跑通時(shí)左右臂竟然同時(shí)把末端伸到同一個(gè)點(diǎn)附近雖然沒(méi)有物理碰撞但那一下冷汗就出來(lái)了——所以從仿真階段開(kāi)始就要把避碰機(jī)制加進(jìn)去而不是等到真機(jī)再考慮。3. 雙機(jī)械臂運(yùn)動(dòng)規(guī)劃避碰與協(xié)同3.1 兩個(gè)MoveIt規(guī)劃組在同一套環(huán)境中共存我的做法是啟動(dòng)兩個(gè)MoveIt節(jié)點(diǎn)一個(gè)管左臂一個(gè)管右臂。它們加載的URDF是同一份完整的雙機(jī)械臂模型各自的planning_group分別設(shè)置為left_arm和right_arm。這樣每個(gè)MoveIt都擁有全部機(jī)器人的狀態(tài)但只規(guī)劃自己負(fù)責(zé)的那組關(guān)節(jié)。這里有個(gè)容易踩坑的地方如果你在MoveIt Setup Assistant里用單臂模型生成配置拿到雙臂環(huán)境中直接用MoveIt會(huì)因?yàn)檎也坏讲糠株P(guān)節(jié)名字而報(bào)錯(cuò)。正確做法是開(kāi)啟雙臂模型在生成的config/srdf中保留兩個(gè)group并設(shè)置默認(rèn)規(guī)劃參數(shù)。MoveIt允許同一個(gè)機(jī)器人模型里有多個(gè)group這就是雙系統(tǒng)并存的基礎(chǔ)。兩個(gè)move_group的命名空間可以通過(guò)ns參數(shù)隔離例如先啟動(dòng)roslaunch dual_ur10_moveit_config moveit_group.launch ns:arm_left group:left_arm roslaunch dual_ur10_moveit_config moveit_group.launch ns:arm_right group:right_arm這樣在topic層面左、右臂的MoveIt接口就完全分開(kāi)了任務(wù)節(jié)點(diǎn)可以分別調(diào)用。3.2 把對(duì)側(cè)機(jī)械臂變成動(dòng)態(tài)障礙物雙臂規(guī)劃最核心的問(wèn)題左臂規(guī)劃時(shí)必須知道右臂此刻在哪里。最簡(jiǎn)單的辦法是在規(guī)劃前把對(duì)側(cè)臂的每個(gè)link當(dāng)成一個(gè)CollisionObject加到當(dāng)前MoveIt的planning scene里。我在協(xié)調(diào)任務(wù)節(jié)點(diǎn)里維護(hù)一個(gè)定時(shí)器每200毫秒讀取對(duì)側(cè)臂的/joint_states然后根據(jù)URDF里的link尺寸將這些link的位置轉(zhuǎn)化為一組shape_msgs/SolidPrimitive和geometry_msgs/Pose通過(guò)PlanningSceneInterface發(fā)布到當(dāng)前規(guī)劃場(chǎng)景中。這樣規(guī)劃時(shí)MoveIt就會(huì)認(rèn)為另一條臂是環(huán)境中不能碰的障礙物。這種方法實(shí)時(shí)性好代碼也容易理解。代價(jià)是每次更新都要重新發(fā)布collision object如果頻率太高會(huì)擠占規(guī)劃時(shí)間。實(shí)測(cè)200毫秒刷新足夠因?yàn)閁R10的正常運(yùn)動(dòng)速度不會(huì)在兩三百毫秒內(nèi)產(chǎn)生致命位移變化。如果要求更高可以在一段軌跡執(zhí)行前先推演對(duì)側(cè)臂未來(lái)的軌跡片段再生成動(dòng)態(tài)障礙物但工程量大很多我暫時(shí)沒(méi)有追求。還有一種方法是使用MoveIt的AllowedCollisionMatrix直接把對(duì)側(cè)臂的link加入“不可接觸”列表。這個(gè)辦法更快但對(duì)復(fù)雜環(huán)境模型不夠細(xì)致我建議還是用CollisionObject更直觀。3.3 雙臂協(xié)調(diào)任務(wù)的具體實(shí)現(xiàn)我這里舉一個(gè)非常常見(jiàn)的任務(wù)雙臂同時(shí)抓取一根長(zhǎng)桿。你可以把任務(wù)拆成三個(gè)動(dòng)作左臂運(yùn)動(dòng)到長(zhǎng)桿左邊抓取點(diǎn)右臂運(yùn)動(dòng)到長(zhǎng)桿右邊抓取點(diǎn)兩個(gè)機(jī)械臂同時(shí)抬起長(zhǎng)桿到某個(gè)高度。每一步都依賴(lài)上一步完成所以要有一個(gè)頂層調(diào)度狀態(tài)機(jī)。Python偽代碼如下import rospy from moveit_commander import MoveGroupCommander, PlanningSceneInterface rospy.init_node(dual_arm_task_node) left_group MoveGroupCommander(left_arm) right_group MoveGroupCommander(right_arm) scene PlanningSceneInterface() left_group.set_planning_time(5.0) right_group.set_planning_time(5.0) def move_both(left_pose, right_pose): left_group.set_pose_target(left_pose) right_group.set_pose_target(right_pose) left_plan left_group.plan() right_plan right_group.plan() if left_plan and right_plan: left_group.execute(left_plan, waitFalse) right_group.execute(right_plan, waitTrue) else: rospy.logwarn(plan failed, try again)注意execute方法里的waitTrue/False的組合。如果兩個(gè)都waitTrue第一個(gè)會(huì)阻塞導(dǎo)致第二只臂遲遲不啟動(dòng)。這里我先讓左臂開(kāi)始執(zhí)行再讓右臂執(zhí)行并用waitTrue等待右臂完成。實(shí)際項(xiàng)目中還需要等待兩個(gè)動(dòng)作都結(jié)束后再進(jìn)入下一階段可以用一個(gè)Future或者線程去輪詢(xún)MoveIt的狀態(tài)。如果單純是同步運(yùn)動(dòng)上面的方式足夠了。但如果兩個(gè)目標(biāo)的完成時(shí)間差距太大可能出現(xiàn)一臂先到位等待另一臂的情況。這時(shí)我會(huì)把兩段軌跡的時(shí)間手動(dòng)對(duì)齊在后處理時(shí)把較長(zhǎng)軌跡的時(shí)間作為總時(shí)間對(duì)短軌跡做時(shí)間縮放保證雙臂同時(shí)啟動(dòng)、同時(shí)到位。代價(jià)是一條臂的速度被壓低好處是整體姿態(tài)更安全。3.4 規(guī)劃參數(shù)調(diào)整和實(shí)時(shí)性?xún)?yōu)化MoveIt默認(rèn)的規(guī)劃時(shí)間只有1秒規(guī)劃嘗試次數(shù)也很少。在雙臂場(chǎng)景中由于對(duì)側(cè)臂不斷變成障礙物規(guī)劃失敗的可能性比單臂高很多。我把planning_time調(diào)到5秒num_planning_attempts調(diào)到10。這對(duì)仿真和真機(jī)都適用但如果用于實(shí)時(shí)產(chǎn)線5秒規(guī)劃時(shí)間太長(zhǎng)需要換更快的規(guī)劃器或預(yù)生成軌跡庫(kù)。另外可以把max_velocity_scaling_factor和max_acceleration_scaling_factor分開(kāi)設(shè)置。仿真時(shí)可以設(shè)0.8速度拉滿(mǎn)看效果真機(jī)第一次跑我建議設(shè)0.1尤其雙臂同時(shí)動(dòng)的時(shí)候低速度給緊急停止留足反應(yīng)時(shí)間。還有一個(gè)小技巧給規(guī)劃場(chǎng)景里的障礙物加上padding。MoveIt支持為collision object設(shè)置padding參數(shù)相當(dāng)于給物體膨脹一圈。兩只臂之間的距離本來(lái)就近時(shí)稍微膨脹一點(diǎn)可以把規(guī)劃結(jié)果往安全方向推。我通常會(huì)設(shè)置0.02米到0.05米的padding。4. 從仿真切換到真實(shí)UR104.1 硬件連接和驅(qū)動(dòng)安裝真實(shí)UR10和仿真的差距主要體現(xiàn)在底層通信。UR10控制器支持通過(guò)以太網(wǎng)口與外部PC通信。我把兩臺(tái)UR10分別接到工控機(jī)的兩個(gè)獨(dú)立網(wǎng)口設(shè)置靜態(tài)IP避免共用一個(gè)網(wǎng)口導(dǎo)致帶寬爭(zhēng)搶。驅(qū)動(dòng)我用的是ur_robot_driver相比老舊的ur_modern_driver它對(duì)Polyscope新版系統(tǒng)支持更好還能通過(guò)dashboard接口控制機(jī)器人的上電和加載程序。為了配合驅(qū)動(dòng)必須在UR10的示教器上安裝externalcontrol.urcap并在程序里加入External Control節(jié)點(diǎn)這樣機(jī)器人才能接受來(lái)自ROS側(cè)的速度/位置指令。準(zhǔn)備好之后啟動(dòng)roslaunch ur_robot_driver ur10_bringup.launch robot_ip:192.168.1.50這時(shí)可以在另一個(gè)終端里檢測(cè)能否收到關(guān)節(jié)狀態(tài)rostopic echo /joint_states如果沒(méi)有任何數(shù)據(jù)先檢查機(jī)器人的External Control節(jié)點(diǎn)是否正在運(yùn)行以及網(wǎng)絡(luò)是否能ping通。4.2 MoveIt從仿真切到真實(shí)的配置改動(dòng)MoveIt本身不關(guān)心底層是仿真還是真實(shí)它只通過(guò)FollowJointTrajectory動(dòng)作發(fā)送軌跡。區(qū)別在于執(zhí)行這條動(dòng)作的服務(wù)端是誰(shuí)。仿真時(shí)是ros_control的joint_trajectory_controller真實(shí)時(shí)是ur_robot_driver提供的scaled_pos_joint_traj_controller。我在整個(gè)項(xiàng)目里用一個(gè)頂層launch參數(shù)做切換arg namesim defaulttrue/ arg namerobot_ip_left default192.168.1.50/ ... group unless$(arg sim) node namearm_left_driver pkgur_robot_driver typeur10_bringup.launch/ /group group if$(arg sim) node namearm_left_gazebo pkgdual_ur10_gazebo .../ /group在MoveIt配置里需要把controllers.yaml也根據(jù)sim參數(shù)加載不同的版本。仿真版本對(duì)應(yīng)控制器名字arm_left_joint_trajectory_controller真實(shí)版本對(duì)應(yīng)scaled_pos_joint_traj_controller。否則MoveIt執(zhí)行軌跡時(shí)會(huì)一直報(bào)“controller not found”。還有一處必須要改use_sim_time。仿真中要設(shè)為true讓所有ROS節(jié)點(diǎn)使用Gazebo的仿真時(shí)鐘真機(jī)時(shí)要設(shè)為false使用系統(tǒng)時(shí)鐘。這個(gè)參數(shù)如果忘記切換最典型的癥狀是MoveIt規(guī)劃正常但執(zhí)行時(shí)卡住不動(dòng)或者機(jī)器人收到一串零速度指令。4.3 真機(jī)調(diào)試的安全流程真機(jī)和仿真最大的不同就是一旦出錯(cuò)代價(jià)很高。我的經(jīng)驗(yàn)是分四步走首先在示教器上把工具速度限制設(shè)到最低例如10%。然后把ROS側(cè)的max_velocity_scaling_factor設(shè)為0.05到0.1先做單臂小范圍往復(fù)運(yùn)動(dòng)確認(rèn)關(guān)節(jié)方向和驅(qū)動(dòng)反饋一致。第二步用MoveIt在RViz里規(guī)劃一條非常簡(jiǎn)單的軌跡比如從home點(diǎn)到旁邊10厘米的位置。發(fā)送執(zhí)行觀察真實(shí)機(jī)械臂的移動(dòng)方向是否與RViz中的預(yù)演完全一致。UR10的關(guān)節(jié)方向和URDF模型默認(rèn)是匹配的但如果你改過(guò)零點(diǎn)或者安裝方向這一步最容易發(fā)現(xiàn)偏差。第三步再測(cè)試雙臂低速聯(lián)動(dòng)。先讓左臂從home點(diǎn)運(yùn)動(dòng)到目標(biāo)位右臂原地不動(dòng)驗(yàn)證對(duì)側(cè)臂作為障礙物時(shí)不會(huì)產(chǎn)生誤報(bào)。然后讓右臂運(yùn)動(dòng)左臂不動(dòng)。最后才讓雙臂同時(shí)運(yùn)動(dòng)。第四步準(zhǔn)備緊急停止。UR10示教器上的紅色急停按鈕是最后防線同時(shí)我還在工控機(jī)上監(jiān)聽(tīng)機(jī)器人的safety_mode話(huà)題如果進(jìn)入保護(hù)性停止立刻發(fā)送停止軌跡指令。4.4 網(wǎng)絡(luò)延遲和實(shí)時(shí)性注意事項(xiàng)真實(shí)UR10的控制方式并不像仿真那樣每個(gè)關(guān)節(jié)直接接受位置指令而是通過(guò)UR控制器內(nèi)部進(jìn)行平滑和速度規(guī)劃。因此ROS側(cè)發(fā)過(guò)來(lái)的軌跡到了機(jī)器人端肯定會(huì)有一小段緩沖。網(wǎng)絡(luò)延遲主要體現(xiàn)在幾個(gè)地方指令傳輸延遲、狀態(tài)反饋延遲、dashboard命令延遲。如果發(fā)現(xiàn)真實(shí)機(jī)器人執(zhí)行軌跡時(shí)“一頓一頓”優(yōu)先排查網(wǎng)絡(luò)。我用有線直連時(shí)ping延時(shí)通常小于1毫秒非常穩(wěn)定。如果用無(wú)線網(wǎng)絡(luò)經(jīng)常出現(xiàn)幾十毫秒甚至幾百毫秒的抖動(dòng)這時(shí)候機(jī)器人很容易進(jìn)入保護(hù)停。如果是路由器轉(zhuǎn)發(fā)也建議關(guān)閉其他帶寬占用較大的服務(wù)。在代碼層面我給FollowJointTrajectory客戶(hù)端設(shè)置了執(zhí)行超時(shí)檢查。如果5秒內(nèi)沒(méi)有收到執(zhí)行結(jié)果反饋就自動(dòng)取消軌跡并報(bào)警。這個(gè)保護(hù)在實(shí)際產(chǎn)線上非常重要因?yàn)镸oveIt的plan()只能保證規(guī)劃成功不能保證底層真的執(zhí)行完畢。5. 源碼組織和文檔應(yīng)該怎么寫(xiě)5.1 包結(jié)構(gòu)劃分一個(gè)好的雙臂項(xiàng)目源碼不應(yīng)該把所有l(wèi)aunch和腳本塞到一個(gè)包里。我最終交付的源代碼按功能拆成了五個(gè)包dual_ur10_description雙UR10的URDF/xacro、左右臂模型、底座和夾爪模型。dual_ur10_gazeboGazebo世界文件、控制器配置、PID參數(shù)、仿真launch。dual_ur10_moveit_configMoveIt配置、SRDF、OMPL規(guī)劃配置、controllers.yaml。dual_ur10_bringup頂層入口launch支持sim/real切換。dual_ur10_tasks雙臂任務(wù)調(diào)度節(jié)點(diǎn)、腳本、狀態(tài)機(jī)、服務(wù)定義。這樣劃分的好處是改仿真設(shè)置不會(huì)影響真機(jī)配置改運(yùn)動(dòng)規(guī)劃參數(shù)不影響任務(wù)邏輯。項(xiàng)目維護(hù)起來(lái)非常清晰多人協(xié)作也不會(huì)互相覆蓋文件。5.2 頂層啟動(dòng)流程和參數(shù)傳遞我寫(xiě)了一個(gè)總?cè)肟趌aunch用sim參數(shù)區(qū)分模式roslaunch dual_ur10_bringup main.launch sim:true roslaunch dual_ur10_bringup main.launch sim:false內(nèi)部啟動(dòng)順序大致是先啟動(dòng)機(jī)械臂驅(qū)動(dòng)Gazebo spawn或ur_robot_driver再啟動(dòng)robot_state_publisher然后啟動(dòng)MoveIt最后啟動(dòng)雙臂任務(wù)節(jié)點(diǎn)。順序不能亂尤其是MoveIt啟動(dòng)時(shí)如果讀不到robot_description會(huì)直接退出。我給每個(gè)節(jié)點(diǎn)加respawntrue這樣某個(gè)節(jié)點(diǎn)崩潰后能快速重啟。在文檔里一定要寫(xiě)清楚如何檢查每一層是否啟動(dòng)成功。例如看/joint_states是否有數(shù)據(jù)???tf里是否存在左右臂各自的TF樹(shù)??碝oveIt的RViz插件是否正常加載機(jī)器人模型。用rosnode list確認(rèn)move_group節(jié)點(diǎn)都在運(yùn)行。5.3 文檔說(shuō)明的要點(diǎn)文檔并不是簡(jiǎn)單貼幾個(gè)命令而是要讓人拿到源碼后能順利跑起來(lái)。我的項(xiàng)目文檔包含以下幾塊環(huán)境依賴(lài)清單Ubuntu 20.04、ROS Noetic、Gazebo 11、MoveIt、ur_robot_driver、moveit_commander、catkin。編譯步驟catkin_make或catkin build以及哪些包需要額外安裝。快速啟動(dòng)先仿真后真機(jī)的兩條完整命令。雙機(jī)械臂任務(wù)說(shuō)明每個(gè)任務(wù)節(jié)點(diǎn)的功能、依賴(lài)的topic和service、可調(diào)參數(shù)。常見(jiàn)問(wèn)題表例如Gazebo啟動(dòng)后機(jī)械臂下墜、MoveIt執(zhí)行時(shí)找不到控制器、真機(jī)連接失敗等都列出排查思路。文檔中的常見(jiàn)問(wèn)題表我建議采用如下結(jié)構(gòu)癥狀可能原因解決方法Gazebo中機(jī)械臂劇烈抖動(dòng)PID參數(shù)不合適降低P提高DMoveIt執(zhí)行軌跡無(wú)反應(yīng)控制器名字不匹配檢查controllers.yaml真機(jī)連接失敗機(jī)器人程序未啟動(dòng)External Control檢查URCap和程序節(jié)點(diǎn)雙臂規(guī)劃時(shí)碰撞檢測(cè)失效對(duì)側(cè)臂未加入planning scene檢查協(xié)調(diào)節(jié)點(diǎn)的joint_states訂閱6. 實(shí)測(cè)中避不開(kāi)的坑6.1 TF樹(shù)和命名空間的坑這是第一次在RViz里看到兩臺(tái)機(jī)械臂時(shí)最容易出問(wèn)題的地方。癥狀是兩臺(tái)臂重疊在一起或者關(guān)節(jié)位置亂跳。原因基本是URDF中左右臂沒(méi)有統(tǒng)一加前綴。如果左臂的某個(gè)link仍叫base_link而右臂也叫base_linkTF樹(shù)里會(huì)出現(xiàn)兩個(gè)名字相同的linkRViz只能隨機(jī)顯示一個(gè)看起來(lái)就像模型“穿越”了。解決方法是加前綴后用check_urdf或直接打開(kāi)生成的URDF文件搜索每一個(gè)link name和joint name確保左臂相關(guān)名字都帶left_右臂帶right_。一旦有漏網(wǎng)之魚(yú)立刻修。不要指望只靠robot_state_publisher來(lái)區(qū)分。6.2 仿真的抖動(dòng)和過(guò)沖Gazebo里的機(jī)械臂抖動(dòng)大多數(shù)不是模型問(wèn)題而是控制器參數(shù)問(wèn)題。UR10關(guān)節(jié)的力矩相對(duì)較大如果PID的P值過(guò)高系統(tǒng)容易震蕩如果D值太小又會(huì)出現(xiàn)到位后反復(fù)搖擺。我從單臂調(diào)起先把所有關(guān)節(jié)P設(shè)為20D設(shè)為0.2確定系統(tǒng)穩(wěn)定后再逐漸增大P直到軌跡跟蹤精度滿(mǎn)足需求。最后測(cè)試下來(lái)腕部關(guān)節(jié)因?yàn)閼T性小P和D可以比大臂關(guān)節(jié)更低。另一個(gè)細(xì)節(jié)是Gazebo的仿真步長(zhǎng)。默認(rèn)步長(zhǎng)1000Hz對(duì)多關(guān)節(jié)雙臂來(lái)說(shuō)計(jì)算壓力很大如果電腦性能不夠可以把max_step_size設(shè)為0.002秒但步長(zhǎng)太大反而更易造成抖動(dòng)。我的建議是先保持0.001秒調(diào)好控制器后再考慮提高性能。6.3 真機(jī)與仿真不一致的問(wèn)題有一類(lèi)問(wèn)題在仿真里幾乎發(fā)現(xiàn)不了UR10的關(guān)節(jié)零點(diǎn)偏移和方向定義。雖然官方URDF和真實(shí)機(jī)器人一致但在長(zhǎng)期使用后機(jī)器人零點(diǎn)可能需要重新標(biāo)定。實(shí)際跑真機(jī)之前我建議在示教器上先手動(dòng)把每個(gè)關(guān)節(jié)轉(zhuǎn)到0度附近再對(duì)比ROS里讀到的/joint_states確認(rèn)關(guān)節(jié)序號(hào)和方向?qū)?yīng)關(guān)系。另外真實(shí)環(huán)境中不能完全依賴(lài)MoveIt的規(guī)劃場(chǎng)景。仿真里桌面的尺寸是已知的但真實(shí)環(huán)境可能有線纜、物料堆、圍欄等物體。我后來(lái)在真實(shí)工作臺(tái)上加了一個(gè)靜態(tài)點(diǎn)云發(fā)布節(jié)點(diǎn)把深度相機(jī)數(shù)據(jù)轉(zhuǎn)成OccupancyMap再疊加進(jìn)PlanningScene這樣MoveIt才能有效地避開(kāi)地面雜散物體。6.4 效率優(yōu)化和后續(xù)擴(kuò)展仿真和真機(jī)都跑通之后項(xiàng)目才算真正可用。再往后擴(kuò)展的話(huà)有幾個(gè)方向比較有價(jià)值第一加入視覺(jué)引導(dǎo)。用ArUco碼或者3D點(diǎn)云獲取工件目標(biāo)位姿讓雙臂根據(jù)視覺(jué)結(jié)果動(dòng)態(tài)調(diào)整抓取點(diǎn)。這比固定位姿更貼近產(chǎn)線。第二加入力控或?qū)Ъ{控制。UR10的末端如果要做裝配、打磨這類(lèi)接觸任務(wù)純位置控制不夠??梢栽谀┒搜b六維力傳感器通過(guò)force_torque_sensor_controller把力反饋接入ROS。第三遷移到ROS2。如果你要長(zhǎng)期維護(hù)這套系統(tǒng)ROS2的節(jié)點(diǎn)生命周期和通信機(jī)制更適合分布式部署。不過(guò)需要把MoveIt2、gazebo_ros2、ur_robot_driver的ROS2版本全部對(duì)齊工作量不小。我個(gè)人在實(shí)際使用中的體會(huì)是雙機(jī)械臂項(xiàng)目的成敗一半在規(guī)劃算法另一半在工程細(xì)節(jié)。如果你只是想在仿真里玩做到這里已經(jīng)算完整但如果要落地到真實(shí)設(shè)備建議先把仿真里的成功率跑到95%以上并把安全鏈路全部測(cè)通再碰真機(jī)。最后再分享一個(gè)小技巧不管代碼寫(xiě)得有多順手每次改完模型或控制器參數(shù)都先讓機(jī)械臂在home點(diǎn)附近做一次低速循環(huán)測(cè)試確認(rèn)關(guān)節(jié)狀態(tài)、TF樹(shù)和控制指令都沒(méi)有異常再進(jìn)行正式任務(wù)。這個(gè)習(xí)慣能幫你擋掉很多莫名其妙的“炸機(jī)”問(wèn)題。本文還有配套的精品資源點(diǎn)擊獲取
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
无遮羞AV| 婷婷六月丁香激情综合| 91碰免费视频| 五月婷婷色色| 亚洲男女激情| 免费婷婷| 色五月涩涩婷婷| 婷婷成人综合免费视频| 久久99精品九九久久久婷婷| 五月花激情网| 色狠狠色狠狠| 天堂A∨在线| 色伦专区97中文字幕| 五月婷婷 激情五月| 婷婷久久亚洲| 久久久久久9| 爱iii做iiii日| 91久热| 亚洲性爱日韩无码| 桃色激情婷婷伊人网| 五月激情婷婷国产精品久久久久久| www.久久综合| 991精品在线视频| 九日日夜夜69| 色天使久久综合| 日本三级大片| 五月综合久久| 亚洲V国产V欧美V久久久久久| 久久婷婷五月丁香网| 五月丁香花婷婷玉莉AV| 天天日日夜夜| WWW.夜夜| 天天色激情| 九九色99| www激情网站| 99这里只有精品| 丁香五月天AV| 香蕉人在线香蕉人在线 | 五月丁香激情四射| 99资源在线视频| 丁香六月婷婷激情| 92久操视频| 精品久9| 99国产精品白浆在线观看免费| 国产免费AV网站| 天天爽,夜夜爽| 天天摸天天日天天舔| 亚洲色情激情丁香五月| 色婷婷香蕉丁丁网| 综合久久丁香婷婷,五月婷婷六月丁香,开心激情综合网,六月丁香在线观看,婷婷丁 | 激情六月一二| 天天综合天综合| 91日韩在线| 久久精品视频在这里有| 色天堂操| 在线视频你懂得| 99黄色在线视频精品熟女| 97久操视频| 99热在线播放精品| 婷婷五月中文字幕| 综合色色婷婷| 国产激情视频在线观看| 五月停停激情网| 开心五月深爱五月婷| 五月婷色色| 亚洲视频五区| 一區四區歐美日韓| 亚洲色色香蕉| 欧日韩成人| 色五月在线观看| 超碰人人艹| 色综合九九| 一起草AV| 伊人网色婷婷五月天| AV大片在线播放| 亚洲无码性爱| 丁香六月婷婷综合激情欧美| 开心 五月 综合| 九九色影院| 五月天婷婷影院| 久久久人妻| 国产AV一区二区三区最新精品| AAA级久久久精品| 婷婷WWW久久| 五月丁香最新| 狠狠色婷婷7| www.99热这里只有精品| 夜色综合网| 国产成人网站在线观看| 五月天婷婷无码| 综合五月天天天天天五月| 日韩AAA| 丁香五月天激情免费在线观看AV777 | www.99情趣网| 色偷偷综合| 淫五月停停| 99在线视频女女视频| 成人版视频在线观看| 五月天色色网站| 丁香五月婷婷久久久| 99色综合| 激情综合色婷婷啪啪六月天| 婷婷综合网站| 大香蕉五月天婷婷丁香91| 亚洲综合网区| 婷婷五月天激情网| 午夜丁香六月婷| 色五月婷婷激情综合网| 亚洲第一成人无码A片| 91九色成人原创视频| 色婷成人狠干| 婷婷久久色五月婷婷久久久| 亚洲美女高潮久久久久久69| 久久视频在线| 嫩草AV久久伊人妇女超级A| 超91热| 色婷婷9| 夜夜骑日日夜夜| 五月天com| 99精品综合| 99热最新地址在线| xx人人xx| 久草九九| 涩涩涩五月天| 婷婷日韩| 天天摸天天日天天舔| 五月天大香蕉| 五月丁香婷中文| 99热这里只有精品搜| 五月婷婷婷婷网| 99热在线成人网站| 91天天操天天干天天射| 日韩久热| 九九综合色综合| 五月天网站免费欧美| 在线看片av| 日韩无码亚欧无码| 97丁香花五月天激情小说| 婷婷五月深爱五月| 日本V在线观看不卡视频网站| 五月婷婷综合久久| 综合99视频| 五月丁香婷婷伊人| 五月丁香六月婷婷免费| 五月大香蕉| 丁香五月影视| 欧美精产国品一二三区| 97婷婷狠狠久久综合9色| 99热久久这里只有精品| 久久综合激情| 激情无码五月天| WWW.17C亚洲精品| 激情玖玖综合网| 97涩涩丁香五月天| 欧美成人在线观看| 色播五月综合网| 丁香五月激情图片婷婷| 思思热视频| 人操91在线| 逼里香不卡| www色哟哟| 久久婷婷五月天激情唯美| 久久婷婷五月综合色区| 激情五月天影院| 91九色成人原创视频| 97色视频网| 26uuu欧美亚洲日韩| 久久久中文| 天天做天天爱高潮片| 丁香婷婷色色| 色婷婷影院| 五月丁香亚洲综合| 国产片天天爽夜夜爽| 久久婷狠狠色| 丁香五月天激情网址| 超碰1999| 国产小网站| 97色97干| 激情五月综亚网| 丁香花社区av| 欧洲亚洲午夜| 99热国内| 天堂亚洲 在线| 五月停停色色丁香| 亚洲mm色| 久久婷婷东京热大香樵| 婷婷六月天激情| 天天综合久久| 日韩aaaaa| 久久99这里| www.婷婷| 亚洲综合丁香五月天| 九一牛视频探花| 婷婷五月激情在线视频| 五月婷婷色播| 激情五月婷婷| 播五月丁香六月| 超碰97色| 国产激情视频在线观看| 色五月婷婷内射| 中文字幕97超级碰| 亚洲一二三网| 天天做天天爽| 97色久| 激情网五夜婷婷| www.色欲丁香婷婷| 99ri视频| 亚洲情a| 色综合视频在线| 婷婷丁香小说| 色五月开心婷婷| 99热热热99精品婷婷| 99热久| 91丨九色丨熟女| 久久久婷婷| 乱女乱妇熟女熟妇综合网站| 一区=区操屄高清大全av| 久久99网| 国产欧美婷婷五月| 国产精品久久在线观看技巧| 五月天大香蕉婷| 操一操干一干| 中文激情网| 天天五月情| 色五月激情视频在线综合| 激情色五月天| 精品成人无码A片观看香草视频| 日本天堂免费99| 亚洲 无码 中文字幕 中出| 久re热视频| 午夜无码熟熟妇丰满人妻| 九九99九九99| 久久99热这里只频精品6学生| 俺五月| 亚洲激情婷婷| 色婷婷综合综合网| 91精产品自偷自偷综合| 久久视频这里有精品99| 亚洲色就是色色色| 9+1视频网址| 久久丁香五月婷| 婷婷激情综合色五月久久,色婷婷丁香花,丁香婷婷五月情天,久久婷婷五月综合色 | 97久人人| 九九热啪啪| www.色情五月天.com| 少妇人妻丰满做爰XXX| 人妻中文在线| 激情婷婷六月天| 99日本在线| 激情五月天小说|五月天开心激情网|亚洲精品国产自在现线|黄色五月天 | 婷香五月激情视频| 五月婷婷激情| 人妻丰满精品一区二区A片| 久久久婷| 国产精品色色| 三年高清大片免费观看国语| 久久久久久五月天| 免费观看高清无码| 欧美色色色色色色| 婷婷五月丁香综合| Se.婷婷五月天| 天天色天天搡| 五月天亚洲最大成人| 色婷婷XXXXX| 婷婷五月综合在线| 婷婷深爱五月天在线| 欧美日韩大黄| 六月色国内综合| 五月丁香六月婷婷在线播放| 久久综合9| 五月丁香成人版| 久热69| 亚洲AVDVD| 色五月婷婷影院| 日本人人干| 伊久久婷婷| 成人版视频在线观看| 青青草轻轻操| 5月婷婷视频网站综合| 色播五月婷婷综合| 婷婷五月天偷拍| 小视频久久久aaa| 五月婷婷深深爱| 秋霞AV淫| 无码 av电影| 香蕉曰比| 色人久久| 五月婷婷激情四月| www色色色com| 久久婷婷七月丁香| 人人性久久| 欧美性爱五月天| 色婷婷五月天视频网站| 99免费| 专区无日本视频高清8| 色色网站毛片| -91九色大屁股| 思思视频这里是精品| 色情激情五月| 91热在线| 日韩国产AV播放| 啪啪婷婷五月天激情| 99ri在线观看视频| 六月丁香婷婷综合色播| 五月丁香六月婷婷亚洲激情综合| 国色天香伊人狠狠色| 思思re视频在线| 日日做夜夜爱| 丁香五月成人| 成人短视频在线观看| 91超碰在线观看| 丁香五月另类色婷婷麻豆| 26uuu丁香婷婷五月| 婷婷久久丁香五月| 日本va欧美va国产激情| 六月婷综合| 超碰99热在线观看| 97中文在线| 思思热闹这里只有精品| 婷婷五月激情欧美大胆视频| 免费视频99| 99操无码视频观看| 色五月激情五月| 婷婷五月天 丁香五月天 裸体| 日本三级99人妇网站| 亚洲色区17| 久婷婷五月综合欧美| 啊V视频在线观看| 九九热av| 日韩国产在线精品| 99热精品中文字幕| www.日本91| 综合色五月天| 在线中文AV| 综合99在线| 97视频.干com| 狠狠色噜噜狠狠狠888了| 五月色色激情网| 91碰| 五月综合激情久久| 综激情网| 亚洲性爱区无码区| 亚洲久久激情| 色婷五月天| 欧美精品中文字幕亚洲专区| 在线日韩视频| 91黄址| 秋霞免费视频| 99久久www| yazhou seshipin| 天天插插天天| 色婷网| 碰人人97| 五月情婷婷五月| 夜夜躁爽日日| 日本啪啪网| 99免费超碰在线| 五月天日日操夜夜操| 婷婷五月中文在线视频| 日韩婷久| 六月丁香网| 老师把我爽高潮了免费A片| 五月天激情视频五月天| 五月丁香综合久久夜夜| 五月天激情视频| 在线播放成人| 久草a片| 婷婷丁香综合| 久久婷婷国产| 丁香五月色色色色| 人人插操| 婷婷深爱五月丁香| 9久热免费视频99| 久热AA| 久久婷婷91| 丝袜激情网| 伊人色综合影院视频| 久久综合影院| 另类色视频| 天天插天天干| 婷婷激情丁五月| 丁香五月激情综合久久| 九月色婷婷综合| 噜噜操操| 九九热精品视频在线观看| 天天色伊人| 日本综合99| se99视频| 色综合网上班开心婷婷久久| 激情五月婷婷视频| 亚洲激情综合| 五月天婷五月天综合网小说首页-五月天激激婷婷大综合,婷婷亚洲综合五月天小说 | 婷婷综合激情| 青草青草久热这里只有精品| 99久久国产宗和精品1上映| 怡红院精品视频久久久久久久久| 大香蕉免费9| 五月丁香六月色| 丁香五月婷婷丫| 99热在线极品极品| 久婷五月| 色综合色综合网| 色婷婷操逼网| 婷婷五月天激情网| 五月天伊人久久久久| 五月丁香六月色婷婷综合五月天| 99热最新国内| 26uuu精品一区二区| 五月天婷婷丁香蜜桃91| 97九色视频| 久久丁香五月天| 26uuu另类亚洲欧美日本一| 久久婷婷五月激情综合| 色五月婷婷狠狠撸| 激情碰碰碰| 91久久久久久久久久久| 噜噜久| 99re热视频这里只有综合亚洲| 精品夜夜澡人妻无码AV| 五月丁香亭亭操逼| 99视频只有这里精品| 性爱网五月天| 91色欲综合| 久久久久人妻精品| 国产午夜精品一区二区| 五月丁香狠狠| 人人人人人人人人人草| 色综合丁香| 婷婷五月开心六月AV| 99re6久热只有精品6在线直播| 国精产品一区二区三区| 婷婷激情五月天在线视频| 日韩无码乱轮| 婷婷丁香无码专区| AA片在线观看视频在线播放| av人人干| www久久99| 人。妻久久| 丁香婷婷色情社区成人小说| 丁香五月欧美婷婷| 欧美精产国品一二三区| 五月网激情| 欧类av怡春院| 亚洲无码色| 久久多色| 国产AV一区二区三区最新精品| 狠狠色激情综合| 激情综合网激情五月俺也去| 激情开心五月天| 色域五月婷婷丁香| 久久在线视频免费观看| www.com五月天| 狠狠爱婷婷爱| 免费观看欧美成人AA片爱我多深| 丁香六月亭亭久久综合| wwxx日本| 久久这里只有精品1| 亚洲av无码精品色午夜| 久热黄色| 国产亚洲精品久久久久久久久动漫| αv中文字幕在线观| 婷婷五月丁香色播| 色的色综合| 99精品网| 97人妻超级碰碰碰碰碰| 色婷婷婷婷| 婷婷五月天com| 五月天激情久久| 91狠狠综合久久久| 丁香婷婷色情| 激情五月六月丁香| 色吧五月| 99综合成人视频在线观看| 9+1视频网址| 操人妻视频91| 午夜不卡久久精品无码免费 | 激情五月五月五月婷婷| 六月婷婷色综合| 久久婷婷综合五月| 久久er免费视频| 五月丁香六月婷婷在线观看| 三人荫蒂添的好舒服A片| 日韩无码91| 日日干综合| 久色激情| 九九九九中文字幕| 丁香五月天婷婷中文| 九月激情综合| 婷婷综合伊人| 婷婷五月天少妇| 丁香五月首页| yw.av| 欧美激情五月综合| 丁香五月色色| 色婷婷很很丝袜| 9+1视频网址| 久久er99| 五月天成人手机在线视频| 99综合自拍| 国产va在线视频| 91超级碰在线视频| 狠狠色大香蕉| 91av色色乱视频| 五月丁香六月日逼| 日日夜夜天天综合| 久99视频在线观看| 五月婷婷九| 五月丁香狠狠爱婷婷综合| 91操色| 综合伊人狠狠| 欧美久草在线日本一级特黄大片做受9在线观看韩国电影《两个女人》未删减-毛片 | 精品一区二区三区三区| 婷婷五月天国产传媒| 五月激情啪啪啪| 狠狠狠狠狠狠| 丁香五月成人社区| 婷婷五月亚洲一本在线丁香| 五月丁香综合网| 极品人妻VIDEOSSS人妻| 欧美激情 日韩无码 婷婷 五月天 久久婷婷丁香五月一二三 | 狠狠色97| 97色天堂| 五月丁香成人网| 97色色网| 国产白丝在线一区| 婷婷色导航| 天天干天天干天天操| 99ri网站在线观看| 丁香五月综合亚洲| 天天爽曰日爽| 色五月婷婷成人视频| 五月天婷婷爱| 97色啪| 色婷婷亚洲在线观看| 五月激情综合深爱| 91人人网| 棕合影院色色| 7777激情基地| 亚洲小视频免费播放| 五月丁香啪啪综合| 五月色婷婷影院| 日本乱论99| 婷婷五月天中文字幕| αV电影| 免费日本aⅴ中文字幕| 五月丁香狠狠爱婷婷综合| 超极99精品| 在线免费视频caop| 婷婷丁香先锋资源网站| 偷偷操99| 五月丁香| 色五月婷婷五月久久| ji'qing'luan'ren'lun| www.五月丁香av| 97色色色色色| 伊人久久大香蕉网| 1024日韩| 91综合视频丁香| 爱狠射| 日本97在线| 99日在线视频| 亚洲综合另类| 激情婷婷五月社区| 午夜丁香五月天综合| 欧美性生交XXXXX无码小说| 国产干逼片| 日韩综合成人| 热热99爱爱| 亚洲成人网在线观看| 99热r| 无码中文一区二区三区| 九九色综合九九色| av中文在线| 激情五月伊人婷婷| 色丁香久久| 色婷婷久久久| 激情网五月天| 99热综合在线观看| 丁香美女主播视频在线观看| 色域五月婷婷丁香| 国产偷人爽久久久久久老妇APP| 五月天婷婷色综合| 亚洲精品视频在线播放| 中文字幕性爱丰满| ww久久| 丰满女老板BD高清A片| site:jszngf.com| 激情小说五月天| 久久久色婷婷五月天| 亚州美女| 夜夜操天天爽| 国产无人区大片| 日本欧美在线| 最新激情五月天| 9久精品| 大香蕉av在线| 国产.亚洲.欧洲视频在线| 思思99精品视频在线观看| 精品久久久人妻| 丁香五月天视频| 9 1 A v久久久| 天天色综合天天| 六月综合在线| 26.uuu丁香五月婷婷| 激情中文在线| 久久久久久人妻| 五月婷婷综合潮喷| 99re视频在线播放| 韩日另类| 久草性爱| 热久久66| 超碰人人射| 国产AV一区二区三区最新精品| 毛片毛片毛片毛片| 婷婷丁香五月综合| 久久婷婷五月综合网| 色~性~乱~伦~噜| 婷婷 激情 五月| 色月丁| 色色热| 欧美日本va| 久久久久久欧美精品se一二三四| 亚洲欧美综合7777色亭亭| 国产色网站| 成人色情五月天婷婷丁香| 婷婷久久婷婷| 99热国内| 91人碰| 欧美顶级少妇做爰HD| 色欲午夜无码久久久久久张津瑜| 狠狠狠人妻| 亚洲婷婷婷| av大片在线| 国产91视频| 深爱婷婷丁香五月激情| 婷婷五月欧美综合| 色五月天丁香| www.9797国产| 99惹 精品在线| 婷婷五月天激情网| 丁香婷婷六月天| 色婷婷九月| 色五月涩涩婷婷蜜桃| 国产色网站| tingtingseav| 9国产在线视频| 天天爽天天| 综激情网| 超碰资源在线| 亚洲久久激情| 思思久久99热只有频精品66| 九九视频精品在线免费| 五月丁香爱婷婷深深| 狠狠99| 99人人干人人操| 99年操人人爽| 97在线观看| 亚洲色色色| 任你爽视频| 91九色熟女| 91精品久久久久、久五月天| 婷婷五月天美女视频| 色五月天综合| 六月丁香婷婷网| 777久久精品| 五月色视频| 久久久中文| 色色色色色色色色五月先| 超碰精品国产首页| 色播激情| 亚洲人成网站999综合| 无码激情AAAAA片-区区| BBWCUCKOLD精品熟妇| 俺去也综合| 99热色精品| 久久丁香五月婷婷| 青青草激情网| 九九性爱网| 五月婷综合| 啪啪六月婷婷| 99热这里只有精品2| 婷婷五月久久| 婷婷五月激情在线| www,五月天激情| 五月丁香六月欧美综合| 琪琪理论片| 婷婷五月天成人五月天| 色玖玖综合网| 久久亚洲婷婷| 91在线日| 丁香五月Av| 激情五月天在线视频| 二色av| 婷婷99狠狠躁天天躁| 少妇高潮A片无套内谢麻豆传| 亚洲综合另类| 激情综合丁香| 大香蕉久久婷婷精品综合| 色欲影香| 啪啪色激情五月天| 狠狠看狠狠| 亚洲精品乱码久久久久99| 丁香狠狠| 丁香六月婷婷综合啪啪| 99热只有| 亚洲人妻AV| 婷婷综合中文| 日韩精品一品二区三区的使用体验| www.97干视频| 国产99美少妇| 五月综合777| 激情五月www| 天天日 天天草| 99热这里只有精品青草| 免费视频WWW在线观看网站| 爱iii做iiii日日| 97丁香五月| 色色网站观看| 五月第四色| 天天干 夜夜爽| 欧美性生交XXXXX无码小说| 久久免费试看120秒| 99热18| 三级大香蕉网| 97香蕉久久超级碰碰高清版| 疯狂做受XXXX高潮A片| AV网在线观看| 99ri精品| 婷婷五月天综合色| 天天草天天爽| 青青久久五月| 五月色色网| 五月丁香久久丝袜啪啪| 久久女人天堂| www.婷婷久久五月天| www.五月天色色.com| 九九久久99| 97在线/亚洲| 成人五月丁香花| 久久五月天视频| 天天爽天天透天天爱| 97久久人人| 色五月激情图片| 成人做爰A片免费看网站找不到了| 五月丁香六月婷婷亚洲视频| 激情四射五月天| 国精产品久久| 色婷婷五月天在线观看| 色婷婷综合在线| 思思久久精品视频| 天天爱综合网| 久久人妻超碰一区| 欧美情月伍月天| 婷婷中文字幕| Aaa久久| 精品无码色| 五月丁香大相交| 亚洲AV无码电影| 天天AV导航网| 青青草成人网| 91精产一区三区免费观看| 狠狠色综合五月| AV九九| 色色操| 婷婷五月综合久久中文字幕| 日本黄色精品| 久久五月激情| 九月婷婷在线视频| 丁香女人五月天| 激情婷婷久久| 99热超碰天堂网| 色婷亚洲| 成人在线二区| 嫩草综合网| 久久这里只有精品99| 美女爆乳18禁www久久久久久| 色综久久AV| 97狠狠色| 一区二区乱码视频| 只有久久精品免费| 午夜69成人做爰视频| 九九这里是免费的视频5| 五月天综合在线观看| 国产又爽又猛又粗的视频A片| 五月丁香婷婷爱激情综合网| 亚洲综合99| 九九色影视| 五月丁香香蕉| 开心婷婷中文字慕| 五月综合色| 丁香女人五月天| 精品夜夜澡人妻无码AV| 高清无码 一区 二区 三区| 最近中文字幕2019视频1| 99热在线里有精品| 狠狠噪| 天天撸天天干天天插| 69精品无码一区二区三区| 九九热免费| 99热国产婷婷| 日本色图综合| 伊人丁香六月婷婷| 国产古装妇女野外A片| 九玖欧洲亚洲| 欧美碰碰碰| 97影院一级片| 五月综合久久| 色天堂婷婷| 色综合天天网| 99色在线观看视频者| 伊人色综在线| 五月婷婷婷| 9久久久久久久久久久| 色婷婷基地| 九九无码| 五月六月激情| 9999综合99综合人| 玖玖热视频| 久青操| 久久er99热精品一区二区| 天天摸.天天mo| 日韩综合成人| 欧美黄色韩日网| 91色涩| 深爱五月天| 五月丁香狠狠| 五月丁香 啪啪| 激情婷婷丁香| 丁香五月婷在线观看| 欧美网站视频4399| 丁香婷婷激情| 草逼大片| 五月天第四色开心色播| 亚洲正能量欧美| 久久东京热婷婷五月| 亚洲 日韩色色| 色色色天堂网| 五月丁香六月激情在线| 欧美成人五月天| 99九九精品视频| 999热在线观看视频| 激情综合五月天| 翔田千里aV中文字幕| 婷婷丁香91| 久久人妻精品| 婷婷丁香九月| 日韩色情亚洲五月天婷婷| 97色片| 国产毛片操B| 亚洲五月天婷婷| 日日.c| 五月丁香六月婷婷亚洲激情综合| 丁香五月网| 色综色网| 五月婷六月| 99无吗| 激情色播| 国精产品一区二区三区| 日本啪啪天堂| 婷婷不卡基地| 久久久99精品免费观看| 日韩黄色电影| 逼里香不卡| 五月色导航| 久久九九爽| 色婷婷啪啪| 久久人妻少妇嫩草AV| 日本久久99| 99热首页| 婷婷婷婷色| 深爱女色婷婷丁香五月亚洲图区| 婷婷伊人75| 婷久久高清| 成人无码精品1区2区3区免费看| 久久精品人妻| 亚洲五月天婷婷综合| 日本色婷婷综合| 色婷婷精品视频在线播放| 色偷偷AV亚洲男人的天堂| 久久综合干| 日日爽夜夜爽| 乱轮A片| 色婷婷4| 91天天操天天干天天射| 亚洲有码在线视频| 97色一二三| 欧美情色电影一区二区| 人人爱操| 狠狠综合| 婷婷丁香五月激情| 九月丁香婷婷综合| 五月天狠狠| 丁香丝袜五月| 丁香五月天啪啪激情综合网| 99区视频| 操操操操操操婷婷五月天| 久久99网址| 影音先锋91| 五月婷婷色色网址| 色原狠狠综合| 亚洲丁香五冃97色| 超碰婷婷色| 色呦精品| 成人做爰黄A片免费看直播室男男| 亚洲精品白浆高清久久久久久| 99啪啪视频| 激情色色| 丁香婷婷色五月| 超碰在线99| 99热久久这里只有精品| 成人综合网站| 99re资源在线视频导航| 久久综合五月天激情小说网站 | 色九九七七| 综合99久久天天综合| 92国产福利| 色三级色三级| 久激情网| 五月丁香婷色| 人人舔天天| 五月婷婷综合在线视频小说| 丁香六月婷婷色XXXXX| 99国产在线| 久久久久久久97| 日本久久精品| 天天综合精品| www,婷婷,com| 成人一区在线观看| 91色久| 狠狠狠狠免费| 六月丁香综合| 婷婷五月激情欧美| 99色在线| 丁香五月婷婷综合啪啪| 久久久久五月丁香| 久久五月综合| ji'qing'luan'ren'lun| 久久 视频这里只有精总| 成人丁香婷婷| 色综合丁香| 120分钟婬片免费看| 久久精品凹凸分类| 人妻久热| 综合激情五月综合激情五月激情1| 操嫩逼电影| 思思久久99| 99综合| 大香伊人久色| 久久婷婷热| 天天干肏夜夜| 67194中文字幕| 丁香久久| 99热观看| 99在线观看视频精品| 色欲AV导航| 我爱大香蕉| 操操操97| 国产性爱一级| 婷婷五月综合在线视频| 99热只有| 丁香五月激情图片婷婷| 99riAV国产精品视频| 激情五月综合ì香亚洲| 97操碰碰无码视频| 免费超碰在线观看| 狠狠干五月天婷婷网| 婷婷六月激情啪啪| 激情六月天| 大香蕉在线99热| 啊v视频在线观看| 五月亚洲| 国产精产国品一二三在观看| 91大屁股精品| 免费视频这里只有精品| 99热这里有精品| 97人人操人人操人人操人人| 97干在线| 久久五月天婷婷| 狠狠狠狠狠| 香蕉视频91| 亚洲人妻五月丁香婷婷| www.狠狠| 日韩在线99| 99热免| 激情五月婷婷| 中文字幕成人| 五月天综合激情网| 婷婷福利影院| 婷婷色5月天在线。| 日本高清综合网五月丁香| 99色在线| site:hcxsz888.com| 五月丁香六月激情在线| 艹B高清无码| 99人妻碰碰碰久久久久禁片| 婷婷五月天第三页| 91久久精品国产91性色TV| 五月婷婷激情网| 色婷婷久久综合久色综| 丁香五月 性爱| 六月五月久久丁香| 开心五月婷婷| 91chinese在线| 成人网址在线观看| wWW九九在线播放| 五月天激情国产综合婷婷| 在线看的免费网站| 久婷婷| 丁香婷婷五月天激情四射| www.com.色色| 六月丁香社区| 日韩五月婷婷| 亚洲99视频| 丰满老熟妇BBBBB搡BBB| 欧洲婷婷五月天| 婷婷成人五月天成人文学| 综合网色| 激情四射婷婷| 99久re热| 成人网址在线观看| 五月丁香婷婷色色色| 久久视频婷婷| YJLZZJLZZ亚洲乱熟无码| 99re热在线视频观看| 色蜜婷婷| 色五月影视| 亚洲韩国日产综合AV| 色色综合色| 丁香婷婷婷婷十二月在线观看视频| 日本在线噜噜| 成人免费视频一区| 久狠狠狠| 91色在线| 在线中文字幕av| A片一曲| 人妻久久久久久久| 激情五月婷婷免费视频| 亚洲色五月| 只有精品在线观看| 三男玩一女三A片| 五月色天五月色| 69热91天堂| 一级二级色大片| 色久九| 99爱精品| 丁香婷婷五月六月天| 伊综合蕉| 99男人的天堂| 26uuu视频欧美| 99网| 天天爽天天干| 色综合综合色| 99在线精品观看99| 亚洲第一精品成人999久久精品| 久久综合网桃花| 五月久久婷婷| 婷婷五月天99| 亚洲妇女熟BBW| 国产色五月| 91久久久久久久久| 精品人妻伦一二三区久| 天天色天天色天天色天天色天天色| 91久久久久久久久久| 99操视频| www.色擼擼.com| 新激情婷婷| 成人网在线视频| 亚洲婷婷丁香五月亚洲| 五月婷婷丁香91| 丁香在线视频| 五月婷婷天天色| 丁香五月激情啪啪综合| 精品99视频| 美女激情婷婷| 91精品又长又大又粗又爽又猛| 亚洲欧美丁香五月天亚洲欧美| 欧美久草在线日本一级特黄大片做受9在线观看韩国电影《两个女人》未删减-毛片 | 色插综合网| 亚洲天堂制| 婷婷91| 五月丁香六月婷综合成人综合| 亚洲成人网在线观看| 国产露脸150部国语对白| 欧美Va日本Va| 亚州视频九九99| 91啪啪网| 丁香婷婷九月在线| 99久热| 久久这里只| 婷婷色女| 色狠狠综合网| 亚洲AV久久久久久久久久久久久久久久| 色婷婷婷婷| 婷婷五月视屏| 26uuu.| 六月婷婷色色色| 婷婷视频网| 亚洲婷婷五月天| 99色热视频| 成人在线精品| 超碰成人在线免费观看| 亚洲精品字幕在线观看| 婷婷狠狠18禁久久| 久久人妻在线| 99成人网站| 天天搡日日搡aaaaⅩ| 久久婷婷五月天丁香| 五月婷婷深深爱| 久久免费操| 99热综合网| 亚洲人人操BD| 五月天婷五月天综合网在线观| 一逼色综合| www:99热视频| 丁香五月婷中字在线| 狠狠精品干练久久久无码中文字幕| 99riAV国产精品视频| 天天色综合图片| 99热的无码| www.久久五月天.com| 九九色热| 五月丁香中文婷婷中文| 丁香六月天婷婷色| 黄色AV日韩| 激情网五月天| 亚洲mm色| 婷婷在线视频| 午夜色婷婷| 丁香五月中文字幕| 激情图片99| AVV黄| 五月丁香久久婷| 丁香,开心成人,久久| 超碰人妻公开在线| WWW.桔色成人.COM| www超碰| 色婷婷激情| 狠狠干婷婷| 成人在线精品| 婷婷欧美激情综合| 人妻少妇色综合| 丁香五月天堂网| 色五月婷婷很很操| 九九在线这里只有精品视频| 激情综合丁香五月| 色色COm| 五月婷视屏在线观看| 婷婷丁香18| 丁香五月婷婷AV在线| 六月丁香婷婷六月激情综合| 五月久久亚洲| 欧美久久婷婷| 全国最新疫情| 五月丁香色婷婷基地| 婷婷丁香五月天小说| 婷婷五月天免费| 色婷婷丁香五月综合| 深爱激情五月网| 超碰99资源站| 九九热啪啪| 狠狠操狠狠| 99久久精品免费精品国产_国产精品久久久久久_国产在线|日韩_久久国产精品电影 | 色情网综合| 91九色视频| 久久婷五月| 六月成人网| 色五月色开心开心五月| 99ri国产精品| 国产91视频| 激情综合网,五月| 婷婷丁香人妻| 激情婷婷网| www色五月| 久久久99精品免费观看| 99cao婷婷| 色天堂在线| 亚洲成人色五月天| 人妻videos人妻高清| 五月天停停成人网| 亚洲综合五月天婷婷丁香| 99久久九九| 男女啪啪视频久 9| 91人人操.COM| 婷婷六月激情丁香| 婷婷开心激情| 久久久婷| 五月色情精品| 色婷婷狠狠| 激情综合五月婷| 婷婷精品性性性性性性性| 婷婷丁香成人| 国产暴力强伦轩1区二区小说| 亚洲9久久精品| 99精品久久| 五月青青草综合| 九九色视频| www九九| 亚洲av另类在线观看| 成人版视频在线观看| 久久这里只有精彩| 男人的天堂五月丁香| 另类 在线| 无码人妻丰满熟妇奶水区码| 六月婷婷青青青视频| 婷婷五月天成人娱乐| 丁香久久久| 国产成人+综合亚洲+天堂| 少妇搡BBBB搡BBB搡毛茸茸| 中文字幕婷婷在线| 狠狠操天天操天天操| 操骚货在线| 大地9中文在线观看免费高清| 久久综合五月婷婷| 五月丁香婷婷激情久久| 日本一级特黄大片AAAAA级| 极品少妇高潮啪啪AV无码| 五月丁香好婷婷A片网| 五月丁香色婷| 色婷婷久久| 色婷婷文字幕| 丁香五月天啪啪激情综和网| 午夜丁香| 国模狼狼| 久久这里只有国产| 五月天婷婷色综合| 欧美大肥婆大肥BBBBB| 精典久久| 国精产品久久| 婷婷五月丁香五月| 99狠狠操一| 日日射天天射| 天天做天天爱天天爽| 五月丁香色婷基地综合久久| 另类综合国产| 俺去也婷婷| 久九色| 丁香婷婷伊人| 96自拍视频九色在线观看| 激情小说五月丁香在线视频观看视频| 五月婷导航| www九九| 超碰激情五月| 99久热在线精品| 久久精彩视频| 婷婷五月激情片| 丁香激情五月少妇| av在线免费播放| 91热er| 九九久久久综合| 久9热| 婷婷五月天激情在线观看 | 五月丁香色色色| 色九亚洲| 这里只有精9| 67194中文在线| 色老久久| 黄色99网| 超碰不卡在线| 色色综合网站| 五月天婷婷色播| 99ri在线播放| 国产肥白大熟妇BBBB视频| 五月丁香六月婷婷国产视频| 91婷婷丁香| 老司机视频lsj爱就色| 五月天色社区|