原创力文档- 1、原创力文档（book118）网站文档一经付费（服务费），不意味着购买了该文档的版权，仅供个人/单位学习、研究之用，不得用于商业用途，未经授权，严禁复制、发行、汇编、翻译或者网络传播等，侵权必究。。
- 2、本站所有内容均由合作方或网友上传，本站不对文档的完整性、权威性及其观点立场正确性做任何保证或承诺！文档内容仅供研究参考，付费前请自行鉴别。如您付费，意味着您自己接受本站规则且自行承担风险，本站不退款、不进行额外附加服务；查看《如何避免下载的几个坑》。如果您已付费下载过本站文档，您可以点击 这里二次下载。
- 3、如文档侵犯商业秘密、侵犯著作权、侵犯人身权等，请点击“版权申诉”（推荐），也可以打举报电话：400-050-0827(电话支持时间：9:00-18:30)。
- 4、该文档为VIP文档，如果想要下载，成为VIP会员后，下载免费。
- 5、成为VIP后，下载本文档将扣除1次下载权益。下载后，不支持退款、换文档。如有疑问请联系我们。
- 6、成为VIP后，您将拥有八大权益，权益包括：VIP文档下载权益、阅读免打扰、文档格式转换、高级专利检索、专属身份标志、高级客服、多端互通、版权登记。
- 7、VIP文档为合作方或网友上传，每下载1次， 网站将根据用户上传文档的质量评分、类型等，对文档贡献者给予高额补贴、流量扶持。如果你也想贡献VIP文档。上传文档
查看更多
山东大学威海分校2012年上学期工业机器人学作业论文
第 PAGE 1 页 DATE \@ M/d/yyyy 12/29/2012 作 者：李安洲
PUMA560机器人运动学论文
姓 名:
学 号:
专业及班级:
目 录
TOC \o 1-3 \h \z \u 摘 要 2
关键词 2
1.引言 2
2．PUMA560机器人数学模型的建立 2
2.1.确定D-H坐标系并获取D-参数 2
2.2建立运动学方程 3
3. 位姿的正﹑逆解 3
3.1 正 解 3
3.2 逆 解 3
3.2.1求 ，， 3
3.2.2求，， 4
4. PUMA560雅克比矩阵 5
4.1矢 量 积 法 6
4.2 微分变换法 6
5． Matlab编程对其正﹑逆解和雅克比矩阵的求解 7
5.1正解﹑逆解 7
5.2雅克比矩阵 7
6. 总结 7
参考文献 7
附件： 8
正解程序 8
逆解程序 8
雅克比矩阵的矢量法程序 10
雅克比矩阵的微分变换法程序 11
摘 要：采用D-H坐标系对机器人Puma560建立个关节的坐标系并获取D-H参数，并 对其运动建立数学模型用matlab编程对其求位姿正逆解及雅克比矩阵， catia对Puma560建模三维模型。
关键词：Puma560正逆解；雅克比矩阵；Matlab
引 言
机器人运动学包括正向运动学，即给定机器人各关节变量，计算机器人末端的位置姿态；逆向运动学即已知机器人末端的位置姿态，计算机器人对应位姿的全部关节变量。一般正向运动学的解是唯一和容易获得的，而逆向运动学往往有多个解而且分析更为复杂。机器人逆运动分析是运动规划与控制中的重要问题，但由于机器人逆运动问题的复杂性和多样性，无法建立通用的解析算法。机构逆运动学问题实际上是一个非线性超越方程组的求解问题，其中包括解的存在性、唯一性及求解的方法等一系复杂问题。本文主要通过最基本分析方法对Puma560机器人的运动进行分析，包括运动的位置和姿态的正、逆解，及其运动的雅克比矩阵的求解。
2．PUMA560机器人数学模型的建立
PUMA机器人操作臂可以看作一个开式运动链，它由一系列连杆通过转动关节串联而成，关节的相对转动导致连杆的运动。为了研究机器人各连杆的运动，建立如图1所示坐标系根据Denavil和Hartenberg提出的齐次变换矩阵法，建立机器人的运动学方程。
2.1.确定D-H坐标系并获取D-参数
PUMA560的6个关节全为转动关节:
坐标轴:沿着i+1关节的运动轴;
坐标轴:沿着和的公法线,指向离开轴的方向;
坐标轴:按右手直角坐标系法则制定;
连杆长度;和两轴心线的公法线长度;
连杆扭角: 和两轴心线的夹角;
两连杆距离:和两坐标轴的公法线距离;
两杆夹角:和两坐标轴的夹角;
D-H参数表
连杆
变量
变量范围
1
0
0
2
0
149.09
3
431.8
0
4
20.32
433.07
5
0
0
6
0
0
2.2建立运动学方程
PUMA560机器人具有六个自由度，而且六个关节均为旋转关节，前三个关节主要影响末端执行器的位置，后三个关节决定末端执行器的姿态，将机器人位置结构和姿态结构末端执行器的位置矢量和姿态转换矩阵并通过齐次变换得到：
两杆间的位姿矩阵
其中：
末端执行器位姿矩阵即PUMA560机器人的运动学方程：
3. 位姿的正﹑逆解
3.1 正 解
已知各关节的变量，求末端执行器的位姿矩阵即正解。把带入（2.1）求得各两连杆间的位姿矩阵，再由（2.2）即可求得末端执行器的位姿矩阵：
3.2 逆 解
将PUMA 560的运动方程（3.1）写为:
若末端连杆的位姿已经给定,即 和为已知,则求关节变量 的值称为运动反解.
3.2.1求 ，，
式中,正、负号对应于的两个可能解.
再令矩阵方程(3.3)两端的元素(1,4)和(3,4)分别对应相等,则得两方程:
式(3.68)与式(3.71)的平方和为:
式中,正、负号对应于的两个可能解.
令矩阵方程(3.8)两端的元素(1,4)和(2,4)分别对应相等,则得两方程:
根据和解的四
文档评论（0）