PUMA560机器人运动学分析_第1页
PUMA560机器人运动学分析_第2页
PUMA560机器人运动学分析_第3页
PUMA560机器人运动学分析_第4页
PUMA560机器人运动学分析_第5页
已阅读5页，还剩12页未读， 继续免费阅读

下载本文档

版权说明：本文档由用户提供并上传，收益归属内容提供方，若内容存在侵权，请进行举报或认领

文档简介

1、PUMA560机器人运动学分析,1.PUMA560机器人的参数设计,2.PUMA560机器人运动学分析,1. PUMA560机器人的参数设计 1.1 坐标系的建立,PUMA560 机器人及其坐标系的建立示意图,1.2 PUMA560机器人连杆参数,2. PUMA560机器人的运动学分析 2.1 连杆变换矩阵（D-H矩阵） (1)沿Xi-1 轴平移ai-1 , 将Oi-1 移动到Oi-1 ; (2)以Xi-1为转轴, 旋转i-1 角度, 使新的Zi-1轴与Zi轴同向; (3)沿Zi 平移di, 使Oi-1 移动到Oi ; (4)以Zi 轴为转轴, 旋转i 角度, 使新的Xi-1轴与Xi 轴同向。

2、 Ai =Trans(ai-1,0,0) Rot(Xi-1, i-1) Trans(0,0, di ) Rot(Zi , i) =,2.2 机器人正向运动学 第i 坐标系相对于第i -1 坐标系的位姿Ai , 则第i 坐标系相对于基坐标系的位姿的齐次变换矩阵 0Ti , 表示为: 0Ti =A1 A2 Ai （式1） 当i =6 时, 0T6 确定了机器人末端连杆坐标系相对于基坐标系的位姿。 0T6 =A1 A2 A6 , （式2） 其中：,2.3 Matlab求解机器人末端位姿 将PUMA560机器人的参数带入上述矩阵中，然后在matlab中计算求解,得到末端位姿。 编程：,2.4 PUMA

3、560机器人逆运动学 即为针对下式给定的末端位姿，求解机器人各个关节角16。,nx ox ax px T= ny oy ay py =A1 A2 A3 A4 A5 A6 （式3） nz oz az pz 0 0 0 1,位姿运动学方程,c1表示cos1 ；c23 表示cos(2+3)其他类推,（1）求1 对式3两边左乘A1-1,得 A1-1T=A2 A3 A4 A5 A6 （式4） 将等式两端分别展开得 t11 t12 t13 cos1p+sin1p m11 m12 m13 a2c2+a3c23d4s23 t21 t22 t23 -sin1p+cos1p = m21 m22 m23 d2 t3

4、1 t32 t33 p m31 m32 m33 -a2s2-a3s23d4c23 0 0 0 1 0 0 0 1 将等式两边的矩阵中第4列第2行元素对应，得 -sin1 px +cos2 py =d2 （式5）,（2）求3 在选定1后，令等式两边矩阵第4列第1行和第4列第3行的元素对应相等，得到 对上式取平方和，有,利用三角代换 带入式5中，得1的解为,同样的，用三角代换求出3 （3）求2 式3左右乘以A1A2 A3的逆矩阵，得 A3-1 A2-1 A1-1 T=A4 A5 A6 经过一系列变换得,（4）求4 根据矩阵对应，得到等式 5180时，便有 5=0时，这时z4 与z6轴重合， 4 与 6 的转动效果相同，会有无穷组解,（5）求5 通

人人文库> 全部分类> 教育资料 > 课件下载

温馨提示

  • 1. 本站所有资源如无特殊说明，都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
  • 2. 本站的文档不包含任何第三方提供的附件图纸等，如果需要附件，请联系上传者。文件的所有权益归上传用户所有。
  • 3. 本站RAR压缩包中若带图纸，网页内容里面会有图纸预览，若没有图纸预览就没有图纸。
  • 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
  • 5. 人人文库网仅提供信息存储空间，仅对用户上传内容的表现方式做保护处理，对用户上传分享的文档内容本身不做任何修改或编辑，并不能对任何下载内容负责。
  • 6. 下载文件中如有侵权或不适当内容，请与我们联系，我们立即纠正。
  • 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。

最新文档

评论

0/150

提交评论