杆4
X5 Y6
杆5
X6
根据D-H表示法,确定了相邻 连杆坐标系{i}与{i-1}的齐次变 换矩阵,最后根据正向运动学 方程,写出机器人的总变换矩
阵
60T 01T •21T •32T •43T •54T •65T 01T (q1)•21T (q2 )•32T (q3 )•43T (q4 )•54T (q5 )•65T (q6 )
2 50 ( 2
6 4
2 ) 25 4
6 75 2
2 2
8
解法2
T Rot(zA,1)Trans(l1,0,0)Rot(zB ,2 )Trans(l2,0,0)
cos 45 sin 45 0 01 0 0 100cos(30 ) sin(30 ) 0 01 0 0 50
sin
45
cos 45
0 00 1 0
0
sin(30
)
cos(30 )
0 00 1 0
0
0
0 1 00 0 1 0 0
0
1 00 0 1 0
0
0
0 10 0 0
1
0
0
0
1
0
0
0
1
6 4
2 4
6 4
2 4
0
0
2 6 44 2 6 44
0
0
0
25
6 125 2
2
2
0
25
6 75 2
2 2
1
0
0
6 0
R
6 0
P
0
0
0
1
6
正向运动学计算-例题
• 某机器人有2个关节,分OA别OB位 于 , 点,O机C 械手中心为 点。这三个点分别为三个坐 标系的原点,调整机器人各 关节l1 使100得,l2 末50端,1 操 45作,2器 最30终到 达指定位置(未沿Z轴发生平 移),其中