R机构矩阵法求解运动学.docVIP

R机构矩阵法求解运动学.doc

此“教育”领域文档为创作者个人分享资料,不作为权威性指导和指引,仅供参考
  1. 1、本文档共10页,可阅读全部内容。
  2. 2、有哪些信誉好的足球投注网站(book118)网站文档一经付费(服务费),不意味着购买了该文档的版权,仅供个人/单位学习、研究之用,不得用于商业用途,未经授权,严禁复制、发行、汇编、翻译或者网络传播等,侵权必究。
  3. 3、本站所有内容均由合作方或网友上传,本站不对文档的完整性、权威性及其观点立场正确性做任何保证或承诺!文档内容仅供研究参考,付费前请自行鉴别。如您付费,意味着您自己接受本站规则且自行承担风险,本站不退款、不进行额外附加服务;查看《如何避免下载的几个坑》。如果您已付费下载过本站文档,您可以点击 这里二次下载
  4. 4、如文档侵犯商业秘密、侵犯著作权、侵犯人身权等,请点击“版权申诉”(推荐),也可以打举报电话:400-050-0827(电话支持时间:9:00-18:30)。
  5. 5、该文档为VIP文档,如果想要下载,成为VIP会员后,下载免费。
  6. 6、成为VIP后,下载本文档将扣除1次下载权益。下载后,不支持退款、换文档。如有疑问请联系我们
  7. 7、成为VIP后,您将拥有八大权益,权益包括:VIP文档下载权益、阅读免打扰、文档格式转换、高级专利检索、专属身份标志、高级客服、多端互通、版权登记。
  8. 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)

panguoxiang + 关注
实名认证
文档贡献者

该用户很懒,什么也没介绍

1亿VIP精品文档

相关文档