日韩精品一区二区三区在线视频放-无码中文字幕V?一区二区-成年片免费观看视频-国内少妇人妻丰满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ù)需求。該類技術(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)這件事最開始是因?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)備做類似的雙臂項(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ī)接入、代碼組織、典型坑位全部拆開講清楚。1. 雙機(jī)械臂系統(tǒng)的整體架構(gòu)與選型邏輯1.1 為什么是雙機(jī)械臂而不是兩臺(tái)獨(dú)立單臂很多人一開始會(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)樹、統(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)有一開始就上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ī)劃MoveIt 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)定。我不建議從零手寫底層關(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)作客戶端每個(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)鍵的話題和服務(wù)大致如下名稱類型作用/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樹直接沖突。我采用的做法是把單臂模型寫成一個(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子樹的命名空間都隔開了。不過(guò)需要注意某些link名稱如果不通過(guò)參數(shù)傳入可能會(huì)漏掉前綴。初始化完成之后我會(huì)用rosrun tf2_tools view_frames.py生成TF樹檢查一遍確保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一開始我直接用默認(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}右臂類似。注意控制器名稱里的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組合類似這樣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ì)稱位姿雙臂同時(shí)執(zhí)行。我第一次跑通時(shí)左右臂竟然同時(shí)把末端伸到同一個(gè)點(diǎn)附近雖然沒(méi)有物理碰撞但那一下冷汗就出來(lá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ò)。正確做法是開啟雙臂模型在生成的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接口就完全分開了任務(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è)非常常見的任務(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è)高度。每一步都依賴上一步完成所以要有一個(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)。這里我先讓左臂開始執(zhí)行再讓右臂執(zhí)行并用waitTrue等待右臂完成。實(shí)際項(xiàng)目中還需要等待兩個(gè)動(dòng)作都結(jié)束后再進(jìn)入下一階段可以用一個(gè)Future或者線程去輪詢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í)性優(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分開設(shè)置。仿真時(shí)可以設(shè)0.8速度拉滿看效果真機(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)聽機(jī)器人的safety_mode話題如果進(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客戶端設(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)該怎么寫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ù)傳遞我寫了一個(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)崩潰后能快速重啟。在文檔里一定要寫清楚如何檢查每一層是否啟動(dòng)成功。例如看/joint_states是否有數(shù)據(jù)???tf里是否存在左右臂各自的TF樹。看MoveIt的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)境依賴清單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)的功能、依賴的topic和service、可調(diào)參數(shù)。常見問(wèn)題表例如Gazebo啟動(dòng)后機(jī)械臂下墜、MoveIt執(zhí)行時(shí)找不到控制器、真機(jī)連接失敗等都列出排查思路。文檔中的常見問(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è)中避不開的坑6.1 TF樹和命名空間的坑這是第一次在RViz里看到兩臺(tái)機(jī)械臂時(shí)最容易出問(wèn)題的地方。癥狀是兩臺(tái)臂重疊在一起或者關(guān)節(jié)位置亂跳。原因基本是URDF中左右臂沒(méi)有統(tǒng)一加前綴。如果左臂的某個(gè)link仍叫base_link而右臂也叫base_linkTF樹里會(huì)出現(xiàn)兩個(gè)名字相同的linkRViz只能隨機(jī)顯示一個(gè)看起來(lái)就像模型“穿越”了。解決方法是加前綴后用check_urdf或直接打開生成的URDF文件搜索每一個(gè)link name和joint name確保左臂相關(guān)名字都帶left_右臂帶right_。一旦有漏網(wǎng)之魚立刻修。不要指望只靠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直到軌跡跟蹤精度滿足需求。最后測(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)題有一類問(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)境中不能完全依賴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才能有效地避開地面雜散物體。6.4 效率優(yōu)化和后續(xù)擴(kuò)展仿真和真機(jī)都跑通之后項(xiàng)目才算真正可用。再往后擴(kuò)展的話有幾個(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的末端如果要做裝配、打磨這類接觸任務(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è)小技巧不管代碼寫得有多順手每次改完模型或控制器參數(shù)都先讓機(jī)械臂在home點(diǎn)附近做一次低速循環(huán)測(cè)試確認(rèn)關(guān)節(jié)狀態(tài)、TF樹和控制指令都沒(méi)有異常再進(jìn)行正式任務(wù)。這個(gè)習(xí)慣能幫你擋掉很多莫名其妙的“炸機(jī)”問(wèn)題。本文還有配套的精品資源點(diǎn)擊獲取
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
热热色AV| 热久久99999| 91伊人大香蕉| 91美女视频| 久久婷五月天| 国产诱惑| 欧美日韩亚洲一区二区在线观看| 精品玖九九久| 九久久九精品视频| 人妻在线臀日韩| 久久国产成人精品国产成人亚洲| 亚洲九月丁香| 亚州欧美综合| 91大神精品长腿在线观看网站| 嗯啊不要啊在线 | 欧美亚洲素人制服精品| 91人人爽人人爽| 岛国天天午夜影院传媒网| 国产精品女久久久久av爽| 麻豆婷婷成人一二三| 丝袜足交视频| 男人兔费天堂| 91综合熟女| 97干在线| 亚欧无码线免费观看视频| 欧美性巨大╳╳╳╳╳高跟鞋| 大香蕉伊人网WWWn0n| 东北黄色电影| 亚洲国产精品成人久久蜜臀| 久视频在线观看| 欧洲精品二区| 色五月婷婷麻豆在| 91超碰在线| 欧美黑人极品高潮喷吹熟女黑人性暴力日韩在线欧美极品一区 | 97视频7| 久久免费少妇| 很黄很污的免费网站| 亚洲欧美电影| 精品久久久久黄少妇| yaouchengrenav| 色九月综合| 黑人精品欧美一区二区蜜桃| 激情看片网站| 久久久四区| 黄色二级片网站| 伊人天天久久动态图| 人妻一区二区三区| AV乱伦国产| 高树玛利亚无码流出| 热99这里有精品综合久久| 欧美黑人XXXⅩ高潮交| 91高潮| 麻豆视频test| 亚洲成人免费中文字幕| 亚洲精品九九九九九九| 色妺妺在线视频| 亚洲无线观看久久| 神马影院午夜福利久久久| 精品熟女呻吟久久91| 久久久亚洲精品电影免费看| 国产午夜福利电影免费在线观看| 久久熟女久| 色欲日韩欧美在线一区| 丰满人妻-区二区三区免费看 | 久久女人视频| 26uuu成人影片| 欧美青青视频| 在线播放成人网站| se吧提供国产乱老熟视频胖女人| 天天搞欧美| 大香蕉手机视频| 欧美成人免费在线观看| 中文字幕在线2| 综合色色网| 91人妻在线视频| 伊人操操| 五月婷婷综合在线| 999亚洲国产视频| 91欧美www| 欧美内射少妇| 久久性视频| 亚洲综合电影| 久久久少妇诱惑精品视频| 曰韩精品九九无码| 又大又长又粗又爽又黄| 四虎精品永久在线播放| 天天综合站| 玖玖色综合| 99久国产精品午夜性色福利| 久久粉色| 人妻人久久精品中文字幕| 嗯嗯啊啊操死我| 黄色片大香蕉| 免费少妇一区二区| 性色aV一区二区三区噜噜| 中文字幕超碰CAO| 国产又色又爽又舒服的三级视频| 少妇啪啪自拍| 国产探花日韩援交| 久久伊人最新网址视频| 久操视频这里只有精品| 日韩人成网站在线播放| 丰满人妻一区二区三区性色| 极品AV网站在线观看| 久久乐| 91精品国产高清久久久久久,亚洲成人| 91狠狠| 2020中文字幕在线| 国产25页| 一区| 人妻天天操天天爽视频免费| 亚洲欧美成人在线| 熟女色综合久久| 久久无码成人| 老外又粗又长一晚做五次| 97中文热色| AV男人天堂网| 国产风韵犹存熟妇三区| 熟女网站最新| 99re8免费高清在线| 五月天久久久| 婷婷五月色| 国产AV激情无码久久无码 | 国产精品探花在线| 国产极品99热在线播放69| 欧美高清18A片| 一区二区三区四区理论片| 在线五区| 日韩特一级久久| 欧美成不卡网| 亚洲精品97在线| 五月丁香在线| 一区二区精品更新提醒| 嗯嗯啊好大| 天天操天天射青青草| 日本 欧美 国产一区| 国产乱码精品一区二区三区四川| 日本一区二区成人在线| 丁香五月婷婷基地| 九九在线视频| ′ !γ}丶。。久久精品欧美一区二区三区| 天天日天天爽| 久久久久久久久久久六六| 激情网五月天| 校园春色之综合网| 五月天偷拍| av天堂手机版追回 | 920日本午夜免费| 三级三久久线久久99久目本WW| A 天堂在线观看视频| 熟女精品va中文字幕| 久久透逼视频| 国产一区二区啪啪视频| 中亚av| 日本不卡三级网在线播放| 亚洲另类电影| 欧日韩不卡视.频| 1956日韩精品| 亚洲情色一区综合| 亚洲国产一级中文综合久久天堂在线免费观看 | 精品无码久久| 久久男人| av毛片aaaaa免费看| 377p欧洲日本亚洲大胆| 91精品伊人久久久大香线蕉91| 操比国产| 天天综合~91入口| 色色99| 超碰伊人在线| 亚洲成a人v欧美综合天堂下载| 国产黄色剧情影片麻豆免费播放| 熟女探花啪啪| 国产精品成人无码av无码免费| 留下AⅤ黄色片| 五月婷婷色色| 久久有碼| 亚洲熟妇A V黑人| 亚洲伊人青青草| 九九九九亚洲| 日韩无码精品综合久久| 色区久久| 伊人aaa| 97超碰9| 国产一区自拍欧美日韩| 国产精品久久久久无码Av网曝门 | av一区二区三区 中文| a在线观看| av在线人气| 精品久久9| 91国模| 人人操人人操人人操人人操人人操人人人11.CM| 国产精品成人无码a v毛片| 色色婷婷丁香| 中文字幕久久精品一区| 射综合网| 熟女人妇一区二区三区| 91爱综合| 精品久久久一本一道| 丁香婷婷五月| 亚洲操逼网| 欧美色图成人网一区二区| 加勒比少妇AV婷婷六月天超碰超碰| 中文字幕成人乱码熟女精品国50| 国产精品麻豆免费视频| 狠狠狠狠狠狠| 人人九九精| 欧美精品精品一区二区| 99久久9| 91欧美另类| 大香蕉草草| 中文字幕一区二区日韩网| 操人91| 国产1727欧美| 乱伦a片视频| 最新加勒比丝袜在线| 98超碰日本| 激情天天视频| 玖玖97综合| 色97国产69香蕉| 18禁无码永久免费无限制| 一起草av| 久操国产在线| yellow网站免费观看日韩高清无码| 91xingse| 中文久久久| 九九久久一区二区伦理| 艾草av| 久操视频在线观看| 啊灬啊灬啊灬好深灬快高潮了动漫-国产字幕国产在线观看-B049AV | 五月天激情四射| 亚洲熟女乱熟乱熟妇综合网二区| 麻豆久久精品亚洲精品88 | 91原创在线观看| 亚洲日本天堂| 亚洲欧美精品福利在线| 久久精品中文| 天天拍夜夜| 亚欧无码线免费观看视频| 日韩一级成人毛片免费观看| 中文字幕久久精品一区| 欧美精品一区二区少妇免费A片 | 久久人人爽人人爽人人片Ⅴ| 超碰97久| 极品粉嫩一区二区| 亚洲国产综合视频| 免费的av网| 精品人妻中文字幕高清| 精品一区二区三区最新| 秋霞Av理论一级在线| 亚洲,欧美,春色,另类| 欧美色图91| 色综合天天| 欧美一二三| 超碰79人人乐| 亚洲图片视频小说| 国产精品自拍欧美在线| 人妻久久| 91在线页| 97超碰碰| 中文久久96| 日本国产高清色www视频在线| 九一国产精品| 91高清无码下载| 亚洲国产福利视频| 先锋精品av色鲁| 999久久久九九九九| 九月丁香婷婷| 日本欧美一区二区三区视频麻豆| 国产日韩欧美| 做爱A级亚欧| 中文字幕乱偷人妻久久艾草网| 激情网色| 久久久久久免费电影| 久久性爱城| 亚洲精品91| 天天躁日日躁XXXXYY| 日韩欧美~中文字| 天天肏夜夜肏| 亚洲乱色熟女一区| 后入式999| 97人人模人人爽人人| 97在线亚洲| 一区二区 韩日AV| WWW.操逼.COM| 色偷综合| 91N欧美| 国产三级资源在线观看| 亚洲图片偷拍欧美| 99久久无色码| 日本一本道A级黄色毛片试看60分钟| 综合av影片| 天天躁日日躁AAAXX| 亚洲综合20p| 天天综合网入口~91| 亚洲Av无码成人精品国产| 熟妇人妻丰满久久久久久久无码| 熟妇一区二区三区| 操人91| 日本人妻伦在线中文字幕| 成人十八禁日韩欧美一二三| 久久草草欧美精品| 天天艹天天日| 天天综合站| 亚洲 欧美 小说| 午夜精品视频777| 国产区在线| 欧美性爱一区| 99色视频| 懂色天天爱天天日天天射天天澡| 亚州色综合| 免费看污网站| 玖玖色综合| 国产超碰AV在线精品| 国产91 丝袜在线播放 | 校园春色中文字幕AV| 99热18| 久久首页| 欧美性性性| 天天操人人操骚逼网站| 亚洲国产剧情少妇激情| 开心五月天激情网| 亚洲小电影免费涩涩成人在线高清 | 综合激情一一91| 深夜操逼网| 成人五月天丁香激情综合| 插B在线观看| 婷婷色一区| 人妻-91porn| 99亚洲精品| 亚洲欧美不卡线| 伊人在线大香蕉视频久久| 少妇天堂网络| 久久久久13| 岛国黄色大片网站| 人人操肉肉| 日韩性爱小视频| 91成人18| 蜜臀一区二区三区亚洲最新章节在线观看 - 高清蜜臀一区二区三区亚洲全集播放 | 97天天综合网| 91麻豆天美传媒HD| 国产精品欧美激在线| 成人综合色网| 天天干天天干天天| 九月婷婷综合| 精品国产精品一区二区| 人人色人人操在线| 亚洲欧美中文日韩视频中国语| 久久亚洲AV无码专区国产精品| 欧亚日韩中文在线| 熟女熟妇伦久久影院毛片一区二区 | 涩涩涩综合| 一级做受视频免费是看美女| 熟女少妇视频| 4虎在线观看| 97久久超碰日韩精品| 九九九只有精品| 岛国不卡超碰护士AV在线播放| 久久日本熟女精品一区| 亚洲熟久久| 91色黑人少妇| 国产精品视频播放| 综合97亚洲| 精品一区二区麻豆| 久久久111| www.男人天堂| 综合情欲网| 韩国三级三级BD在线| 欧洲乱码一区二区| 日韩AV色图| 亚州色站 日韩电影| 五月婷婷色| 又大又白奶子| 九九热精品免费视频| 国产区性爱在线视频秋霞豆| 国产情侣自拍在线播放| 欧美婷婷五月天| 91美女丝袜诱惑视频| 亚洲精品色| 99人人干| 91超碰人人| 超碰午夜在线| 超碰到97情色| 丰满人妻一区二区三区免费| 亚洲AV成人无码一二三久久| 国产极品美女高潮无套在线观看| 国产97色在线| 五月丁香色婷婷| 久久性爱城| 国产熟女少妇一区| 超碰人妻中文在线| 99热在线只有精品| 久久久性| 久草网站免费在线观看| 超碰久热| 免费成人在线熟妇网| 婷婷五月天色网| 禁止观看美女黄| 欧美黄色图片| 肉嘟嘟www视频在线观看高清| 一起草三级AV电影在线观看 | 八戒午夜福利理论片| 亚洲国产一区二区入口| 五月激情天| 久久亚州高清| 又黄又硬又粗又长国产视频| 久久免费9| 国产黄色在线播放观看| 欧美日韩国产高清在线一二三区 | 熟妇乱伦一区二区| 在线可观看的黄色网址| 精品一区二区三区最新| 好色美女九七第一页| 精品欧美老熟女一二区| 日本欧美韩国国产在线| 色色婷婷五月| 色娱乐色呦呦夜夜夜夜av| 欧美日韩系列| 国产特级毛片AAAAAA高潮流水 | 激情五月婷婷| 天天综合精品| 加勒比久久av| 在线日韩日本亚洲国产| 国产免费一区在线观看| 国产精品。| 日本欧美不卡| 国模精品娜娜一二三区| 欲香欲色天天天综合和网| 婷婷激情四射| 亚洲欧美综合区自拍另类 | 黄色一级视| 91色爽欧美| 亚洲色图A| 亚洲二区精品在线观看| 伊人久久大香线蕉亚洲五月天,青草青草欧美日本一区二区,欧美日产欧美日产国产 | 免费1级a做爰片观看| av天堂影视中文在字幕在线中文| 天天看人人操屄犊摸阴| 国产99热| 麻豆91熟妇人妻中文字幕茄子 | 亚洲熟女综合一区二区| 午夜久久无码1000合集| 超碰97网址| 久久97精品久久久久久久不卡| 亞洲久久直播| 久久爱超碰网| 欧美v日韩v亚洲v最新在线| 亚洲最新Av| 久久久久久久九九九九九九| 欧洲站一级二级三级h| 香港澳门日本三级网站| 后入综合久久| 麻豆视频一区二区| 牛牛AV人人夜夜澡人人爽| 搡老熟女老女人老熟妇免费视频| 中文有码第五页| 欧美综合天堂| 91超级碰碰碰| 欧美性夜| 97色色视频| 国产suv精品一区| 温婉少妇玩3p| 人妻少妇久久中文| 九九久久一区二区伦理| 欧美 牲| 青青草久草| 91无码中出人妻视频| 啊啊啊慢点| 国产精品老师| 诱惑人妻欧美一区在线播放| 国产AAAAAABBBBB| 亚洲情色1区| AVE乱伦| 九九热免费在线国产视频伊人五月| 97爱啪| 欧美顶级黄片AAAAA在线免费看| 啊好爽受不了无码| 男女一进一出视频久久| 国产女人成人精品视频| 久久九九久精品国产尤物|国产精品爽黄69天堂A片潘金莲,国产亚洲精品第一综合 | 亚洲成人帖图| 开心五月激情网| 91青青在线视频| 欧美一级A片在线看视频性色| 丝袜视频一区二区在线播放国产中文| 国产精品视频自拍在线| 日韩97视频| 国产男女无套视频免费观看| 99最新日韩偷拍视频| 欧美日韩不卡a片| 色香综合天天影视综合 | 一二区在线观看视频| 五月天婷婷色色| 亚洲在线欧美| 97精品97| 亚洲蜜乳av| 超碰偷拍| 东京太热久久久| 成人av影院在线观看| 九九亚洲色在线观看| 中文字幕成人| 亚洲午夜未满十八勿入网站日本又色又爽又黄 | 亚洲另类久操网| 国产亚洲精品精AV.| 老熟妇一区二区三区啪啪| 美女国产一区二区久久| 综合网天天| 97日视频| 色色五月婷婷| 亚洲A曰本VA欧美VA视频| 青青草日韩免费观看高清在线| 激情专区综合| 无码动漫av中文字幕| 国产一区二区在线播放,久久亚洲精品中文字幕第一区,亚洲精品在线中文字幕视频 | av在线浏览| 国产亚洲精品av一区| 人妻久久| 亚洲国内精品成人不卡| 中文字幕在线高清男人的天堂| 蜜臀AV一区二区三区| 看黑丝美女操逼青青网站| 成在线人在线观看视频| 亚洲欧美日韩中文久久自慰| 欧美在线官网| www色日本| 男人女人18禁片免费看网站| 久热这里| 99精品无码| 天天艹天天日| 极品国产内射| 99re这里只有精品2| 精品乱子一区二区三区99| 成人亚欧免费视频| 久96热在线观看视频| 欧美日动态视频| 色婷婷五月综合激情中文字幕| 色综91| 97超碰人操| 91美女丝袜诱惑视频| 欧美另类精品xxxx| 久久久久久久9| 十八禁一区二区无码观看| 日韩熟女精品无码专区一区二区| www九九热| 欧美一区二区三区另类精品| 97超碰人人操人人操| 91四海无码日韩欧美| 日韩欧美偷拍美女视频| 91老司机在线视频免费观看| 97摸视频| 久久久久久久国产视频| 偷拍亚洲熟女视频播放| 电家庭影院午夜69久久夜色精品国产69乱 | 啊啊啊啊啊啊在线看| 国内毛片免费h片在线| se01国产在线视频| 翔田千里爆乳巨臀无码| 亚洲欧洲综合| 日1区2区3区2020| 少妇内射视频| 99激情视频| 久久精品国产免费观看99| 91丝袜在线观看| 九九热在线精品视频| 操人妻逼91| 91人妻丝袜无码| 人看人人摸人人操| 国产亚洲精品无码三区| 亚洲日韩精品久久久久一区壹牛| 99精品九九九九九九| 超碰欧美97资源| 激情情色五月天| 亚洲91综合| 肉丝无码中文高清| 成人一区二区三区四区| 亚州综合图片| 国产精品色哟哟| 东京热激情视频一二三区| 婷婷五月色| 久久久婷| 中文字幕一区av| 日本 欧美 国产一区| 综合操逼| 国产1769在线| 天天爽人人综合免费7799| 日韩不卡av一二三| 五月婷色| 欧美一区91大爱| 大稥蕉免费视频这里只有精品| 资源在线观一 二| 精品丰满人妻一区二区三区免费观| 国产女人成人精品视频| 六月丁香啪啪| 欧美性爱十八禁| 国产福利小视频高清在线观看| 无码日韩人妻av一| 亚洲Av无码成人精品国产| 国产网红精品| 免费A V在线| 欧美国产日韩清纯唯美| 91在线色综合| 第四色亚洲色图| 91久久久老司机| 欧美第五页| 视频不卡中文字幕| 精品国产无码中文| 另类一区| 国产精品白虎| 夜夜操天天肏| 欧美综合网1| 又黄又硬又粗又长国产视频| 亚洲精品自拍| 91人妻素女| 91狠狠色丁香婷婷综合久久精品| 精品一区96| 久久99精品九九久久久婷婷| 欧美中字二区| 91观看 国产白丝| 欧美成年人性爱视频免费观看| 一区二区三区黄片免费观看| 欧美日韩91| 999在线电影香蕉| 一个人在线看的黄色电影网站| 91综合国产精品| 色欲天香天天综合网-成年人三级片网站-欧美乱妇狂野-日韩国产专区-久久久久久 | 91丝袜在线观看| 操逼天美3区| 久久色情| 久久伊人青青草| 老鸭窝成人| www.99色| 开心五月深爱五月| 黑人与人妻| 97超碰9| 国产AV毛片| 巨爆乳肉感一区二区三区竹菊影视 | 免费啪啪av| 六月色婷婷| 嗯嗯啊啊好疼| 夜夜嗨视频| 99精品久久久久久久婷婷| 欧州色图区| 夜夜无码| 免费又黄又裸乳的视频| 欧美日韩国产中文超碰| 人妻天天爽夜夜爽2| 欧美亚洲高清| 久久人人爽人人爽人人片Ⅴ| 欧美亚洲日韩16色| 中文字幕后石码四区五区| 新婚人妻扶着粗大强行坐下| 一区麻豆 高清中文字幕| 精品成人久久久人人亚洲| 伊人久久综合影院精品久久久| 成人片在线播放| 久草热制服丝袜在线观看 | 老司机老司机午夜影院| 日韩精品高清资源在线| 欧美人妻制服| 日本理论在线| 久久日本熟女精品一区| 美女诱惑久久| 国产久久久久久久久一区二区| 国产乱码精品久久久久久| 在线观看不卡一区二区三区| 天天综合亚在线| 嗯嗯不要 视频| 国产不卡免费在线视频| 一级@啪啪视频| 91在线综合网| 亚洲天堂资源网| 91干熟女| 亚洲男人天堂视频| 国产亚洲精品一区二区三区| 91亚洲综合在线| 欧美日本国产日韩激情视频| 91网站18在线观看| 亚洲熟妇A V黑人| 色噜噜综合网| 一本大道青青| 日韩人妻一区二区精品| 亚洲综合113页| 久久国产成人精品国产成人亚洲| 色五月激情网| 1024精品在线| 玖玖在线视频| 999热这里只有精品| 婷婷综合激情| 97久久超碰日韩精品| 国产精品熟女乱伦| 好湿好紧视频| 五月天婷婷综合| 久久久555| 天天爱天天韩国日本牛牛牛牛 | 夜夜嗨一区二区三区三州加勒比| 91强奸乱轮| 欧美在线|亚洲| 手机在线看片免费人成视频| 国产蜜臀在线| 翔田千里av一区二区三区| 日韩欧美麻豆 | 亚洲色图欧美色图制服丝袜| 大屁股人妻女教师撅着屁股| 欧美色997| 欧美亚洲色图另类国产| 第二页中文字幕| 久久久久久久九九九九九九| 一区二区国产视频在线观看| 911粉嫩人妻| 色香网| 色婷婷激情| 色网色网色网色网色网色| 九九久久一区二区三区| 青娱乐欧美激情一区二区| 天综合网欧美| 操逼日韩无码| 另类图片天天影视| 亚洲自拍欧美国产首页网曝 | 图色综合网| 天天色黄色影院天天操| 免费国产| 精品超碰中文在线| 久久中文字幕一区不卡| 超碰一区二区| 美女黄频a美女大全免费皮| 国产剧情在线| 乱老熟女一区二区三区| 成人免费在线网站| 亚洲综合20p| AV老汉| 亚洲砖码砖专无区2023| 91熟女丨91老女人| 欧美一区二区传媒| 国产小u女在线观看| 尤物网站91| 欧美天堂第二区| 9999久久久久| 久久 国产 无码| 欧美色图片欧美色图| 超碰调教97| 色婷婷激一区二区三区 | 国产欧美在线观看免费观看| 欧美天天综合站| 丁香五月影院| 91人妻最真实刺激绿帽| 欧美综合综合| 蜜臀久久久国产| 99色综合| 国产精品久久久久无码A√| 久草精品在线| 人妻社区男人天堂| 超碰人人色| 国产高清精品一区二区三区毛片| a啊啊啊啊啊啊啊啊一区二区| 白丝少妇一区二区| 日本天天色| av网站在线观看了| 天天综合97| 亚洲少妇自拍中文字幕懂色| 夜夜高潮夜夜爽| 性爱av网站| 韩国手机不卡无码三级视频| 亚洲国产日韩精品久久久| 亚洲成人妻日韩在线| 神马精品视频| 日韩中文字幕在线视频观看| 日韩精品碰碰| 黄片视频观看| AV天堂因数| 免费草草草草草视频| 亚洲熟妇乱女区二区三区| 看一级黄色视频| 精品国产91av一区二区三区| 黑人综合网| surenchaopeng| 成人日本精品九区| 极品色社| 国产成人精品亚洲日本| 在线A日本| 夜夜草天天| 日韩有码专区| 青青草在线视频播放器| 亚洲免费97免费| 日韩三级网址| 91蜜臀熟女| 成人av免费观看| 国产成人欧美一区二区三区的国产| 国产在线视频午夜精华在| 超碰超碰超碰超碰的大鸡吧操黑丝袜| 97bbn| 亚洲综合图色在线| 91总综合网| 日韩成人午夜精品久久高潮| 日韩精品三区四区| 久热婷婷| 综合激情五月丁香| 热九九精品| 操逼片中文| 在线色导航| 为用户提供免费看黄网址在线观看| 日本一道在线播放高清| 超碰91在线| 97综合国产| 夜夜爽夜夜操| 97亚洲精品| 另类天堂| 国产高清亚洲日韩一区| 9Ⅰ超碰| 日韩97在线| 国产中文字幕在线观看| 中文字幕精品专区搜索结果91| 精品久久九| 欧美超碰人妻97| 一二视频神马久久传媒| 91女优在线观看 | 99热伊人| 天天拍夜夜| 91春色| 神马久久久久| 操逼视频色| 淫荡少妇免费| 日本色色色视频| 熟女五十路一区二区三| a级成人毛片免费视频高清| 夜夜影视四色| 日韩性爱高清免费视频| 日韩性爱电影一区| www.激情| 久久人人妻| 和协无码影院| 日韩精品怡红院| 国产熟女高潮一区二区三区| 色欲天香天天综合网-成年人三级片网站-欧美乱妇狂野-日韩国产专区-久久久久久 | 日本性交操一区二区不卡系列| 1区2区3区在线视频| 五月天激情网站| 欧美最婬乱婬爆婬性视频 | 国产人妖视频一区在线观看| 久草免费在线一区二区| 99精品无码| 黄色二级片网站| 国产精品丝袜久久亚洲不卡| 亚洲好色人妻| 精品视频一二三中文| 翔田千里爆乳巨臀无码| 日韩欧美中文| 啊灬啊灬啊灬好深灬快高潮了动漫-国产字幕国产在线观看-B049AV | 18禁免费视频| 女人被添高潮免费视频| 精品四五区| 国产日韩欧美| 黄站在线免费观看| 久久91| 亚洲一区日韩精品| 凸凹视频在线观看| 国产黄a三级三级三级av在线看| 诱惑人妻欧美一区在线播放| 国产一区二区在线播放,久久亚洲精品中文字幕第一区,亚洲精品在线中文字幕视频 | 国产熟女无套内射| 青娱乐999| 国产超碰人人爽人人做| 99热免费| 丝袜狠狠草尤物 91| 亚洲视频精选| 襙一襙| 激情五月天丁香社区| 日本亚洲vr欧美不卡高清专区| A男人的天堂| 欧美91变态| av网页一区二区三区| 亚洲少妇喷视频看| 超碰 av 女人天堂| 亚洲欧洲激情卡通另类文学四射小说网站| 中国一级操逼视频| 俺去俺来也在线www| 天天操女人| 五十路熟女,国产欧美精品区一区二区三区 | 亚州欧美综合| 日本孕妇一区二区视频操逼免费看| 国精精品无码一二三区水多多| 性色一线| 亚洲日本大香蕉1| av天堂天堂av日韩| http://qxhbdz.com| …中文字幕亚洲乱,97人妻无码费视…| 欧美亚洲首页| 久久精品国产亚洲AV高级北京| 丰满人妻一区二区三区在线| 少妇丝袜在线观看AV| 超碰免费97| 国产成人网| 超碰到97情色| 久久性生大片免费观看性| 久久人妻精品| 九九人妻| 91深夜夜| 色一射色一射| 91精品网站| 久久精品性| 欧美综合狠| 少妇啪啪自拍| 夜夜夜夜夜夜夜夜夜狠狠狠狠狠狠狠| 暴力av在线| 亚洲成A∨人影院在线欢看| 99热免费精品| 日韩超碰97| 99视频在线| 少妇人妻在线| 网页导航五月天免费一二三区| 亚洲日韩少妇一道本视频| 三级日韩一区二区三区| 精品区9| 欧美高清16| 婷婷综合视频| 天天躁日日躁狠狠狠躁| 国产伦乱91| 国产后入清纯| 色婷婷激一区二区三区| 成人一区二区三区四区| 思思视频免费看网站| 中日无幕一二三四区| 九九久久玖玖| 亚洲欧美日韩综合在线尤物 | 青青伊人加勒比海| 亚洲男人综合| 久久精品老司| A级毛片在线看免费| 97在线国产精品| 日本精品999| 亚州操操穴网| 尤物网站91| 国产嫩草精品A88AV在线| 日韩在线观看三级电影| 久久国产精品91| 久久久日本电影| 美女尤物福利视频| 97综合久久| 久久久久密| 精品国产av一区二区三区四区入口| 97 亚洲 日韩 欧美 在线| 2024黄色视频| 日han少妇无码| 久久精品国产99精品亚洲蜜...| 国厂麻豆77q4| 日本色色视频网站| 国产乱码精品久久久久久| 日韩亚洲国产视频| 久久久涩| 天天综合,91综合永久| 国产60页| 天天操天天插| 91丝袜在线观看| 精品亚洲一区在线观看| 亚洲天堂另类小说男人| 亚洲国产精品成人综合| 国产精品亚洲四五区在线观看| 欧美日韩国产另类综合| 天天综合站| 黄网在线播放| 91精品国产91久久青草| 精品国产72| 国产一区二区在线电影| 深喉吞精| 亚洲免费精品一区| 天堂俺去俺来也www久久婷婷| 国产日韩中文字幕欧美| 久久天天摸| 久久综合国产精品国产| 黄站在线免费观看| 91蜜臀熟女| 国产最新小视频在线播放下载 | 欧美96精品在线| 国产视频三区四区| www.99中文字幕| 亚洲色图日韩丝袜制服一区二区五月在线| 蜜臀av一区二区三区免费观看| 粉嫩av在线| 亚州中文字幕超碰97| 欧美十八禁在线看| 一级人妻性爱视频| 天天天堂影视日韩亚洲91| 男人天堂一区二区| 大香蕉乱级| 综合欧美色图| 欧美中文字幕一区| 国产无马av| 99精品国产户外露出| 97超碰色中文字幕| 九色 人妻 大香蕉| 国产一级操B视频| 资源新线在线天堂| #NAME?| 久久黄黄| 亚洲午夜福利在线影院| 丝袜人妻av一区二区| 欧美色图亚洲色,麻豆| 日日日啊啊啊| 91人妻中文| 尤物视频视频官网| 午夜福利在线合集| 91爱综合| 一个人免费HD91视频| 蜜臀99久久| 亚洲精品蜜桃久久久久久久| 丁香激情五月| 成人性爱AV在线免费观看| 国产精品另类| 高清肉丝中文无码| 久久女婷| 日va操| 高清国产无码av| 中文字幕在线观看丝袜| 日婷婷| 日韩色| 午夜噜噜噜| 97热视频在线观看| 欧美三级免费伊人| 91美女丝袜诱惑视频| 亚洲成熟国产精品美女| 日韩欧无码一区二区三区免费不卡| 蜜臀网址在线| 青草香蕉网| 婷婷五月天成人| 六十路日本| 一区二区三区免费岛国片| 国产亚洲精品激情| 在线日韩精品一区二区三区| 国产精品乱码久久久久久久久| 亚洲精品天天影视综合网| 三级三级三级日本99| 国产18精品亚洲精品| 曰韩操B| 亚洲无码超碰免费| 男人天堂网站| 亚洲天堂男人的天堂| 欧美色图99| 伊人色综合欧美| 北条麻妃性愛视频| 你草精品在线视频| 黄色高清久久无码依人| 青娱乐 成人娱乐在线| www.91色综合| 天天天天操| 91色久| 影音先锋少妇| 搡老熟女免费视频 | 天综合网欧美| 日韩不卡网操逼中文字幕日韩| 99色骚| 久噜噜| 大香蕉99热| 伊人影院中文字幕| 色婷婷狠狠| 婷婷五月丁香五月| 可以看的av| 精品久久人妻成人网| 国产中文大片资源中文字幕| 国产成人无码a| 99久久久无码精品国产人| 91精品微拍福利| 天天日天天搞天天干| 毛片久久| 欧美gv在线观看| 国产亚洲深夜激情| 成全在线观看免费观看| 亚洲无码国产探花在线观看| 欧美在线永久天堂| 97精品熟女少妇一区| 美女操逼福利视频| 亚洲成av人片色午夜乱码| 极品色综合| yazhououmeizongya| 久久免费9| 久久久久国产精品久久久| 久久久96| 国产成人超碰在线| 中日亚韩免费视频| 欧美成va视频网站| 中文字幕 码 自拍 视频 区| 黑丝少妇麻豆| 伊人一区二区三区| 美女让帅哥通她小鸡鸡| 欧美熟妇精品黑人巨大91| 免费国产视频| 国产野战露脸在线播放| 婷婷视频在线免费观看| 国产精品青草综合久久| 亚洲综合网电影91| 91殴美大片| 免费亚洲国产精品久久一区| 久久久青草青青国产亚洲免观精品高清完整版_97久久综合区小说区图片区,国精品 | 91欧美| 亚洲色人妻综合| 欧美白嫩女HD| 一区久久久二区| 天堂伊人久久| 91天美免费| 人妻夜夜爽天天爽三区麻豆AV网站| 天天视频网站黄| 熟女中出视频| 亚洲,欧美,春色,另类| 久操高青| 东京热熟女亚洲视频网站| 亚洲小说视频| 国产精品香蕉| 无码高清专| 五月婷婷六月激情| 极品丝袜无码| 亚洲男人的天堂在线看| 国产吹潮女在线观看| 97香蕉网| 人妻人人做人人澡人人爽欧美一区| 六月丁香啪啪| 亚洲视频一二区| 五月天欧美色图| 欧美亚洲情色| 色嗨嗨在线| 72av视频| 久艾草在线精品视频在线观看| 久草国产在线视频| 色色热| 另类图片亚洲加勒比另类图片亚洲加勒比另类图片亚洲加勒比 | 天堂av2019| 美女91色黄18| 欧美精品亚洲精品日韩传电影| 超碰78| 超碰人人超在线观看| 超碰天天久久79| 97在线视频免费看| 91深夜夜| 极品色社| 色老久久| 性色av大全| 99色综合| 久久久久深夜无码| 日本操逼aaaaa| 婷婷五月天丁香| 久久精品国产久精国产| 日韩黄色片子| 人人人人人人少妇| 男人的天堂久久狠| 日韩精品一区二区人人人| 人人妻人射| 少妇被玩视频二三区| 男人的天堂VA| 亚洲精品日韩国产欧美| 蜜臀99999| 亚洲91在线| 色五月综合| 丁香激情网| 综合情欲网| 国产高清在线观看欧美| 中文字幕五区| 国产三级中文字幕粉嫩| 国产白嫩漂亮KTV在线| 久久九九一区二区三区成人| 夜夜欢天天干| 日韩性爱视频免费在线| 欧美色日| 岛国激情视频软件| 久久仑合|