03T 01T12T 23T
如此类推,对于六连杆机器人,有下列矩阵:
06T 01T 12T 23T 34T 45T 56T
3.2 3.2 机械手运动学方程
26
0 6
T
3.1.4 连杆变换矩阵及其乘积
06T 01T12T 23T 34T 45T 56T
机器人运动学方程
此式右边表示了从固定参考系到手部坐标系的各连杆
一个六连杆机械手可具有六个自由度,每个连杆含 有一个自由度,并能在其运动范围内任意定位与定向。 其中三个自由度用于规定位置,而另外三个自由度用 来规定姿态。
8
3.1.1 连杆坐标系
机械手的运动方向
机器人手部的位置和姿态也可以
用固连于手部的坐标系{B}的位姿
来表示
关节轴为ZB, ZB轴的单位方向 矢量α称为接近矢量,指向朝外。
(1) 坐标系{i-1}绕xi-1轴转角αi-1,使Zi-1与Zi平行,算子为Rot(x, αi-1) ; (2) 沿Xi-1轴平移ai-1,使Zi-1和Zi共线, 算子为Trans(ai-1,0,0); (3)绕Zi轴转角θi; 使得使Xi-1与Xi平行, 算子为Rot(z,θi);
(4) 沿Zi轴平移di。使得i-1系和i系重合, 算子为Trans(0,0,di)。
3.2.1 机器人正运动学方程
连杆 i 1
2
3
连杆长 度ai-1
0
a0
a1
连杆偏距 di 0
0
d2
连杆扭角 αi-1 00
00
-900
关节角 θi
θ1(00) θ2(00) θ3(00)
3.2.1 机器人正运动学方程
该3自由度机器人的运动学方程为: