SCARA型装配机械手结构设计

SCARA型装配机械手结构设计摘

要Scara机器人是一种由三个自由度组成的平面关节型机器人，它的主要作用是可以完成精密仪器和物体的搬运和移动。由于体积小，传动原理简单，被广泛运用于电子电气业，家用电器业，精密机械业等领域。整个系统由机器手，机器臂，关节，步进电机驱动系统等组成。通过各自由度步进电机的驱动，完成机器手，机器臂的位置变化。具体设计内容为：同步齿形带传动设计，丝杠螺母设计，各输出轴和壳体的设计,步进电机的选择等。在校核满足其结构强度的基础上，我们对scara机器人的结构进行优化设计。本论文着重研究scara机器人的结构设计和运动学分析。在论文开始首先介绍了机器人的发展及其分类情况。在论文第二，三章具体叙述了scara机器人的结构设计和运动学分析的详细过程。在论文末尾还对scara机器人进一步改进措施和应用展望进行了阐述。关键词：scara机器人，步进电机，结构设计，机器臂StructureDesignofSCARAAssemblyManipulatorAbstractASCARArobotisarobotofplaneandjointcomposedofthreedegreesoffreedom.Itsmostlyfunctionisusedtocompletetransitionandmotionofexactapparatusesandobjects.Becauseofitssmallvolumeandsimpledriveprinciple,itiswidelyusedinthefieldofelectronicandelectricindustry,home-usedelectric-wareindustryandexactmechanism.Thewholesystemiscomposedofmanipulatorhand,manipulatorarm,jointsandsteppermotordrivingsystem.Bysteppermotor’sdrivingofeachdegreeoffreedom,itcompleteslocationchangeofmanipulatorhandandmanipulatorarm.Theidiographicdesigningcontentisdesigningofin-phasetooth-shapestrap,designingofsilk-barnut,designingofshellandaxisandthechoiceofsteppermotors.Onthebaseofcheckingitsstructureintensity,whileitsatisfied,weoptimizedesigningofthestructureofSCARArobots.Thispaperputitsemphasesonresearchofitsstructuredesigningandkinematicsanalysis.Atthebeginningofthispaper,itintroducesthedevelopmentandsortofrobots.Inthesecondandthirdchapter,itintroducesdetaileddetailamongtheprocessingofthestructuredesigningofaSCARArobotanditskinematicsanalysis.Atthelast,thispapergivessomemeasuresaboutimprovingofSCARArobots,andgivesaexpectationaboutitsfuture.KeyWords:

SCARArobots,steppermotor,structuredesign,manipulatorarm目

录摘

要

iAbstract

ii第一章

绪论

11.1

机器人的特点

11.2

机器人的构成及分类

11.2.1

机器人的构成

11.2.2

机器人的分类

31.3

机器人的应用与发展

41.3.1

机器人的应用

41.4SCARA机器人的研究意义

61.4.1SCARA机器人的研究意义

61.4.2SCARA机器人的特点

71.5本文的研究内容

8第二章

SCARA机器人结构设计

92.1

SCARA机器人传动方案的比较及确定

92.2

各自由度步进电机的选择

112.2.1

第一自由度步进电机的选择

122.2.2

第二自由度步进电机的选择:

122.2.3

第三自由度步进电机的选择

132.3

同步齿形带传动设计

142.4

丝杠螺母设计

182.4.1

丝杠耐磨性计算

182.4.2

丝杠稳定性计算

192.4.3

丝杠刚度计算

192.4.4

丝杠和螺母螺纹牙强度计算

202.4.5

螺纹副自锁条件校核

212.5各输出轴的设计

212.5.1

机身输出轴设计

212.5.2

大臂输出轴设计

222.5.3

带轮轴设计:

222.5.4

升降轴设计

222.6壳体设计

23第三章

SCARA机器人运动学分析

253.1引言

253.2SCARA机器人正运动学分析

253.2.1SCARA机器人连杆坐标系的建立

253.2.2SCARA机器人正运动学问题

273.3

SCARA机器人逆运动学分析

293.4

本章小结

31第四章

总结与展望

32参考文献

33致

谢

34第一章

绪论1.1

机器人的特点机器人最显著的特点有以下几个:1.可编程。生产自动化的进一步发展是柔性自动化。机器人可随其工作环境变化的需要而再编程，因此它在小批量多品种具有均衡高效率的柔性制造过程中能发挥很好的功用，是柔性制造系统(FMS)中的一个重要组成部分。2.拟人化。机器人在机械结构上有类似人的行走、腰转、大臂、小臂、手腕、手爪等部分，在控制上有电脑。此外，智能化机器人还有许多类似人类的“生物传感器”，如皮肤型接触传感器、力传感器、负载传感器、视觉传感器、声觉传感器、语言功能等.传感器提高了机器人对周围环境的自适应能力。3.通用性。除了专门设计的专用机器人外，一般机器人在执行不同的作业任务时具有较好的通用性。比如，更换机器人手部末端操作器(手爪、工具等)便可执行不同的作业任务。4.机电一体化。机器人技术涉及的学科相当广泛，但是归纳起来是机械学和微电子技术的应用，特别是计算机技术的应用密切相关。因此，机器人技术的发展必将带动其它技术的发展，机器人技术的发展和应用水平也可以从一个方面验证一个国家科学技术和工业技术的发展和水平。1.2

机器人的构成及分类1.2.1

机器人的构成一个机器人系统，一般由操作机、驱动单元、控制装置和为使机器人进行作业而要求的外部设备组成。1.操作机(又称执行系统)操作机是机器人完成作业的实体，它具有和人手臂相似的动作功能，是可在空间抓放物体或进行其它操作的机械装置。通常由下列部分构成。(1)末端执行器又称手部，是操作机直接执行工作的装置，并可设置夹持器、工具、传感器等，是工业机器人直接与工业对象接触以完成作业的机构。(2)手腕是支承和调整末端执行器姿态的部件，主要用来确定和改变末端执行器的方位和扩大手臂的动作范围，一般具有2-3个回转自由度以调整末端执行器的姿态。有些专用机器人可以没有手腕而直接将末端执行器安装在手臂的端部。(3)手臂它由操作机的动力关节和连接杆件等构成，是用于支承和调整手腕和末端执行器位置的部件。手臂有时不止一条，而且每条手臂，也不一定只有一节(如关节型就可能有多节)，所以，它有时还应包括肘和肩的关节，即手臂和手臂间(靠近末端执行器的一节通常叫小臂，靠近机座的，通常叫大臂)，手臂与机座间用关节连接，因而扩大了末端执行器姿态的变化范围和运动范围。(4)机座有时称为立柱，是工业机器人机构中相对固定并承受响应力的基础部件。可分固定式和移动式两类，移动式机座下部安装了移动机构，它可以扩大机器人的活动范围。2.驱动单元它是由驱动器、减速器、检测元件等组成的组件，是用来为操作机各部件提供动力和运动的装置。驱动器是将电能或流体能等转换成机械能的动力装置，通常是电动机、液压或气动装置。驱动形式不同，传动装置也有所不同。3.控制装置它是由人对机器人的启动、停机及示教进行操作的一种装置，它指挥机器人按规定的要求动作。控制装置包括检测(如传感器)和控制(如计算机)两部分，可用来控制驱动单元，检测其运动参数是否符合规定要求，并进行反馈控制。这就是闭环控制。如果没有反馈控制，就是较简单的开环控制。4.人工智能系统对于智能机器人，还应有人工智能系统。它主要由两部分组成，一部分为感觉系统(硬件)，主要靠各类传感器来实现其感觉功能。另一部分为决策一规划智能系统(软件)，它包括逻辑判断、模式识别、大容量数据库和规划操作程序等功能。1.2.2

机器人的分类目前世界各国对处于发展阶段的机器人还没有统一的分类标准，大致有以下几种分类方法。1.按使用范围分类(1)固定程序的专用机器人(机械手)通常根据主机的特定要求设计成固定程序(或简单的可变程序)。这种机器人(机械手)多为气动或液动，用行程开关、机械挡块来控制其工作位置。工作对象单一，动作较少，结构与系统简单，价格低廉。(2)可编程序的通用机器人工作程序可变，以适应不同的工作对象，通用性强，适合于以多品种、中小批量生产为特点的柔性制造系统中。2.按使用行业、部门和用途分类(1)工业机器人它们又可按作业类别分为锻压、焊接、表面喷涂、装卸、装配、检测等机(2)采掘机器人如海洋探矿机器人等。(3)军事用途机器人(4)服务机器人如医疗机器人，家用机器人，教学机器人等。3.按机械结构、坐标系特点分类按机械结构坐标系特点可分为直角坐标型;圆柱坐标型;球坐标型;多关节型。4.按机器人运动控制方式分类(1)点位控制(PTP)机器人就是由点到点的控制方式，这种控制方式只能在目标点处准确控制机器人末端执行器的位置和姿态，完成预定的操作要求。目前应用的工业机器人中，很多是属于点位控制方式的，如上下料搬运机器人、点焊机器人等。(2)连续轨迹控制(CP)机器人机器人的各关节同时作受控运动，准确控制机器人末端执行器按预定的轨迹和速度运动，并能控制末端执行器沿曲线轨迹上各点的姿态。弧焊、喷漆和检测机器人等均属连续轨迹控制方式。5.按驱动方式分类按驱动方式可分为液压驱动式、气动式、电力驱动式(这是目前用得最多的一类)6.根据机器人的功能水平和技术的先进程度按“代”分类(1)第一代机器人其特点是采用开关量控制，示教再现控制或数字控制，其作业路径和运动参数需通过示教或编程给定。60年代以来，工业中实际应用的绝大多数工业机器人都属于第一代机器人，它包括可编程序(用于上下料)的工业机器人具有记忆装置的示教再现型机器人，数控型搬运机器人等。

(2)第二代机器人是70年{BANNED}始出现的，其技术特点是采用计算机直接控制，是通过具有视觉、触觉的摄像机和传感器，能“感觉”外界信息并通过计算机进行计算和分析自动地控制操作机进行运动和操作，因此，其控制方式较第一代机器人要复杂得多，目前这类机器人已开始在工业生产、排险救灾等场合应用，并将进入普及阶段。(3)第三代机器人即智能机器人。这是国内外正在积极研究，开发的高级机器人，其主要特点是具有人工智能。包括:模式识别能力、规划决策能力、知识库、专家系统、人机交互能力等。这一类机器人目前正在研究开发之中。1.3

机器人的应用与发展1.3.1

机器人的应用在发达国家，机器人己广泛地应用于工业、国防、科技、生活等各个领域。产业部门应用最多的当推汽车工业和电子工业，在金属加工、塑料成型、机械制造等行业也有普遍应用，并逐渐向纤维加。食品工业、家用产品制造等行业发展。焊接作业包括点焊和弧焊，是机器人用得最多的作业之一。传统的点焊机虽然可以减轻人的劳动强度，焊接质量也较好，但它适宜少品种大批量的生产环境，其夹具和焊枪位置不能随零件的改变而变化，而点焊机器人可通过重新编程来调整空间点位，满足不同零件的需要，故特别适宜于小批量多品种的生产环境。弧焊作业由于其焊缝多为空间复杂曲线，故多由人工完成，连续轨迹控制的机器人可以胜任此任务，故广泛用于各种复杂结构和容器的焊接。Unimate,Motoman,ASEA等都是典型的焊接机器人。喷漆作业由于环境恶劣，国外大量使用了机器人，挪威生产的Trallfa机器人是目前世界上用得最多的喷漆机器人，该机器人为关节式，6自由度，电液或全电动伺服驱动，采用示教再现方式，既可实行点位控制，也可实行连续轨迹控制。搬运物料的作业包括为机床上下料，为自动生产线转运工件，搬运机器人和数控机床一起组成柔性加工系统，一条柔性生产线可配置几台至十几台搬运机器人，典型的搬运机器人是T3和Funac机器人。机器人用于装配作业是随着视觉系统的发展而发展起来的，电子工业用得最多，主要用在电路板的装配上，还有电动机、发动机部件、阀门等产品的装配。PUMA机器人是一种典型的装配机器人，有6个自由度，关节式，直流伺服电机驱动，微机控制点位或连续轨迹，用VAL语言示教编程，其手腕机构具有顺应性，可克服装配中的误差。国外的航空航天工业中应用机器人也十分广泛，如铆接装配作业就大量使用了机器人，此外如电气插头的装配，发动机风扇外壳和高压涡轮的焊接，飞机座舱盖和风挡钻孔作业，飞机机身和垂直尾翼钻孔，都采用了机器人。某些飞机机身、机舱的喷漆作业，发动机零部件等离子喷涂也采用了机器人。在空间开发中，航天飞机上收放卫星的机器人是加拿大Spar公司生产的，美国NASA实施的火星测计划，发射了两个火星探测器海盗I和海盗H，它们也是一种机器人，在火星上采集样品，作各种实验，并能将实验结果发回地球。在海洋开发方面，美国曾用Curv号有缆水下机器人成功地从西班牙附近900米深的海底打捞一颗因B-52轰炸机失事掉入水中的氢弹。挪威卑尔根公司生产的一种水下机器人，可在水下600米处作业，装有电视摄像机，可收集海底标本，切割石油管道和缆索等。在放射性环境中，如在核电站里，机器人可用来检查、修复管道、阀门等，如日本东芝公司研制的一种蛇形机器人，具有八个关节，可以在狭小的空间里操作，臂长达2.25米，臂顶端装有电视摄像机。在军事方面，机器人己用于侦察、布雷、排除爆炸物、装填弹药等。在建筑中，己有一种爬壁机器人可用来修理墙面，擦洗窗户。此外还有摘果实、挤牛奶、剪羊毛、清理垃圾、监护病人的机器人等。总之，机器人的应用面相当广泛，机器人的工作特点是在计算机控制下离开人的干预进行各项工作。用机器人代替人，可以使人摆脱高温、有毒、粉尘、振动、放射性、强噪音等恶劣环境，而去从事机器人的监控、维护等工作，使工作性质发生了变化，减轻了劳动强度，同时也改善了就业结构。机器人工作抗干扰能力强，一心一意按所编程序工作，动作精度、重复精度高，因此能保证和提高产品质量。解决多品种小批量生产的自动化问题二随着人民生活水平的提高，人们要求提供更丰富更多样的产品。因此，用传统的生产方式难以满足人们的需求，当前柔性制造系统的飞速发展正是适应了这种发展趋势，而机器人是柔性系统中不可缺少的提高劳动生产率的关键设各。与人相比，机器人有一个最大的特点:不知疲倦、不需要休息，在合宜的条件下，可以连续工作，因此可以大大地提高劳动生产率。机器人对于改善劳动条件、减少安全事故，减少人受危险环境的伤害等方面都有显著的效果。1.4SCARA机器人的研究意义1.4.1SCARA机器人的研究意义目前，国外已有各种专用和通用的装配机器人在生产中得到应用，主要类型大致有直角坐标型、圆柱坐标型和关节型三大类。关节型装配机器人又有垂直关节型(即空间关节型)和平面关节型(即SCARA型)两种。拒统计资料介绍，在这些装配机器人中，平面关节型装配机器人是应用数量最多且较为广泛的一种装配机器人。1991年世界上4万余台在生产上应用的装配机器人中，SCARA机器人约占3/4左右。其主要应用领域为电子电气业、家用电器业、精密机械业。从事印刷电路板上电子元器件的插入作业;家用电器及仪器仪表的组装作业:小型电器开关、接触器等电器产品的组装作业。可以说，SCARA型机器人在轻型、较简单且要求机器人价格较低的装配作业中大显了身手。随着社会需求的增大和技术的进步，装配机器人将会得到迅速的发展，多品种、少批量生产方式和为提高产品质量及生产效率的生产工艺需求，将是推动装配机器人发展的直接动力。近年来计算机、CIMS及柔性自动装配系统等的发展，又为装配机器人的应用和发展提供了良好的可能性。1972年我国开始研制机器人，但发展缓慢，受经济、观念等因素的制约，基本没有什么应用，直到1986年，沈阳机器人研究所成立，中国的机器人才向实用阶段发展。随着国内教育和科技的发展，哈工大等高校出现了专门的机器人机构，研究水平在某些方面己达到国际先进水平。在应用方面，一汽等大型企业己开始使用机器人自动化生产线。但总体来说，国内机器人发展还是趋于落后，特别是在应用方面发展缓慢。究其原因，除了经济因素的制约外，很重要的一点是有关机器人的教育跟不上，知道机器人的人很多，但真正了解、懂机器人的人少而又少，这就使我国的机器人发展缺乏智力支持，加强机器人技术教育，缓解人才危机迫在眉睫。而研制结构简单、成本较低SCARA机器人用于教学可以提高教育的现代化水平，用于实际生产可以大大提高工作效率，还可以用于科学研究工作，为开发更先进的装配机器人提供有利条件，随着我国经济和科技的发展，我们有能力也有必要进行这方面的研究1.4.2SCARA机器人的特点根据工作环境、工作特点等要求，本SCARA机器人应具备以下几个特点:1.外形美观，适于观察。如果作为示教用机器人应该让观看者赏心悦目，同时能直观地了解它的构成和动作原理。故机器人的外形应巧妙设计，部分外壳应采用透明材料，内部结构应简单明了，另外，机器人的动作应连续，速度适中。2.成本低在满足所要求功能的前提下，尽可能降低成本，这是设计的基本要求.如果作为教学用机器人只要求有一些示范性动作，而对实践的功能要求不高，速度等参数可在一定范围内调整，定位精度要求也不高，故机构尽可能采用规则件、标准件，驱动元件采用便宜的步进电机，而光电码盘等测试校验元件则可不用，其功能由软件部分实现补偿。这样，结构大大简化，成本也随之降低。3.体积小，重量轻SCARA机器人要求抓取重量不大，动作范围也很小，故体积很小，展开应在60x80cm2左右。要实现SCARA机器人的四个自由度，内部零件应尽量小巧，结构应尽可能紧凑。重量轻是机器人研制的一个方向，在满足强度和刚度的条件下，零部件越轻越好，故材料要首选铝质轻质材料，零件特别是具有定位功能的壳体定位板应采用板筋结构，各零件的空间分布要合理，减小倾覆力矩。4.传动原理简单本SCARA机器人采用步进电机驱动，速度要求不高，故减速比可在一定范围内调整，只要能满足转矩即可。选择减速方案可根据空间结构要求，跨距转大的传动可选用同步带传动力求一步到位，传动简单。1.5本文的研究内容SCARA机器人为平面关节型机器人，一般采用步进电机驱动，控制简单，编程方便。主要应用于电子产品中异形元件装配，小型机电产品如电机、空压机、电器、泵类等的装配工作，是一种小型经济型机器人。该机器人的突出特点是机构承载能力强，具有较好的通用性，重复定位精度高，动作速度快，应用范围广。该论文涉及计算机技术、电子、机械等多学科的知识，主要完成了以下的工作:1.在进行充分的课题可行性论证及详细的理论计算之后，用AutoCAD等计算机图形辅助设计软件完成了SCARA机器人的机械本体结构设计。为了满足灵活性强、工作空间大、重量轻及结构紧凑等工作要求，将其设计为具有三个转动关节的机器人。2．建立了SCARA机器人的运动学数学模型，得到了运动学方程的正解和反解，并在运动学分析的基础上，求得了SCARA机器人的雅可比矩阵。第二章

SCARA机器人结构设计2.1

SCARA机器人传动方案的比较及确定初步确定以下两种可行方案：方案一：大臂转动采用谐波减速，小臂转动采用二级同步带减速，升降轴采用丝杠螺母传动，手腕转动采用步进电机直接驱动。这种方案主要考虑了传动链的简化，结构比较简单易行。方案二：大臂转动采用齿轮减速，小臂转动采用二级同步带传动，升降轴采用一级齿带传动加齿轮齿条实现升降运动。方案一具有以下特点:1.第一个自由度采用谐波减速器，适合结构特点，减速比大、体积小、重量轻、精度高、回差小、承载能力大、噪音小、效率高、定位安装方便，由于使用标准件，价格也不高。2.第二个自由度采用二级同步齿形带减速，充分利用了大臂的空间，结构紧凑，传动比恒定，传动功率大，效率较高，但对安装有一定要求，需加调整装置。3.第三个自由度采用丝杠螺母传动。电机直接驱动丝杠螺母传动的同时兼有减速的作用，一步把旋转运动转变为直线运动，传动精度较高，丝杠有自锁功能，速度不宜过高。方案二具有以下特点:1.第一个自由度采用齿轮减速，这是最常用的减速方法，传动比恒定，传动效率高，工作可靠，使用寿命长，结构紧凑，传递功率大，但传动精度低，噪音大，传动比小。齿轮的加工成本比较高，体积和重量都比较大。2.第三个自由度采用了齿带加齿轮齿条传动，基本具备齿轮传动的特点，传递功率大，传动效率高，精度低，有噪音，传动比小，工作可靠，但需要平衡装置，不能自锁。3.其它方面与方案一基本相同。两方案相比较，在传动的实现上，二者都是可行的。方案一结构比较简单，各传动元件的定位比较容易实现;方案二结构较为复杂，各部分定位都需仔细考虑。外观上，方案二显得更好一些。传动精度方面，显然方案一比较高。成本上考虑，方案一采用标准件较多，零部件较少，且比较规则，易于加工，丝杠螺母在精度要求不高的情况下，加工成本也不是很高;方案二用了很多齿轮，需专门设备加工，且各定位部件形状不规则，加工困难，这都使成本增加。故综合考虑，选择方案一。机器人驱动方案的对比分析及选择:对机器人驱动装置的一般要求如下:1.动装置的重量尽可能要轻，单位重量的输出功率(即功率/重量比)要高，效率也要高;2.反应速度要快，即要求力/重量比和力矩/惯量比要大;3.动作平滑，不产生冲击;4.控制尽可能灵活，位移偏差和速度偏差要小;5.安全可靠;6.操作和维护方便;7.对环境无污染，噪声要小;8.经济上合理，尤其是要尽量减少占地面积。通常的机器人驱动方式有以下四种:1.步进电机:可直接实现数字控制，控制结构简单，控制性能好，而且成本低廉;通常不需要反馈就能对位置和速度进行控制;位置误差不会积累;步进电机具有自锁能力(变磁阻式)和保持转矩(水磁式)的能力，这对于控制系统的定位是有利的，适于传动功率不大的关节或小型机器人。2.直流伺服电机:直流伺服电机具有良好的调速特性，较大的启动力矩，相对功率大及快速响应等特点，并且控制技术成熟。但其结构复杂，成本较高，而且需要外围转换电路与微机配合实现数字控制。若使用直流伺服电机，还要考虑电刷放电对实际工作的影响。3.交流伺服电机:交流伺服电机结构简单，运行可靠，使用维修方便，与步进电机相比价格要贵一些。随着可关断晶闸管GTO，大功率晶闸管GTR和场效应管MOSFET等电力电子器件、脉冲调宽技术(PWM)和计算机控制技术的发展，使交流伺服电机在调速性能方面可以与直流电机媲美。采用16位CPU+32位DSP三环(位置、速度、电流)全数字控制，增量式码盘的反馈可达到很高的精度。三倍过载输出扭矩可以实现很大的启动功率，提供很高的响应速度。4.液压伺服马达:液压伺服马达具有较大的功率/体积比，运动比较平稳，定位精度较高，负载能力也比较大，能够抓住重负载而不产生滑动，从体积、重量及要求的驱动功率这几项关键技术考虑，不失为一个合适的选择方案。但是，其费用较高，其液压系统经常出现漏油现象。为避免本系统也出现同类问题，在可能的前提下，本系统将尽量避免使用该种驱动方式。SCARA机器人负载并不大，决定了机器人必须重量轻(10~20Kg)，另外其作业范围也不大，所以机器人必须体积小。对此机器人，这些特点决定了它的驱动方式。又通过以上比较，由于步进电机的诸多优点，初选上述方案中的步进电机方案进行详细的计算和选择，并在此基础上参考同类机器人的驱动方案，最后确定一种适合我国国情的实施方案。SCARA机器人两个关节均选用步进电机驱动。机器人大臂，小臂均采用了二级齿带传动，升降轴采用一级齿带加齿轮齿条实现升降运动。2.2

各自由度步进电机的选择本机器人前两个自由度是平面旋转，若轴承是光滑的，则旋转所需的静转矩比较小。因为将臂伸开呈一条直线时转动惯量最大，所以在旋转开始时可产生步进电机的转矩不足。下面估算一下绕机器人臂的旋转轴的转动惯量，设两臂及手腕绕各自重心轴的转动惯量分别为JG1,JG2,JG3根据平行轴定理可得绕第一关节轴的转动惯量为:J1=JG1+m1112+JG2+m2122+JG3+m3l32(2-1)其中，m1,m2,m3分别为大臂，小臂,腕部的质量为3kg,0.8kg,4kg。11,12,l3分别为各重心到第一关节处的距离，其值为150mm,450mm,550mm。在式(2-1)中，JG1≤m1112，JG2<<m2122,JG3<<m3l32故JG1,JG2,JG3,可忽略不计,所绕第一关节轴的转动惯量为:

J1=m1112+m2122+m3l32

=3×0.152+0.8×0.452+4×0.552

(2-2)

=1.44kg.m2同理可得小臂及腕部绕第二关节轴的转动惯量:

J2=m2142+m3l52

=0.8-0.12+4×0.22

=0.168kg.m2

(2-3)式中：l4

小臂重心距第二关节轴的水平距离mm。

l5

腕部重心距第二关节轴的水平距离mm。2.2.1

第一自由度步进电机的选择设大臂速度为ω1=300/s，使机器人大臂从ω0=0到ω1=300/s所需的时间为:△t=0.ls,则同步带应输出转矩为:

（2-4）设安全系数为2，同步带减速比i=10，同步带传动效率为:η=85%。则电机所需输出力矩为:T=(2×T1)/i×η2=20Nm

（2-5）选择步进电机型号：KP8M2-037步距角：1.80最大启动力矩:2.68kgcm2.2.2

第二自由度步进电机的选择:设小臂速度为ω2=150/s,角速度从0到ω2所需加速度时间△t=0.2s,则同步带应输出转矩为:

T2=J2×ω2

=0.22Nm

（2-6）设安全系数为2，同步带减速比i=10，同步带传动效率为:η=85%。则电机所需输出力矩为:

（2-7）选择步进电机型号：KP56LMS2-1步距角：1.80最大启动力矩:3.33kgcm2.2.3

第三自由度步进电机的选择丝杠螺母传动,实现腕部的升降,设丝杠轴向承载总和为:Q=34.3N。丝杠基本参数选择:螺纹牙形:梯形螺纹，β=300螺距:

P=2mm公称直径:

d=10mm,中径:

d=9.5mm摩擦系数:

f=0.1螺旋升角为:

λ=arctgP/(πd2)=arctg2/(9.5π)=3.8340

(2-8)当量摩擦角为:

(2-9)螺纹阻力矩为:T1=d2/2Qtg(λ+ρˊ)=9.5/2×34.3×tg(3.8340+5.9110)=0.031Nm

(2-10)螺纹所受摩擦力矩为:

T2≈fcQDm/2

（2-11）式中:fc----摩擦系数，取0.1

Dm----

支撑面平均直径,此例中取螺母内外径和的一半,即(10+40)/2=25mm.带入数据得:T2≈(0.1×34.3×25)/2=0.047Nm

（2-12）丝杠所受力矩为阻力矩与摩擦力矩之和,即:T=T1+T2

=0.031+0.047=0.078Nm

（2-13）安全系数取2,则电机所需最小转矩为:T3=2T=2×0.078=0.056Nm

（2-14）选择电机型号:

KP56LMS2-1步距角：1.80最大启动力矩:3.33kgcm2.3

同步齿形带传动设计由2.2.2知,同步带输出转矩为:0.22Nm,输出转速为:ω=150/s,单级传动效率为:η=85%,传动比为:10,取安全系数为k=3,则同步带传递功率为:P=kTω/η2=3×0.22×(π/12)/0.852

=0.24w

(2-15)设传动比分配为:第一级传动i1=5,第二级传动i2=2,带轮依次为I、Ⅱ、Ⅲ、Ⅳ,则：Ⅳ轮转速：n4=150/s=2.5r/minⅡ、III轮转速:n2=n3=i2×n4=2×2.5=5r/min

I轮转速:n1=in4=10×2.5=25r/min设中心距:

L1=100mm,L2=250mm(1)求出设计功率Pd由文献[12]表9.3-11查得载荷修正系数k0=1.6，因为未使用张紧轮,又是减速运动，故文献[12]中表9.3-11的附加修正系数均为零。则:

Pd=k0P=1.6×0.24=0.384w(2)选择带的节距由Pd=0.384W和n1=25r/min，从[12]图9.3-4中查得带的节距代号为XL,对应的节距为Pd=5.08mm(见表9.3-1-2[1])。(3)确定带轮直径和带节线长由表9.3-10[1]，带轮I齿数最小可取10，考虑到制造和安装等因素，取Z1=13。则：

Z2=i1Z1=5Z1=65根据【12]表9.3-6标准系列，取Z2=60同理可得:

Z3=17,Z4=40重新计算传动比:i1=Z2/Z1=60/13=4.6

i2=Z4/Z3=40/17=2.4

i=i1l2=10.8由表9.3-6可得I,II,III,Ⅳ各带轮的直径:d1=21.02mm,d2=97.02mmd3=27.49mm,d4=64.68mm由[12]式(15)可得带长计算公式:

(2-16)式中:

L---中心距mm

Lp---带长mmd1,d2一配合带轮直径mm代入数据计算可得:按[12]表9.3-2，选择最接近算值的标准带长:Lp1=406.4mm

齿数80

代号160Lp2=635mm

齿数125

代号250近似计算中心距:

(2-17)式中：

L---中心距

mm

Pb---节距,这里为5.080mm

Zb----带齿数，这里Zb1=80,Zb2=125Z2,Z1为配合带轮齿数则:取整，则L1=103mm取整，则

L2=245mm进行标准带宽的选择:小带轮I齿数Z1=13，转速为n=25r/min，由[12]表9.3-12内插法得XL型带的基准额定功率为P0=1.25W啮合齿数:则啮合齿数系数为:由文献[13]表4-20可以查Pb=50.8的XL型同步带的基准宽度为Bs0=9.5mm,同步带宽为:查文献【13]表4-25得带宽的标准值，为安全可靠，带宽bs=7.9mm带宽系数：带的许用拉应力查表9.3-11[2]得Ta=50.17N带的单位长度质量查表9.3-11[l]得m=0.022kg/m带的圆周速度:带的工作能力:额定功率大于设计功率，故带的传动能力足够。结果整理如下:两极同步带类型均为为XL型同步齿型带Pb=5.08mm,带宽bs=7.9mm一级同步齿型带齿数:

Zp1=80

带长

Lp1=402mm

代号

160二级同步齿型带齿数:Zp2=125

带长Lp2=646.71mm

代号

250各带轮齿数：Z1=13，

Z2=60，

Z3=17，

Z4=40各带轮节径：d1=21.02mm,d2=97.02mmd3=27.49mmd4=64.68mm传动中心距：L1=103mm

L2=245mm图2-1

SCARA机器人大臂结构图2.4

丝杠螺母设计设丝杠所受轴向载荷总和为34.3N，由于载荷较小，强度不成问题，根据结构要求，从标准系列中选取以下参数:螺距:

t=2mm，

梯形螺纹

导程:

s=2mm

头数:

Z=1螺母高度与螺纹中径之比:

φ=H/d2=1.5螺纹牙工作高度:

h=1mm2.4.1

丝杠耐磨性计算丝杠材料采用钢，螺母材料选用青铜，根据[2]表3-8取许用比压[P]=11N/mm2对于单头标准梯形螺纹:式中，P—轴向载荷

N根据标准系列，取丝杠公称直径：d=10mm2.4.2

丝杠稳定性计算柔度:

λ=μl/i

式中：μ一长度系数，这里取2

l

一丝杠最大工作长度，取120mmi

一危险截面惯性半径，i=d1/4=2.25mm代入数据得:

λ=106.7丝杠临界压缩载荷:式中:

E一弹性模量,钢取20.58×104

N/mm2I一惯性矩,

I=1/64πd14490.9mm4代入数据得:

Pc=17306.8N取丝杠稳定安全系数:

nw=4

则Pc/nw=17306.8/4=4326.7N故丝杠稳定.2.4.3

丝杠刚度计算一个导程的变形量的最大值:式中:p一轴向载荷

34.3Ns一导程

2mmE一弹性模量

20.58×104N/mm2d1一丝杠小径

9mmM一丝杠传递扭矩,由2.2.3知,M=T=0.078NmG一切变模量,

83.3×103N/mm2将数据代入得:1000mm变形量为:

δ1000=6.15×10-3/2=3.08um120mm变形量为:δ120=120δs/2=0.37um由变形量可知，丝杠变形较小，刚度足够。2.4.4

丝杠和螺母螺纹牙强度计算螺母所受弯曲应力式中:

b一齿根宽度b=0.65s=1.3mm，其它字母意义同前。青铜的许用弯曲应力为:[σw]=49N/mm2，故σw<[σw].螺母螺纹所受剪切应力:青铜的许用剪切应力为[τ]=34.3N/mm2，故:τ<[τ]丝杠螺纹所受弯曲应力钢的许用弯曲应力为[σ]w=72N/mm2,故σ<[σ]w丝杠的螺纹所受的剪切应力钢的许用剪切强度为[τ]=43N/mm2,,故τ<[τ]。以上校核表明，丝杠和螺母的螺纹牙强度足够。2.4.5

螺纹副自锁条件校核由[2]表3-10得，此螺纹副的当量摩擦系数fv=0.1。当量摩擦角为由式(2-6)知，螺旋升角为λ=3.8340<，故此螺纹副能自锁。结论:丝杠螺母副公称直径d=10mm，导程p=2mm，刚度、强度、稳定性均合格，且能自锁。2.5各输出轴的设计各轴的材料均选用45号钢，由【2]表8-2知轴的许用扭剪应力[τ]=30MPa,由许用应力确定的系数为C=120。2.5.1

机身输出轴设计由2.2.1知，此轴传递扭矩T=20Nm，转速ω=300/s，则传递功率为:P=T×w=20×（π/6）=10.5W=0.0105kWn=(w/360)×60=5r/min减速器的轴颈较大，故d的值可取大一些，这里取d=30mm;轴承部分φ=30mm，轴承选为单列角接触球轴承，轴承型号为7206AC，其余根据结构确定。由于载荷不大，轴承选的较大，强度足够，这里不再详算。2.5.2

大臂输出轴设计由2.3知，此轴的设计功率为P=0.382W，转速w=150/s,n=15×60/360=2.5r/min则：最小轴径在两臂连接处，有键槽，且承受一定弯矩，故取d=16mm，轴承部分轴径选用φ17，其余按结构确定。，其余按结构确定。轴承选为单列角接触球轴承，轴承型号为7203C,其余根据结构确定。2.5.3

带轮轴设计:此轴传递的扭矩为此轴的转速为w=300/s，则传递功率为:由于轴上有键槽，且承受一定弯矩，故取d=15mm，轴承处轴颈取为d=12mm。轴承选为单列角接触球轴承，轴承型号为7301C.2.5.4

升降轴设计升降轴上螺母与丝杠配合，故需设计成空心轴，主要承受轴向拉力，取内径d=14mm，外径D=18mm，用两光杠与一直线轴承导向。丝杠采用一对面对面角接触球轴承支撑，轴承型号为7201AC。光杠采用φ5钢棒，与升降轴同一平面平行放置，示意图如下:图2-2升降轴导向示意图由2.2.3知丝杠传递扭矩T=0.078N-m，则光杠所受圆周力则光杠所受径向力为光杠挠度最大值式中:

1一光杠长度

120mmE一弹性模量200GpaI一惯性矩

πd4/4将数据代入得:ymax=3.586um2.6壳体设计机身部分采用铸铝材料，方形结构，臂厚5-6mm。大臂壳体采用铸铝，U形结构，质量轻，强度大。底板厚度4mm,上壁厚4-5mm。侧面采用透明塑料，厚度为3mm左右。小臂外壳体采用铸铝，U形结构，底板厚度4mm,上壁及筋板厚4-5mm。侧面用塑料，厚度3mm左右。图2-3SCARA机器人小臂及腕部结构图图2-4

SCARA机器人总体结构图第三章

SCARA机器人运动学分析3.1引言机器人运动学涉及到机械手相对于固定参考系原点几何关系的分析研究，特别是机械手臂末端执行器位置和姿态与关节空间变量之间的关系。机器人运动学研究有两类问题:一类是构型已知，要求计算机器人末端手爪的位置与姿态问题，称为正向运动学;另一类是己知末端手爪的位置与姿态求机器人对应该位姿的全部关节角，称为逆运动学。显然，正问题是简单的，解是唯一的，但逆问题的解是复杂的，而且具有多解性，这给问题求解带来困难，往往需要一些技巧与经验。事实上，逆运动学问题更为重要，它是机器人运动规划和轨迹控制的基础。机械手可用一个开环关节链来建模，此链由数个刚体(杆件)串联而成。开链的一端固接在基座上，另一端是自由的。由于机器人末端执行器的位置和姿态是由各杆件运动形成的，采用D-H法来描述和表达机械手各杆件相对于固定参考系的空间几何学关系，从而把运动学问题同齐次变换矩阵联系起来。3.2SCARA机器人正运动学分析3.2.1SCARA机器人连杆坐标系的建立SCARA机器人属于平面关节型机器人，对实际本体及其各连杆坐标系的建立见图。图3-2

SCARA机器人D-H杆件坐标系图3-3SCARA机器人D-H杆件坐标系实际上，为了建模中问题的简化，我们往往按照图3-3所示进行建模。在这里，不同之处主要在Z0和Z5。对于实际问题Zo到Z1的变换矩阵和Z4到Z5的变换矩阵(工具坐标变换)是常量，因此在数学建模时为了方便可以按照图4-3进行建模，最后在分别左乘和右乘两个常数矩阵。本文都是以图3-3为基础进行建模。相应的连杆参数列于表3-1。其中L1=340mm,L2=380mm,

表中θ1,θ2,d3,θ4为关节变量。采用Denavit-Hartenberg法为每个关节处的连杆坐标系建立齐次变换矩阵，表示它与前一个连杆坐标系的关系。设与机器人机座相固连的坐标系O0X0Y0Z0为参考坐标系，每个杆件固接一个动坐标系，根据表3-1各杆件间的关系，可以得到相应的位姿变换矩阵(记为“n-1Tn”)，见公式(3-1)“n-1Tn”表示连杆n相对于前一连杆n-1的位置和姿态，其中，n=1~4.

（3-1）其中ci---表示cos(θi)

Si---表示sin(θi)表3-1D-H参数表#

关节转角θ

连杆偏移d

连杆距离a

连杆扭角α

变量范围1

θ1

0

l1

0

-150°≤θ1≤150°2

θ2

0

l2

π

-150°≤θ2≤150°3

0

d3

0

0

0<d3≤3003.2.2SCARA机器人正运动学问题机器人运动学只涉及到物体的运动规律，不考虑产生运动的力和力矩。机器人正运动学所研究的内容是:给定机器人各关节的角度，计算机器人末端执行器相对于参考坐标系的位置和姿态问题。各连杆变换矩阵相乘，可得到机器人末端执行器的位姿方程(正运动学方程)为;0T4=0T1(θ1)1T2(θ2)2T3(d3)3T4(θ4)=

（3-2）其中;工具坐标系的z向矢量处于夹手指向物体的方向，称之为接近矢量;工具坐标系的y向矢量的方向从一个指尖指向另一个指尖，处于规定夹手方向上，称为方向矢量;最后一个矢量叫法线矢量，它与矢量和矢量一起构成一个右手矢量集合，由矢量的叉乘规定:

。公式(3-2)表示了SCARA机器人手臂变换矩阵0T4，它描述了末端连杆坐标系{4}相对于基坐标系{0}的位姿，是机械手运动分析的基础。把式(3-1)中的值代入式(3-2)可得:nx=c1c2c4-s1s2s4+c1s2s4+s1c2s4=c12-4ny=s1c2c4+c1s2c4+s1s2s4-c1c2s4=s12-4nz=0ox=s1c2c4+c1s2c4+s1s2s4-c1c2s4=c12-4oy=-c1c2c4+s1s2s4-c1s2s4-s1c2s4=-c12-4oz=0ax=0ay=0az=-1px=c1c2l2-s1s2l2+c1l1=c12l2+c1l1py=s1c2l2+c1s2l2+s1l1=s12l2+s1l1pz=-d3

(3-3)式中：c12-4表示cos(θ1+θ2-θ4)

s12-4表示sin(θ1+θ2-θ4)

c12表示cos(θ1+θ2)

s12表示sin(θ1+θ2)最后得:

(3-4)通过建立各关节的连杆坐标系，然后利用D-H法建立齐次变换矩阵，就可以直观地进行末端执行器的位姿矩阵的求解,方便,易掌握、便于检查。3.3

SCARA机器人逆运动学分析给定机器人终端位姿，求各关节变量，以驱动关节上的电机，从而使手部的位姿符合要求，称为求机器人运动学逆解，也就是机器人逆运动学问题。从工程应用角度而言，机器人的运动学逆解问题往往更有实际意义，它是机器人运动规划和轨迹控制的基础。正向运动学的解是唯一的，然而运动学反问题往往具有多重解，如果位于工作空间外也可能没有解。另外，对于运动学逆解而言，还要求计算方法的计算效率、

计算精度等较多要求，最理想的情况是得到封闭解。运动学逆解的方法有封闭解和数值解两种。封闭解的具体步骤和最终公式，因机器人的具体构形而异，但是，计算速度快，效率高，便于实时控制。数值解不具备这些特点，它是人们寻求位姿逆解的通解而得到的方法，由于计算量大，计算时间往往不能满足实时控制的需要，在多重解的情况下，某些迭代算法不能保证求出所有解，而且非线性方程的数值解法本身还有待研究，因此这一方法目前只具有理论意义。封闭解法有代数解法和几何解法。目前已建立的一种系统化的代数解法为:运用左乘逆矩阵来求解腕的运动学逆解，运用臂终端位置来求臂的运动学逆解，运用臂腕分离法求整个机器人的逆解。常用的是Paul提出的反变换法(也称代数方法)。机器人正运动学方程为:0T4=0T1(θ1)1T2(θ2)2T3(d3)3T4(θ4)

（3-5）(1)求关节变量θ1分离变量，对方程两边同时左乘0T1-1(θ1),得

（3-6）即：

(3-7)令左右矩阵中的第一行第四个元素，第二行第四个元素分别相等。即

cosθ1px+sinθ1py-l1=cosθ2l2

(3-8)

-sinθ1

px+cosθ1py=sinθ2l2

(3-9)由以上两式联立可得:

（3-10）式中

(2)求关节变量θ2由公式(3-9)可得:

（3-11）式中(3)求关节变量d3令左右矩阵中的第三行第四个元素相等，可得:Pz=-d3

（3-12）(4)求关节变量θ4令左右矩阵中的第二行第一个元素相等，即: