各关节序号从J1开始,逐个递增至J6。在上图中+
键表示关节转动的正方向,-
键表示关节转动的负方向。
关节 | 各关节旋转法向 | 关节坐标 |
---|---|---|
J1 | [0, 0, 1] | [0, 0, 0.065] |
J2 | [0, 1, 0] | [0, 0, 0.1115] |
J3 | [0, 1, 0] | [-0.35, 0. 0.1115] |
J4 | [0, 1, 0] | [-0.132, 0, 0.1685] |
J5 | [0, 0, 1] | [-0.06, 0, 0.1685] |
J6 | [1, 0, 0] | [-0.0128, 0, 0.1685] |
实际计算采用弧度制,还有其他如坐标轴、惯性矩阵等信息都在unitree_ros/robots/z1_description/xacro的文件里有描述。
其中手爪装载平面(即J6末端平面)的绝对初始位置为[0,049, 0, 0.1605],即无手爪时的笛卡尔系末端计算位姿。
Unitree_gripper电机中心(并非手爪位型中心)相对于装载平面的位置为[0.0382, 0, 0],有手爪时最终的末端计算位姿为[0.0872, 0, 0.1605]。