簡(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)擊獲取