欧美成人午夜精品久久久,国产?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久久久久天天| 久久九九99| 九九色综合| 激情图片婷婷| 狠狠综合久久| 久久超级碰视频| 色色婷婷五月| 狠狠操狠狠爱| 久久久久这里只有精品| 丁香五月激情六月综合| 久久狠狠高潮亚洲精品 天天摸夜夜摸夜夜狠狠摸| 中字幕视频在线永久在线观看免费| 婷婷五月婷| 激情视频网址| 色情婷| 五月色亭丁香| 大香蕉欧美在线| 五月天综合婷婷| 五月丁香六月婷综合成人综合| 色播五月婷婷| 五月天丁香综合在线| 五月亭亭六月天| 麻豆WWWCOM内射软件| 五月丁香久久激情网| 久9热视频在线| 99热99热不卡| 二色AV| 99热91| 丁香五月综合久久八| 国产成人精品一区二三区熟女在线| 六月婷婷网站| 色色色婷婷五月| 思思热精品在线| 五月丁香天天| 91久久五月天| 久久综合五月| 丁香九月色| 欧洲第一久色| 久久精典| 操97在线观看| 亚洲AV成人精品日韩在线播放| 婷婷欧美偷拍综合| 婷婷丁香婷婷97| 欧美色五月| 掩去也综合五月视频| 亚洲乱码日产精品BD| 欧美综合激情五月天| 九九激情视频| 色婷婷影视| 天天射综合网夜夜操| 另类国产区| 九九热视频99| 情婷婷五月天在线| Www.狠狠| 99久久99综合| 色婷婷成人| 狠狠操天天操天天操| 在线亚洲综合网| 激情伊人| 五月天开心婷婷激情网站| 99九色视频在线观看| 99成人| 九九久久网| 日日干天天射| 色九综合| www婷婷| 日本熟女内射| 五月丁香怕怕综合| 曰曰久久| 久久国产AV| 丁香五月影院| 色久综合| 噜噜噜噜噜色| 懂色av粉嫩av蜜臀av| 热99AV网站| 97自拍视频在线| 久超免费视频| 丰满人妻妇伦又伦精品国产| 色婷婷五月天偷拍| 亚洲综合草草| 丁香婷婷五月| 激情五月天婷婷视频| 亚洲 视频 导航 一区| 狠狠精品干练久久久无码中文字幕 | 激情五月婷婷丁香六月| 六月婷婷九月丁香| 9999综合99综合人| 内射 无码 伊人| www.婷婷| 91狠狠综合久久久| 免费亚洲婷婷中文字幕| 五月婷婷六月丁香在线视频免费在线观看| 国模淫穴色图| 先锋av性爱成人电影| 啪啪激情综合| 美女激情综合| 一起草无码| 婷婷操无码| 婷婷色婷婷| 婷婷五月天国产| 色色色色色色97| 蜜桃婷婷五月| 色五月开心婷婷| 成人婷99最新| 五月婷婷导航| 人人爱摸视频| 激情五月天小说|五月天开心激情网|亚洲精品国产自在现线|黄色五月天 | 人人叉久| 99综合成人视频在线观看| 久草热久草在线视频| 午夜免费试看| 五月婷婷影| 99色在线视频| 第五色婷婷| 日日婷婷不卡| 欧美性爱特黄一级aaaassss| 狠狠色婷婷丁香六月| 99精品激情| 五月天婷婷免费| 亚洲电影中文字幕| 9色免费网| 亚洲亚洲人成综合网络| 疯狂做受XXXX高潮A片| 99这里只有精| 亚洲黄色影视| 久久无码成人| 久久免费高| 国产伦亲子伦亲子视频观看| 欧美性爱丁香五月| 婷婷综合干| 人妻视频一区而且二区| .comwww在线观看免费操| 欧州婷婷五月天综合| 超碰av在线| 综合久久99| 色色丁香| 狠狠插狠狠| 美臀自射自家人妻| 丁香六月婷婷色XXXX| 亚洲乱码成人| Www,五月天| 五月丁香六月婷婷亚洲视频| 激情婷婷六月天| 五月丁香六月婷婷色日| 激情五月丁香六月综合AVXXXX| 六月婷婷开心| 亚洲色网址| 天天爽天天日| 97久久超碰| 亚洲成人五月天| 97色婷| 26uuu最新地址| 色久九| 亚洲欧美婷婷五月色综合| www.99热视频| 久久精品国产AV一区二区三区 | 中文字幕日产A片在线看| 少妇真实被内射视频三四区| 久久天堂女人| 影音先锋噜一噜| 性韩日色婷婷五月天激情啪啪XXX| 日日噜人人人做人| 无码人妻一区二区三区免费九色| 色婷婷六月| 激情中文在线| 另类图片五月天| 色优久久| 五月丁香综合影院| 五月丁香怕怕综合| 五月天,激情四射,婷婷频道| 久色网址| 色色三级视频| 香蕉综合在线| 99久久综合| 中文字幕不卡网站| 五月丁香色情| 五月宗合激情网| 成人va视频| 丁香婷婷五月综合色情| 国产在线网| 综合久久综合综合| 99色这里| 婷婷香五月天| 久草热在线视频| 六月婷婷毛片| 99精品视频免费观看| 99热99艹在线观看| www.久9| 狠狠色97| 五月丁香啪啪啪免费看| 九九性视频| 天天色天天操天天射| 超碰久热| 五月天丁香欧美激情| 亚洲第一黄网| 五月丁香婷婷开心| 99亚洲精品视频| 婷婷99狠狠躁天天久久久九九九| 黄色片精品| 色婷婷婷婷成人网| 婷婷午夜综合| 偷拍九九热| 九九色色色| 婷婷六月爽| 92久操视频| 久激情网| 激情五月天色婷婷综合| 五月天激情图片| 久草热8精品视频在线观看| 亚洲第一av| 99这里是99在线视频| 操日挥操日日| 欧美电影在线观看| 丁香六月啪| 日日日影院| 99热精品在线| 秋霞av不能| 婷婷五月天色丁香| 在线中文字幕视频| 玖玖婷婷色| 天天狠狠插| 99超级碰碰| 亚洲成人AV电影在线| 狼人婷婷综合| 能直接看的av网站| 香蕉影院色| 婷婷久久五月天| 婷婷伊人网| 99热国品| 狠狠88综合久久久久噜噜噜| 六月丁香激情网| 91日综合欧美| 色婷婷丁香香香蕉视频| 国产日产亚系列精品版优势| 九九亚洲视频| 伊人久久婷| 丁香五月激情啪啪啪| 五月天婷婷自拍图片在线观看| 婷婷五月丁香五月| 91丨九色熟女丨首页| 99爱免费在线视频| 亚洲九N| 五月天婷婷色五月天| 色偷偷综合| 男人大jjc女人免费视频| 秋霞免费三级片| 高清无码网址| 久久婷婷五月激情综合| 丁香五月激情婷婷婷婷在线观看| 色五月色情| 99色看| 久久九九99| 永久无码色| 五月停停色色丁香| 亚州操逼网| 激情五月天小说|五月天开心激情网|亚洲精品国产自在现线|黄色五月天 | 天天噜噜| 9色免费网| 久久在这里有精品| 亚洲V国产V欧美V久久久久久| 五月久久五月激情| 久久久久人妻| 久久只有精品| 国产乱妇无乱码大黄AA片| 草草视频91| 色碰碰视频| 991精品在线视频| 欧美激情综合五月色丁香| 人碰人人人玩91| 色综合久久伊伊婷婷五月| 婷婷五月天丁香花| 久久婷婷五月天激情| 日本不卡一区二区三区| 色综合综合网| 久久女人九九| 丁香婷婷六月| 五月丁香成人| 色五月六月| 亚州精品色情无码A片| 九九操操| 亚洲99激情| 婷婷另类小说| 五月色丁香婷婷中文字幕| 51精品国自产在线| 久久这里只| 热久久婷婷| 中文av网| 五月婷婷色播| 色色色色色网| 97婷婷丁香五月| 欧美成人AAA片一区国产精品| 国产一区男女| 超级碰91| 在线99热| 亚洲五月天综合| 日本视频不卡123区| 色婷五月| 99ri视频在线观看| 亚洲色婷婷| 中文字幕丰满乱孑伦无码专区| 久久激情视频| 99热无码| 五月天天综合| 色婷婷六月天| 色丁香影院| 日本人人干| av中文在线| 丁香六月天婷婷色| 激情五月色综合网| 激情五月丁香五月| 丁香六月视频免费观看| 91精品久久久久久久久久久久| 色色色综合色| 久久激情五月| 97久久综合网| 热久久91| 99性爱精品| 久操干| 亚洲色另类| 婷婷六月激情啪啪| 欧美日韩国产一区| 免费无码毛片一区二区A片| 欧洲免费视频色| 9久久精品视频| 色五月网址| 狠狠另类视频| 99热 在线播放| 婷婷综合五月| 热99久久这里只有精品| 久久婷婷色情7777网站| 日本久久激情| 婷婷伊人五月天| 99热这里只有精品33| 日本操片| 无码99| 亚洲九九99精品视频在线播放| 97成人超碰免| 亚洲激情久久| 日本啪啪网| 五月丁香 久久久| 9 1在线视频| 五月天婷婷激情小说电影| 五月激情婷婷播播网| 五月婷婷黄色毛片| 2018国产大陆天天弄| 这里只有精品免费| 婷婷成人丁香色情基地30| 国产综合A片| 99这里只有| 五月丁香久久丝袜啪啪| www.天天干.com| 亚洲av另类在线观看| 激情婷婷| 婷婷五月丁香在线视频| 久久一二三视频| 狠狠爱综合网| 九色激情网| 青草视频在线播放| www.久久| 五月丁香好婷婷A片网| 久热这里只有精品99re,久热这里只有精品7 | 五月婷婷视频在线观看| va婷婷在线| 色你久久| 婷婷激情综合色五月久久91| 无码一区精品一区视频| 天天色天天| 九九在线精点品| 亚洲AV激情五月综合网| 五月丁香激情综合| 98永久精品| 久久五月婷婷综合网| 欧美激情综合| 伦乱天堂| 激情爱爱网站| 人人草人人爱| 五月天狠狠网| 色五XX| 伊人五月久久| 嫩草综合网| 亚洲综合九九| 操日视频| 日本乱论99| 亚洲操女| 色婷婷五月综合激情中文字幕| 天天综合色| 大香蕉伊人99| 中文字幕不卡+婷婷五月| 日本成人噜噜| 久色国产| 天堂婷婷丁香六月网| 久久人妻熟女一区二区| 天天爽夜夜操| 色五月婷婷五月| 色噜噜狠狠色综合网| 开心色五月天久久久久久久| 这里只有精品网站| 丁香婷婷中文字幕| 女人天堂 AV| 婷婷开心综合人妻小说网址| 午夜电影网VA内射| 99色看| 四色 爱 婷婷 精品 亚洲 五月天| 人妻狠狠操| 超碰超碰在线| 久久五月婷| 超碰在线人人| 99视频精品| 第四色激情网| 色婷婷五月影视| 成人电影在线免费试看| 日韩成人av在线| www.99热视频| 丁香激情五月| 五月丁香无码| 九九精品热| 六月综合婷婷开心伊人| 天天狠天天叉| 久久人人妻| 色色色色综合网| 欧美色婷婷| 婷婷午夜| 岛国AAAV| 99碰在线视频| 日本色99| 一夜福利不卡| 五月天色婷婷图片| 久久人妻视步| 在线观看欧美| 色婷婷婷婷| 色婷婷狠狠| 五月天激情婷婷| 免费看欧美成人A片无码| 亚洲熟妇AV乱码在线观看| 亚洲亚洲人成综合网络| 色婷婷精品视频在线播放| 香蕉五月婷婷| 99色干| 九九热在线亚洲免费视频| 大香蕉啪啪啪| 五月丁香青草综合啪啪| 五月丁香婷婷导航视频| 欧美丁香婷婷五月| 超碰色热| 久热中文字幕| 第六色在线| 五月六月伦理| 天天天天天天操| 99久久国产宗和精品1上映| WWW色色色COM| 丁香九月综合激情| 亚洲开心激情网| 欧美久久婷婷| 国产精品成人AV在线| 狠狠色狠狠操| 无语停婷丁香网| 午夜九九九九九九九九九九九九九| 久久日本wwww色| 婷婷射图五月天| 丁香五月花婷婷开心| 少妇久久诱惑视频| 极品另类| 人妻体体内射精一区二区 | AVDV久久| 91丨九色丨国产打屁股| 在线综合亚洲欧美65| 国产熟女大叫受不了| 日本激情ⅩXX免费视频| 国产成人99久久亚洲综合精品| www.色婷婷.com| 99色综合| 五月激情射| 亚洲精品99| 色青青视频| 久久hd| 五月婷婷六月丁香| 国产亚洲色婷婷久久99精品91 www.riverspirits.org www.hnnun.com www.changh | 婷婷久久精品| 色婷婷丁香网| 26UUU精品一区二区| 婷婷丁香18| 欧美色必爱| 久久一伦| 综合久久丁香婷婷,五月婷婷六月丁香,开心激情综合网,六月丁香在线观看,婷婷丁 | 久久婷婷六月综合| 97婷婷在线| 一根材五月婷成人| 91超碰九色| 伊人激情综合| 久月丁香爱婷婷综合| 五月天天爱| 狠狠色噜噜狠狠狠狠综合| avh片在线观看| 五月丁香婷婷色色色| 五月天婷婷基地综合网| 狠狠色 综合色区| 国产99热| 色综合偷拍| 婷婷五月天va| 色欲色香综合网| 91人人爽人人操| 免费精品66| 91碰在线| www.91在线看| 99爱在线视频观看| 无码AV免费精品一区二区三区| 成人婷婷| 99激情视频| 亚洲午夜成人av电影网| 99色色网| 操人91| 高清无码视频网址| 九九热视频精品999| 久久久思思热| 欧美婷婷丁香五月社区| 久9热插入| 春色激情第四色| 夜夜爽天天爽| av在线免费网站| 99re这里只有精品在线观看| 桃色成人网| 99视频内射三四| 综合一区二区三区| 欧美婷婷丁香五月| 老司机伊人| 日韩限制级大尺度黑料泄密大尺度视频一区二区在线观看 | 在线观看av网站| www.国产色| WWW色五月| 91欧美日韩综合| 26UUU精品一区二区| 五月激情婷婷偷拍| 秋霞影音91人妻久久| 激情五月天社区| 97热这里精品在线视频| 天天综合五月| 婷婷人人操| 天天做天天爱天天高潮| 香蕉伊人综合| 婷婷免费视频| 欧美啪啪网| 五月色色激情网| 激情综合丁香| 欧美日本va| 抽插特写| 五月综合无码| 超碰网站在线观看| 五月激情影院| av无码电影| 99性爱| 婷婷色情五月| 婷婷99中文字幕| 五月激情六月丁香| 狠狠 久久| 婷婷五月亚洲一本在线丁香| 精品九九网| 日本五月婷婷| 婷婷丁香九色| 思思热99在线视频| 这里只有精品96| 九九婷婷五月天影视| www九九热| 色色色综合视频| 午夜大香蕉| 亚洲顶级VA在线观看-高清完整版在线影院观看-S022AV | 在线视频另类| 国产91视频| 69热在线| 内射干少妇亚洲69XXX| 色婷婷深爱五月| AV中文网| 久久久久丁香婷婷五月天| Aα在线免费观看| 色爱综合网| 综合网色| 婷婷五月色| 六月丁香深深爱| 五月伊人91| www五月天com| 色综合天堂| 婷婷伊人综合中文字幕| 婷婷丁香77777| 婷色影院| 啪啪小说五月天| CAOBIBI| 久久色区| 婷婷色日本| 蜜乳久AV| 九九热在线视频| 色婷婷99| 亚洲无码99| 婷婷综合在线观看视频| 亚洲免费av观看| 婷婷久久五月| 婷婷狠狠五月综合| 超碰人人操| 色综合色五月| 久久婷婷五月综合色播| 丁香五月婷婷99| 五月叮香啪| 777丁香六月青青草婷婷综合久月| 色亭亭九月| 任你日视频| 婷婷爱综合| 午夜福利8055| 亚洲天堂热| 人人爽人人射-美女久久久久久久久久-成人AV| 五月婷三级片| 另类专区在线观看| 成人色色视频| www九九热| 九九性视频| 超碰1999| 99无码免费视频| 91VIP在线观看| 亚洲第一第二网站| 国产亚洲精久久久久| 色婷婷操逼| 婷婷综合仓库中文| 超碰在线国产| se99视频| 这里只有精品日韩精品| 久久久久久18| 天天插天天插| www.9797国产| 婷婷五月天激情五月天网站| 九九热欧美| 99色爱| 99热99美国在线观看| 伊人国产婷婷五月天| 熟女网站久久| 日本美女97在线视频| 欧美在线视频99| 久久婷婷五月综合色区| 久久婷婷啪啪视频| 色停停五月天| 另类图片五月天婷婷| 色色五月婷婷久久| 成人亚洲精品久久久久| 婷婷五月大香蕉| 日日干综合| 亚洲最大在线| 奇米网大香蕉| 玖久久网站| 五月婷婷成人| 99亚州综合精品成人网| 婷婷五月婷婷五月天| 色播五月丁香| www.日韩国产| 9久操| 丁香五月欧美婷婷综合| 色婷婷免费观看| 欧州色色| 性生活久久人妻| 国产伊人五月天| 91精品人妻少妇无码影院| 国内精品免费一区二区2009| 青青草国产亚洲精品久久| 九九热99热| 久久综合影院| 九九無妻| 久久婷婷成人综合色怡春院| 久久这里有精品在线观看| 婷婷久久五月天亚洲欧美国产日韩在线观看| 丁香五月婷婷av| 色五月综合97| 色丁香五月婷婷综合久久| 99年操人人爽| 亚洲妇女熟BBW| 色色国产| 中文字幕在线免费观看视频| 婷婷六月丁| 狼友视频在线观看18| 久热这里只有| 五月丁香成人视频| 五月天啪啪| 夜夜综合色| 色婷五月天网站| 五月天婷婷激情干干| www.夜夜操.con| 天天操中文字幕| 五月丁香激情综合啪啪| 欧美日韩成人在线网站| 影音先锋男士资源网一区| 六月丁花香啪啪激情欧美| 99久久国产宗和精品1上映| 99国产精品久久久久久久久久久| 人妻丰满精品一区二区A片| 五月综合久久| 国产精品18久久久| 中文字幕乱码亚洲精品一区| 色情综合| 国产欧美熟妇另类久久久| 久草热8精品视频在线观看| www.99色| 中国女人做爰A片| 99国产精品久久久久久久久久久| 国精产品一区一区三区免费视频| 五月天综合在线网| 97se在线视频| 久久宗合影| 六月婷婷香蕉| 五月激情啪啪啪| 草综合网| 婷婷丁香五月激情图片| 色偷偷狠狠| 婷婷五月天美女视频| 丁香五月婷久久| 人人色婷婷| 亚洲色五月| 色停停香蕉视频| site:pnnrt.com| 疯狂做受XXXX高潮A片| 一二线视频 另类| 97涩婷婷婷婷基地| 综合色网站| 五月香婷婷| 狠狠色丁香久久久婷| 亚洲精品操一操、噜一噜、摸一摸、爽 | 成人毛片在线免费观看| 丁香花色色网| 情五月亚洲婷婷| 日韩一区二区三区无码| av五月天婷婷丁香| 91干在线| 色五月婷婷丁香国产在线| 激情五月婷婷中文字幕| 国产毛片精品一区二区色欲黄A片| 激情网五月天| 久久久久这里只有精品| 亚洲视频在线观看| 久热在线观看视频9| 97色色婷婷五月天| 人妻性爱| 婷婷五月天激情网站| 天天碰夜夜爽| 久久xxxx| 久热伊人91| 97五月久久丁香婷婷| 久久婷婷六月| 婷婷涩五月天综合| 五月婷婷天堂| 最近中文字幕2019视频1| 六月婷婷最新网址| 五月激情五月丁香| 日日夜夜小色哥| ww久久| 久久久国产精品黄毛片| 狠狠99| 天天综合精品| 婷婷五月天第三页| 97色色色| 日本综合99| 日良久久| 99热99re6国产在线播放| 久久9精品| 亚洲狠狠色丁香婷婷综合久久| 丁香婷婷五月综合| 午夜性爱影视一区77| h亚洲| 欧美性色A片免费免费观看的 | 色色色色色色网站| 91/九色黑人| 婷婷五月天堂网| 99视频精品8| 中文字幕av在线| 久久久av久av久片一区二区| 玖玖爱伊人| 思思热99在线视频| 色情五月丁香| 亚洲殴洲精品Av在线| 狠狠色丁香五月婷巨| 亚洲成人在线五月天| 五月天激情综合网| 天天综合 99久久婷婷| 五月天激情AAAA| AA久久| 婷婷五月综合社区在线| 好吊操这里只有精品| 六月色婷婷| 江苏少妇性BBB搡BBB爽爽爽| 免费黄色视频网址| 国产婷婷五月在线视频| 99热在线观看| 99小视频| 亚欧州精品视频| 超级碰 久久9| 丁香五月天殴美激情| 色综合久久久久| 97久久久免费福利网址| www激情网| 激情综合久久| 91在线日| 天天综合中文| 久久婷婷免费| 婷婷五月色花丁香社区| 中文字幕在线免费| 9热在线视频| 五月婷六月丁| 色综合婷婷| AAA久久| 五月天婷婷乱论小说| 亚洲春色奇米影视| 天天天久久久| 丁香婷婷视频在线| 成人亚洲精品久久久久| 综合欧美五月婷婷| 欧美综合五月丁香六月婷| 99re在线免费视频| 骚货艹网站视频| 亚洲亚洲人成综合网络| 五月天色婷好好| 91丨九色丨大屁股| 亚洲操精品| 俺去也五月天| 色五月婷婷天堂| 日日操天天| 亚洲欧洲另类图片| 久久久久婷婷五月热综合| 4399亚洲视频| 黄色五月婷| www激情com| 三日本无码| AV美美午夜| 丁香六月婷婷综合| 综合五月草| 婷婷五月影院| 无码九九| 九九热免费| 色色吧综合| 九九精品99| 91碰碰视频| AV在线免费网站| 五月天久久www| 色色五月婷婷久久| www.久久爱.com| 超碰9| 亚洲人妻Av| 91人操| 玖玖无码中文| 99热免费精品| 久久综合激情五月天| 淫视馆aV二区一区| 激情五月天色| 久久性视频| 五月停停直播| 国产成人精品123区免费视频| 成人五月天在线视频在线观看| 中文字幕人妻熟女在线| 五月丁香色婷婷基地| 96丁香婷婷九月蜜桃综合久久| 激情六月丁香综合| 嫩草AV久久伊人妇女超级A| 久久婷婷五月丁香| 狠狠色综合久久久久| 亚亚州久久高潮| 91超级碰在线| 91狠狠综合久久| 久久er免费视频| 国产毛片精品一区二区色欲黄A片| 99热欧| 激情五月婷婷| 婷婷激情丁五月| 中文字幕高清av| 免费视频无码| 人妻中文在线| 最近中文字幕2019视频1| 六月丁香好婷婷| 玖玖热99| 色色色干| 激情五月天噢美| www.久99| 色色五月天网站| 六月色婷婷欧美| 亚洲中文AV| 亚洲操精品| 六月婷婷五月丁香首页| 综合色、色综合| 操骚货在线| 99精品热| 91日本在线观看| 丁香五月婷婷在线视频| 99毛片| 五月丁香狠狠爱| 亚洲夜夜操| 91九色国产熟女| 99九九久久| 2025年最新亚洲在线欧美| www.97碰碰com| 国产一区二区三区影院| 五月丁香花婷婷玉莉AV| 玖玖婷婷婷丁香五月| 九九激情| 五月丁香亚洲婷婷| 中文字幕成人| 婷婷五月天免费99| 综激情网| 五月婷婷无码专区| 情色婷婷五月天| 第四色在线观看| 天天插天天插| www·五月天| 国产成人在线不卡AV| 九九热在线视频| 欧美黄色韩日网| 美女五月激情| www,色综合| 五月天激情网站| 热99.com婷婷| 五月天亭亭俺也| 洗浴中心操B视频| 亚洲AV人人操| 日本三级第一页| 婷婷五月天丁香| 婷婷五月18永久免费视频| 亚洲AV成人在线| 97久久精品视频| 色婷婷综合网站| 99视频| 蜜乳A√| 激情久久五月天| 婷婷情色五月| 久热9| 五月丁香六月综合基地| 91丨熟女丨首页| 五月丁香婷婷啪啪综合| 精品一二三区久久AAA片| 色欲久久久久久综合网综合网| 99久久思思| 国产精品汇聚精彩第二页 - 高清完整版在线 - 青蛙AV | www.日日日.com| 激情五月综合久久| 久99久视频精品| 激情综合五月天| 五月天婷婷AV| 五月丁香无码| 99热20| 五月天久久www| 超碰永久在线| 丰满少妇乱A片无码| 老司机伊人| 丁香五月婷婷五月天| 思思99精品视频在线观看| 热久久这里只有精品| 色人五月婷婷| 激情五月天久久丁香| 在线看黄色| 亚洲图色五月天| 超碰日韩成人| 超碰v| 久久99精品九九久久久婷婷| 99re热在线视频观看| va亚洲中文在线| 综合五月亭亭9| 婷婷爱在线观看| 色五月天堂| 久久99看免费| 九月色婷婷综合| 色婷婷AV久久| 99cao婷婷| 最近中文字幕在线中文视频| 五月婷婷深深爱| 碰97久久| 丁香婷婷色情| 91激情五月开心| 色五月婷婷小说亚洲中文字幕组| 开心色五月天久久久久久久| 五月天婷婷五月| 成 久久| 丁香五月综合图片在线观看| oumeisesewang| 天天 青草 制服丝袜 在线| 婷婷啪啪| 天天爽人人综合免费7799| 激情爱爱网站| 天堂资源欧日浪女在线播放| 色播播婷婷| 五月丁香网站| 欧美性久| 久久精典| 丁香大香蕉| 婷婷在线视频| 99热精品在线| 少妇丁香婷婷| 伊人婷婷青青cao| 久久久久久久综合狠狠综合| 狠狠操天天操| 玖玖伦理电影| 丁香久久五月天视频在线观看 | a色色片| 国产激情久久| 3pAV| 婷婷五月开心中文字幕在线| 在线超碰免费| 日韩AC在线免费观看| 久久婷鲁| 97五月天婷婷综合激情网| 五月丁香综合影院| 欧美色色色色色色色| 99操碰| 五月天快乐开心激情网| 五月丁香六月色婷| va婷婷在线| 天天操夜夜爽| 99国产视频网| 五月婷婷与六月丁香图片激情| 超碰成人在线观看| 丁香五月性| 极品少妇XXXX精品少妇偷拍| 在线不卡AC| 99啪啪骑| 91久久综合亚洲鲁鲁五月天| 五月天天丁香婷婷在线中| 五月激情综合婷婷| 激情综合网五月激情| 天天日夜夜爽| 很很干天天干| 青草青草视频2免费观看| 五月婷婷久久网| 五月婷婷七月丁香| 中文字幕 码精品视频网站| 综合网激情五月天| 色爱终和网| 丁香狠狠色婷婷| 综合久久99| 色婷青青| 91丨九色丨老农村| 四色综合网| 狠狠人人| 五月丁香香蕉| 思思99热| 天天色中文字幕女优AV| 亚洲免费观看高清完整版AV线| 丁香五月婷婷基地| 开心五月深爱五月婷| 日本人人xxx| 五月婷婷六月丁香在线| 伊人婷婷福利网| 色综合狠狠色| 99热久只有| 99操逼| 26uuu成人网| 五月婷A V在线| 99视频35精品视频在线观看| 天天色伊人| 开心五月网| 91久久久久久| 殴美97色| 日韩色色小视频| 五月综合色播播丁香婷婷| 久热9| av婷婷丁香| 久久久WWW| 天天色综合网吨吧| 啪啪婷婷五月天激情| 久久精品一区二区三区四区| HD久久精品视频| 99热九九这里只有精品10| 日日操日日撸| 久99| 大香蕉久久婷婷精品综合| 五月丁香六月婷婷啪啪综合| 五月天婷婷在线播放| 九九碰九九爱97超碰| 国产高潮白浆一区二区| 日日夜夜狠狠婷婷色| 俺也去在线视频| 99碰碰| 百度4399有码精品V在线观看| 丁香五月婷婷姐| 成人综合视频在线| 国产欧美精品AAAAAA片| 国产精品成人AV在线| 欧美噜一噜| 99无码视频| 人妻激情久久| 日韩色色网| www.婷婷六月天| 中文字幕精品无码一区二区| 九九久久99精品免费观看www| 久久草婷婷丁香网站| 中文字幕在线观看视频www| 色丁香五月婷婷综合久久| 激情深爱综合| 五月激情婷婷综合| www.ywav| 噜色精品| 很很干天天干| 日本黄色精品| 六月色国内综合| 五月天开心激情综合网| 丁香婷婷性久久| 日日夜夜天天爽| 99色色网| 爽极品色| 国产综合网在线| 怎么样可以看免费的一级av| 丁香色五月婷婷17C| 色婷久久| 激情国产五月| 婷婷丁香五月天欧美| 六月丁香激情网| 日韩成人电影在线播放| 五月天六月婷婷电影| 国产精品久久久爽爽爽麻豆色哟哟| 色综合色五月| 狠狠爱婷婷丁香| 日本情色一区二区| 日本噜噜色网| 开心五月色婷婷综合开心网| 激情九月婷婷| 8区视频在线| 亚洲顶级VA在线观看-高清完整版在线影院观看-S022AV | 欧美S码亚洲码精品M码| 天天 青草 制服丝袜 在线 | 在线观看欧美| 欧美性爱五月天| 超碰人人摸AV| 五月丁香六月花| 精品一二三区久久AAA片| 五月天色导航婷婷资源婷婷| 粉嫩av蜜桃av蜜臀av| 超级碰碰视频无码| 欧美va在线| 色综合视频在线| 久热这里只有精品66| 亚洲精品一区中文字幕乱码| 久久人妻久久久久| 九九色热| www,色婷婷| 97视频.干com| 婷婷色啪| 激情五月天综合网| 超碰爱爱爱| 亚洲无码99| 婷婷性爱综合| 五月激情六月丁香| 亚洲AV久久久久久久久久久久久久久久 | 亭亭五月丁香五月天激情| 狠狠操天天干| 丁香五月天婷婷91| 六月丁香深深爱| 五月色天情| 国产精品久久久久久久久久免费| 一本久久亚洲五月婷婷| 九九热超碰| 欧美激情xxxXX| 少妇搡BBBB搡BBB搡毛茸茸| 人妻内射麻豆视频| 国产免费性爱| 丁香五月中文字幕久色| 五月婷婷伊| 激情五月天电影| 蜜乳AV成人| 久热这里| 丁香激情久久| 超碰狠狠操| 久久亚洲无码| site:picc-up.com| 狼人婷婷综合| 五月婷婷 自拍| 六月婷婷七月丁香| 亚洲操逼网| 九九99热久久精品66中文字幕| 人人视频色| 日本99久久| 狠狠爱综合| 婷婷六月天激情| 色玖玖玖| 婷婷五月电影| 噜噜噜噜综合在线| 粉嫩AV久久一区二区三区| 综合婷婷| 色婷婷基地| 中文字幕网站在线观看| 五月开行婷婷色五月| 五月婷婷99热| 六月婷婷香蕉| 99这里只有精品视频| 99丁香婷婷综合网| 日韩一区二区三区无码| 人人操AV| Av九九| www.五月丁香| wWW九九在线播放| 亚洲欧美一区二区三区四区爱爱动图| 色哟呦av| 五月欧美色色五月| 丁香五月天社区| 狠狠色丁香综合| 久久人妻视频| 亚洲天堂热| 可以免费观看的AV| 在线你懂的亚洲欧| 色五月天电影| 色婷婷视频综合| 97人人操人人| 国产做爰视频免费播放| 婷婷五月天成人小说| 97福利视频| 99国产精品久久久久久久久久久 | 五月丁香婷婷综合网色欲| 久久99看免费| 婷婷久久综合| 五月丁香六月婷婷综合网缴情| AV网站免费在线| 国外亚洲成AV人片在线观看| 五月丁香在线看| 日本高清久久| 色综合女人99| 婷婷激情九月| Www.婷婷五月| www.91操| 久久97久久99久久综合欧美| www.夜夜操| 亚洲五月天天| 啪啪五月综合| 开心五月深爱五月| 五月丁香综合激情| 丁香五月天天哦| 超碰九热| 九九九九这里只有精品| 久久久久思思热| 久久99久久99精品免观看粉嫩| 高清无码网址| 久久久婷婷五月亚洲97号色| 色婷婷伦理| 五月激情射| 色婷青青| 六月丁香啪啪| 丁香婷婷婷五月| 婷婷久久婷婷色五月| 91chinese 在线| 风流少妇A片一区二区蜜桃| 欧美99视频| 色人妻五月| 国产亚洲在线观看| 狠狠综合久久综合| 少妇高潮A片无套内谢麻豆传| 国产午夜精品一区二区| 婷婷五月天777| 伊人网碰碰| 色五月激情图片| 丁香婷婷激情| 久综合| 五月天婷婷在线播放免费| 激情小说五月天社区丁香| 操操精品| 国产精品成人网址| 中文字幕成人| 噜啊噜在线| 特级片神马电影| 婷婷久久综合久| 99人这里只有精品| 大香蕉丁香| 狠狠狠狠狠狠| 婷婷六月天激情影院| 六月婷婷啪啪| 国自产拍偷拍精品啪啪一区二区| www.激情在线| 六月丁香成人| 99热香港| 日本少妇裸体做爰高潮片| 五月天社区| 久久大香蕉同僚|