工业机器人 三自由度直角坐标工业机器人设计.docx
《工业机器人 三自由度直角坐标工业机器人设计.docx》由会员分享，可在线阅读，更多相关《工业机器人 三自由度直角坐标工业机器人设计.docx（24页珍藏版）》请在冰点文库上搜索。
工业机器人三自由度直角坐标工业机器人设计
沈阳工程学院
课程设计
设计题目：
三自由度直角坐标工业机器人设计
系别自控系班级测控本071
学生姓名杨薇学号04
指导教师祝尚臻职称 讲师
起止日期：
2010年12月27日起——至2011年1月7日
沈阳工程学院
课程设计任务书
课程设计题目：
三自由度直角坐标工业机器人设计
系别自动控制工程系班级测控本071
学生姓名 杨薇
学号 **********
指导教师祝尚臻职称讲师
课程设计进行地点：
F430
任务下达时间：
2010年12月27日
起止日期：
2010年12月27日起——至2011年1月7日止
教研室主任年月日批准
火灾预警机器人的设计课程设计成绩评定表
系（部）：
自控系班级：
测控本071学生姓名：
杨薇
指导教师评审意见
评价
内容
具体要求
权重
评分
加权分
调研
论证
能独立查阅文献,收集资料；能制定课程设计方案和日程安排。
0.1
5
4
3
2
工作能力
态度
工作态度认真，遵守纪律，出勤情况是否良好，能够独立完成设计工作，
0.2
5
4
3
2
工作量
按期圆满完成规定的设计任务，工作量饱满，难度适宜。
0.2
5
4
3
2
说明书的质量
说明书立论正确，论述充分，结论严谨合理，文字通顺，技术用语准确，符号统一，编号齐全，图表完备，书写工整规范。
0.5
5
4
3
2
指导教师评审成绩
（加权分合计乘以12）
分
加权分合计
指导教师签名：
年月日
评阅教师评审意见
评价
内容
具体要求
权重
评分
加权分
查阅
文献
查阅文献有一定广泛性；有综合归纳资料的能力
0.2
5
4
3
2
工作量
工作量饱满，难度适中。
0.5
5
4
3
2
说明书的质量
说明书立论正确，论述充分，结论严谨合理，文字通顺，技术用语准确，符号统一，编号齐全，图表完备，书写工整规范。
0.3
5
4
3
2
评阅教师评审成绩
（加权分合计乘以8）
分
加权分合计
评阅教师签名：
年月日
课程设计总评成绩
分
中文摘要
角坐标机器人具有空间上相互垂直的两根或三根直线移动轴，通过直角坐标方向的3个独立自由度确定其手部的空间位置，其动作空间为一长方体。
直角坐标机器人结构简单，定位精度高，空间轨迹易于求解；但其动作范围相对较小，设备的空间因数较低，实现相同的动作空间要求时，机体本身的体积较大。
大型的直角坐标机器人也称桁架机器人或龙门式机器人是能够实现自动控制的、可重复编程的、多自由度的、运动自由度建成空间直角关系的、多用途的操作机。
其工作的行为方式主要是通过完成沿着X、Y、Z轴上的线性运动。
近年来随着工业机器人的不断发展，工业机器人不断在工业领域得到广泛的应用，尤其是结构简单的直角坐标机器人，本次设计我主要是对三自由度的直角坐标机器人进行设计，完成一个大概的设计，在设计中我采用了各种光电传感器，还采用了C8051F系列单片机作为本次设计的主控芯片,各种算法的实现就是使用这款芯片实现的。
随着直角坐标机器人的应用越来越广泛，直角坐标机器人的设计工作日益显得重要。
成功的设计一台直角坐标机器人涉及到很多方面的工作，包括机械结构、动力驱动、伺服控制等等。
关键词三自由度直角坐标机器人
1三自由度直角坐标工业机器人设计
1.1设计目的及基本要求
1.1.1设计目的
1了解工业机器人技术的基本知识以及单片机、机械设计、传感器等相关技术。
2初步掌握工业机器人的运动学原理、传动机构、驱动系统及控制系统并应用于工业机器人的设计中。
3通过学习掌握工业机器人的驱动机构、控制技术，并使机器人能独立执行一定的任务。
1.1.2基本要求
1要求设计一个微型的三自由度的直角坐标工业机器人；
2要求设计机器人的机械机构（示意图），传动机构、控制系统、及必需的内外部传感器的种类和数量布局。
3要有控制系统硬件设计电路。
1.2对设计论文撰写内容、格式、字数的要求
（1）课程设计论文是体现和总结课程设计成果的载体，一般不应少于3000字。
（2）学生应撰写的内容为：
中文摘要和关键词、目录、正文、参考文献等。
课程设计论文的结构及各部分内容要求可参照《沈阳工程学院毕业设计（论文）撰写规范》执行。
应做到文理通顺，内容正确完整，书写工整，装订整齐。
（3）论文要求打印，打印时按《沈阳工程学院毕业设计（论文）撰写规范》的要求进行打印。
（4）课程设计论文装订顺序为：
封面、任务书、成绩评审意见表、中文摘要和关键词、目录、正文、参考文献。
1.3时间进度安排
顺序
阶段日期
计划完成内容
备注
1
2010.12.27
讲解主要设计内容，布置任务
打分
2
2010.12.28
检查框图及初步原理图完成情况，讲解及纠正错误
打分
3
2010.12.29
检查机械结构设计并指出错误及纠正；
打分
4
2010.12.30
继续机械机构和传动机构设计
打分
5
2010.12.31
进行控制系统设计
打分
6
2011.1.3
检查控制系统原理图设计草图
打分
7
2011.1.4
完善并确定控制系统
打分
8
2011.1.5
指导学生进行驱动机构的选择
打分
9
2011.1.6
进行传感器的选择和软件流程设计
打分
10
2011.1.7
检查任务完成情况并答辩
打分
2010-12-27
2设计思路
2.1系统总体结构的设计
本次设计的题目是三自由度直角坐标机器人，直角坐标机器人具有空间上相互垂直的两根或三根直线移动轴，通过直角坐标方向的3个独立自由度确定其手部的空间位置，其动作空间为一长方体。
直角坐标机器人结构简单，定位精度高，空间轨迹易于求解；但其动作范围相对较小，设备的空间因数较低，实现相同的动作空间要求时，机体本身的体积较大。
2.2系统各环节设计
直角坐标机器人，它由水平轴（X轴，Y轴），垂直轴Z轴及驱动电机组成。
此外一个完整的机器人系统还需要控制系统和手抓，下面分别予以介绍:
直线运动轴
也叫直线运动单元，它就是一个独立的运动轴，主要由支撑载体的铝型材或钢型材和被安装在型材内部的直线导轨、运动滑块以及作为带动滑块做高速运动的同步带组成。
运动轴的驱动系统
直角坐标机器人的传动主要是通过驱动电机的转动带动同步带运动，同步带带动直线导轨上的滑块运动。
当驱动轴的最高转速低于60Or/min时通常选用步进电机，否则选用交流伺服电机。
直角坐标机器人的控制系统
机器人要在一定时间内完成特定的任务，在完成抓取，加速运动，高速运动，减速运动，释放工件等同时，还要与相关的设备通过通讯或I/O口实现一些时序上的协调同步。
另外在涂胶应用上，各个运动轴要完成直线和圆弧插补运动。
因此其数控系统要按具体应用要求来选定其控制轴数、I/O口数量和软件功能。
通常选用数控系统，PLC，工控机加运动控制卡和带轴卡功能及I/O口的驱动电机来做控制系统。
直角坐标机器人的末端操作器—手爪系统
根据其具体应用情况，其手爪系统可能是气动吸盘、气动夹取手爪、电动夹取手爪、电磁吸取手爪、焊枪、胶枪、专用工具和检测仪器等。
在很多场合可以一次抓取多个工件。
3设计方框图
图3—1主程序方框图
4直角坐标机器人的硬件设计
4.1直角坐标机器人的结构特点
针对各种不同的应用，实际上可以方便快速组合成不同维数，各种行程和不同带载能力的壁挂式、悬臂式、龙门式或倒挂式等各种形式的直角坐标机器人。
从简单的二维机器人到复杂的五维机器人就有上百种结构形式的成功应用案例。
从电机到汽车等各行各业的自动化生产线中，更是各式各样的多台直角坐标机器人和其它设备严格同步协调工作。
可以说直角坐标机器人几乎能胜任所有的工业自动化任务。
下面是其主要特点:
1.任意组合成各种样式:
每根直线运动轴最长是6m，其带载能力从10kg到20Okg。
在实际应用中已有近百种结构的直角坐标机器人，这些结构也可以任意组合成新的结构等;
2.超大行程:
因为单根龙门式直线运动单元的长度是6m，还可以多根方便地级连成超大行程，所以其工作空间几乎没有限制，小到手机点胶机，大到18m长行程的切割机，sm长行程钻铣床，6m‘6m”3m的检测机器人等。
超大行程时要采用直线导轨和齿条传动方式;
3.负载能力强:
单根直线运动单元的负载通常小于20Okg。
但当采用双滑块或多滑块刚性联结时负载能力可以增加5到10倍。
当把两根或四根直线运动单元并排接起来使用时，其负载可以增加2到4倍。
当采用多根多滑块结构时其负载能力可增加到数吨;
4.高动态特性:
轻负载时其最大运行速度可达到sm/s，加速度可达到4m/s’。
使其具有很高的动态特性，工作效率非常高，通常在几秒内完成一个工作节拍;
5.高精度:
按传动方式及配置在整个行程内其重复定位精度可达到0.05mm到0.olmm;
6.扩展能力强:
可以方便改变结构或通过编程来适合新的应用;
7.简单经济:
对比关节机器人，直角坐标机器人不仅外观直观且构造成本低，编程简单类同数控铣床，易培训员工和维修，使其具有非常好的经济性;
8.胜任复杂任务:
采用带有RTCP功能的五轴或五轴以上数控系统能完成非常复杂的喷涂，喷丸，检测，加工等任务;
9.寿命长:
直角坐标机器人的维护通常就是周期性加注润滑油，寿命一般是10年以上，维护好了可达20年;
10.应用面宽:
可以方便地装配多种形式和尺寸的手爪，可以胜任许多常见的工作，如焊接、切割，搬运、上下料、包装、码垛、拆垛、检测、探伤、分类、装配、贴标、喷码、打码和喷涂等任务。
4.2直角坐标机器人的应用
因末端操作工具的不同，直角坐标机器人可以非常方便的用作各种自动化设备，完成如焊接、搬运、上下料、包装、码垛、拆垛、检测、探伤、分类、装配、贴标、喷码、打码、（软仿型）喷涂、目标跟随、排爆等一系列工作。
特别适用于多品种，便批量的柔性化作业，对于稳定，提高产品质量，提高劳动生产率，改善劳动条件和产品的快速更新换代期着十分重要的作用。
4.3直角坐标机器人的分类
1，按用途分：
焊接机器人、码垛机器人、涂胶（点胶）机器人、检测（监测）机器人、分拣（分类）机器人、装配机器人、
排爆机器人、医疗机器人、特种机器人等。
2，按结构形式分：
壁挂（悬臂）机器人、龙门机器人、倒挂机器人等
3，按自由度分：
两坐标机器人、三坐标机器人、四坐标机器人、五坐标机器人、六坐标机器人。
4.4三自由度直角坐标机器人的硬件设计
4.4.1机械结构设计
工业机器人的机械结构系统由基座、手臂、末端操作器三大件组成。
每一大件都有若干自由度，构成一个多自由度的机械结构。
若基座具备行走机构、则构成行走机器人；若基座不具备行走及腰转机构，则构成单机器人臂（SingleRobotArm）。
手臂一般由上臂、下臂和手腕组成。
末端操作器是直接装在手腕上的一个重要部件，它可以是二手指或多手指的手抓，也可以是喷漆枪、焊具等作业工具。
工业机器人的坐标形式多种多样，按坐标形式来分的话有：
直角坐标型、圆柱坐标型、球坐标型、关节坐标型和平面关节型。
在本次设计中我们要设计的机器人为三坐标直角坐标机器人，这种机器人由三个线性关节组成，这三个关节用来确定末端操作器的位置，通常还带有附加的旋转关节，用来确定末端操作器的姿态。
这种机器人在想x、y、z轴上的运动时独立的，运动方程可独立处理，且方程式是线性的，因此，很容易通过计算机控制实现；它可以两端支撑，对于给定的结构长度，刚性最大；它的精度和位置分辨率不随工作场合而变化，容易达到高精度。
下图4-1为其工作，空间示意图。
图4-1
从上图可以看到此机器人具有三个自由度，其参考坐标系为x、y、z。
自由度是指机器人所具有的独立坐标轴运动的数目，理论上自由度越多机器人越灵活，那么它的躲避障碍物和改善动力性能就会得到提高。
4.4.2传动机构的设计
表4-1工业机器人常用传动方式的比较
工业机器人常用传动方式的比较
传动方式
特点
运动方式
距离
应用部件
圆柱齿轮
用于手臂第一转动轴提供大扭矩
转转
近
臀部
锥齿轮
转动轴反向垂直相交
转转
近
臀部、腕部
涡轮蜗杆
大传动比，重量大，有发热问题
转转
近
臀部、腕部
行星传动
大传动比，价格高，重量大
转转
近
臀部、腕部
谐波传动
很大的传动比，尺寸小，重量轻
转转
近
臀部、腕部
链传动
无间隙，重量大
转转、转移
远
移动部分、腕部
同步齿形带
有间隙和振动，重量轻
转转、转移
远
腕部、手抓
钢丝传动
远距离传动力性能很好
转转
远
腕部、手抓
齿轮齿条
精度高，价格低
转移、移转
远
腕部、手抓、臀部
传动机构是指向各轴传递运动和动力，以实现轴间的相对移动，在三自由度直角坐标机器人中，其主要传动机构为平移型传动机构。
从上表一中我们可以看到各种传动方式的对比。
机械传动机构，可以将动力所提供的运动的方式、方向或速度加以改变，被人们有目的地加以利用。
我国古代传动机构类型很多，应用很广，除了上面介绍的以外，像地动仪、鼓风机等等，都是机械传动机构的产物。
我国古代传动机构，主要有齿轮传动、绳带传动和链传动。
齿轮传动齿轮只用来传递运动，强度要求不高。
至于生产上所采用的齿轮，要传递较大的动力，受力一般较大，强度要求较高。
古代在利用畜力、水力和风力进行提水、粮食加工等工作时，都要应用此类齿轮。
例如在翻车上，须应用一级齿轮传动机构，以改变运动的方位和传递，适应翻车的工作要求。
其工作示意图如下图4-2。
齿轮传动式由两个或两个以上的齿轮组成的传动机构。
它不但可以传递运动角位移和角速度，而且还可以传递力和力矩。
图4-2
链传动链，在我国古代出现很早，商代的马具上已有青铜链条，其他青铜器和玉器上也有用链条作为装饰的。
西安出土的秦代铜车马上，有十分精美的金属链条。
但这都不能算是链传动。
作为动力传动的链条，出现在东汉时期。
东汉时毕岚率先发明翻车，用以引水。
根据其工作原理和运动关系，可以看作是一种链传动。
翻车的上、下链轮，一主动，一从动，绕在轮上的翻板就是传动链，这个传动链兼做提水的工作件，因此，翻车是链传动的一种特例。
到了宋代，苏颂制造的水运仪象台上，出现了一种“天梯”，实际上是一种铁链条，下横轴通过“天梯”带动上横轴，从而形成了真正的链传动。
绳带传动这是一种利用摩擦力的传动方式。
在西汉时，四川出产井盐，在凿井、提水时，都是用牛带动大绳轮，收卷绕过滑轮上的绳索，来提升凿井工具、卤水等。
西汉时出现的手摇纺车，是一种典型的绳带传动。
在西汉时期的画像石上，有几幅手摇纺车图，可以清楚地看到：
大绳轮主动，通过绳索带动纱锭，用手摇大绳轮旋转一周，纱锭旋转几十周，效率很高。
以后出现的三锭、五锭的纺车，效率就更高了。
元代的水运大纺车，也是用绳带传动的。
东汉时，冶金手工业有一项重要发明“水排”，用于鼓风。
这种绳带传动的工作原理是：
水力推动卧式水轮旋转，水轮轴上装有大绳轮，通过绳带带动小绳轮，小绳轮轴上端曲柄随之旋转，通过连杆推动鼓风器鼓风。
这种水排鼓风效力很高，可以抵得上几百匹马鼓风。
它的出现，标志着东汉时发达的机械已经在我国出现了，因而意义十分重大。
在经过了以上论证后，我决定采用齿轮链传动机构。
现在我以图4-3为例来说明齿轮链传动的转换关系。
图4-3
在设计这个齿轮链传动机构的时候我主要考虑到两个问题：
一是齿轮链的引入会改变系统的等效转动惯量，从而使驱动电机的响应时间减少，这样伺服系统就更加容易控制。
输出轴转动惯量转换到驱动电机上，等效转动惯量的下降与输入输出齿轮齿数的平方成正比。
二是在引入齿轮链的同时，由于齿轮间隙误差，将会导致机器人手臂的定位误差增加；而且，假如不采取一些补救措施，齿隙误差还会引起伺服系统的不稳定性。
4.4.3驱动方式的选择
要使机器人运动起来，需给各个关节即每个运动自由度安置传动装置，这就是驱动系统。
驱动系统可以是液压驱动、气动驱动、电动驱动，或者把它们结合起来应用的综合系统；可以是直接驱动或者是通过同步带、链条、轮系、谐波齿轮等机械传动机构进行间接驱动。
下面我各自介绍这三种驱动方式：
（1）液压驱动
液压驱动是由高精度的缸体和活塞一起完成的。
活塞和缸体采用滑动配合，压力油从液压缸的一端进入，把活塞推向液压缸的另一端，调节液压缸内部活塞两端的液体压力和进入液压缸的油量即可控制活塞的运动。
机器人的驱动系统采用液压驱动，有以下几个优点：
A、液压容易达到较高的单位面积压力，体积小，可获得较大的推理或转矩。
B、液压系统介质的可压缩性小，工作平稳可靠，并可得到较高的位置精度。
C、液压传动中力、速度和方向比较容易实现自动控制。
D、液压系统采用油液做介质，具有防锈性和自润滑性能，寿命长。
但是液压驱动也有其不足之处：
A、液压的粘度随温度变化而变化，这将影响工作性能。
高温度容易引起爆炸、燃烧等危险。
B、液体的泄露难于克服，要求液压元件有较高的精度和质量，故造价较高。
C、需要相应的供油系统，尤其是电液伺服系统要求严格的滤油装置，否则会引起故障。
（2）气压驱动
与液压驱动相比，气压驱动的特点是：
A、压缩空气粘度小，容易达到高速（1m/s）。
B、利用工厂集中的空气压缩机站供气，不必添加动力设备。
C、空气介质对环境无污染，使用安全，可直接应用于高温作业。
D、气动元件工作压力低，故制造要求也比液压元件低。
气压驱动的不足之处是：
A、压缩空气常用压力为0.4~0.6MPa，若要获得较大的压力，其结构就要相对增大。
B、空气压缩性大，工作平稳性差，速度控制困难，要达到准确的位置控制和困难。
C、压缩空气的除水问题是一个很重要的问题，处理不当会使刚类零件生锈，导致机器人失灵。
此外，排气还会造成噪声污染。
（3）电力驱动
分类：
按照电机的工作原理不同分为步进电机、直流伺服电机、无刷电机等。
按照控制水平的高低来分分为开环控制系统和闭环控制系统。
适用范围：
适合于中等负载，特别适合于动作复杂、运动轨迹严格的各类机器人。
考虑到体积以及精度，在比较了以上三种驱动方式后，我最终选择了电力驱动，因为电力驱动体积小，而且容易组成闭环控制系统，故控制精度高，方便，但在算法上可能稍微复杂一些，但这都可以克服的，故实现起来时选择电力驱动更好一些。
4.4.4内部传感器的选择
电机控制系统中的位置检测通常有：
微电机解算元件，光电元件，磁敏元件，电磁感应元件等。
这些位置检测传感器或者与电机的非负载端同轴连接，或者直接安装在电机的特定的部位。
其中光电元件的测量精度较高，能够准确的反应电机的转子的机械位置，从而间接的反映出与电机连接的机械负载的准确的机械位置，从而达到精确控制电机位置的目的。
（1）光电编码器的介绍：
光电编码器是通过读取光电编码盘上的图案或编码信息来表示与光电编码器相连的电机转子的位置信息的。
根据光电编码器的工作原理可以将光电编码器分为绝对式光电编码器与增量式光电编码器，下面我就这两种光电编码器的结构与工作原理做介绍。
A、绝对式光电编码器
绝对式光电编码器如图4-4所示，它是通过读取编码盘上的二进制的编码信息来表示绝对位置信息的。
编码盘是按照一定的编码形式制成的圆盘。
图十一是二进制的编码盘，图中空白部分是透光的，用“0”来表示;涂黑的部分是不透光的，用“1”来表示。
通常将组成编码的圈称为码道，每个码道表示二进制数的一位，其中最外侧的是最低位，最里侧的是最高位。
如果编码盘有4个码道，则由里向外的码道分别表示为二进制的23、22、21和20，4位二进制可形成16个二进制数，因此就将圆盘划分16个扇区，每个扇区对应一个4位二进制数，如0000、0001、…、1111。
图4-4
按照码盘上形成的码道配置相应的光电传感器，包括光源、透镜、码盘、光敏二极管和驱动电子线路。
当码盘转到一定的角度时，扇区中透光的码道对应的光敏二极管导通，输出低电平“0”，遮光的码道对应的光敏二极管不导通，输出高电平“1”，这样形成与编码方式一致的高、低电平输出，从而获得扇区的位置脚。
B、增量式光电编码器
增量式光电编码器是码盘随位置的变化输出一系列的脉冲信号，然后根据位置变化的方向用计数器对脉冲进行加/减计数，以此达到位置检测的目的。
它是由光源、透镜、主光栅码盘、鉴向盘、光敏元件和电子线路组成。
增量式光电编码器的工作原理是是由旋转轴转动带动在径向有均匀窄缝的主光栅码盘旋转，在主光栅码盘的上面有与其平行的鉴向盘，在鉴向盘上有两条彼此错开90o相位的窄缝，并分别有光敏二极管接收主光栅码盘透过来的信号。
工作时，鉴向盘不动，主光栅码盘随转子旋转，光源经透镜平行射向主光栅码盘，通过主光栅码盘和鉴向盘后由光敏二极管接收相位差90o的近似正弦信号，再由逻辑电路形成转向信号和计数脉冲信号。
为了获得绝对位置角，在增量式光电编码器有零位脉冲，即主光栅每旋转一周，输出一个零位脉冲，使位置角清零。
利用增量式光电编码器可以检测电机的位置和速度。
（2）光电编码器的测量方法：
光电码器在电机控制中可以用来测量电机转子的磁场位置和机械位置以及转子的磁场和机械位置的变化速度与变化方向。
下面就我就光电编码器在这几方面的应用方法做一下介绍。
可以利用定时器/计数器配合光电编码器的输出脉冲信号来测量电机的转速。
具体的测速方法有M法、T法和M/T法3种。
M法又称之为测频法，其测速原理是在规定的检测时间Tc内，对光电编码器输出的脉冲信号计数的测速方法，例如光电编码器是N线的，则每旋转一周可以有4N个脉冲，因为两路脉冲的上升沿与下降沿正好使编码器信号4倍频。
现在假设检测时间是Tc，计数器的记录的脉冲数是M1，则电机的每分钟的转速为
在实际的测量中，时间Tc内的脉冲个数不一定正好是整数，而且存在最大半个脉冲的误差。
如果要求测量的误差小于规定的范围，比如说是小于百分之一，那么M1就应该大于50。
在一定的转速下要增大检测脉冲数M1以减小误差，可以增大检测时间Tc单考虑到实际的应用检测时间很短，例如伺服系统中的测量速度用于反馈控制，一般应在0.01秒以下。
由此可见，减小测量误差的方法是采用高线数的光电编码器。
M法测速适用于测量高转速，因为对于给定的光电编码器线数N机测量时间Tc条件下，转速越高，计数脉冲M1越大，误差也就越小。
T法也称之为测周法，该测速方法是在一个脉冲周期内对时钟信号脉冲进行计数的方法。
例如时钟频率为fclk,计数器记录的脉冲数为M2，光电编码器是N线的，每线输出4N个脉冲，那么电机的每分钟的转速为
为了减小误差，希望尽可能记录较多的脉冲数，因此T法测速适用于低速运行的场合。
但转速太低，一个编码器输出脉冲的时间太长，时钟脉冲数会超过计数器最大计数值而产生溢出;另外，时间太长也会影响控制的快速性。
与M法测速一样，选用线数较多的光电编码器可以提高对电机转速测量的快速性与精度。
升级会员 