《三自由度直角坐标工业机器人设计论文》由会员分享,可在线阅读,更多相关《三自由度直角坐标工业机器人设计论文(13页珍藏版)》请在金锄头文库上搜索。
1、沈 阳 工 程 学 院课 程 设 计设计题目:三自由度微型直角坐标工业机器人模型设计 中 文 摘 要直角坐标机器人具有空间上相互垂直的两根或三根直线移动轴,通过直角坐标方向的3个独立自由度确定其手部的空间位置,其动作空间为一长方体。直角坐标机器人结构简单,定位精度高,空间轨迹易于求解;但其动作范围相对较小,设备的空间因数较低,实现相同的动作空间要求时,机体本身的体积较大。大型的直角坐标机器人也称桁架机器人或龙门式机器人是能够实现自动控制的、可重复编程的、多自由度的、运动自由度建成空间直角关系的、多用途的操作机。其工作的行为方式主要是通过完成沿着X、Y、Z轴上的线性运动。近年来随着工业机器人的不
2、断发展,工业机器人不断在工业领域得到广泛的应用,尤其是结构简单的直角坐标机器人,本次设计我主要是对三自由度的直角坐标机器人进行设计,完成一个大概的设计,在设计中我采用了各种光电传感器,还采用了C8051F系列单片机作为本次设计的主控芯片,各种算法的实现就是使用这款芯片实现的。随着直角坐标机器人的应用越来越广泛,直角坐标机器人的设计工作日益显得重要。成功的设计一台直角坐标机器人涉及到很多方面的工作,包括机械结构、动力驱动、伺服控制等等。关键词:三自由度 直角坐标 机器人 单片机 硬件 软件目 录中 文 摘 要I目 录II1设计任务描述12 设计思路22.1系统总体结构的设计22.2系统各环节设计
3、23 设计方框图34 直角坐标机器人的硬件设计44.1单片机最小系统电路设计44.2单片机稳压电源设计54.3直流电机驱动设计54.4步进电机驱动设计64.5机械结构部分74.6传感器选择85直角坐标机器人的控制设计105.1 示教再现功能105.2运动控制功能106 主要元器件介绍117 小结128 致谢139.参考文献14附录151设计任务描述1.1 设计题目:三自由度直角坐标工业机器人设计1.2 设计要求设计目的:1)了解工业机器人技术的基本知识以及单片机、机械设计、传感器等相关技术。2)初步掌握工业机器人的运动学原理、传动机构、驱动系统及控制系统并应用于工业机器人的设计中。3)通过学习
4、,掌握工业机器人的驱动机构、控制技术,并使机器人能独立执行一定的任务。基本要求:1)要求设计一个微型的三自由度的直角坐标工业机器人; 2)要求设计机器人的机械机构(示意图),传动机构、控制系统、及必需的内外部传感器的种类和数量布局。 3)要有控制系统硬件设计电路。发挥部分: 自由发挥2 设计思路2.1系统总体结构的设计本次设计的题目是三自由度直角坐标机器人,直角坐标机器人具有空间上相互垂直的两根或三根直线移动轴,通过直角坐标方向的3个独立自由度确定其手部的空间位置,其动作空间为一长方体。直角坐标机器人结构简单,定位精度高,空间轨迹易于求解;但其动作范围相对较小,设备的空间因数较低,实现相同的动
5、作空间要求时,机体本身的体积较大。2.2系统各环节设计 直角坐标机器人,它由水平轴(X轴,Y轴),垂直轴Z轴及驱动电机组成。 此外一个完整的机器人系统还需要控制系统和手抓,下面分别予以介绍:直线运动轴 也叫直线运动单元,它就是一个独立的运动轴,主要由支撑载体的铝型材或钢型材和被安装在型材内部的直线导轨、运动滑块以及作为带动滑块做高速运动的同步带组成。运动轴的驱动系统 直角坐标机器人的传动主要是通过驱动电机的转动带动同步带运动,同步带带动直线导轨上的滑块运动。当驱动轴的最高转速低于60Or/min时通常选用步进电机,否则选用交流伺服电机。直角坐标机器人的控制系统 机器人要在一定时间内完成特定的任
6、务,在完成抓取,加速运动,高速运动,减速运动,释放工件等同时,还要与相关的设备通过通讯或I/O口实现一些时序上的协调同步。另外在涂胶应用上,各个运动轴要完成直线和圆弧插补运动。因此其数控系统要按具体应用要求来选定其控制轴数、I/O口数量和软件功能。通常选用数控系统,PLC,工控机加运动控制卡和带轴卡功能及I/O口的驱动电机来做控制系统。直角坐标机器人的末端操作器手爪系统 根据其具体应用情况,其手爪系统可能是气动吸盘、气动夹取手爪、电动夹取手爪、电磁吸取手爪、焊枪、胶枪、专用工具和检测仪器等。在很多场合可以一次抓取多个工件。3 设计方框图接近觉传感器转速传感器传感器信号调理电路A/D转换器计算机
7、人机交互系统机器人控制器PID控制算法距离控制算法电动马达图31主程序方框图4 直角坐标机器人的硬件设计4.1单片机最小系统电路设计最小系统是指保证系统能正常工作的最基本电路和软件部分,单片机的最小系统电路包括外部晶振电路、电源电路和复位电路,如图4-3所示。 (a) 外部晶振电路 (b) 电源电路 (c)外部复位电路 图4.1 单片机最小系统电路时钟基本脉冲是CPU工作的基础。C8051F020单片机的系统时钟信号,由时钟振荡电路或专用时序脉冲信号提供。C8051F020在内部集成了完整的振荡电路,XTAL1和XTAL2分别为振荡器的输出和输入,XTAL1和XTAL2引脚可接入一个石英或陶瓷
8、振荡器,如图4-1(a)所示。图中电阻R2是为了避免对外接晶体振荡器的过驱动,电容C可提高振荡器的稳定性。为单片机提供电源是单片机正常工作的最基本操作,电源通过电容与单片机并联相连,是为了避免出现耦合,对单片机造成损伤。外部复位电路是通过外部引脚提供了使用外部电路强制MCU进入复位状态的手段。在引脚上加上一个低电平有效信号将导致进入复位状态。最好能提供一个外部上拉或对引脚去耦以防止噪声引起复位,如图4-1(c)所示。在低有效的信号撤出后,MCU将保持在复位状态至少12个时钟周期。从外部复位状态推出后,PINRSF标志(RSTSRC.O)被置位。4.2单片机稳压电源电路设计 为了给单片机提供稳定
9、的3.3伏电源,我设计了直流稳压电路,其主要有变压器,整流电路,滤波电路,三端稳压器件组成,能保证给单片机提供稳定的直流电源。集成稳压器具有输出电流大,输出电压高,体积小,可靠性高等优点,在电子电路中应用广泛。分类: 外部结构:三端、多端。输出电压可调、输出电压固定,输出正电压、输出负电压。三端固定输出集成稳压器主要用于固定输出标准电压值的稳压电源中。虽然通过外接电路元件,也可构成多种形式的可调稳压电源,但稳压性能指标有所降低。集成三端可调稳压器性能指标优良。本设计主要用到LM7805其优点主要有,7805 系列为 3 端正稳压电路,TO-220 封装,能提供多种固定的输出电压,应用范围广。内
10、含过流、过热和过载保护电路。带散热片时,输出电流可达 1A。虽然是固定稳压电路,但使用外接元件,可获得不同的电压和电流。其电路图如下:图4.2直流稳压电源电路 该电路将市电380伏通过变压器转化为220伏电压,再通过桥式电路进行整流,将交流转化为直流,其中电容C1为滤波作用,滤除纹波干扰,C2作用为防止自激振荡,C3作用为减小高频干扰。1117与LM7805作用基本相同,将5伏电压将为3.3伏。4.3直流电机驱动电路设计本次设计我用直流电机模拟风机来进行散热,其驱动用三极管。输出或输入为直流电能的旋转电机,称为直流电机,它是能实现直流电能和机械能互相转换的电机。当它作电动机运行时是直流电动机,
11、将电能转换为机械能;作发电机运行时是直流发电机,将机械能转换为电能。当P口为高电平时电机转动,低电平时,电机停止。电路图连接如下:图4.3直流电机驱动电路图4.4步进电机驱动电路设计步进电机是将电脉冲信号转变为角位移或线位移的开环控制元件。在非超载的情况下,电机的转速、停止的位置只取决于脉冲信号的频率和脉冲数,而不受负载变化的影响,即给电机加一个脉冲信号,电机则转过一个步距角。这一线关系的存在,加上步进电机只有周期的误差而无累积误差等特点。使得在速度、位置等控制领域用步进电机来控制变的非常的简单。其电路图如下:图4.4步进电机驱动电路本步进电机为四相电机。通过控制P1.0,P1.1,P1.2,
12、P1.3的高低电平,来控制电机的正反装。其中二极管有保护作用,因为电机通电时电流逐渐增大,而电机断电时电流也是正逐渐减小,如果逐渐减小的的电流不能及时流走,将对其他器件造成损坏。故接二极管保护单片机免受损坏。4.5机械机构设计工业机器人的机械结构系统由基座、手臂、末端操作器三大件组成。每一大件都有若干自由度,构成一个多自由度的机械结构。若基座具备行走机构、则构成行走机器人;若基座不具备行走及腰转机构,则构成单机器人臂(Single Robot Arm)。手臂一般由上臂、下臂和手腕组成。末端操作器是直接装在手腕上的一个重要部件,它可以是二手指或多手指的手抓,也可以是喷漆枪、焊具等作业工具。 工业
13、机器人的坐标形式多种多样,按坐标形式来分的话有:直角坐标型、圆柱坐标型、球坐标型、关节坐标型和平面关节型。 在本次设计中我们要设计的机器人为三坐标直角坐标机器人,这种机器人由三个线性关节组成,这三个关节用来确定末端操作器的位置,通常还带有附加的旋转关节,用来确定末端操作器的姿态。这种机器人在想x、y、z轴上的运动时独立的,运动方程可独立处理,且方程式是线性的,因此,很容易通过计算机控制实现;它可以两端支撑,对于给定的结构长度,刚性最大;它的精度和位置分辨率不随工作场合而变化,容易达到高精度。下图4-5为其工作,空间示意图。 图4-5从上图可以看到此机器人具有三个自由度,其参考坐标系为x、y、z
14、。自由度是指机器人所具有的独立坐标轴运动的数目,理论上自由度越多机器人越灵活,那么它的躲避障碍物和改善动力性能就会得到提高。 传动机构的设计 传动机构是指向各轴传递运动和动力,以实现轴间的相对移动,在三自由度直角坐标机器人中,其主要传动机构为平移型传动机构。从上表一中我们可以看到各种传动方式的对比。机械传动机构,可以将动力所提供的运动的方式、方向或速度加以改变,被人们有目的地加以利用。我国古代传动机构类型很多,应用很广,除了上面介绍的以外,像地动仪、鼓风机等等,都是机械传动机构的产物。我国古代传动机构,主要有齿轮传动、绳带传动和链传动。 驱动方式的选择要使机器人运动起来,需给各个关节即每个运动
15、自由度安置传动装置,这就是驱动系统。驱动系统可以是液压驱动、气动驱动、电动驱动,或者把它们结合起来应用的综合系统;可以是直接驱动或者是通过同步带、链条、轮系、谐波齿轮等机械传动机构进行间接驱动。本次设计经综合比较,用的是电力驱动。分类:按照电机的工作原理不同分为步进电机、直流伺服电机、无刷电机等。按照控制水平的高低来分分为开环控制系统和闭环控制系统。适用范围:适合于中等负载,特别适合于动作复杂、运动轨迹严格的各类机器人。考虑到体积以及精度,在比较了以上三种驱动方式后,我最终选择了电力驱动,因为电力驱动体积小,而且容易组成闭环控制系统,故控制精度高,方便,但在算法上可能稍微复杂一些,但这都可以克服的,故实现起来时选择电力驱动更好一些。4.6传感器模块 传感器是整个机器人得以准确循迹的核心部件,只有经过传感器采集了外界信息后才能对机器人身处的环境进行识别,才能使机器人根据轨迹运动