圆柱坐标型工业机器人设计论文

2007 届机械设计制造及其自动化专业毕业设计（论文） 1 第一章 绪论 1.1 工业 机器人研究的目的和意义 工业机器人是集机械、电子、控制、计算机、传感器、人工智能等多学科先进技术于一体的现代制造业重要的自动化装备。自从 1962年美国研制出世界上第一台工业机器人以来 ,机器人技术及其产品发展很快 ,已成为柔性制造系统 ( FMS) 、自动化工厂 ( FA) 、计算机集成制造系统 (CIMS)的自动化工具。广泛采用工业机器人 ,不仅可提高产品的质量与数量 ,而且保障人身安全、改善劳动环境、减 轻劳动强度、提高劳动生产率、节约材料消耗以及降低生产成本有着十分重要的意义。和计算机、网络技术一样 ,工业机器人的广泛应用正在日益改变着人类的生产和生活方式。 20世纪 80年代以来，工业机器人技术逐渐成熟，并很快得到推广，目前已经在工业生产的许多领域得到应用。在工业机器人逐渐得到推广和普及的过程中，下面三个方面的技术进步起着非常重要的作用。 1. 驱动方式的改变 20世纪 70年代后期，日本安川电动机公司研制开发出了第一台全电动的工业机器人，而此前的工业机器人基本上采用液压驱动方式。与采用液压驱动的机器人相比，采用伺 服电动机驱动的机器人在响应速度、精度、灵活性等方面都有很大提高，因此，也逐步代替了采用液压驱动的机器人，成为工业机器人驱动方式的主流。在此过程中，谐波减速器、 R V减速器等高性能减速机构的发展也功不可没。近年来，交流伺服驱动已经逐渐代替传统的直流伺服驱动方式，直线电动机等新型驱动方式在许多应用领域也有了长足发展。 2. 信息处理速度的提高 机器人的动作通常是通过机器人各个关节的驱动电动机的运动而实现楼渊：四自由度圆柱坐标机器人设计 2 的。为了使机器人完成各种复杂动作，机器人控制器需要进行大量计算，并在此基础上向机器人的各个关节的驱动电动机发出必要的 控制指令。随着信息技术的不断发展， C P U的计算能力有了很大提高，机器人控制器的性能也有了很大提高，高性能机器人控制器甚至可以同时控制 20多个关节。机器人控制器性能的提高也进一步促进了工业机器人本身性能的提高，并扩大了工业机器人的应用范围。近年来，随着信息技术和网络技术的发展，已经出现了多台机器人通过网络共享信息，并在此基础上进行协调控制的技术趋势。 3. 传感器技术的发展 机器人技术发展初期，工业机器人只具备检测自身位置、角度和速度的内部传感器。近年来，随着信息处理技术和传感器技术的迅速发展，触觉、力觉、视觉 等外部传感器已经在工业机器人中得到广泛应用。各种新型传感器的使用不但提高了工业机器人的智能程度，也进一步拓宽了工业机器人的应用范围。 1.2 工业 机器人在国内外的发展现状与趋势 目前，工业机器人有很大一部分应用于制造业的物流搬运中。极大的促进物流自动化，随着生产的发展，搬运机器人的各方面的性能都得到了很大的改善和提高。气动机械手大量的应用到物流搬运机器人领域。在手爪的机械结构方面根据所应用场合的不同以及对工件夹持的特殊要求，采取了多种形式的机械结构来完成对工件的夹紧和防止工件脱落的锁紧措施。在针对同样的目标任 务，采取多种运动方式相结合的方式来达到预定的目的。驱动方面采用了一台工业机器人多种驱动方式的情况，有液压驱动，气压驱动，步进电机驱动，伺服电机驱动等等。愈来愈多的搬运机器人是采用混合驱动系统的，这样能够更好的发挥各驱动方式的优点，避免缺点。并且在它的控制精度方面和搬运效率方面有了很大的提高。在搬运机械手的控制方面，出现了多种控制方式。如：由原始的电控的机械手，2007 届机械设计制造及其自动化专业毕业设计（论文） 3 较先进的基于工控机控制的，基于 PC 控制的，进一步的嵌入式 PC 控制技术，还有采用 PLC 可编程控制的。 在物料搬运方面近年来呈现出的趋势就是系统化。无论是 我国还是国外，物料搬运的发展都是由单一设备走向成套设备，由单机走向系统。在制造业方面，随着 JIT, FMS, CIMS 等现代制造技术的发展，对物料搬运系统也提出了新的要求。其特点是力求减少库存、压缩等待和辅助时间，使多品种、少批量的物料准时到达要求的地点。这一趋势在机械工业方面得到了很大的应用。其中采用了机器人等先进的物料搬运技术，促进了机械工业的技术进步和生产水平提高。 当代工业机器人技术发展一方面表现在工业机器人应用领城的扩大和机器人种类的增多。另一方面表现在机器人机械系统性能的提高和控制系统的智 能化。前者是指应用领域的横向拓宽，后者是在性能及水平上的纵向提高。机器人应用领城的拓宽和性能水平的提高二者相辅相承、相互促进。应用领城的扩大对机器人不断提出断的要求，推动机器人技术水平的提高 .反过来，机器人性能与智能水乎的提高，又使扩大机器人应用领域成为可能。 1工业机器人机械系统性能的提高。 进一步提高业机器人的运动精度。机器人是一种多关节开链式结构，因此，机器人手臂的刚度一般都不高。另外由于构件的尺寸误差和传动间隙的存在，以及机器人手臂末端误差的放大作用，使当前机器人的定位与运动还不能达到很高的精度。 度大 .精度高的数控机床相比，机器人在工作精度上大为逊色。因此，至今工业机器人在精密装配及其它精密作业中的应用仍受到了很大的限制。除了精密作业要求高精度机器人以外 .采用离线编程的工业机器人系统也要求该机器人要具有足够高的定位精度和运动精度。 进一步提高机器人工作精度的主要办法是：提高机器人的加工精度与装配精度，采用无隙传动的减速机构，采用直接驱动电机，通过标定进行楼渊：四自由度圆柱坐标机器人设计 4 机器人的 2误差补偿，通过实时检侧对机器人运动误差进行实时修正。提高机器人手的灵活度和避障能力 :当前常用的机器人手肴的灵活度的都不够高，即手臂末端 达到某一工作点时。手臂可能采取的姿态是有限的，有时要有很大的灵活度和很强的避障能力 .例如。当用喷涂机器人喷涂车身内表面时，要求机器人能将车身内表面的各个角落都喷上漆，必须要有高灵活度机器人手有才行。另外，在有限空间及有障碍的复杂环境中作业的机器人，例如在核电站工作的机器人，也要求其具有高灵活度的机器人手臂。为了提工业机器人手臂的灵活度，主要是采用具有冗余自由度的机器人手臂和在机器人手臂机构上采用膨铰关节及可双向弯曲的手臂。 3提高机器人的运动速度和响应频率：为了提高机器人作业效率，以及提高具有感知功能机器 人的反应速度，就必须提高机器人运动速度和响应频率，这一点，对装配机器人来说尤为重要。为此，一方面可以通过采用高强度材料或轻质材料 (如碳纤维复合材料 )制造机器人手臂，以达到减轻手臂重量和提高手臂动态特性的目的，另一方面，也可以通过采用直接驱动电机或其它高性能驱动电机，从控制和驱动方面提高机器人系统的运动速度与响应频率。 4提高机器人手爪或手腕的操作能力、灵活性与快速反应能力 :为了使机器人能像人一样进行各种复杂作业，如装配作业、维修作业及设备操作，机器人就必须有一个运动灵活和动作灵敏的手腕和手爪。这一点对装配 作业机器人、核工业机器人和在空间站上作业的空间机器人来说是特别重要的。 5采用模块化组合式机器人结构，提高机器人快速维修性能 :根据优化设计，制造出多种不同尺寸和规格的手臂和连接器模块。用少量的模块可组合成多种机器人配置。这种机器人能进行快速维修，可以实现自动修复。所以，这种机器人结构最适用于空间机器人、核工业机器人等。如这种积2007 届机械设计制造及其自动化专业毕业设计（论文） 5 木结构能推广用于一般工业机器人，将使工业机器人的成本下降、生产周期及维修周期缩短。 1.3 工业机器人的分类 1.3.1 按作业用途分类 如前所述，各类工业机器人的应用范围非常广泛，而且 还有一种机器人多种用途的情况。通常我们依据其具体的作业用途来称呼它，如一条自动生产线上使用了相同结构的数台机器人，有的用于点焊就称为点焊机器人，有的用于搬运工件就称为搬运机器人，以此类推，便有喷漆机器人、涂 (密封 )胶机器人、装配机器人和测量机器人等有的作业具有一定范围，如潜入水下作勘查、采矿和铺 4 管道的机器人，就统称为水下机器人，类似的还有宇航机器人等。 1.3.2 按操作机的运动形态分类 按工业机器人操作机运动部件的运动坐标把机器人区分为 :直角坐标式机器人，极 (球 )坐标式机器人，圆柱坐标式机器人和关 节式机器人，另外还有少数复杂的机器。人是采用以上方式组合的组合式机器人。 1.3.3 按机器人的负荷和工作范围分类 按照这种分类方法，工业机器人分为 : 超大型机器人 负荷为 10KN以上。 大型机器人 负荷 1-10KN，工作空间为 1 10m3 以上。 中型机器人 负荷为 100-1000N。工作空间为 0.1 1 m3 小型机器人 负荷为 l-100N，工作空间为 0.1 m3 。 超小型机器人 负荷小于 1N ,工作空间为 0.1 m3 。 以上所谓机器人的“负荷”是指在机器人的规定性能条件下，机器人所能搬移的重量中包括了机器人末端执行器的重量。 1.3.4 按机器人具有的运动自由度数分类 机器人的自由度数的定义是 :操作机各运动部件独立运动的数目之和。这种运动只有两种形态 :直线运动和旋转运动，其腕端的任何复杂的运动都楼渊：四自由度圆柱坐标机器人设计 6 可由这两种运动来合成。工业机器人的自由度数。一般为 2 7个，简易型的 2 4个自由度，复杂型的 5 7个 自由度。自由度数越多，机器人的“柔性”越大，结构和控制也就越复杂，所以并非越多越好。 1.4 本课题研究的主要内容 （ 1） 确定机器人运动参数及工作行程。 （ 2）根据工件的负载情况，工作空间以及各个运动的实现形式对搬运机器人进行整体方案的设计； （ 3）对搬运机器人的手爪， ， 小臂，大臂 ， 的结构设计，绘制各部分的结构草图； （ 4）由第 2 步所给定的条件和第 3步的结构特点，选取驱动系统并确定驱动电机的驱动方式和传动方式； （ 5）对各结构的质量进行粗估，完成对手爪的 夹紧气缸 ， 小臂、大臂丝杠的驱动电机，以及 腰部、腕部 的旋转驱动电机的计算选型； （ 6） 根据电机的外形尺寸及输出轴轴径，以及电 机 的重量完善 结构草图 。 （ 7）通过以确定的结构的质量的分析，验算重要零件的受力情况，绘制最终装配图。 2007 届机械设计制造及其自动化专业毕业设计（论文） 7 第二章 总体设计方案确定 2.1 结构设计概述 一个机器人系统结构由下列互相作用的部分组成：机械手、环境、任务。 机械手是由具有传动执行装置的机械，它由臂，关节和末端执行装置构成，组合为一个互相连接，互相依赖的运动机构。机械手用于执行指定的作业任务。工业机器人的末端执行器是安装在腕端的附加装置。 机器人的手部可分为夹持式和吸附式两大类。夹持式的是指型手，夹持方式有外夹式和内撑式之分，吸附式的分为空气负压 式和电磁式两种， 任务是指机器人要完成的工作。机器人的类型是随着工作任务的特点而决定的。例如： SCARA机器人就非常适合平面上的工件的抓取。 环境是指机器人所处的周围环境。环境不仅由几何条件 (可达空间 )所决定，而且由环境和它所包含的每一个事物的全部自然特性所决定。 2.2 基本设计参数 根据次机械手的应用场合和实地的应用要求，其主要的设计参数要求如下： （ 1）抓取的重物 ： 2kg； （ 2）机械手的自由度数： 4个 ； （ 3）运动参数： 大臂 升降 ： 线 速度 ： sm02.0 ； 小臂伸缩 ： 线 速度 ： sm02.0 ； 手腕 俯仰 ： 角 速度 ： srad14.3 ； 腰部 旋转： 角速度 ： srad14.3 ； （ 4）运动行程： 大臂升降： 300mm 楼渊：四自由度圆柱坐标机器人设计 8 小臂伸缩 :300mm 腰部旋转 : 90 手腕俯仰 : 90 2.3 工作空间 分析 2.4 传动方案的确定 ： 2.4.1 传动方案分析 方案 1： 图 2-2 传动方案一 第一、二、自由度均采用伺服电机加减速器的结构形式。大臂的驱动电机和大臂的回转轴共线。小臂的传动方案与大臂的传动方案相同，这样虽然结构上较为简单，但对大臂产生了一定的附加弯矩，对工件的抓取精度产生了一定的不利影响，并且对转矩的计算也会较为麻烦。第三个自由度，即就是升降机构采用电机步进电机加同步齿形带的传动方案。同步齿2007 届机械设计制造及其自动化专业毕业设计（论文） 9 形带具有传动精度高，结构紧凑，传动比恒定等特点。但对安装的精度要求较高，负载能力也很有限， 并且不能实现反向自锁，需要另加断电保护装置。手爪的结构采用较为简单的气动控制直线运动的手爪。 方案二： 图 2-3 传动方案二 第一、二自由度均采用交流伺服电机加减速器的驱动模式，故此结构可以较为简单。电机轴和小臂的关节轴是同一方向的。这是在充分考虑到小臂的驱动电机对大臂所产生的附加弯矩的条件下，对大臂的结构设计特别做了加强处理。第三个自由度为丝杠螺母的升降运动，采用的传动方式是电机轴经过一级齿轮减速，再驱动滑动丝杠，利用滑动丝杠的大减速比的特点，达到控制上 升的速度不至于过快。同时，选择单头的滑动丝杠具有很好的自锁性能，从而在系统突然断电的情况下，不致使此自由度方向上发生运动，从而保证了结构的安全。第四自由度旋转机构也是采用电机楼渊：四自由度圆柱坐标机器人设计 10 加谐波减速器的结构形式。手爪采用目前广泛采用的，而且技术成熟的连杆导杆式气动机械手，这一机械手的造价低廉，结构简单，针对此处所抓取的工件的特点是不易变形的金属工件，所以对夹紧力的要求不是太高，故采用气动机械手爪完全可以达到设计要求。 方案三： 图 2-4 传动方案三 如图 2-4 所示，第 一自由度采用步进电机加减速装置的传动模式。大臂与回转关节之间采用谐波减速器传递动力。小臂的驱动电机考虑到它的重量会对大臂造成较大的附加弯矩，则把小臂的驱动电机安装在大臂的回转轴的轴线方向，电机输出轴与小臂的回转轴之间通过同步齿形带相连接，保证了小臂回转的精度。但这样就使得小臂的传动机构很复杂，有多段承受弯矩的轴，并且电机轴也承受了一定的弯矩。第三个自由度采用滚珠丝杠并配以电机加减速器驱动的传动方案，这是利用了滚珠丝杠的传动精度高，并且是把旋转运动转换为直线运动，而不需要中间环节的转化，结构2007 届机械设计制造及其自动化专业毕业设计（论文） 11 简单。但滚珠丝杠必 须附加自锁装置以确保能够做到断电保护。滚珠丝杠的造价较高，重量也较重，因此在滚珠丝杠的材料选择方面要求加工材料要较轻。并且滚珠丝杠需要电机的输出转矩也较大，自身的减速比较小。机器人的手爪部分仍然采用较为常用的气缸配合连杆式气动机械手的结构，其作用与方案一所述的相同。 2.4.2 伺服驱动与 步 进驱动的比较 1）低频特性不同 歨进电机在低速时容易出现低频振动现象，振动的频率与负载情况以及与驱动器的性能有关。当步进电机工作在低速的时候一般还应采取阻尼技术来克服低频振动现象。交流伺服电机运转非常平稳，即使在低速时也 不会出现振动现象。 2）矩频特性不同 不进电机的输出力矩随转速的升高而降低，而且在较高的转速时会急剧下降所以其最高的工作转速在 min600300 r 。交流伺服电机为恒力矩输出即使在额定转速以内都能输出额定的转矩，在额定转速以上为恒功率输出。 3）过载能力不同 不仅电机一般不具有过载能力，交流伺服电机具有较强的过载能力比进电机因为没有这种过载能力，为了克服启动时较大的惯性力矩，往往要选取具有较大静转矩的电机，而机器人正常工作时又不需要这么大的转矩，所以便出现了力矩浪费的现象。 4）运行 性能不同 步进电机的控制一般为开环控制，速度过快或负载过大都会出现失转或堵转现象。交流伺服电机为驱动系统为闭环控制，驱动器可以直接对电动机编码器反馈信号进行采样，在内部构成位置环和速度环，能避免失步或过冲现象。 综上所述，交流伺服系统在许多性能方面都优于步进电动机，所以在一些对位置和速度要求较高的场合，采用交流伺服系统的优势更为明显。此次的搬运机器人队工件的抓取，对其驱动系统的要求就是要能够较为准确楼渊：四自由度圆柱坐标机器人设计 12 的完成对位置和速度的控制，这样选取交流伺服电机就能够很好的满足这一点。 通过对上面的方案的比较，综合分析后我认 为方案二有更多的优势，而且结构合理，能够比较好的完成本次的输送线出货台的物料搬运工作。故此次方案二作为本次设计的最终设计方案。 第三章 搬运机器人的结构设计 2007 届机械设计制造及其自动化专业毕业设计（论文） 13 3.1 驱动和传动系统的总体结构设计 （ 1）底座 如图所示：电机和谐波减速器通过连轴套筒相连，谐波减速器的输出轴和大臂的回转关节轴直接相连。外壳的材料采用 45钢底座的轴承采用角接触轴承，使利用了它既能承受轴向力也能承受一定的径向里的特点。电机和减速器通过外壳内部的凸台进行安装，这样使得结构简单 ， 加工和安装方便。里 面部件的材料采用铝合金 ,位于底部的电机通过谐波减速器的减速对顶端轴进行驱动，从而带动了大臂回转轴和大臂一起转动，需要注意的是臂回转轴是做成一体的。 图 3-1 机器人的结构设计方案图 （ 2） 传动装置 传动的主要方式是采用交流伺服电机加减速器的传动模式，大臂的轴承选择的是角接触轴承，用此来承受较大的负载产生的弯矩，避免了减速器的输出轴，以及电机轴承受附加载荷，从而保护了减速器和电机。大臂楼渊：四自由度圆柱坐标机器人设计 14 的长度尽可能的做的短一些，这样会在整体结构简单的情况下将小臂回转关节的电机自身重量 和减速器的重量极可能多得通过壳体传递到地面，另外对大臂的设计也采用了增加强度的处理，从而尽可能电机和减速器所产生的附加弯矩对机构的影响。小臂回转关节采用了电机减速后直接驱动小臂关节轴旋转，从而带动小臂旋转，这里大、小臂的运动具有独立性的特点。 （ 3）升降机构 此处机械手的升降机构是采用电机加一级齿轮减速，传递动力给滑动丝杠，利用滑动丝杠的大的降速比来完成夹持工件的机械手上下移动，这样可以把电机输出的转动转化成丝杠螺母的上下移动，并且整体结构较为简单。同时考虑滑动丝杠的原因也是利用了滑动丝杠的反向自锁的特性 ，从而实现了断电保护。在滑动丝杠的外螺母上连接导向杆，这样可以对螺母起到导向的作用，同时可以减少负载产生的附加弯矩对滑动丝杠的影响，进一步挺高了机械手抓取时的抓取精度。 （ 4）旋转机构 如图所示，此处的旋转机构主要是利用步进电机利用键连接来驱动机械手进行旋转来实现抓取工件位姿的调整，这里是考虑到机械手在抓取工件时所需要的位姿来进行设计的，使得机械手的手爪更方便有效的完成工件的抓取。 3.2 气动手爪的选型计算 机械手爪受力分析：（ 如图 3-3） P：机械夹持器轴向施加的作用力； e：夹持器活塞中心至手 指支点的距离； R：支点销轴的半径； ：中间连杆对手指的压力角； ：摩擦角； ：构件间的摩擦系数； 2007 届机械设计制造及其自动化专业毕业设计（论文） 15 角度条件：2； 尺寸条件： ea ； lea ； 如图 3-2 所示，设力 P 的方向与中间连杆之间的夹角为 ，作用在中间连杆上的分力为 F， P/2=Fcos + sin （ 3.1） 图 3-2 则作用在连赶上的分力 F可以用下面的式子来表示： F= s in + co s 12 P（ 3.2） 设中间连杆与手指之间的夹角，即压力角 图 3-2 手爪结构 为 ，手指支点的反力为 R，手指支点轴的半径为 r，连接销与手指支点的距离为 l 。手指支点到指尖的距离为 l .则根据绕手指支点的力矩平衡关系可得到下式： llQ cos lF 0sin Rr （ 3.3） 其中 R可 根据下式求得： c o s222 FQQFR (3.4) 则将（ 3.2）（ 3.3）代入（ 3.4）中可得如下式子： lrRlPlQ )s in( co s2)s in( co s （ 3.5） 由于lrR很小，可以忽略。设手指与手部中心线夹角为 ，并且注意到（ 2/ ） + = ，可由此改写为 2/ ,则（ 3.5）式子最终可以改写成： )s i nc o s)(2 tglPlQ（ 3.6） 楼渊：四自由度圆柱坐标机器人设计 16 图 3-3 手爪受力分析 则最终得到活塞杆的输出力 P 与夹紧力 Q 之间的关系为： P=)s inco s)( 2 tgl lQ（ 3.7） 由于工件夹紧时手指所处的位置，设手指夹紧部分的摩擦系数为 f =0.5。则可得到 2/GfQ ，由已知得到工件重 4kg 则可推得 Q =40N。 由此时手爪所处的位置可得到： 0 由此（ 3.7）式子可以简化为： )(2 tgl lQP（ 3.8） 2007 届机械设计制造及其自动化专业毕业设计（论文） 17 测得 45 ，又知道 15 ，则 tg( )=33带入（ 3.8）式则得到： P=3 78.5401312 =231.2N。 3.3 手爪驱动气缸设计计算 手指的理论驱动力为 P，选用驱动气缸时应考虑手指与回转轴之间的摩擦以及气缸的活塞与缸壁之间的摩擦。因为回转轴处的效率较低，从工作的安全和动作的可靠性考虑，所取手指的驱动力为 N=5P=1156N。 由气缸的输出力计算公式： N=422 10PD （ 3.9） 其中： F：气缸的理论输出力（ kgf） D：气缸的缸径（ mm） P：工作压力（ kgf/cm2 ） 气缸的效率一般为 85%，则由（ 3.9）公式可得到气缸的缸径为： 21085.04 PND=24610108.9 105.08.914.385.011564=58.86mm。 根据气缸的选型表可以选择的气缸内径为 63mm。由气缸气的选型手册可选LG 系列气缸。主要的技 术参数为：气缸内径 63mm，最大行程 800mm，工作压力范围 0.049 0.98MPa，耐压力 1.47MPa，不需要给油。缓冲行程20mm，选择 FB 后法兰盘结构。 根据所选择的气缸，并计算出在 0.5 MPa 下的实际输出力 F 是否满足手指的 驱 动 力 的 要 求 。 在 P=0.5MPa 的 压 力 下 实 际 输 出 力f =462210 105.063104 14.385.0 =1323N。 故此结果满足要求。 3.4 进给丝杠的设计计算： 楼渊：四自由度圆柱坐标机器人设计 18 当机械手爪抓起工件时， 丝杠的负载就由以下几个部分组成：工件，手爪，驱动气缸，手爪与气缸的连接套筒，俯仰电机，减速器，丝杠套杯与 L型支架等组成。 它们的重量可以做以下粗估：工件 40N，手爪 20 N，驱动气缸 20N，手爪与气缸的连接套筒 20N，俯仰电机 55N，减速器 5N， 丝杠套杯与 L型支架 40N 等组成。考虑到实际的影响因素，可以估计出丝杠的真实负载约为 F=230N。 考虑到先前方案分析是提到的丝杠要求反向自锁的特点，先根据其负载情况粗选滑动丝杠的类型为单头梯形丝杠。大径 1d =39mm，中径 2d =27mm，小径3d=23mm, 螺距 P=6mm 。螺杆材料为 45 钢，螺母的材料为ZCuSn5Pb5Zn5，高度 H=600mm。 对所选的丝杠进行验算： (1)丝杠螺杆的耐磨性验算：因为工作压强 P=F/( d2 H1 n),式子当中，mmPH 365.05.01 ，而 n=H/P=600/6 mm100 。带入上式得 :P=1003273.14 160 =0.0063N/ 2 ,并且考虑到螺杆升降速度 0.04m/s,并且不是连续工作 PP =10N/ 2 。可见 P PP 。满足耐磨性要求。 （ 2）螺纹强度校核：根据螺母材料查表，取 p=35 N/ 2 ， bp=50 N/ 2 。 由螺纹剪切强度公式 =bnDF4检验。式子中： b=0.65P=0.65 6=3.9。 D4 =d1 +2ac d=40 .所以 =10 09.34014.3 16 0 =0.00327 N/ 2 。 螺纹的弯曲应力 b=nbDFH24 13=10 0 3. 9403. 14 316 03 2 =0.0075 N/ 2 。 则满足： P PP ， p， bbp。螺纹的强 度足够。 2007 届机械设计制造及其自动化专业毕业设计（论文） 19 （ 3）自锁性验证：因为是单头螺纹，故导程 S=P=6 ,所以螺纹升角 =arctg2dS =arctg 2714.3 6 =4.05 。 由表面的钢对青铜的摩擦系数 f=0.08 0.10,此处可以针对此范围取到f=0.10，得 =)2/cos( farctg=arctgcos710.0 = 75.5 所以 rT =0.51 mN 。转子的转动惯量为 420 .2 0 1 0 kg m，额定转速为 3000 minr ，最高转速为5000 minr ，质量为 1.5kg。电机输出轴直径为 11mm。 3.5.2 滑动丝杠驱动电机的选型计算 1)负载 转动惯量的计算 由折算公式： 22 )()( ii ihk hLvmJJ kg m 2 可得： 2i22 v ）（）（）（ 移动部件齿轮减速器丝杠 mJJJ hhL kg m 2 丝杠J= 221mr= 21 3 3 2 2 3 2235 . 6 1 0 ( 1 0 ) 0 . 6 5 0 . 0 1 1 5 0 . 1 1 02 k g m 则 2）（丝杠 hJ= 3 2 5 23 1 . 2 50 . 1 1 0 ( ) 0 . 1 1 03 1 2 . 5 k g m 。 我们记齿轮减速器的转动惯量为齿轮减速器J则齿轮减速器J= 21 JJ 。 齿轮减速器的齿轮采用双叶片式，模数 mmm 2 ，齿轮 1 的分度圆直径为mmd 401 ，齿轮 2 的分度圆直径为 mmd 1202 。由此我们可得 齿轮 1 转动惯量 1J 41132 dl= 43 04.0034.01085.714.3321 = 25107.6 mkg 2J 42232 dl = 43 12.003.01085.714.3321 = 23108.4 mkg 则齿轮减速器J= 21 JJ = 2310867.4 mkg 对于此处的双页片齿轮减速器，各部分转动惯量折算到电机轴上的转动惯楼渊：四自由度圆柱坐标机器人设计 22 量为： 2）（齿轮 hJ = 24235 1015.1187 5 01875104. 8 67107.6 mkg ）（。 移动部件m工件m+手爪m+气缸m+汽缸手爪连接套筒m+旋转电机m+连接支架m 4kg+2kg+2kg+2kg+2kg+4kg=16kg。 2iv ）（移动部件 m 16 25.3120.04 ）（ 2610262.0 mkg 可得总的转动惯量LJ = 5 4 6 4 20 . 1 1 0 1 . 1 5 1 0 0 . 3 2 7 1 0 1 . 1 7 1 0 k g m 。根据伺服电机的惯量匹配原则： 125.0 MLJJ可以粗选电机的转动惯量为 MJ =2.84 410 kg m 2（带制动器）。则总的折算到电机轴上的转动惯量为： rJ =（ 1.17+2.84）410 = 424 .0 1 1 0 kg m。 2）伺服电机的转矩计算： 电机所需要的转矩可以用快速空载起动转矩来计算，由此得到mNTTTTT fa m a xm a x 。 其中maxaT=t Jn r602 max= 42 3 . 1 4 5 0 0 0 4 . 0 1 1 06 0 0 . 0 5 =4.19N m （取加速度时间为 0.05s）。 1 6 0 0 . 5 0 . 0 0 6 0 . 0 0 9 52 2 3 . 1 4 0 . 8 1 0fFST N mi （此处取阻尼系数 5.0f ） 此处没有涉及到丝杠预紧，所以 mNT 0 又rr TTT 8.1m a x （交流伺服电 机 8.1 ）所以 mNTTTTrfa m a x，即就是 8.1m a x farTTT 4 . 1 9 0 . 0 0 9 5 2 . 3 31 . 8 Nm 。 至此所选择的电机的额定功率为 1.5KW，额定转矩为 4.77N m ，最大2007 届机械设计制造及其自动化专业毕业设计（论文） 23 转矩为 14.3 N m ，电机惯量为 2.84 410 kg m 2 （带制动器），额定转速为 3000 minr ，最高转速为 5000 minr ，重量为 6.5kg，电机输出轴直径为19mm。 3.5.3 小臂驱动电机的选型计算 1）对小臂的负载进行估算：工件 40N，手爪 20 N，旋转电机重 15 N，气缸手爪连接套筒 20 N，谐波减速器 5 N，支架 40 N，丝杠 25 N，减速齿轮 5 N，丝杠驱动电机 65 N，箱体 30 N，小臂 30 N。根据转动惯量的平行移轴定理 i iiiidmrmJ )21( 22，对各个部分的转动惯量分别进行分析。 222 m02kg.15.041.0421 工件J 222 m0. 50 225 kg5.0215.0221 手爪J 222 m0. 5kg5.0203.0221 气缸J 2222 m0. 5 kg5.020. 0 6-09.0221 ）（连接套筒J 222 m0 . 1 2 6 k g5.00 . 50 . 0 60 . 521 减速器J 2 2 21 1 . 5 0 . 2 5 1 . 5 0 . 5 0 . 4 2 2 k g m2J 旋 转 电 机 222 m02kg.15.041.0421 支架J 222 m0. 0 81k g18.02. 50115.02. 521 丝杠J 222 m0 . 0 9 k g18.00 . 506.00 . 521 齿轮减速器J 222 m1. 22 kg25.06. 55.06. 521 丝杠电机J 222 m0 . 1 8 kg0 . 232.0321 箱体J 222 m0. 3 76k g25.0603.025.03121 小臂J 楼渊：四自由度圆柱坐标机器人设计 24 则hJ=1.02+0.5+1+0.126+0.422+1.02+0.081+0.09+1.22+0.18+0.376=6.67 2mkg 则根据转动惯量折算公式： 22 )()( ii ihk hLvmJJ kg m 2 LJ 6.67 2 4 22 . 1( ) 6 . 7 8 1 02 0 8 . 3 k g m 根据伺服电机的惯量匹配原则： 125.0 MLJJ可以粗选电机的转动惯量为MJ =16.7 410 kg m 2 （带制动器）。则总的折算到电机轴上的转动惯量为：rJ =（ 16.7+6.78） 410 = 422 3 . 4 8 1 0 k g m。 2）小臂伺服电机的转矩计算： 电机所需转矩用快速空载起动转矩计算，得 mNTTTTTfa m a xm a x 。其中maxaT=t Jn r602 max= 42 3 . 1 4 3 0 0 0 2 3 . 4 8 1 06 0 0 . 2 =3.69N m （加速度时间0.2s）。 摩擦力矩主要是由轴承的运动所产生的摩 擦力所形成，记为fT=0.2N m 。 此处没有涉及到预紧，所以 mNT 0 又由rr TTT 8.1m a x （交流伺服电机 8.1 ） 所以 mNTTTTrfa m a x，即 8.1m a x farTTT 3 . 6 9 0 . 2 2 . 1 61 . 8 Nm 。 至此所选择的电机的额定功率为 2KW，额定转矩 9.54N m ，最大转矩为 28.5 N m ，电机惯量为 16.7 410 kg m 2 （带制动器），额定转速为 2000 minr ，最高转速为 3000 minr ，重量为 12.5kg，电机输出轴直径为 22mm。 小臂的谐波减速器的生产厂家是 陕西蔡家坡渭河工具厂生产。型号选择2007 届机械设计制造及其自动化专业毕业设计（论文） 25 为 XBW 32 107 8。输入转速 3000 minr ，输出转矩 6N m ，传动比为 107。质量为 0.5kg。 3.5.4 大臂驱动电机的选型计算： 1）： kgm 5.12小臂电机， kgm 5.0减速器， kgm 10大臂， kgm 5.0支架。 小臂驱动 电机关于大臂驱动轴的转动惯量 2112111 21 dmrmJ =21 12.5 0.0752 +12.5 0.32 =1.16kg m 2 。 同理可得小臂减 速器关于大臂驱动轴的转动惯量： 2J 21 0.5 0.032 +0.5 0.32 =0.045kg m 2 小臂负载关于大臂驱动 轴的转动惯量： 3J 6.67+31.5 0.32 =9.51kg m 2 大臂关节轴的转动惯量： 4J 21 10 0.082 =0.032kg m 2 由此可得到总的转动惯量为 21 . 1 6 0 . 0 4 5 9 . 5 1 0 . 0 3 2 1 0 . 7 5hJ k g m 由折算公式： 22 )()( ii ihk hLvmJJ kg m 2 可得折算到电机轴上的各个负载的转动惯量为 LJ 2 4 21 . 51 0 . 7 5 ( ) 5 . 5 7 1 02 0 8 . 3 k g m 。根 据伺服电机的惯量匹配原则： 125.0 MLJJ，可以粗选电机的转动惯量为 MJ =21.1 410 kg m 2（带制动器）。则总的折算到电机轴上的转动惯量为： rJ =（ 21.1+5.57）410 = 422 6 . 6 7 1 0 k g m。 2）大臂伺服电机的转矩计算： 电机所需要的转矩可以用快速空载起动转矩来计算，由此得到mNTTTTT fa m a xm a x 。 楼渊：四自由度圆柱坐标机器人设计 26 其中maxaT=t Jn r602 max= 42 3 . 1 4 3 0 0 0 2 6 . 6 7 1 06 0 0 . 5 =1.67N m （加速度时间为0.5s） 摩擦力矩主要是由轴承的运动所产生的摩擦力所形成，记fT=0.5N m 。 此处由于没有涉及到预紧，所以 mNT 0 。 又rr TTT 8.1m a x （交流伺服电机 8.1 ）所以 mNTTTTrfa m a x，即就是 8.1m a x farTTT 1 . 6 7 0 . 5 1 . 2 11 . 8 Nm 。 至此所选择的电机的额定功率为 3KW，额定转矩 14.3N m ，最大转矩为 42.9 N m ，电机惯量为 21.1 410 kg m 2 （带制动器），额定转速为2000 minr ，最高转速为 3000 minr ，重量为 14.7kg，电机输出轴直径为24mm。 大臂的谐波减速器选型为 XBW 80 134 120，传动比为 134，输入转速 3000 minr 。输出转矩 120N m ，质量为 10kg，效率为 70% 80%。 3.6 手臂强度校核 大小臂主要承受来自臂体自身及臂端部件重量载荷，即臂体要承受均匀载荷和突加载荷。 由材料力学知识知道弯矩最大处发生在左端截面处， 由重力产生弯矩 21 2qlM 突加载荷产生的弯矩 2M Pl故左端最大弯矩 22qlM Pl为计算简便将两臂近似看作等截面长方体。则大小臂必须满足弯曲正应力的强度条件： 2007 届机械设计制造及其自动化专业毕业设计（论文） 27 m a xm a x ZM W 矩形截面积： 26Z bhW 铝合金材料拉压强度铝合金= MPa310 235Q材料拉压强度235 Q= MPa160 大小臂胶合过程如下： (1) 大臂强度校核 kgm 5.12小臂电机 ， kgm 5.0减速器 ， kgm 10大臂 ， kgm 5.0支架 。 大臂受力情况 mNq 333 ， NP 440 , ml 3.0 , mb 07.0 , mh 09.0 则 3522 1045.96 09.007.06 mbhW Z mNPlqlM 1 4 73.04 4 02 3.03 3 3222 23556.11045.9147 5m a xm a x QZ M P aWM 所以大臂满足强度要求。 （ 2）小臂强度校核工件 40N，手爪 20 N，旋转电机重 15 N，气缸手爪连接套筒 20 N，谐波减速器 5 N，支架 40 N，丝杠 25 N，减速齿轮 5 N，丝杠驱动电机 65 N，箱体 30 N，小臂 30 N。 小臂受力情况 mNq 60 ， NP 285 , mml 5.0 , mmb 05.0 , mmh 07.0 3522 1008.46 07.005.06 mbhW Z mNPlqlM 1 5 05.02 8 52 5.060222 楼渊：四自由度圆柱坐标机器人设计 28 铝 合 金68.31008.4150 5m a xm a x M P aWM Z第四章 搬运机器人的控制系统 2007 届机械设计制造及其自动化专业毕业设计（论文） 29 4.1 机器人控制系统分类 1.程序控制系统：给每一个自由度施加一定规律的控制作用，机器人就可实现要求的空间轨迹。 2.自适应控制系统：当外界条件变化时，为保证所要求的品质或为了随着经验的积累而自行改善控制品质，其过程是基于操作机的状态和伺服误差的观察，再调整非线性模型的参数，一直到误差消失为止。这种系统的结构和参数能随时间和条件自动改变。 3.人工智能系统：事先无法编制运动程序，而是要求在运动过程中根据所获得的周围状态信 息，实时确定控制作用。 4机器人控制系统结构 机器人控制系统按其控制方式可分为 两 类 ： 1） 集中控制方式：用一台计算机实现全部控制功能，结构简单，成本低，但实时性差，难以扩展，其构成框图如图所示 。 图 4-1集中控制方式 2） 主从控制方式：采用主、从两级处理器实现系统的全部控制功能。楼渊：四自由度圆柱坐标机器人设计 30 图 4-2 主从控制方式 主 CPU 实现管理、坐标变换、轨迹生成和系统自诊断等；从 CPU 实现所有关节的动作控制。其构成框图如图 3 所示。主从控制方式系统实 时性较好，适于高精度、高速度控制，但其系统扩展性较差，维修困难。 4.2 控制系统方案设计 4.2.1 控制系统方案分析 控制系统通常是指在复杂的条件下，将预定的控制目标转变为期望的机械运动。控制系统使被控机械实现精确的位置控制、速度控制、加速度控制、转矩或力的控制，以及这些被控机械量的精确综合控制。 搬运机器人的手部、小臂、大臂的动作都是通过控制系统来控制的，所以控制系统是搬运机器人的重要组成部分，控制系统的设计对于机器人的总体设计而言至关重要。目前，搬运机器人的控制方式大多采用可编程序的点位控制 (PTP)方 式，而在各种控制方式中，可编程序控制器 (PLC)因其通用性好、编程方便、成本较低、易于设计和维护等优点而被广为使用，它完全可以取代继电器控制柜，而且可以实现比继电器功能强得多的控制功能。 4.2.2 控制系统特点 2007 届机械设计制造及其自动化专业毕业设计（论文） 31 1. 编程方法简单 可编程控制器的梯形图语言程序一般采用顺序控制设计方法。这种编程方法很有规律，容易掌握。对于复杂的控制系统，设计梯形图语言程序和调试程序比设计和调试继电器控制系统所花的时间要少得多。 2控制系统结构简单，通用性强 尽管现在世界各个生产可编程控制器的厂家和公司，有着多种品牌和种类， 但其基本结构和工作原理大致相同。配以各种组件就可以灵活的组成各种规模和不同要求的控制系统。 3抗干扰能力强 可编程控制器采用了一系列硬件和软件的抗干扰干扰能力措施，如滤波、隔离、屏蔽、自诊断、自恢复等，使之具有很浅的抗干扰能力。一般无故障的时间数已经达到数万小时以上，可以应用于有强干扰的工业生产现场。现在可编程控制器已经被公认为最可靠的工业控制设备之一。 4可靠性高 继电接触器控制系统使用了大量的机械触电，连线复杂，各触点在吸合和断开时容易受到电弧的损伤，所以寿命多，工作可靠性差。而可编程控制器以软件代 替硬件，许多继电器的触点和繁杂的连线可以用程序来实现，大量的开关动作可以用无触电的电子电路来完成，因此寿命长，可靠性大大的提高。 5体积小、结构紧凑，安装、维护方便 可编程控制器体积小、质量小，便于安装。通常可编程控制器都有自诊断、故障报警、故障显示的功能，便于操作和维修人员检查，可以较容易的通过更换模块插件来迅速排出故障。它的结构精凑，与硬件连方式简单，接线少，易于维护。 4.3 机器人的控制系统方案确定 本次控制系统采用的方案是 PLC+交流伺服系统。 交流伺服系统由交流伺服电动机和伺服电动机驱动器组成， 它已经成为无刷直流伺服系统的代替品。近年来交流伺服驱动技术有了飞速的发展，楼渊：四自由度圆柱坐标机器人设计 32 它不仅能克服了直流伺服电动机在结构上存在的电刷维护困难、造价高、寿命短、应用环境受限制等缺点，同时又发挥了交流伺服电动机坚固耐用、经济可靠及动态响应好等优点。 一个伺服驱动系统并不仅仅是驱动器与电动机的组合，而是一个完整复杂的控制系统。完整的交流伺服驱动系统包括：伺服控制器、伺服驱动器、伺服电动机以及至少一个检测元件，所有这些部件都在一个闭环控制系统中运行：驱动器接受控制控制器的指令信息，然后将电流送给电动机，通过电动机转换成扭矩，然 后带动负载；检测元件测量负载的位置（角度、直线位移）、速度、加速度等参数，输入控制器实现指令信息值与实际位置值的比较，然后通过闭环控制使实际位置值和指令信息值保持一致。 4-1 交流伺服系统控制框图 机器人各关节由电机输出动力，通过各种传动方案，带动各关节运动，传感器、编码器将检测记录到的运动部件的运动状况并以开关量形式传递给 I/O， PLC 接收到这些信号并经过处理后，发出指令，传递给 I/O，系统进入下一道命令执行中。 PLC 是要对搬运机器人的执行机构进行控制，控制机器人对工件的抓取。对搬运机器人的控制包 括 PLC 通过 I/O 接口向机器人发出控制指令，以及获取机器人的工作状态信息等内容。 PLC接收机器人的各种工作状态信 号、指令及传感系统，包括各指令开关、工件识别传感信号和执行机构的 2007 届机械设计制造及其自动化专业毕业设计（论文） 33 4-3 机器人控制系统框图 位置信号等，实现 PLC对搬运机器人的状态信息的获取。 在机器人控制系统中，提供了搬运工作模式 (运行、示教等 )设置。机器人伺服系统开启停止、重启、继续和回零等输入控制端口。通过这些控制端口 PLC可以对焊接机器人进行上述的控制 ,同时也提供了搬运机器人所处的运行 模式。伺服系统的开、停、就绪和急停等状态输出端口通过读取这些端口的状态。 PLC就能获知机器人的搬运基本状态。 4.4 PLC 及运动控制单元的选型 针对 本次控制系统的方案，选择 SYSMAC 的 CS1 系列的 PLC ，与之配套的 MC 单元为 MC421，此处注意到 MC421 能够实现四轴的伺服驱动，分别对应本次 SCARA 机器人的四个伺服电机的伺服驱动。系统的配置图如 4-4所示： MC 的控制面板主要有 LED 指示器、单元号设置开关， X/Y 轴和 Z/U 轴连接器、 I/O连接器、示教盒连接器、 MPG 连接器等组成。各个部分的分布如 图4-5所示。 1、 单元号设置开关 单元号的设置确定了 CPU单元专用 I/O单元区的那些字分给 MC单元。CS1-MC421占用了 50个字。 楼渊：四自由度圆柱坐标机器人设计 34 2、 连接器 图 4-4 控制系统配置图 图 4-5 MC单元控制面板 1) I/O 连接器 用于外部输入输出的连接器，包括各轴的限值输入、急2007 届机械设计制造及其自动化专业毕业设计（论文） 35 停输入、圆点接近输入、外部输入、常规输入。 2）示教盒连接器 用于连接示教盒。 3) MPG连接器 用于 MPG（手动脉冲发生器）或同步译码器的连接 器。 楼渊：四自由度圆柱坐标机器人设计 36 第五章 结论与展望 搬运机器人在工业机器人的领域中扮演着非常重要的角色，本次设计的主要目的是围绕实验室的建设，设计与实地环境相符的搬运机器人来实现输送线出货台上的工件到 AGV 小车上的搬运，从而实现工件的传送和运输这一环节的自动化操作。论文工作总结如下： （ 1）根据各种传动方式之间的联系及特点，通过取长补短，主要考虑了结构紧凑简单等原则，确定了机器人的整体设计方案； （ 2）各个回转关节的驱动方式均采用电机加减速器的方式的传动设计，大臂的回转关节和大臂做成一体，大臂的截面形 状采用等强度处理； （ 3）在各个关节的结构设计中，充分考虑到附加载荷对电机轴的影响，回转关节轴的载荷通过固定在其两端的轴承把负载的附加载荷传递到轴承上，从而保护了电机和减速器； （ 4）在进给机构的设计中，滑动丝杠自锁性可以很好的保护工件不会在断电的情况下落，造成意想不到的事故； 由于时间有限，本次设计还存在一定的不足，还有待进一步提高，展望如下