- 1、本文档共10页,可阅读全部内容。
- 2、有哪些信誉好的足球投注网站(book118)网站文档一经付费(服务费),不意味着购买了该文档的版权,仅供个人/单位学习、研究之用,不得用于商业用途,未经授权,严禁复制、发行、汇编、翻译或者网络传播等,侵权必究。
- 3、本站所有内容均由合作方或网友上传,本站不对文档的完整性、权威性及其观点立场正确性做任何保证或承诺!文档内容仅供研究参考,付费前请自行鉴别。如您付费,意味着您自己接受本站规则且自行承担风险,本站不退款、不进行额外附加服务;查看《如何避免下载的几个坑》。如果您已付费下载过本站文档,您可以点击 这里二次下载。
- 4、如文档侵犯商业秘密、侵犯著作权、侵犯人身权等,请点击“版权申诉”(推荐),也可以打举报电话:400-050-0827(电话支持时间:9:00-18:30)。
- 5、该文档为VIP文档,如果想要下载,成为VIP会员后,下载免费。
- 6、成为VIP后,下载本文档将扣除1次下载权益。下载后,不支持退款、换文档。如有疑问请联系我们。
- 7、成为VIP后,您将拥有八大权益,权益包括:VIP文档下载权益、阅读免打扰、文档格式转换、高级专利检索、专属身份标志、高级客服、多端互通、版权登记。
- 8、VIP文档为合作方或网友上传,每下载1次, 网站将根据用户上传文档的质量评分、类型等,对文档贡献者给予高额补贴、流量扶持。如果你也想贡献VIP文档。上传文档
查看更多
R机构矩阵法求解运动学
1..建立D-H坐标系。
D-H坐标(后置)
杆号
转角变量θi
连杆扭角αi
连杆间距di
连杆长度ai
1
-
0.5
0
2
0.5
0
3
-
0.5
0
4
0.5
0
5
0
0
0.5
0
2.计算ii-1T
ii-1T=ii-1RP000i;
ii-1R=CθiSθi-SθiCαiSαiSθiCθiCαi-CθiSαi0SαiCαi;
P=aiCθiaiSθidi;ii-1T=Cθi-SθiCαiSθiCθiCαiSαiSθiaiCθi-CθiSαiaiSθi0Sαi00Cαidi01.即:
10T=Cθ1-Sθ1Cα1Sθ1Cθ1Cα1Sα1Sθ1a1Cθ1-Cθ1Sα1a1Sθ10Sα100Cα1d101 即:10T=Cθ10Sθ10-Sθ10Cθ100 -10 0 0 0.50 1
∴ 21T=Cθ20Sθ20Sθ20-Cθ200 10 0 0 0.50 1; 32T=Cθ30Sθ30-Sθ30Cθ300 -10 0 0 0.50 1;
43T=Cθ40Sθ40Sθ40-Cθ400 10 0 0 0.50 1; t4T=1 00 10 00 0 0 00 0 1 0.5 0 1
3. 任意设定各关节变量,计算(解运动学正问题);
设定θ1=θ2=θ3=θ4=π3 ,则:
t0T=10T?21T?32T?43T?t4T
=0.500000.86000-0.866000.500000 -10 0 0 0.50 1?0.500000.860000.86600-0.500000 10 0 0 0.50 1?0.500000.86000-0.866000.500000 -10 0 0 0.50 1?
0.500000.860000.86600-0.500000 10 0 0 0.50 1 . 1 00 10 00 0 0 00 0 1 0.5 0 1
=-0.6875 -0.6495-0.3247 -0.1250 -0.3247 -0.7036 0.9374 1.0312 -0.6495 0.75000 0-0.1250 1.0625 0 1.0000
4. 利用Paul反变换法求解各关节变量.
∵ t0T=10T?21T?32T?43T?t4T
在式的两边同时乘10T-1得:10T-1?t0T=21T?32T?43T?t4T………………………………………⑴
由10T得10T-1=Cθ1Sθ10000-10.5-Sθ1Cθ1000001
∴⑴式左边为
10T-1?t0T=Cθ1Sθ10000-10.5-Sθ1Cθ1000001?-0.6875 -0.6495-0.3247 -0.1250 -0.3247 -0.7036 0.9374 1.0312 -0.6495 0.75000 0-0.1250 1.0625 0 1.0000=
-0.6875C1-0.3247S1-0.6495C1-0.1250S10.6495-0.7500-0.3247C1+0.9374S1-0.7036C1+1.0312S10.1250-1.06250.6875S1-0.3247C10.6495S1-0.1250C1000.3247S1+0.9374C10.7036S1+1.0312C101
⑴ 式右边为:
21T?32T?43T?t4T =nxoxnyoyaxpxaypynzoz00azpz01 其中:
nx=Cθ2Cθ3Cθ4-Sθ2Sθ4 ; ny=Sθ2Cθ3Cθ4+Cθ2Sθ4 ; nz=Sθ3Cθ4
ox=-Sθ3Cθ2 ; oy=-Sθ3Sθ2 ; oz=Cθ3
ax=Cθ2Cθ3Sθ4+Cθ4Sθ2 ; ay=Sθ2Cθ3Sθ4-Cθ2Cθ4 ; az=Sθ3Sθ4
px=0.5Cθ2Cθ3Sθ4+0.5Cθ4Sθ2-0.5Sθ3Cθ2+0.5Sθ2 ;
py=0.5Sθ2Cθ3Sθ4-0.5Cθ4Cθ2-0.5Sθ3Sθ2-0.5Cθ2 ;
pz=0.5Sθ3Sθ4+0.5Cθ3+0.5
由⑴
文档评论(0)