机器人技术大作业(puma机器人的关节坐标建立、D-H参数表给出、正逆运动学推导、matlab工作空间建立)
- 1、下载文档前请自行甄别文档内容的完整性，平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益，请联系客服反馈,我们会尽快为您处理(人工客服工作时间：9:00-18:30)。
PUMA机器人大作业1坐标系建立：
坐标系可以简化为：
2 D-H 参数表：
PUMA 机器人的杆件参数:
1d 0.6604m =，2d 0.14909m =，4d 0.43307m =，6d 0.05625m =，2a 0.4318m =，3a 0.02032m =
3 正运动学推导
由式1
11111111100
00
1i
i i i i i i i i i i i i i i i i i i c s a s c c c s d s T s s c s c d c θθθαθαααθαθααα-----------⎡⎤
⎢⎥--⎢⎥=
⎢⎥
⎢
⎥⎣⎦
可得： 1
11
10
1000000100001c s s c T -⎡⎤⎢⎥⎢⎥=⎢⎥
⎢⎥⎣⎦，2
2212220
0001000001c s d T s c -⎡⎤⎢⎥⎢⎥=⎢⎥
--⎢
⎥⎣⎦，3
32332300000100001c s a s c T -⎡⎤
⎢⎥⎢⎥=⎢⎥
⎢⎥⎣⎦44343
4440001000
01c s a d T s c -⎡⎤⎢⎥⎢
⎥=⎢⎥
--⎢⎥⎣⎦，
5
545550000100000
01c s T s c -⎡⎤⎢⎥-⎢⎥=⎢⎥
⎢⎥⎣⎦，6
65666000010000001c s T s c -⎡⎤⎢⎥⎢⎥=⎢⎥
--⎢⎥⎣⎦
0123456123456
T T T T T T T =
机械手变换矩阵
60
1x x x x y
y y y z z z z n o a p n o a p T n o a p ⎡⎤⎢⎥⎢⎥=⎢⎥⎢⎥⎣⎦
23654164123651654164123654164123651654164123654642365
()()()x y z n c c c c c s s c s c s c c c s s s c s n c c c c s s s s s c s s c c s c s c c n s c c c s s c c s =--++=----=--- 23654164123651654164123654164123651645164123654642365()()()x y z o c s c c c c s c s s s c s c s s c c s o c s c c s c s s s s s s s s c c c c c o s s c c s s c c s =-++-+=-+++-=++ 2354123515412354123515412352354
x y z a c s c c s c c s s s a c s c s s c s s s c a c c s s c =---=--+=-+ 3231221423121323122142312142332322
x y z p a c c a c c d s c d s p a c s a c s d s s d c p d c a s a s =+--=+-+=---
4 逆运动学推导
1．求1θ
用逆变换01
1T -左乘方程00123456123456T T T T T T T =两边： 0
10123451623456T T T T T T T -=
1111160000001000010
1x
x x x y
y y y z
z z z c s n o a p s c n o a p T n o a p ⎡⎤⎡⎤⎢⎥⎢⎥-⎢⎥⎢⎥=⎢⎥⎢⎥⎢
⎥⎢⎥⎣⎦⎣⎦
得112x y s p c p d -+=
三角代换 cos x p ρφ=，sin y p ρφ=
式中，ρ=tan 2(,)x y a p p φ=
得到1θ的解
12a tan 2(,)a tan 2(,y x p p d θ=-
2．求3θ
矩阵方程两端的元素（1，4）和（2，4）分别对应相等
1132322423
42332322x y z c p s p a c a c d s p d c a s a s +=+-⎧⎨
-=++⎩
平方和为：
4333d s a c k +=
其中 2222222
2423
2
2x y z p p p d d a a k a ++----=
解得：334a tan 2(,)a tan 2(,a d k θ=- 3．求2θ
在矩阵方程00123456123456T T T T T T T =两边左乘逆变换01
3T -。 0
1034536456T T T T T -=
123123232312312323233611200
10
1x
x x x y
y y y z
z z z c c s c s a c n o a p c s s s c a s n o a p T s c d n o a p --⎡⎤⎡⎤⎢⎥⎢⎥---⎢⎥⎢⎥=⎢⎥⎢⎥--⎢⎥⎢⎥⎣⎦⎣⎦
方程两边的元素（1，4）和（3，4）分别对应相等，得
123123233231231232323
40
0x y z x y z c c p s c p s p a a c c s p s s p c p a s d +---=⎧⎨
++-+=⎩ 联立，得23s 和23c
()()()()()()()()23411233232211233112342322
11x y z x y z x y z x y z a s d c p s p p a c a s p c p s p a c a c p s p p a s d c p c p s p ⎧-+-+=⎪⎪++⎪
⎨
+++-⎪=⎪++⎪⎩