机械臂urdf

机械臂的坐标系层级,以及每个 link 之间的相对平移、旋转关系,这是理解机械臂位姿建模的核心。我会按坐标系层级 + 逐关节 / 连杆位姿拆解的方式,清晰呈现所有关键关系。

一、整体坐标系层级(核心骨架)

整个机械臂的坐标系从根到末端的传递路径:

plaintext

world(虚拟根) 
  ↓ fixed关节(无偏移)
base_link(基座)
  ↓ JM0关节(旋转+平移)
JM0_Link(关节0连杆)
  ↓ JM1-2关节(旋转+平移)
JM1-2_Link(关节1-2连杆)
  ↓ JM4-3关节(平移)
JM4-3_Link(关节4-3连杆)
  ↓ JM4关节(平移)
JM4_Link(关节4连杆)
  ↓ JM5关节(旋转+平移)
JM5_Link(关节5连杆)
  ↓ YB关节(旋转+平移)
YB_Link(末端夹爪/工具连杆)

二、逐环节拆解:各 Link 的相对平移 / 旋转关系

以下所有位姿均为子 Link 相对于父 Link的最终位姿(关节 origin + Link 自身 origin,抵消 / 叠加后):

1. world → base_link(虚拟根→基座)
连接关节关节 originLink 自身 origin最终相对位姿
world_to_base(fixed)xyz=(0,0,0) rpy=(0,0,0)base_link 所有 origin 的 rpy=0,inertial xyz≈(0,-0.0196,0.0102)平移:base_link 质心≈(0,-0.0196,0.0102) m 旋转:无(rpy=0)

关键:world 是虚拟根,base_link 相对于 world 无旋转,仅质心有微小平移(惯性坐标系),视觉 / 碰撞模型与 world 坐标系完全重合。

2. base_link → JM0_Link(基座→关节 0 连杆)
连接关节关节 originLink 自身 origin最终相对位姿
JM0(revolute)xyz=(0,-0.0495,-0.0196)m rpy=(1.5708,0,0)(绕 X 轴 + 90°)JM0_Link 所有 origin 的 rpy=0 inertial xyz≈(0,-0.0036,0.0020)m平移: X=0+0=0m Y=-0.0495-0.0036=-0.0531m Z=-0.0196+0.0020=-0.0176m 旋转:绕 X 轴 + 90°(仅关节旋转,Link 无抵消)
3. JM0_Link → JM1-2_Link(关节 0→关节 1-2 连杆)
连接关节关节 originLink 自身 origin最终相对位姿
JM1-2(revolute)xyz=(0,-0.0735,0)m rpy=(-1.5708,0,0)(绕 X 轴 - 90°)JM1-2_Link 所有 origin 的 rpy=0 inertial xyz=(0.0104,-0.1937,-0.0010)m平移: X=0+0.0104=0.0104m Y=-0.0735-0.1937=-0.2672m Z=0-0.0010=-0.0010m 旋转:绕 X 轴 - 90°(仅关节旋转,Link 无抵消)

关键:JM1-2 关节的 - 90° 旋转抵消了 JM0 关节的 + 90° 旋转,JM1-2_Link 相对于 base_link 的总旋转为 0(+90°-90°)。

4. JM1-2_Link → JM4-3_Link(关节 1-2→关节 4-3 连杆)
连接关节关节 originLink 自身 origin最终相对位姿
JM4-3(revolute)xyz=(0.0207,-0.3875,0.084)m rpy=(0,0,0)JM4-3_Link 所有 origin 的 rpy=0 inertial xyz≈(0,-0.1730,-0.0004)m平移: X=0.0207+0=0.0207m Y=-0.3875-0.1730=-0.5605m Z=0.084-0.0004=0.0836m 旋转:无(rpy=0)

关键:无旋转,仅纯平移,是机械臂 “大臂” 的延伸。

5. JM4-3_Link → JM4_Link(关节 4-3→关节 4 连杆)
连接关节关节 originLink 自身 origin最终相对位姿
JM4(revolute)xyz=(0,-0.375,-0.084)m rpy=(0,0,0)JM4_Link 所有 origin 的 rpy=0 inertial xyz≈(0,0.0020,0.0036)m平移: X=0+0=0m Y=-0.375+0.0020=-0.3730m Z=-0.084+0.0036=-0.0804m 旋转:无(rpy=0)
6. JM4_Link → JM5_Link(关节 4→关节 5 连杆)
连接关节关节 originLink 自身 origin最终相对位姿
JM5(revolute)xyz=(0,-0.084,0)m rpy=(1.5708,0,0)(绕 X 轴 + 90°)JM5_Link 所有 origin 的 rpy=0 inertial xyz≈(0,0.0020,-0.0036)m平移: X=0+0=0m Y=-0.084+0.0020=-0.0820m Z=0-0.0036=-0.0036m 旋转:绕 X 轴 + 90°
7. JM5_Link → YB_Link(关节 5→末端连杆)
连接关节关节 originLink 自身 origin最终相对位姿
YB(revolute)xyz=(0,-0.03,0)m rpy=(1.5708,0,0)(绕 X 轴 + 90°)YB_Link 所有 origin 的 rpy=0 inertial xyz≈(0,0,0.0039)m平移: X=0+0=0m Y=-0.03+0=-0.03m Z=0+0.0039=0.0039m 旋转:绕 X 轴 + 90°

关键:末端 YB_Link 相对于 JM5_Link 有 + 90° 旋转,是机械臂工具端的最终姿态调整。

三、关键补充:旋转轴与运动约束

所有旋转关节(JM0/JM1-2/JM4-3/JM4/JM5/YB)的旋转轴均为:axis xyz="0 0 1"(绕 Z 轴旋转),且运动范围均为 -1.5264 ~ 1.5264 rad(≈±87.5°),最大力矩 10N・m,最大速度 1rad/s。

总结

  1. 坐标系传递核心:机械臂位姿由 “关节 origin(父→子的基础偏移)+ Link 自身 origin(子自身的微调)” 叠加而成,旋转主要由关节的 rpy 提供,Link 自身无额外旋转(rpy=0)。
  2. 旋转关键抵消:JM0 关节的 + 90° 旋转被 JM1-2 关节的 - 90° 旋转抵消,使机械臂大臂(JM1-2_Link)回到与基座平行的姿态。
  3. 平移规律:所有 Link 的视觉 / 碰撞模型自身无平移(xyz=0),仅惯性坐标系(质心)有微小偏移;机械臂的整体延伸主要由关节的 xyz 参数决定。

关键点:整个机械臂的旋转仅出现在 JM0/JM1-2/JM5/YB 关节(均绕 X 轴 ±90°),所有关节的运动旋转轴均为 Z 轴;平移则是通过各关节的 xyz 参数逐步延伸,从基座到末端累计偏移约 1.3m(Y 轴为主方向)。

深度思考

PPT 生成

编程

帮我写作

更多

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值