机器人技术基础大作业.pdf
KUKA KR40PA 码垛机器人运动学仿真目录目录摘要.31 引言.41.1 机器人发展.41.1.1发展.41.1.2现状.52 KUKA 机器人综述.62.1 公司简介.62.2 产品.63 机器人理论基础.73.1.求正运动学公式.73.2 运动学逆解.83.3静力分析.94机器人建模.104.1 问题描述.104.2 模型描述.105仿 真.115.1轨迹规划.115.2 特征曲线.135.2.1位移曲线.135.2.2速度曲线.145.2.3加速度曲线.16总结.17参考文献.18摘摘要要本次作业主要针对KUKA KR40PA码垛机器人进行运动学仿真，根据已知的条件和需要以KUKA机器人为研究对象，对KUKA机器人进行运动学仿真，通过讨论该机器人的运动学问题，然后在matlab环境下，用simmechanics工具箱对该机器人的正运动学、逆运动学、轨迹规划进行了仿真,通过仿真，观察到了机器人各个关节的运动，并得到了所需的数据，从而能够达到预定的目标.关键字关键字：KUKA KR40PA 码垛机器人运动学仿真 matlab1 1 引引言言1.11.1 机器人发展机器人发展1.1.11.1.1发展发展虽然机器人已经历了30 多个春秋,繁衍了三代,是一个拥有几十万台机器人的大家族,可是至今还没有统一的定义。什么叫做机器人?在世界范围内,对于什么是机器人,以及什么不属护机器人,在看法上存在着很大的差差别。为此在第 18 届 ISIR(国际机器人学术讨论会)期间,专门成立了一个工作小组,它的任务是制定机器人分类的标准,并确定机器人数量的原则。总之,不管机器人的定义如何,现在的工业机器人已从原来概念的“纲领工人”或“通用自动机”逐步演进为从事专门任务的柔性机械。进入80 年代以后,机器人的发展十分迅速。198 0 年,全世界工业机器人仅有1 万多台,可是到 1984 年,除了中国、前苏联和东欧国家之外,全世界已有工业机器人102444 台,其中以日本为最多,高达4.4万台,其次是美国,共有1.3万台,以下依次是:德国6600台、法国 3380 台、瑞典 2400 台。联合国欧洲经济委员会于 1992 年 2 月 21 日发表的报告表明,到1990 年底止,世界上共有机器人46万台为1984年的4倍多,其中日本高达27.4万台,仍高踞世界榜首,其次是除独联体以外的欧洲国家,共有工业机器人7.6 万台,其中德国占 3 7%,达 2.8 万台,美国为 4 万台。其它接受调查的大多数国家地区,1990 年的工业机器人数量增长幅度都达到了两位数。Brigham young 大学的 Red 博士在其 1999 年 SME 的国际机器人会议上所作关于技术发展趋势的报告中也强调了开放式结构和插人式问题。他说,数字控制技术正在推动着允许采用分布式结构的运动方法和控制,以及用于数字驱动的高速网络,使工业机器人正在运动得更快,并实现其关节和曲线运动及它们的传动的优化。校准技术在控制器中筛选路径和位置的数据,可以调整机器人对现实位置的不精确运动。更高的机器人精度意味着机器人的性能与仿真研究之间的关系更为接近.。据世界未来学预测,世纪初,第三代智能机器人将大量投放市场,今后 50 年内,智能机器人将可获得广泛的应用,人工智能与机器人的结合,将会使机器人科学带来革命性的变化。随着微电脑技术的发展,机器人的总体结构与控制方式发生了新的变化,机器人的设计已越来越新颖,其主要趋势是:智能强、精度高、速度快、强度大、能适应多种工作要求。它比一般机器人具有更大的灵活性,能排除人为的不可控因素,可实现高节奏、高效率和高质量的生产。如美国西屋 电气公司的电机机器人装配系统,可进行 8 种小型电机装配;日本研制的智能机器人可用于电机组装、集成电路压焊和电刷电路检查等。近几年来,随着微型机器的发展,新一代微型机器人异军突起。麻省理工学院声称,无需人类监督并能迅速完成工作的微型机器人是他们近儿年内的奋斗目标。目前美、日、德竟相研制的智能跳蚤机器人,将比蚊子机器人具有更大的本领,它既可捉虫,充当清洁工,又可作为武器扫一击敌人,还可上天充当太空机器人。我国工业机器人起步于 20 世纪 70 年代初期,经过 30 多年发展,大致经历了 3 个阶段:70 年代萌芽期,80 年代的开发期和 90 年代的应用化期。随着 20 世纪 70 年代世界科技快速发展，工业机器人的应用在世界掀起了一个高潮,在这种背景下,我国于 1972 年开始研制自己的工业机器人。进入 20 世纪 80 年代后,随着改革开放的不断深入,在高技术浪潮的冲击下,我国机器人技术的开发与研究得到了政府的重视与支持,七五期间,国家投入资金,对工定机器人及零部件进行攻关,完成了示教再现式工业机器人成套技术的开发,研制出了喷漆,点焊,弧焊和搬运机器人。1986 年,国家高技术研究发展计划开始实施,经过几年研究,取得了一大批科研成果,成功地研制出了一批特种机器人。从 20 世纪 90 年代初期起,我国的国民经济进入实现两个根本转变期,掀起了新一轮的经济体制改革和技术进步热潮,我国的工业机器人又在实践中迈进了一大步,先后研制了点焊,弧焊,装配,喷漆,切割,搬运,码垛等各种用途的工业机器人,并实施了一批机器人应用工程,形成了一批工业机器人产业化基地,为我国机器人产业的腾飞奠定了基础。但是与发达国家相比，我国工业机器人还有很大差距。目前，我国工业机器人公司主要有中国新松机器自动化股份有限公司和首钢莫托曼机器人有限公司。1.1.21.1.2现状现状机器人是最典型的机电一体化数字化装备，技术附加值很高，应用范围很广，作为先进制造业的支撑技术和信息化社会的新兴产业，将对未来生产和社会发展起越来越重要的作用。国外专家预测，机器人产业是继汽车、计算机之后出现的新的大型高技术产业。据国际机器人联合会（IFR）统计，世界机器人市场前景看好，从 20 世纪下半叶起，世界机器人产业一直保持着稳步增长的良好势头。机器人广泛应用于各行各业。主要进行焊接、装配、搬运、加工、喷涂、码垛等复杂作业。目前，全球现役工业机器人 103万台。过去 10 年，机器人的价格降低约80%，现在继续下降，而欧美劳动力成本上涨了40%。现役机器人的平均寿命在10 年以上，可能高达15 年，它们还易于重新使用。由于机器人及自动化成套装备对提高制造业自动化水平，提高产品质量和生产效率、增强企业市场竞争力、改善劳动条件等起到了重大的作用，加之成本大幅度降低和性能的迅速提高，其增长速度较快。机器人的应用主要有两种方式，一种是机器人工作单元，另一种是带机器人的生产线，并且后者在国外已经成为机器人应用的主要方式。以机器人为核心的自动化生产线适应了现代制造业多品种、少批量的柔性生产发展方向，具有广阔的市场发展前景和强劲生命力，已开发出多种面向汽车、电气机械等行业的自动化成套装备和生产线产品。在发达国家，机器人自动化生产线已形成一个巨大的产业，年市场容量约为 1000 亿美元。像国际上著名公司ABB、Comau、KUKA、BOSCH、NDC、SWISSLOG、村田等都是机器人自动化生产线及物流与仓储自动化设备的集成供应商。从 90 年代初期起，我国的国民经济进入实现两个根本转变时期，掀起了新一轮的经济体制改革和技术进步热潮，我国的工业机器人又在实践中迈进一大步，先后研制出了点焊、弧焊、装配、喷漆、切割、搬运、包装码垛等各种用途的工业机器人，并实施了一批机器人应用工程，形成了一批机器人产业化基地，为我国机器人产业的腾飞奠定了基础。虽然中国的工业机器人产业在不断的进步中，但和国际同行相比，差距依旧明显。从市场占有率来说，更无法相提并论。工业机器人很多核心技术，当前我们尚未掌握，这是影响我国机器人产业发展的一个重要瓶颈。总的来看，我国的工业机器人及其工程应用的水平和国外比还有一定的距离。当前我国的工业机器人生产都是应客户的需求，“一客户，一次重新设计”，品种多，规模小，零部件通用化程度低，供货周期长，成本也不低，而且质量也不稳定。因此迫切需要产业化前期的关键技术，对产品进行全面规划，搞好系列化、通用化、模块化设计，积极推动产业进程。国际上通常以制造业机器人密度(其指每一万名雇佣工人中所拥有的多功能机器人数量)来衡量一个国家的自动化水平。国际机器人联合会(IFR)的数据显示，中国2011 年的这一数字是 21，国际平均水平是 55，中国与日本的 339、韩国的 347 尚有较大的差距。不过中国的增速非常快，从装机量上看，从 1999 年到 2008 年，中国工业机器人的装机量每年都以超过 20%的速度增长，从 1999 年 550 台发展到 2008 年超过 3 万台。甚至在全球经济陷入一片萧条的2009 年，中国工业机器人销量却逆势而上。2010 年中国的装机量为 52290 台，2011 年上涨到了 74317 台，实现了 42%的年增长。从销售来看，中国的机器人销量从2010 年的14978 台增加到 2011 年的 22577 台，年增长超过 50%。业内人士表示，目前，国内工业机器人实际拥有量应该超过10 万台。IFR 预计，中国将成为全球最大的工业机器人市场。2 KUKA2 KUKA 机器人综述机器人综述2.12.1 公司简介公司简介库卡（KUKA）柔性系统制造有限公司，原公司名为KUKA 焊接设备有限公司，是为汽车制造、航天、能源及工业领域提供柔性自动化系统设备的公司。现今，库卡（KUKA）柔性系统制造有限公司和KUKA 机器人有限公司附属于位于德国奥格斯堡的 KUKA 股份集团公司。库卡系统的自动化设备被应用于大众，宝马，通用汽车，克莱斯勒，福特及奔驰等汽车生产线上，同时也应用于空中客车，博西家用电器的其他领域。库卡系统已在中国市场活跃了 20 余年。2000 年 9 月，库卡自动化设备（上海）有限公司正式成立。2004 年 7 月，库卡柔性系统制造（上海）有限公司在上海青浦工业园成立。它是一家及工程部和大型装配车间为一体的生产型企业，提供集设计、建造和安装的一整套服务体系。2.22.2 产品产品KukaKR40PA机器人是一种有四个自由度的码垛机器人，有四个驱动器，很好地运用了平行四边形机构，固定其姿态从而大大简化了控制难度，并且提高了精度及寿命，本文所用 kuka 码垛机器人如下图所示：3 3 机器人理论基础机器人理论基础3.1.3.1.求正运动学公式求正运动学公式D-H 参数表：i12345i-10-900090ai-100l2l30di00000i12345c1s100c2s200s1c1001T=001001T=00210s2c20000010001c3s30l2c4s40l3s3c3003T=s4c40023T=00410001000010001c5s500c1s100100T=s1c1000045T=s5c5100100000010100c1c2c1s200c1c2c1s200s1c2c1000T=0T*2T=s1c2c1000012T=1T*2T=3230010001000010001l3c1c23+c1c2l20R4l3s1c23+s1c2l20034T=3T*4T=l3s23s2l20001由于平行四边形机构的存在使得14R=1000010100104R=1R*4R=s1c1所以04Ts10100c10s1c10*001 =s10c1000100101=l3c1c23+c1c2l2l3s1c23+s1c2l2l3s23 s2l21004R0l3c1c23+c1c2l2c10s1l3s1c23+s1c2l2=s10c1010l3s23 s2l200001雅克比矩阵：c(1 5)s(1 5)0l3c1c23+c1c2l2s(1 5)c(1 5)0l3s1c23+s1c2l2040T=T*T=455001l3s23 s2l20001l3c1s23 c1s2l2l3s1s23 s1s2l2l3c23 l2c2s1c10l3c1s2300l3s1s2300l3c2300s1s10c1c10001l3s1c23 s1c2l2l3c1c23+c1c2l2005JV0J=50=05Jw013.23.2 运动学逆解运动学逆解在此只对位置逆解进行分析，姿态逆解只与15有关因此很简单就可以计算出来。假设我们给出目标位置在0 坐标系表示坐标为(X,Y,Z),由变换矩阵我们可以得出：X=l3c1c23+c1c2l2Y=l3s1c23+s1c2l2Z=l3s23 s2l2用式除以式可以得到 tan1=Y/X利用 2 幅角反正切公式可以得到 1=Atan2（y,x）。式与式可以写成如下形式：X/c1=l3c23+c2l2-Z=l3s23+s2l2两式左右两边分别平方相加得到下式：22(X/c1)2+z2=l2+l3+2l2l3c3又因为 tan1=Y/X22可解得 c3=(X2+Y2+Z2-l2-l3)/2l2l3S3=1 c32 (在此期望值 S3 大于 0，因此取正)再次利用 2 幅角反正切公式可以得到3=Atan2（s3,c3）。可写成如下形式X/c1=K2c2-K3s2-z=K2s2+K3c2式中K2=l2+l3c3K3=l3s3r=K22+K32=Atan2（K3，K2）那么K2=rcosK3=rsin 式可以写成X/(rc1)=c(+2)Z/(-r)=s(+2)所以+2=Atan2（-zc1，X）2=Atan2（-zc1，X）-Atan2（K3，K2）3.33.3静力分析静力分析1q12Fxq2Fy3q3FFzq4q4Mx5q5M6qyM6zTqFT6TqFTJ qFTFTJ6x6y66z6x6y6zJTFJT 14 4 机器人建模机器人建模4.14.1 问题描述问题描述研究码垛机器手臂在除抓手以外其它关节已给定运动状态下，抓手在各个方向上的运动位移、速度和加速度的变化情况。4.24.2 模型描述模型描述在本项目中，首先用三维建模工具 soildworks 对码垛机器手臂建模，模型由网上下载得之，然后导入 ADAMS，在此模型基础上，对其各个关节加约束和运动，最后通过运动仿真得出所需要的各个曲线。格式是 x_t，由 soildworks导出。在 soildworks 中建模：图 4.1 soildworks 中模型图将图纸转移到 ADAMS 中：图 4.2 ADAMS 中模型图5 5仿仿 真真5.15.1轨迹规划轨迹规划加速度表达式是一个三次多项式，速度表达式是一个四次多项式，位移表达式是一个五次多项式。设S 为无量纲的运动位移，为无量纲的运动总时间，V、A 为无量纲的运动速度及加速度，那么3-4-5 多项式运动曲线可以简单表示如下：S a5b4 c3 d2 e fV 5a4 4b3 3c2 2d eA 20a3 12b2 6c 2d e根据如下边界条件：（5-1）（5-2）（5-3）(1)当 0时，S 0，V 0，A 0；(2)当 1时，S 1，V 0，A 0。将以上边界条件代入上述多项式表达式，可解出多项式的系数a 6，b 15，c 10，d 0，e 0，f 0。于是，我们得到3-4-5 多项式运动曲线的表达式：S 65-154 103（5-4）V 304-603 302A 1203-1802 60由加速度多项式可解出。（5-5）（5-6）Amax 5.774为了得到带有量纲的多项式运动曲线表达式，我们令其加速度的最大值为amax，运行总时间为T，运行瞬时时刻t T，有a amax(12035.774180260)将上式对t积分得：v amax774T(3046033025.)同理有：s amax5.774T2(65154103)由此，当t T时：s smaxamaxT2 0.1732a25.774maxT5-7）（5-8）（5-9）5-10）（5.25.2 特征曲线特征曲线5.2.15.2.1位移曲线位移曲线图 4.3 x 方向的位移曲线图 4.4 y 方向的位移曲线图 4.5 z 方向的位移曲线5.2.25.2.2速度曲线速度曲线图 4.6 x 方向的速度曲线图 4.7 y 方向的速度曲线图 4.8 z 方向的速度曲线5.2.35.2.3加速度曲线加速度曲线图 4.9 x 方向的加速度曲线图 4.10 y 方向的加速度曲线图 4.11 z 方向的加速度曲线总结总结通过这次大作业，让我更加深刻了解课本知识，和以往对知识的疏忽得以补充，在作业过程中遇到一些模糊的公式和专业用语时,在使用手册时，有的数据很难查出，但是这些问题经过这次作业，都一一得以解决，我相信这本书中还有很多我为搞清楚的问题，但是这次的课程设计给我相当的基础知识，为我以后工作打下了严实的基础。虽然这次课程是那么短暂的 2 周时间，我感觉到这些天我的所学胜过我这一学期所学，这次大作业，是让我对课本知识的巩固和对基本公式的熟悉和应用，计算力学和运动学过程中的那些繁琐的数据，使我做事的耐心和仔细程度得以提高。大作业是培训学生运用本专业所学的理论知识和专业知识来分析解决实际问题的重要教学环节，是对三年所学知识的复习和巩固。同样，也促使了同学们的相互探讨，相互学习。因此，我们必须认真、谨慎、踏实、一步一步的完成。如果时间可以重来，我可能会认真的去学习和研究，也可能会自己独立的完成一个项目，我相信无论是谁看到自己做出的成果时心里一定会很兴奋。此次作业让我明白了一个很深刻的道理：团队精神固然很重要，担人往往还是要靠自己的努力，自己亲身去经历，这样自己的心里才会踏实，学到的东西才会更多。但是我对于仿真软件只是方面的缺乏让我的作业进度举步维艰，有许多仿真软件的应用都变成了我前进道路中无形的坎，我也还有许多问题没有搞懂，如果有机会，我一定更加努力的去弄懂。总之，这次课程设计使我收获很多、学会很多、比以往更有耐心很多。感谢宁老师给我们这次大作业的机会，他照耀着我们对学习的热爱，同时也增加我们对知识的追求和欲望度。参考文献参考文献1.刘极峰.机器人技术基础.高等教育出版社.2005 年.2.吴振彪.工业机器人M.武汉：华中科技大学出版社.3.李庆龄，刘加亮.六自由度工业机器人运动学分析及仿真.机电工程技术 2008年第 37 卷
