机器人学得一个正运动学的例子_第1页
机器人学得一个正运动学的例子_第2页
机器人学得一个正运动学的例子_第3页
机器人学得一个正运动学的例子_第4页
机器人学得一个正运动学的例子_第5页
已阅读5页,还剩2页未读 继续免费阅读

下载本文档

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

文档简介

1、PUMA 560 运动分析(表示)1 正解PUMA 560是属于关节式机器人,6个关节都是转动关节。前3个关节确定手腕参考点的位置,后3个关节确定手腕的方位。各连杆坐标系如图1所示。相应的连杆参数列于表1。图 1 机器人模型PUMA560每个关节均有角度零位与正负方向限位开关,机器人的回转机体实现机器人机体绕轴的回转(角),它由固定底座和回转工作台组成。安装在轴中心的驱动电机经传动装置,可以实现工作台的回转。大臂、小臂的平衡由机器人中的平衡装置控制,在机器人的回转工作台上安装有大臂台座,将大臂下端关节支承在台座上,大臂的上端关节用于支承小臂。大臂臂体的下端安有直流伺服电机,可控制大臂上下摆动(

2、角 )。小臂支承于大臂臂体的上关节处,其驱动电机可带动小臂做上下俯仰(角),以及小臂的回转()。机器人的腕部位于小臂臂体前端,通过伺服电动机传动,可实现腕部摆动()和转动()。下图为简化模型:图 2 机器人简化模型表1机械手的末端装置即为连杆6的坐标系,它与连杆坐标系的关系可由表示: 可得连杆变换通式为 : 据连杆变换通式式(2)和表1所示连杆参数,可求得各连杆变换矩阵如下:各连杆变换矩阵相乘,得PUMA 560的机械手变换的T 矩阵: 即为关节变量的函数。 该矩阵描述了末端连杆坐标系6相对基坐标系0的位姿。于是,可求得机械手的T 变换矩阵: 2 逆解由上面可得: 若末端连杆的位姿已经给定,即

3、为已知,则求关节变量的值称为运动反解。用未知的连杆逆变换左乘方程(6)两边,把关节变量分离出来,从而求得的解。122.1 求用逆变换左乘式(6)两边: 两边(2,4)项元素对应相等: 利用三角代换: 其中 ,(9)代入(8),得: 式中,正、负号对应于的两个可能解。2.2 求(7)式两边(1,4)项和(3,4)项元素对应相等,可得: 式(8)和式(10)的平方和为:其中式(11)中已经消去了,且方程(11)和(8)有相同的形式,因而可用三角代换求解式中,正负号对应有两种可能解。2.3 求两边(1,4)项和(2,4)项元素对应相等:根据解的四种可能组合可以得到相应的四种可能值,于是可得到的四种可能解:式中,取与相对应的值。2.4 求式(13)两边(1,3)项和(3,3)项元素对应相等:2.5 求两边(1,3)项和(3,3)项元素对应相等:2.6 求两边(3,1)项和(1,1)项元素对应相等:PUMA560的运动反解可能存在8种解,但是,由于结构的限制,例如各关节变量不能在全部

温馨提示

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

评论

0/150

提交评论