ymbot_d.urdf 48 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005
  1. <?xml version="1.0" encoding="utf-8"?>
  2. <!-- This URDF was automatically created by SolidWorks to URDF Exporter! Originally created by Stephen Brawner (brawner@gmail.com)
  3. Commit Version: 1.6.0-4-g7f85cfe Build Version: 1.6.7995.38578
  4. For more information, please see http://wiki.ros.org/sw_urdf_exporter -->
  5. <robot
  6. name="ymbot_d">
  7. <link name="base_footprint_link" />
  8. <joint name="base_footprint_joint" type="fixed">
  9. <parent link="base_footprint_link" />
  10. <child link="base_link" />
  11. <origin xyz="0 0 0" rpy="0 0 0"/>
  12. </joint>
  13. <link
  14. name="base_link">
  15. <inertial>
  16. <origin
  17. xyz="-0.140875815837035 0.00603023020493104 0.109511696472128"
  18. rpy="0 0 0" />
  19. <mass
  20. value="32.8068211995599" />
  21. <inertia
  22. ixx="0.464286511664967"
  23. ixy="1.3488173533289E-05"
  24. ixz="-0.00184851975464834"
  25. iyy="0.221044284911458"
  26. iyz="2.87603238583234E-06"
  27. izz="0.636800996886494" />
  28. </inertial>
  29. <visual>
  30. <origin
  31. xyz="0 0 0"
  32. rpy="0 0 0" />
  33. <geometry>
  34. <mesh
  35. filename="package://ymbot_d_description/meshes/base_link.STL" />
  36. </geometry>
  37. <material
  38. name="">
  39. <color
  40. rgba="0.698039215686274 0.698039215686274 0.698039215686274 1" />
  41. </material>
  42. </visual>
  43. <collision>
  44. <origin
  45. xyz="0 0 0"
  46. rpy="0 0 0" />
  47. <geometry>
  48. <mesh
  49. filename="package://ymbot_d_description/meshes/base_link.STL" />
  50. </geometry>
  51. </collision>
  52. </link>
  53. <link
  54. name="Body_Link1">
  55. <inertial>
  56. <origin
  57. xyz="0.174061543715132 0.0813569335741717 -0.00411355243217093"
  58. rpy="0 0 0" />
  59. <mass
  60. value="8.92329097536367" />
  61. <inertia
  62. ixx="0.0186252194927477"
  63. ixy="0.0108424097177654"
  64. ixz="-7.06681788962594E-06"
  65. iyy="0.0370027371562397"
  66. iyz="-3.14403762865704E-06"
  67. izz="0.0452738830029271" />
  68. </inertial>
  69. <visual>
  70. <origin
  71. xyz="0 0 0"
  72. rpy="0 0 0" />
  73. <geometry>
  74. <mesh
  75. filename="package://ymbot_d_description/meshes/Body_Link1.STL" />
  76. </geometry>
  77. <material
  78. name="">
  79. <color
  80. rgba="0.698039215686274 0.698039215686274 0.698039215686274 1" />
  81. </material>
  82. </visual>
  83. <collision>
  84. <origin
  85. xyz="0 0 0"
  86. rpy="0 0 0" />
  87. <geometry>
  88. <mesh
  89. filename="package://ymbot_d_description/meshes/Body_Link1.STL" />
  90. </geometry>
  91. </collision>
  92. </link>
  93. <joint
  94. name="Body_Joint1"
  95. type="revolute">
  96. <origin
  97. xyz="0 0 0.148"
  98. rpy="1.5708 0 0" />
  99. <parent
  100. link="base_link" />
  101. <child
  102. link="Body_Link1" />
  103. <axis
  104. xyz="0 0 1" />
  105. <limit
  106. lower="-0.03"
  107. upper="1.57"
  108. effort="100.0"
  109. velocity="2.5" />
  110. <dynamics
  111. damping="0.1"
  112. friction="0.01" />
  113. </joint>
  114. <link
  115. name="Body_Link2">
  116. <inertial>
  117. <origin
  118. xyz="-0.205307942286028 0.00564139323609941 0.000527221097167019"
  119. rpy="0 0 0" />
  120. <mass
  121. value="4.99421923736218" />
  122. <inertia
  123. ixx="0.00860523438441792"
  124. ixy="-0.000152945435305184"
  125. ixz="3.75588685217445E-06"
  126. iyy="0.0884561414708571"
  127. iyz="7.13513809482317E-07"
  128. izz="0.0958352096257492" />
  129. </inertial>
  130. <visual>
  131. <origin
  132. xyz="0 0 0"
  133. rpy="0 0 0" />
  134. <geometry>
  135. <mesh
  136. filename="package://ymbot_d_description/meshes/Body_Link2.STL" />
  137. </geometry>
  138. <material
  139. name="">
  140. <color
  141. rgba="0.698039215686274 0.698039215686274 0.698039215686274 1" />
  142. </material>
  143. </visual>
  144. <collision>
  145. <origin
  146. xyz="0 0 0"
  147. rpy="0 0 0" />
  148. <geometry>
  149. <mesh
  150. filename="package://ymbot_d_description/meshes/Body_Link2.STL" />
  151. </geometry>
  152. </collision>
  153. </link>
  154. <joint
  155. name="Body_Joint2"
  156. type="revolute">
  157. <origin
  158. xyz="0.3444 0.16059 0"
  159. rpy="0 0 0" />
  160. <parent
  161. link="Body_Link1" />
  162. <child
  163. link="Body_Link2" />
  164. <axis
  165. xyz="0 0 -1" />
  166. <limit
  167. lower="-0.03"
  168. upper="3.14"
  169. effort="100.0"
  170. velocity="2.5" />
  171. <dynamics
  172. damping="0.1"
  173. friction="0.01" />
  174. </joint>
  175. <link
  176. name="Body_Link3">
  177. <inertial>
  178. <origin
  179. xyz="0.000369625023075082 0.00548012045258922 0.00246863461172153"
  180. rpy="0 0 0" />
  181. <mass
  182. value="2.72098225189872" />
  183. <inertia
  184. ixx="0.00346917224179708"
  185. ixy="-1.3489407520741E-06"
  186. ixz="6.10523991472922E-09"
  187. iyy="0.00331765142239213"
  188. iyz="2.22401392702027E-08"
  189. izz="0.00335553369440741" />
  190. </inertial>
  191. <visual>
  192. <origin
  193. xyz="0 0 0"
  194. rpy="0 0 0" />
  195. <geometry>
  196. <mesh
  197. filename="package://ymbot_d_description/meshes/Body_Link3.STL" />
  198. </geometry>
  199. <material
  200. name="">
  201. <color
  202. rgba="0.698039215686274 0.698039215686274 0.698039215686274 1" />
  203. </material>
  204. </visual>
  205. <collision>
  206. <origin
  207. xyz="0 0 0"
  208. rpy="0 0 0" />
  209. <geometry>
  210. <mesh
  211. filename="package://ymbot_d_description/meshes/Body_Link3.STL" />
  212. </geometry>
  213. </collision>
  214. </link>
  215. <joint
  216. name="Body_Joint3"
  217. type="revolute">
  218. <origin
  219. xyz="-0.38 0 0"
  220. rpy="0 0 0" />
  221. <parent
  222. link="Body_Link2" />
  223. <child
  224. link="Body_Link3" />
  225. <axis
  226. xyz="0 0 -1" />
  227. <limit
  228. lower="-3.14"
  229. upper="0.3"
  230. effort="100.0"
  231. velocity="2.5" />
  232. <dynamics
  233. damping="0.1"
  234. friction="0.01" />
  235. </joint>
  236. <link
  237. name="Body_Link4">
  238. <inertial>
  239. <origin
  240. xyz="-0.00528425143803396 -8.96798079297323E-07 -0.240948814993741"
  241. rpy="0 0 0" />
  242. <mass
  243. value="12.0805095549325" />
  244. <inertia
  245. ixx="0.0997233932660056"
  246. ixy="5.22801191238748E-07"
  247. ixz="0.000766995547826735"
  248. iyy="0.0774270018821678"
  249. iyz="2.95204397503293E-06"
  250. izz="0.0381103289921977" />
  251. </inertial>
  252. <visual>
  253. <origin
  254. xyz="0 0 0"
  255. rpy="0 0 0" />
  256. <geometry>
  257. <mesh
  258. filename="package://ymbot_d_description/meshes/Body_Link4.STL" />
  259. </geometry>
  260. <material
  261. name="">
  262. <color
  263. rgba="0.698039215686274 0.698039215686274 0.698039215686274 1" />
  264. </material>
  265. </visual>
  266. <collision>
  267. <origin
  268. xyz="0 0 0"
  269. rpy="0 0 0" />
  270. <geometry>
  271. <mesh
  272. filename="package://ymbot_d_description/meshes/Body_Link4.STL" />
  273. </geometry>
  274. </collision>
  275. </link>
  276. <joint
  277. name="Body_Joint4"
  278. type="revolute">
  279. <origin
  280. xyz="0 0.0875 0"
  281. rpy="1.5708 0 0" />
  282. <parent
  283. link="Body_Link3" />
  284. <child
  285. link="Body_Link4" />
  286. <axis
  287. xyz="0 0 -1" />
  288. <limit
  289. lower="-2.791111"
  290. upper="2.791111"
  291. effort="100.0"
  292. velocity="2.5" />
  293. <dynamics
  294. damping="0.1"
  295. friction="0.01" />
  296. </joint>
  297. <link
  298. name="Body_Link5">
  299. <inertial>
  300. <origin
  301. xyz="0.0358739801887025 2.72004641033163E-15 -0.172499999999998"
  302. rpy="0 0 0" />
  303. <mass
  304. value="0.0231694625119586" />
  305. <inertia
  306. ixx="2.16843593911807E-05"
  307. ixy="5.48007155816381E-23"
  308. ixz="6.17389596556849E-21"
  309. iyy="2.14878148335587E-05"
  310. iyz="-6.53383278270553E-21"
  311. izz="4.88071765210052E-07" />
  312. </inertial>
  313. <visual>
  314. <origin
  315. xyz="0 0 0"
  316. rpy="0 0 0" />
  317. <geometry>
  318. <mesh
  319. filename="package://ymbot_d_description/meshes/Body_Link5.STL" />
  320. </geometry>
  321. <material
  322. name="">
  323. <color
  324. rgba="0.698039215686274 0.698039215686274 0.698039215686274 1" />
  325. </material>
  326. </visual>
  327. <collision>
  328. <origin
  329. xyz="0 0 0"
  330. rpy="0 0 0" />
  331. <geometry>
  332. <mesh
  333. filename="package://ymbot_d_description/meshes/Body_Link5.STL" />
  334. </geometry>
  335. </collision>
  336. </link>
  337. <joint
  338. name="Body_Joint5"
  339. type="fixed">
  340. <origin
  341. xyz="0 0 -0.408"
  342. rpy="3.1416 0 0" />
  343. <parent
  344. link="Body_Link4" />
  345. <child
  346. link="Body_Link5" />
  347. <axis
  348. xyz="0 0 0" />
  349. </joint>
  350. <link
  351. name="Neck_Link1">
  352. <inertial>
  353. <origin
  354. xyz="1.2958E-08 -0.0051238 -0.024399"
  355. rpy="0 0 0" />
  356. <mass
  357. value="0.2254" />
  358. <inertia
  359. ixx="6.0865E-06"
  360. ixy="-5.2502E-13"
  361. ixz="-4.7167E-12"
  362. iyy="2.5704E-06"
  363. iyz="2.4439E-13"
  364. izz="7.0019E-06" />
  365. </inertial>
  366. <visual>
  367. <origin
  368. xyz="0 0 0"
  369. rpy="0 0 0" />
  370. <geometry>
  371. <mesh
  372. filename="package://ymbot_d_description/meshes/Neck_Link1.STL" />
  373. </geometry>
  374. <material
  375. name="">
  376. <color
  377. rgba="0.69804 0.69804 0.69804 1" />
  378. </material>
  379. </visual>
  380. <collision>
  381. <origin
  382. xyz="0 0 0"
  383. rpy="0 0 0" />
  384. <geometry>
  385. <mesh
  386. filename="package://ymbot_d_description/meshes/Neck_Link1.STL" />
  387. </geometry>
  388. </collision>
  389. </link>
  390. <joint
  391. name="Neck_Joint1"
  392. type="revolute">
  393. <origin
  394. xyz="-0.023818 0 0.075"
  395. rpy="3.1416 0 0" />
  396. <parent
  397. link="Body_Link5" />
  398. <child
  399. link="Neck_Link1" />
  400. <axis
  401. xyz="0 0 -1" />
  402. <limit
  403. lower="-1.57"
  404. upper="1.57"
  405. effort="100.0"
  406. velocity="2.5" />
  407. <dynamics
  408. damping="0.1"
  409. friction="0.01" />
  410. </joint>
  411. <link
  412. name="Neck_Link2">
  413. <inertial>
  414. <origin
  415. xyz="0.0291784619709279 -0.0609723040898356 0.0041286746823011"
  416. rpy="0 0 0" />
  417. <mass
  418. value="0.915089187915991" />
  419. <inertia
  420. ixx="0.00314452922624201"
  421. ixy="6.84940975959184E-06"
  422. ixz="-1.05007409157497E-05"
  423. iyy="0.00253592322995066"
  424. iyz="-5.06676872249796E-05"
  425. izz="0.00114950039082245" />
  426. </inertial>
  427. <visual>
  428. <origin
  429. xyz="0 0 0"
  430. rpy="0 0 0" />
  431. <geometry>
  432. <mesh
  433. filename="package://ymbot_d_description/meshes/Neck_Link2.STL" />
  434. </geometry>
  435. <material
  436. name="">
  437. <color
  438. rgba="0.698039215686274 0.698039215686274 0.698039215686274 1" />
  439. </material>
  440. </visual>
  441. <collision>
  442. <origin
  443. xyz="0 0 0"
  444. rpy="0 0 0" />
  445. <geometry>
  446. <mesh
  447. filename="package://ymbot_d_description/meshes/Neck_Link2.STL" />
  448. </geometry>
  449. </collision>
  450. </link>
  451. <joint
  452. name="Neck_Joint2"
  453. type="revolute">
  454. <origin
  455. xyz="0 0 -0.037"
  456. rpy="1.5708 0 0" />
  457. <parent
  458. link="Neck_Link1" />
  459. <child
  460. link="Neck_Link2" />
  461. <axis
  462. xyz="0 0 -1" />
  463. <limit
  464. lower="-0.6"
  465. upper="0.6"
  466. effort="100.0"
  467. velocity="2.5" />
  468. <dynamics
  469. damping="0.1"
  470. friction="0.01" />
  471. </joint>
  472. <link name="camera_link">
  473. <!-- 工具坐标系通常没有物理几何形状 -->
  474. <inertial>
  475. <mass value="0"/>
  476. <origin xyz="0 0 0" rpy="0 0 0"/>
  477. <inertia ixx="0" ixy="0" ixz="0" iyy="0" iyz="0" izz="0"/>
  478. </inertial>
  479. </link>
  480. <!-- 固定关节,将工具坐标系连接到机械臂末端 -->
  481. <joint name="camera" type="fixed">
  482. <parent link="Neck_Link2"/>
  483. <child link="camera_link"/>
  484. <origin xyz="0.05593865073672299 -0.0805055761270304 0.02484582897311825 " rpy=" -1.35776 1.5202 -1.37192"/> <!-- 根据实际位置调整 -->
  485. </joint>
  486. <link
  487. name="Left_Arm_Link1">
  488. <inertial>
  489. <origin
  490. xyz="0.0025077516660571 0.0001362208206791 0.0813914149014803"
  491. rpy="0 0 0" />
  492. <mass
  493. value="0.838972132111373" />
  494. <inertia
  495. ixx="0.000751989785934902"
  496. ixy="-5.8889624703312E-07"
  497. ixz="-1.69046720878191E-05"
  498. iyy="0.000443278679334891"
  499. iyz="-8.05678618129766E-07"
  500. izz="0.000468957564177447" />
  501. </inertial>
  502. <visual>
  503. <origin
  504. xyz="0 0 0"
  505. rpy="0 0 0" />
  506. <geometry>
  507. <mesh
  508. filename="package://ymbot_d_description/meshes/Left_Arm_Link1.STL" />
  509. </geometry>
  510. <material
  511. name="">
  512. <color
  513. rgba="0.698039215686274 0.698039215686274 0.698039215686274 1" />
  514. </material>
  515. </visual>
  516. <collision>
  517. <origin
  518. xyz="0 0 0"
  519. rpy="0 0 0" />
  520. <geometry>
  521. <mesh
  522. filename="package://ymbot_d_description/meshes/Left_Arm_Link1.STL" />
  523. </geometry>
  524. </collision>
  525. </link>
  526. <joint
  527. name="Left_Arm_Joint1"
  528. type="revolute">
  529. <origin
  530. xyz="0 0.116 0"
  531. rpy="-1.5708 0 0" />
  532. <parent
  533. link="Body_Link5" />
  534. <child
  535. link="Left_Arm_Link1" />
  536. <axis
  537. xyz="0 0 1" />
  538. <limit
  539. lower="-2.791111111"
  540. upper="2.791111111"
  541. effort="100.0"
  542. velocity="2.5" />
  543. <dynamics
  544. damping="0.1"
  545. friction="0.01" />
  546. </joint>
  547. <link
  548. name="Left_Arm_Link2">
  549. <inertial>
  550. <origin
  551. xyz="-0.00306188367559923 0.0161630740147791 0.0111927458017747"
  552. rpy="0 0 0" />
  553. <mass
  554. value="0.255409283233996" />
  555. <inertia
  556. ixx="0.000326831004765838"
  557. ixy="1.78367336998208E-05"
  558. ixz="1.5437175240836E-06"
  559. iyy="0.000349624034273561"
  560. iyz="-3.83766268525858E-05"
  561. izz="0.000472907614836737" />
  562. </inertial>
  563. <visual>
  564. <origin
  565. xyz="0 0 0"
  566. rpy="0 0 0" />
  567. <geometry>
  568. <mesh
  569. filename="package://ymbot_d_description/meshes/Left_Arm_Link2.STL" />
  570. </geometry>
  571. <material
  572. name="">
  573. <color
  574. rgba="0.698039215686274 0.698039215686274 0.698039215686274 1" />
  575. </material>
  576. </visual>
  577. <collision>
  578. <origin
  579. xyz="0 0 0"
  580. rpy="0 0 0" />
  581. <geometry>
  582. <mesh
  583. filename="package://ymbot_d_description/meshes/Left_Arm_Link2.STL" />
  584. </geometry>
  585. </collision>
  586. </link>
  587. <joint
  588. name="Left_Arm_Joint2"
  589. type="revolute">
  590. <origin
  591. xyz="0 0 0.0885"
  592. rpy="1.5708 1.3963 1.5708" />
  593. <parent
  594. link="Left_Arm_Link1" />
  595. <child
  596. link="Left_Arm_Link2" />
  597. <axis
  598. xyz="0 0 1" />
  599. <limit
  600. lower="-0.21"
  601. upper="1.4"
  602. effort="100.0"
  603. velocity="2.5" />
  604. <dynamics
  605. damping="0.1"
  606. friction="0.01" />
  607. </joint>
  608. <link
  609. name="Left_Arm_Link3">
  610. <inertial>
  611. <origin
  612. xyz="-0.0010992 -9.2443E-05 -0.11449"
  613. rpy="0 0 0" />
  614. <mass
  615. value="2.0472" />
  616. <inertia
  617. ixx="0.0037729"
  618. ixy="3.4466E-07"
  619. ixz="-1.1965E-05"
  620. iyy="0.0030709"
  621. iyz="5.2778E-05"
  622. izz="0.0019046" />
  623. </inertial>
  624. <visual>
  625. <origin
  626. xyz="0 0 0"
  627. rpy="0 0 0" />
  628. <geometry>
  629. <mesh
  630. filename="package://ymbot_d_description/meshes/Left_Arm_Link3.STL" />
  631. </geometry>
  632. <material
  633. name="">
  634. <color
  635. rgba="0.69804 0.69804 0.69804 1" />
  636. </material>
  637. </visual>
  638. <collision>
  639. <origin
  640. xyz="0 0 0"
  641. rpy="0 0 0" />
  642. <geometry>
  643. <mesh
  644. filename="package://ymbot_d_description/meshes/Left_Arm_Link3.STL" />
  645. </geometry>
  646. </collision>
  647. </link>
  648. <joint
  649. name="Left_Arm_Joint3"
  650. type="revolute">
  651. <origin
  652. xyz="0 0.0645 -0.0025"
  653. rpy="1.5708 0 0" />
  654. <parent
  655. link="Left_Arm_Link2" />
  656. <child
  657. link="Left_Arm_Link3" />
  658. <axis
  659. xyz="0 0 -1" />
  660. <limit
  661. lower="-2.791111111"
  662. upper="2.791111111"
  663. effort="100.0"
  664. velocity="2.5" />
  665. <dynamics
  666. damping="0.1"
  667. friction="0.01" />
  668. </joint>
  669. <link
  670. name="Left_Arm_Link4">
  671. <inertial>
  672. <origin
  673. xyz="0.0242579469687219 1.16068932243252E-09 -0.030009553809354"
  674. rpy="0 0 0" />
  675. <mass
  676. value="0.0552392184913917" />
  677. <inertia
  678. ixx="3.26304815579912E-05"
  679. ixy="-1.33870530695415E-12"
  680. ixz="1.71609495323931E-05"
  681. iyy="5.76495656370827E-05"
  682. iyz="-1.97263319886454E-12"
  683. izz="5.5252867132742E-05" />
  684. </inertial>
  685. <visual>
  686. <origin
  687. xyz="0 0 0"
  688. rpy="0 0 0" />
  689. <geometry>
  690. <mesh
  691. filename="package://ymbot_d_description/meshes/Left_Arm_Link4.STL" />
  692. </geometry>
  693. <material
  694. name="">
  695. <color
  696. rgba="0.698039215686274 0.698039215686274 0.698039215686274 1" />
  697. </material>
  698. </visual>
  699. <collision>
  700. <origin
  701. xyz="0 0 0"
  702. rpy="0 0 0" />
  703. <geometry>
  704. <mesh
  705. filename="package://ymbot_d_description/meshes/Left_Arm_Link4.STL" />
  706. </geometry>
  707. </collision>
  708. </link>
  709. <joint
  710. name="Left_Arm_Joint4"
  711. type="revolute">
  712. <origin
  713. xyz="0 0 -0.199"
  714. rpy="1.5708 0.7854 1.5708" />
  715. <parent
  716. link="Left_Arm_Link3" />
  717. <child
  718. link="Left_Arm_Link4" />
  719. <axis
  720. xyz="0 0 -1" />
  721. <limit
  722. lower="-0.6"
  723. upper="0.87"
  724. effort="100.0"
  725. velocity="2.5" />
  726. <dynamics
  727. damping="0.1"
  728. friction="0.01" />
  729. </joint>
  730. <link
  731. name="Left_Arm_Link5">
  732. <inertial>
  733. <origin
  734. xyz="0.000965358167256403 -0.000401902508684104 0.0821015958186473"
  735. rpy="0 0 0" />
  736. <mass
  737. value="1.46607296104848" />
  738. <inertia
  739. ixx="0.000912451903459497"
  740. ixy="4.46616409910369E-07"
  741. ixz="1.48579793260901E-06"
  742. iyy="0.000611954971548081"
  743. iyz="-4.2375158773756E-05"
  744. izz="0.00074913166271684" />
  745. </inertial>
  746. <visual>
  747. <origin
  748. xyz="0 0 0"
  749. rpy="0 0 0" />
  750. <geometry>
  751. <mesh
  752. filename="package://ymbot_d_description/meshes/Left_Arm_Link5.STL" />
  753. </geometry>
  754. <material
  755. name="">
  756. <color
  757. rgba="0.698039215686274 0.698039215686274 0.698039215686274 1" />
  758. </material>
  759. </visual>
  760. <collision>
  761. <origin
  762. xyz="0 0 0"
  763. rpy="0 0 0" />
  764. <geometry>
  765. <mesh
  766. filename="package://ymbot_d_description/meshes/Left_Arm_Link5.STL" />
  767. </geometry>
  768. </collision>
  769. </link>
  770. <joint
  771. name="Left_Arm_Joint5"
  772. type="revolute">
  773. <origin
  774. xyz="0.063 0 0"
  775. rpy="0 1.5708 0" />
  776. <parent
  777. link="Left_Arm_Link4" />
  778. <child
  779. link="Left_Arm_Link5" />
  780. <axis
  781. xyz="0 0 1" />
  782. <!-- <limit
  783. lower="-2.791111111"
  784. upper="2.791111111"
  785. effort="100.0"
  786. velocity="2.5" /> -->
  787. <limit
  788. lower="-1.046666667"
  789. upper="1.046666667"
  790. effort="100.0"
  791. velocity="2.5" />
  792. <dynamics
  793. damping="0.1"
  794. friction="0.01" />
  795. </joint>
  796. <link
  797. name="Left_Arm_Link6">
  798. <inertial>
  799. <origin
  800. xyz="-0.0247392090035728 9.47111500337883E-10 0.0241139624607536"
  801. rpy="0 0 0" />
  802. <mass
  803. value="0.0273711756972766" />
  804. <inertia
  805. ixx="1.18991434244031E-05"
  806. ixy="-2.0175815397983E-13"
  807. ixz="5.24373807488259E-06"
  808. iyy="1.80518141402894E-05"
  809. iyz="1.09959333798157E-13"
  810. izz="1.26891883172816E-05" />
  811. </inertial>
  812. <visual>
  813. <origin
  814. xyz="0 0 0"
  815. rpy="0 0 0" />
  816. <geometry>
  817. <mesh
  818. filename="package://ymbot_d_description/meshes/Left_Arm_Link6.STL" />
  819. </geometry>
  820. <material
  821. name="">
  822. <color
  823. rgba="0.698039215686274 0.698039215686274 0.698039215686274 1" />
  824. </material>
  825. </visual>
  826. <collision>
  827. <origin
  828. xyz="0 0 0"
  829. rpy="0 0 0" />
  830. <geometry>
  831. <mesh
  832. filename="package://ymbot_d_description/meshes/Left_Arm_Link6.STL" />
  833. </geometry>
  834. </collision>
  835. </link>
  836. <joint
  837. name="Left_Arm_Joint6"
  838. type="revolute">
  839. <origin
  840. xyz="0 0 0.1407"
  841. rpy="0 1.5708 0" />
  842. <parent
  843. link="Left_Arm_Link5" />
  844. <child
  845. link="Left_Arm_Link6" />
  846. <axis
  847. xyz="0 0 1" />
  848. <limit
  849. lower="-1.4"
  850. upper="0.03"
  851. effort="100.0"
  852. velocity="2.5" />
  853. <!-- <limit
  854. lower="-1.9"
  855. upper="0.63"
  856. effort="100.0"
  857. velocity="2.5" /> -->
  858. <dynamics
  859. damping="0.1"
  860. friction="0.01" />
  861. </joint>
  862. <link
  863. name="Left_Arm_Link7">
  864. <inertial>
  865. <origin
  866. xyz="-0.000416243616873757 -0.000776988365598585 -0.0328080532932422"
  867. rpy="0 0 0" />
  868. <mass
  869. value="0.799411788224661" />
  870. <inertia
  871. ixx="0.000590886062911647"
  872. ixy="-5.69756810750403E-07"
  873. ixz="9.67677741293059E-07"
  874. iyy="0.000464009724138266"
  875. iyz="-4.04946090224755E-05"
  876. izz="0.000481228557111289" />
  877. </inertial>
  878. <visual>
  879. <origin
  880. xyz="0 0 0"
  881. rpy="0 0 0" />
  882. <geometry>
  883. <mesh
  884. filename="package://ymbot_d_description/meshes/Left_Arm_Link7.STL" />
  885. </geometry>
  886. <material
  887. name="">
  888. <color
  889. rgba="0.698039215686274 0.698039215686274 0.698039215686274 1" />
  890. </material>
  891. </visual>
  892. <collision>
  893. <origin
  894. xyz="0 0 0"
  895. rpy="0 0 0" />
  896. <geometry>
  897. <mesh
  898. filename="package://ymbot_d_description/meshes/Left_Arm_Link7.STL" />
  899. </geometry>
  900. </collision>
  901. </link>
  902. <joint
  903. name="Left_Arm_Joint7"
  904. type="revolute">
  905. <origin
  906. xyz="-0.051 0 0"
  907. rpy="0 1.5708 0" />
  908. <parent
  909. link="Left_Arm_Link6" />
  910. <child
  911. link="Left_Arm_Link7" />
  912. <axis
  913. xyz="0 0 -1" />
  914. <limit
  915. lower="-2.791111111"
  916. upper="2.791111111"
  917. effort="100.0"
  918. velocity="2.5" />
  919. <dynamics
  920. damping="0.1"
  921. friction="0.01" />
  922. </joint>
  923. <link
  924. name="Left_Arm_Link8">
  925. <inertial>
  926. <origin
  927. xyz="0.0 0.0 0.0"
  928. rpy="0 0 0" />
  929. <mass
  930. value="0.25707" />
  931. <inertia
  932. ixx="0.00018156"
  933. ixy="-2.5587E-07"
  934. ixz="4.2844E-06"
  935. iyy="0.00014066"
  936. iyz="-3.4923E-07"
  937. izz="0.00010489" />
  938. </inertial>
  939. <visual>
  940. <origin
  941. xyz="0 0 0"
  942. rpy="0 0 0" />
  943. <geometry>
  944. <mesh
  945. filename="package://ymbot_d_description/meshes/Left_Arm_Link8.STL" />
  946. </geometry>
  947. <material
  948. name="">
  949. <color
  950. rgba="0.69804 0.69804 0.69804 1" />
  951. </material>
  952. </visual>
  953. <collision>
  954. <origin
  955. xyz="0 0 0"
  956. rpy="0 0 0" />
  957. <geometry>
  958. <mesh
  959. filename="package://ymbot_d_description/meshes/Left_Arm_Link8.STL" />
  960. </geometry>
  961. </collision>
  962. </link>
  963. <joint
  964. name="Left_Arm_Joint8"
  965. type="fixed">
  966. <origin
  967. xyz="0 0 -0.1267"
  968. rpy="0.0 1.5708 1.5708" />
  969. <parent
  970. link="Left_Arm_Link7" />
  971. <child
  972. link="Left_Arm_Link8" />
  973. <axis
  974. xyz="0 0 0" />
  975. </joint>
  976. <link
  977. name="Right_Arm_Link1">
  978. <inertial>
  979. <origin
  980. xyz="0.00250775166605716 -0.000136220820679434 -0.0813914149014801"
  981. rpy="0 0 0" />
  982. <mass
  983. value="0.838972132111369" />
  984. <inertia
  985. ixx="0.000751989785934903"
  986. ixy="5.88896247033445E-07"
  987. ixz="1.69046720878189E-05"
  988. iyy="0.000443278679334892"
  989. iyz="-8.0567861812989E-07"
  990. izz="0.000468957564177448" />
  991. </inertial>
  992. <visual>
  993. <origin
  994. xyz="0 0 0"
  995. rpy="0 0 0" />
  996. <geometry>
  997. <mesh
  998. filename="package://ymbot_d_description/meshes/Right_Arm_Link1.STL" />
  999. </geometry>
  1000. <material
  1001. name="">
  1002. <color
  1003. rgba="0.698039215686274 0.698039215686274 0.698039215686274 1" />
  1004. </material>
  1005. </visual>
  1006. <collision>
  1007. <origin
  1008. xyz="0 0 0"
  1009. rpy="0 0 0" />
  1010. <geometry>
  1011. <mesh
  1012. filename="package://ymbot_d_description/meshes/Right_Arm_Link1.STL" />
  1013. </geometry>
  1014. </collision>
  1015. </link>
  1016. <joint
  1017. name="Right_Arm_Joint1"
  1018. type="revolute">
  1019. <origin
  1020. xyz="0 -0.116 0"
  1021. rpy="-1.5708 0 0" />
  1022. <parent
  1023. link="Body_Link5" />
  1024. <child
  1025. link="Right_Arm_Link1" />
  1026. <axis
  1027. xyz="0 0 -1" />
  1028. <limit
  1029. lower="-2.791111111"
  1030. upper="2.791111111"
  1031. effort="100.0"
  1032. velocity="2.5" />
  1033. <dynamics
  1034. damping="0.1"
  1035. friction="0.01" />
  1036. </joint>
  1037. <link
  1038. name="Right_Arm_Link2">
  1039. <inertial>
  1040. <origin
  1041. xyz="0.00307740717136255 0.0161643526494041 0.0111753114424136"
  1042. rpy="0 0 0" />
  1043. <mass
  1044. value="0.255467545594865" />
  1045. <inertia
  1046. ixx="0.000326946465501983"
  1047. ixy="-1.77343208102917E-05"
  1048. ixz="-1.58926345380887E-06"
  1049. iyy="0.000349925938465769"
  1050. iyz="-3.8441401946173E-05"
  1051. izz="0.00047313103245942" />
  1052. </inertial>
  1053. <visual>
  1054. <origin
  1055. xyz="0 0 0"
  1056. rpy="0 0 0" />
  1057. <geometry>
  1058. <mesh
  1059. filename="package://ymbot_d_description/meshes/Right_Arm_Link2.STL" />
  1060. </geometry>
  1061. <material
  1062. name="">
  1063. <color
  1064. rgba="0.698039215686274 0.698039215686274 0.698039215686274 1" />
  1065. </material>
  1066. </visual>
  1067. <collision>
  1068. <origin
  1069. xyz="0 0 0"
  1070. rpy="0 0 0" />
  1071. <geometry>
  1072. <mesh
  1073. filename="package://ymbot_d_description/meshes/Right_Arm_Link2.STL" />
  1074. </geometry>
  1075. </collision>
  1076. </link>
  1077. <joint
  1078. name="Right_Arm_Joint2"
  1079. type="revolute">
  1080. <origin
  1081. xyz="0 0 -0.0885"
  1082. rpy="-1.5708 1.3963 -1.5708" />
  1083. <parent
  1084. link="Right_Arm_Link1" />
  1085. <child
  1086. link="Right_Arm_Link2" />
  1087. <axis
  1088. xyz="0 0 1" />
  1089. <limit
  1090. lower="-1.4"
  1091. upper="0.21"
  1092. effort="100.0"
  1093. velocity="2.5" />
  1094. <dynamics
  1095. damping="0.1"
  1096. friction="0.01" />
  1097. </joint>
  1098. <link
  1099. name="Right_Arm_Link3">
  1100. <inertial>
  1101. <origin
  1102. xyz="0.0010969 -0.00020404 -0.11438"
  1103. rpy="0 0 0" />
  1104. <mass
  1105. value="2.0471" />
  1106. <inertia
  1107. ixx="0.0037726"
  1108. ixy="1.2049E-06"
  1109. ixz="1.0745E-05"
  1110. iyy="0.0030706"
  1111. iyz="5.5513E-05"
  1112. izz="0.0019046" />
  1113. </inertial>
  1114. <visual>
  1115. <origin
  1116. xyz="0 0 0"
  1117. rpy="0 0 0" />
  1118. <geometry>
  1119. <mesh
  1120. filename="package://ymbot_d_description/meshes/Right_Arm_Link3.STL" />
  1121. </geometry>
  1122. <material
  1123. name="">
  1124. <color
  1125. rgba="0.69804 0.69804 0.69804 1" />
  1126. </material>
  1127. </visual>
  1128. <collision>
  1129. <origin
  1130. xyz="0 0 0"
  1131. rpy="0 0 0" />
  1132. <geometry>
  1133. <mesh
  1134. filename="package://ymbot_d_description/meshes/Right_Arm_Link3.STL" />
  1135. </geometry>
  1136. </collision>
  1137. </link>
  1138. <joint
  1139. name="Right_Arm_Joint3"
  1140. type="revolute">
  1141. <origin
  1142. xyz="0 0.0645 -0.0025"
  1143. rpy="1.5708 0 0" />
  1144. <parent
  1145. link="Right_Arm_Link2" />
  1146. <child
  1147. link="Right_Arm_Link3" />
  1148. <axis
  1149. xyz="0 0 -1" />
  1150. <limit
  1151. lower="-2.791111111"
  1152. upper="2.791111111"
  1153. effort="100.0"
  1154. velocity="2.5" />
  1155. <dynamics
  1156. damping="0.1"
  1157. friction="0.01" />
  1158. </joint>
  1159. <link
  1160. name="Right_Arm_Link4">
  1161. <inertial>
  1162. <origin
  1163. xyz="0.0242579469962895 -1.10023568034023E-09 0.0300095537028778"
  1164. rpy="0 0 0" />
  1165. <mass
  1166. value="0.0552392180940099" />
  1167. <inertia
  1168. ixx="3.26304813293651E-05"
  1169. ixy="1.44698531992114E-12"
  1170. ixz="-1.71609496638984E-05"
  1171. iyy="5.76495657453139E-05"
  1172. iyz="-2.07152075209454E-12"
  1173. izz="5.52528671266607E-05" />
  1174. </inertial>
  1175. <visual>
  1176. <origin
  1177. xyz="0 0 0"
  1178. rpy="0 0 0" />
  1179. <geometry>
  1180. <mesh
  1181. filename="package://ymbot_d_description/meshes/Right_Arm_Link4.STL" />
  1182. </geometry>
  1183. <material
  1184. name="">
  1185. <color
  1186. rgba="0.698039215686274 0.698039215686274 0.698039215686274 1" />
  1187. </material>
  1188. </visual>
  1189. <collision>
  1190. <origin
  1191. xyz="0 0 0"
  1192. rpy="0 0 0" />
  1193. <geometry>
  1194. <mesh
  1195. filename="package://ymbot_d_description/meshes/Right_Arm_Link4.STL" />
  1196. </geometry>
  1197. </collision>
  1198. </link>
  1199. <joint
  1200. name="Right_Arm_Joint4"
  1201. type="revolute">
  1202. <origin
  1203. xyz="0 0 -0.199"
  1204. rpy="1.5708 0.7854 1.5708" />
  1205. <parent
  1206. link="Right_Arm_Link3" />
  1207. <child
  1208. link="Right_Arm_Link4" />
  1209. <axis
  1210. xyz="0 0 1" />
  1211. <limit
  1212. lower="-0.87"
  1213. upper="0.6"
  1214. effort="100.0"
  1215. velocity="2.5" />
  1216. <dynamics
  1217. damping="0.1"
  1218. friction="0.01" />
  1219. </joint>
  1220. <link
  1221. name="Right_Arm_Link5">
  1222. <inertial>
  1223. <origin
  1224. xyz="-0.00101228479117044 -0.000261061348671543 0.0827914363154845"
  1225. rpy="0 0 0" />
  1226. <mass
  1227. value="1.43551735506232" />
  1228. <inertia
  1229. ixx="0.000839407296506402"
  1230. ixy="1.45064082256621E-06"
  1231. ixz="-1.82472008042489E-07"
  1232. iyy="0.00056792335069047"
  1233. iyz="-3.34877457754713E-05"
  1234. izz="0.000705362226016341" />
  1235. </inertial>
  1236. <visual>
  1237. <origin
  1238. xyz="0 0 0"
  1239. rpy="0 0 0" />
  1240. <geometry>
  1241. <mesh
  1242. filename="package://ymbot_d_description/meshes/Right_Arm_Link5.STL" />
  1243. </geometry>
  1244. <material
  1245. name="">
  1246. <color
  1247. rgba="0.698039215686274 0.698039215686274 0.698039215686274 1" />
  1248. </material>
  1249. </visual>
  1250. <collision>
  1251. <origin
  1252. xyz="0 0 0"
  1253. rpy="0 0 0" />
  1254. <geometry>
  1255. <mesh
  1256. filename="package://ymbot_d_description/meshes/Right_Arm_Link5.STL" />
  1257. </geometry>
  1258. </collision>
  1259. </link>
  1260. <joint
  1261. name="Right_Arm_Joint5"
  1262. type="revolute">
  1263. <origin
  1264. xyz="0.063 0 0"
  1265. rpy="-1.8104E-05 1.5708 -1.082E-05" />
  1266. <parent
  1267. link="Right_Arm_Link4" />
  1268. <child
  1269. link="Right_Arm_Link5" />
  1270. <axis
  1271. xyz="0 0 1" />
  1272. <!-- <limit
  1273. lower="-2.791111111"
  1274. upper="2.791111111"
  1275. effort="100.0"
  1276. velocity="2.5" /> -->
  1277. <limit
  1278. lower="-1.046666667"
  1279. upper="1.046666667"
  1280. effort="100.0"
  1281. velocity="2.5" />
  1282. <dynamics
  1283. damping="0.1"
  1284. friction="0.01" />
  1285. </joint>
  1286. <link
  1287. name="Right_Arm_Link6">
  1288. <inertial>
  1289. <origin
  1290. xyz="-0.0247392089866109 -9.12557807097869E-10 -0.0241139624730627"
  1291. rpy="0 0 0" />
  1292. <mass
  1293. value="0.0273711756575834" />
  1294. <inertia
  1295. ixx="1.18991434100551E-05"
  1296. ixy="2.01863747648133E-13"
  1297. ixz="-5.2437380722917E-06"
  1298. iyy="1.80518141349293E-05"
  1299. iyz="1.17916871642538E-13"
  1300. izz="1.26891882965786E-05" />
  1301. </inertial>
  1302. <visual>
  1303. <origin
  1304. xyz="0 0 0"
  1305. rpy="0 0 0" />
  1306. <geometry>
  1307. <mesh
  1308. filename="package://ymbot_d_description/meshes/Right_Arm_Link6.STL" />
  1309. </geometry>
  1310. <material
  1311. name="">
  1312. <color
  1313. rgba="0.698039215686274 0.698039215686274 0.698039215686274 1" />
  1314. </material>
  1315. </visual>
  1316. <collision>
  1317. <origin
  1318. xyz="0 0 0"
  1319. rpy="0 0 0" />
  1320. <geometry>
  1321. <mesh
  1322. filename="package://ymbot_d_description/meshes/Right_Arm_Link6.STL" />
  1323. </geometry>
  1324. </collision>
  1325. </link>
  1326. <joint
  1327. name="Right_Arm_Joint6"
  1328. type="revolute">
  1329. <origin
  1330. xyz="0 0 0.1407"
  1331. rpy="-3.1416 1.5708 3.1416" />
  1332. <parent
  1333. link="Right_Arm_Link5" />
  1334. <child
  1335. link="Right_Arm_Link6" />
  1336. <axis
  1337. xyz="0 0 -1" />
  1338. <limit
  1339. lower="-0.05"
  1340. upper="1.4"
  1341. effort="100.0"
  1342. velocity="2.5" />
  1343. <!-- TODO: 如果不带外壳 可以尝试放开6关节限制 -->
  1344. <!-- <limit
  1345. lower="-0.63"
  1346. upper="1.9"
  1347. effort="100.0"
  1348. velocity="2.5" /> -->
  1349. <dynamics
  1350. damping="0.1"
  1351. friction="0.01" />
  1352. </joint>
  1353. <link
  1354. name="Right_Arm_Link7">
  1355. <inertial>
  1356. <origin
  1357. xyz="7.94267771177595E-05 -0.000653331883059272 -0.0329550326760396"
  1358. rpy="0 0 0" />
  1359. <mass
  1360. value="0.771614187666742" />
  1361. <inertia
  1362. ixx="0.00052268588803615"
  1363. ixy="-8.07986728161559E-07"
  1364. ixz="1.64607734776642E-06"
  1365. iyy="0.000417242681777081"
  1366. iyz="-3.26900361063905E-05"
  1367. izz="0.000449067784209485" />
  1368. </inertial>
  1369. <visual>
  1370. <origin
  1371. xyz="0 0 0"
  1372. rpy="0 0 0" />
  1373. <geometry>
  1374. <mesh
  1375. filename="package://ymbot_d_description/meshes/Right_Arm_Link7.STL" />
  1376. </geometry>
  1377. <material
  1378. name="">
  1379. <color
  1380. rgba="0.698039215686274 0.698039215686274 0.698039215686274 1" />
  1381. </material>
  1382. </visual>
  1383. <collision>
  1384. <origin
  1385. xyz="0 0 0"
  1386. rpy="0 0 0" />
  1387. <geometry>
  1388. <mesh
  1389. filename="package://ymbot_d_description/meshes/Right_Arm_Link7.STL" />
  1390. </geometry>
  1391. </collision>
  1392. </link>
  1393. <joint
  1394. name="Right_Arm_Joint7"
  1395. type="revolute">
  1396. <origin
  1397. xyz="-0.051 0 0"
  1398. rpy="0 1.5708 0" />
  1399. <parent
  1400. link="Right_Arm_Link6" />
  1401. <child
  1402. link="Right_Arm_Link7" />
  1403. <axis
  1404. xyz="0 0 -1" />
  1405. <limit
  1406. lower="-2.791111111"
  1407. upper="2.791111111"
  1408. effort="100.0"
  1409. velocity="2.5" />
  1410. <dynamics
  1411. damping="0.1"
  1412. friction="0.01" />
  1413. </joint>
  1414. <link
  1415. name="Right_Arm_Link8">
  1416. <inertial>
  1417. <origin
  1418. xyz="0.0 0.0 0.0"
  1419. rpy="0 0 0" />
  1420. <mass
  1421. value="0.21167" />
  1422. <inertia
  1423. ixx="0.00015953"
  1424. ixy="-2.0473E-07"
  1425. ixz="3.9566E-06"
  1426. iyy="0.00012858"
  1427. iyz="-1.0943E-07"
  1428. izz="9.3873E-05" />
  1429. </inertial>
  1430. <visual>
  1431. <origin
  1432. xyz="0 0 0"
  1433. rpy="0 0 0" />
  1434. <geometry>
  1435. <mesh
  1436. filename="package://ymbot_d_description/meshes/Right_Arm_Link8.STL" />
  1437. </geometry>
  1438. <material
  1439. name="">
  1440. <color
  1441. rgba="0.69804 0.69804 0.69804 1" />
  1442. </material>
  1443. </visual>
  1444. <collision>
  1445. <origin
  1446. xyz="0 0 0"
  1447. rpy="0 0 0" />
  1448. <geometry>
  1449. <mesh
  1450. filename="package://ymbot_d_description/meshes/Right_Arm_Link8.STL" />
  1451. </geometry>
  1452. </collision>
  1453. </link>
  1454. <joint
  1455. name="Right_Arm_Joint8"
  1456. type="fixed">
  1457. <origin
  1458. xyz="0 0 -0.1267"
  1459. rpy="0.0 1.5708 1.5708" />
  1460. <parent
  1461. link="Right_Arm_Link7" />
  1462. <child
  1463. link="Right_Arm_Link8" />
  1464. <axis
  1465. xyz="0 0 0" />
  1466. </joint>
  1467. <link
  1468. name="Driven_Wheel_Link1">
  1469. <inertial>
  1470. <origin
  1471. xyz="0.0033346 3.7628E-08 -0.0082757"
  1472. rpy="0 0 0" />
  1473. <mass
  1474. value="0.014785" />
  1475. <inertia
  1476. ixx="3.581E-06"
  1477. ixy="-3.424E-12"
  1478. ixz="-5.1741E-07"
  1479. iyy="3.2077E-06"
  1480. iyz="-7.7305E-12"
  1481. izz="3.879E-06" />
  1482. </inertial>
  1483. <visual>
  1484. <origin
  1485. xyz="0 0 0"
  1486. rpy="0 0 0" />
  1487. <geometry>
  1488. <mesh
  1489. filename="package://ymbot_d_description/meshes/Driven_Wheel_Link1.STL" />
  1490. </geometry>
  1491. <material
  1492. name="">
  1493. <color
  1494. rgba="0.79216 0.81961 0.93333 1" />
  1495. </material>
  1496. </visual>
  1497. <collision>
  1498. <origin
  1499. xyz="0 0 0"
  1500. rpy="0 0 0" />
  1501. <geometry>
  1502. <mesh
  1503. filename="package://ymbot_d_description/meshes/Driven_Wheel_Link1.STL" />
  1504. </geometry>
  1505. </collision>
  1506. </link>
  1507. <joint
  1508. name="Driven_Wheel_Joint1"
  1509. type="fixed">
  1510. <origin
  1511. xyz="0.215 0.14 0.041"
  1512. rpy="0 0 0" />
  1513. <parent
  1514. link="base_link" />
  1515. <child
  1516. link="Driven_Wheel_Link1" />
  1517. <axis
  1518. xyz="0 0 -1" />
  1519. </joint>
  1520. <link
  1521. name="Driven_Wheel_Link2">
  1522. <inertial>
  1523. <origin
  1524. xyz="-9.05022268238298E-09 -6.74460487459783E-15 -7.57172102794357E-14"
  1525. rpy="0 0 0" />
  1526. <mass
  1527. value="0.0294759307719972" />
  1528. <inertia
  1529. ixx="4.25575267887633E-06"
  1530. ixy="-3.87579603937299E-19"
  1531. ixz="-2.38375211456409E-18"
  1532. iyy="4.25578479889487E-06"
  1533. iyz="-1.66003916605682E-12"
  1534. izz="5.52622327218642E-06" />
  1535. </inertial>
  1536. <visual>
  1537. <origin
  1538. xyz="0 0 0"
  1539. rpy="0 0 0" />
  1540. <geometry>
  1541. <mesh
  1542. filename="package://ymbot_d_description/meshes/Driven_Wheel_Link2.STL" />
  1543. </geometry>
  1544. <material
  1545. name="">
  1546. <color
  1547. rgba="0.792156862745098 0.819607843137255 0.933333333333333 1" />
  1548. </material>
  1549. </visual>
  1550. <collision>
  1551. <origin
  1552. xyz="0 0 0"
  1553. rpy="0 0 0" />
  1554. <geometry>
  1555. <mesh
  1556. filename="package://ymbot_d_description/meshes/Driven_Wheel_Link2.STL" />
  1557. </geometry>
  1558. </collision>
  1559. </link>
  1560. <joint
  1561. name="Driven_Wheel_Joint2"
  1562. type="fixed">
  1563. <origin
  1564. xyz="0.02 0 -0.039"
  1565. rpy="1.5708 0 0" />
  1566. <parent
  1567. link="Driven_Wheel_Link1" />
  1568. <child
  1569. link="Driven_Wheel_Link2" />
  1570. <axis
  1571. xyz="0 0 1" />
  1572. </joint>
  1573. <link
  1574. name="Driven_Wheel_Link3">
  1575. <inertial>
  1576. <origin
  1577. xyz="-0.00333456704338905 -3.76281779623788E-08 -0.00827567857349057"
  1578. rpy="0 0 0" />
  1579. <mass
  1580. value="0.0147852658911139" />
  1581. <inertia
  1582. ixx="3.58104194328234E-06"
  1583. ixy="-3.42399130366491E-12"
  1584. ixz="5.17414443984988E-07"
  1585. iyy="3.20768824570684E-06"
  1586. iyz="7.73053261381817E-12"
  1587. izz="3.87896363023522E-06" />
  1588. </inertial>
  1589. <visual>
  1590. <origin
  1591. xyz="0 0 0"
  1592. rpy="0 0 0" />
  1593. <geometry>
  1594. <mesh
  1595. filename="package://ymbot_d_description/meshes/Driven_Wheel_Link3.STL" />
  1596. </geometry>
  1597. <material
  1598. name="">
  1599. <color
  1600. rgba="0.792156862745098 0.819607843137255 0.933333333333333 1" />
  1601. </material>
  1602. </visual>
  1603. <collision>
  1604. <origin
  1605. xyz="0 0 0"
  1606. rpy="0 0 0" />
  1607. <geometry>
  1608. <mesh
  1609. filename="package://ymbot_d_description/meshes/Driven_Wheel_Link3.STL" />
  1610. </geometry>
  1611. </collision>
  1612. </link>
  1613. <joint
  1614. name="Driven_Wheel_Joint3"
  1615. type="fixed">
  1616. <origin
  1617. xyz="-0.275 0.14 0.041"
  1618. rpy="0 0 0" />
  1619. <parent
  1620. link="base_link" />
  1621. <child
  1622. link="Driven_Wheel_Link3" />
  1623. <axis
  1624. xyz="0 0 -1" />
  1625. </joint>
  1626. <link
  1627. name="Driven_Wheel_Link4">
  1628. <inertial>
  1629. <origin
  1630. xyz="9.05022273789413E-09 -6.7168492989822E-15 7.56061879769732E-14"
  1631. rpy="0 0 0" />
  1632. <mass
  1633. value="0.029475930771997" />
  1634. <inertia
  1635. ixx="4.25575267887629E-06"
  1636. ixy="3.84649399219913E-19"
  1637. ixz="-2.38257276947723E-18"
  1638. iyy="4.25578479889483E-06"
  1639. iyz="1.66003915118332E-12"
  1640. izz="5.52622327218638E-06" />
  1641. </inertial>
  1642. <visual>
  1643. <origin
  1644. xyz="0 0 0"
  1645. rpy="0 0 0" />
  1646. <geometry>
  1647. <mesh
  1648. filename="package://ymbot_d_description/meshes/Driven_Wheel_Link4.STL" />
  1649. </geometry>
  1650. <material
  1651. name="">
  1652. <color
  1653. rgba="0.792156862745098 0.819607843137255 0.933333333333333 1" />
  1654. </material>
  1655. </visual>
  1656. <collision>
  1657. <origin
  1658. xyz="0 0 0"
  1659. rpy="0 0 0" />
  1660. <geometry>
  1661. <mesh
  1662. filename="package://ymbot_d_description/meshes/Driven_Wheel_Link4.STL" />
  1663. </geometry>
  1664. </collision>
  1665. </link>
  1666. <joint
  1667. name="Driven_Wheel_Joint4"
  1668. type="fixed">
  1669. <origin
  1670. xyz="-0.02 0 -0.039"
  1671. rpy="1.5708 0 0" />
  1672. <parent
  1673. link="Driven_Wheel_Link3" />
  1674. <child
  1675. link="Driven_Wheel_Link4" />
  1676. <axis
  1677. xyz="0 0 -1" />
  1678. </joint>
  1679. <link
  1680. name="Driven_Wheel_Link5">
  1681. <inertial>
  1682. <origin
  1683. xyz="0.00333456704338897 3.76281779346233E-08 -0.00827567857349087"
  1684. rpy="0 0 0" />
  1685. <mass
  1686. value="0.014785265891114" />
  1687. <inertia
  1688. ixx="3.5810419432824E-06"
  1689. ixy="-3.42399132723456E-12"
  1690. ixz="-5.17414443984929E-07"
  1691. iyy="3.20768824570688E-06"
  1692. iyz="-7.73053261773635E-12"
  1693. izz="3.87896363023522E-06" />
  1694. </inertial>
  1695. <visual>
  1696. <origin
  1697. xyz="0 0 0"
  1698. rpy="0 0 0" />
  1699. <geometry>
  1700. <mesh
  1701. filename="package://ymbot_d_description/meshes/Driven_Wheel_Link5.STL" />
  1702. </geometry>
  1703. <material
  1704. name="">
  1705. <color
  1706. rgba="0.792156862745098 0.819607843137255 0.933333333333333 1" />
  1707. </material>
  1708. </visual>
  1709. <collision>
  1710. <origin
  1711. xyz="0 0 0"
  1712. rpy="0 0 0" />
  1713. <geometry>
  1714. <mesh
  1715. filename="package://ymbot_d_description/meshes/Driven_Wheel_Link5.STL" />
  1716. </geometry>
  1717. </collision>
  1718. </link>
  1719. <joint
  1720. name="Driven_Wheel_Joint5"
  1721. type="fixed">
  1722. <origin
  1723. xyz="0.215 -0.14 0.039693"
  1724. rpy="0 0 0" />
  1725. <parent
  1726. link="base_link" />
  1727. <child
  1728. link="Driven_Wheel_Link5" />
  1729. <axis
  1730. xyz="0 0 -1" />
  1731. </joint>
  1732. <link
  1733. name="Driven_Wheel_Link6">
  1734. <inertial>
  1735. <origin
  1736. xyz="-9.05022279340528E-09 -6.74460487459783E-15 -7.56061879769732E-14"
  1737. rpy="0 0 0" />
  1738. <mass
  1739. value="0.0294759307719969" />
  1740. <inertia
  1741. ixx="4.25575267887627E-06"
  1742. ixy="-3.87348932432216E-19"
  1743. ixz="-2.38068239894147E-18"
  1744. iyy="4.2557847988948E-06"
  1745. iyz="-1.66003913915454E-12"
  1746. izz="5.52622327218635E-06" />
  1747. </inertial>
  1748. <visual>
  1749. <origin
  1750. xyz="0 0 0"
  1751. rpy="0 0 0" />
  1752. <geometry>
  1753. <mesh
  1754. filename="package://ymbot_d_description/meshes/Driven_Wheel_Link6.STL" />
  1755. </geometry>
  1756. <material
  1757. name="">
  1758. <color
  1759. rgba="0.792156862745098 0.819607843137255 0.933333333333333 1" />
  1760. </material>
  1761. </visual>
  1762. <collision>
  1763. <origin
  1764. xyz="0 0 0"
  1765. rpy="0 0 0" />
  1766. <geometry>
  1767. <mesh
  1768. filename="package://ymbot_d_description/meshes/Driven_Wheel_Link6.STL" />
  1769. </geometry>
  1770. </collision>
  1771. </link>
  1772. <joint
  1773. name="Driven_Wheel_Joint6"
  1774. type="fixed">
  1775. <origin
  1776. xyz="0.02 0 -0.039"
  1777. rpy="1.5708 0 0" />
  1778. <parent
  1779. link="Driven_Wheel_Link5" />
  1780. <child
  1781. link="Driven_Wheel_Link6" />
  1782. <axis
  1783. xyz="0 0 1" />
  1784. </joint>
  1785. <link
  1786. name="Driven_Wheel_Link7">
  1787. <inertial>
  1788. <origin
  1789. xyz="-0.00333456704338903 -3.76281778791121E-08 -0.00827567857349087"
  1790. rpy="0 0 0" />
  1791. <mass
  1792. value="0.0147852658911137" />
  1793. <inertia
  1794. ixx="3.58104194328237E-06"
  1795. ixy="-3.42399129644902E-12"
  1796. ixz="5.17414443984963E-07"
  1797. iyy="3.20768824570686E-06"
  1798. iyz="7.73053260764444E-12"
  1799. izz="3.87896363023521E-06" />
  1800. </inertial>
  1801. <visual>
  1802. <origin
  1803. xyz="0 0 0"
  1804. rpy="0 0 0" />
  1805. <geometry>
  1806. <mesh
  1807. filename="package://ymbot_d_description/meshes/Driven_Wheel_Link7.STL" />
  1808. </geometry>
  1809. <material
  1810. name="">
  1811. <color
  1812. rgba="0.792156862745098 0.819607843137255 0.933333333333333 1" />
  1813. </material>
  1814. </visual>
  1815. <collision>
  1816. <origin
  1817. xyz="0 0 0"
  1818. rpy="0 0 0" />
  1819. <geometry>
  1820. <mesh
  1821. filename="package://ymbot_d_description/meshes/Driven_Wheel_Link7.STL" />
  1822. </geometry>
  1823. </collision>
  1824. </link>
  1825. <joint
  1826. name="Driven_Wheel_Joint7"
  1827. type="fixed">
  1828. <origin
  1829. xyz="-0.275 -0.14 0.041"
  1830. rpy="0 0 0" />
  1831. <parent
  1832. link="base_link" />
  1833. <child
  1834. link="Driven_Wheel_Link7" />
  1835. <axis
  1836. xyz="0 0 -1" />
  1837. </joint>
  1838. <link
  1839. name="Driven_Wheel_Link8">
  1840. <inertial>
  1841. <origin
  1842. xyz="9.05022273789413E-09 -6.68909372336657E-15 7.56616991282044E-14"
  1843. rpy="0 0 0" />
  1844. <mass
  1845. value="0.0294759307719968" />
  1846. <inertia
  1847. ixx="4.25575267887626E-06"
  1848. ixy="3.86543809681533E-19"
  1849. ixz="-2.38401621528862E-18"
  1850. iyy="4.2557847988948E-06"
  1851. iyz="1.66003914463259E-12"
  1852. izz="5.52622327218633E-06" />
  1853. </inertial>
  1854. <visual>
  1855. <origin
  1856. xyz="0 0 0"
  1857. rpy="0 0 0" />
  1858. <geometry>
  1859. <mesh
  1860. filename="package://ymbot_d_description/meshes/Driven_Wheel_Link8.STL" />
  1861. </geometry>
  1862. <material
  1863. name="">
  1864. <color
  1865. rgba="0.792156862745098 0.819607843137255 0.933333333333333 1" />
  1866. </material>
  1867. </visual>
  1868. <collision>
  1869. <origin
  1870. xyz="0 0 0"
  1871. rpy="0 0 0" />
  1872. <geometry>
  1873. <mesh
  1874. filename="package://ymbot_d_description/meshes/Driven_Wheel_Link8.STL" />
  1875. </geometry>
  1876. </collision>
  1877. </link>
  1878. <joint
  1879. name="Driven_Wheel_Joint8"
  1880. type="fixed">
  1881. <origin
  1882. xyz="-0.02 0 -0.039"
  1883. rpy="1.5708 0 0" />
  1884. <parent
  1885. link="Driven_Wheel_Link7" />
  1886. <child
  1887. link="Driven_Wheel_Link8" />
  1888. <axis
  1889. xyz="0 0 -1" />
  1890. </joint>
  1891. <link
  1892. name="Driving_Wheel_Link1">
  1893. <inertial>
  1894. <origin
  1895. xyz="-4.8413801856384E-09 -6.23688331063965E-06 -0.0430767857786644"
  1896. rpy="0 0 0" />
  1897. <mass
  1898. value="3.02170182800955" />
  1899. <inertia
  1900. ixx="0.00547791506005889"
  1901. ixy="-4.41461813179246E-10"
  1902. ixz="3.80651517467808E-10"
  1903. iyy="0.00547801108188701"
  1904. iyz="-1.1068722639418E-06"
  1905. izz="0.00948944280146741" />
  1906. </inertial>
  1907. <visual>
  1908. <origin
  1909. xyz="0 0 0"
  1910. rpy="0 0 0" />
  1911. <geometry>
  1912. <mesh
  1913. filename="package://ymbot_d_description/meshes/Driving_Wheel_Link1.STL" />
  1914. </geometry>
  1915. <material
  1916. name="">
  1917. <color
  1918. rgba="0.698039215686274 0.698039215686274 0.698039215686274 1" />
  1919. </material>
  1920. </visual>
  1921. <collision>
  1922. <origin
  1923. xyz="0 0 0"
  1924. rpy="0 0 0" />
  1925. <geometry>
  1926. <mesh
  1927. filename="package://ymbot_d_description/meshes/Driving_Wheel_Link1.STL" />
  1928. </geometry>
  1929. </collision>
  1930. </link>
  1931. <joint
  1932. name="Driving_Wheel_Joint1"
  1933. type="fixed">
  1934. <origin
  1935. xyz="-0.005 0.18 0.0665"
  1936. rpy="1.5708 0 0" />
  1937. <parent
  1938. link="base_link" />
  1939. <child
  1940. link="Driving_Wheel_Link1" />
  1941. <axis
  1942. xyz="0 0 1" />
  1943. </joint>
  1944. <link
  1945. name="Driving_Wheel_Link2">
  1946. <inertial>
  1947. <origin
  1948. xyz="4.83444362320284E-09 -6.23688437320635E-06 0.0430767857799618"
  1949. rpy="0 0 0" />
  1950. <mass
  1951. value="3.02170182785084" />
  1952. <inertia
  1953. ixx="0.00547791505979762"
  1954. ixy="4.41485928228232E-10"
  1955. ixz="3.81169188910475E-10"
  1956. iyy="0.00547801108142406"
  1957. iyz="1.10687234323167E-06"
  1958. izz="0.00948944280093685" />
  1959. </inertial>
  1960. <visual>
  1961. <origin
  1962. xyz="0 0 0"
  1963. rpy="0 0 0" />
  1964. <geometry>
  1965. <mesh
  1966. filename="package://ymbot_d_description/meshes/Driving_Wheel_Link2.STL" />
  1967. </geometry>
  1968. <material
  1969. name="">
  1970. <color
  1971. rgba="0.698039215686274 0.698039215686274 0.698039215686274 1" />
  1972. </material>
  1973. </visual>
  1974. <collision>
  1975. <origin
  1976. xyz="0 0 0"
  1977. rpy="0 0 0" />
  1978. <geometry>
  1979. <mesh
  1980. filename="package://ymbot_d_description/meshes/Driving_Wheel_Link2.STL" />
  1981. </geometry>
  1982. </collision>
  1983. </link>
  1984. <joint
  1985. name="Driving_Wheel_Joint2"
  1986. type="fixed">
  1987. <origin
  1988. xyz="-0.005 -0.18 0.0665"
  1989. rpy="1.5708 0 0" />
  1990. <parent
  1991. link="base_link" />
  1992. <child
  1993. link="Driving_Wheel_Link2" />
  1994. <axis
  1995. xyz="0 0 -1" />
  1996. </joint>
  1997. </robot>