单片机控制的机械手.doc
《单片机控制的机械手.doc》由会员分享,可在线阅读,更多相关《单片机控制的机械手.doc(21页珍藏版)》请在淘文阁 - 分享文档赚钱的网站上搜索。
1、精品文档,仅供学习与交流,如有侵权请联系网站删除 摘 要机械手技术涉及到电子、机械学、自动控制技术、传感器技术和计算机技术等科学领域,是一门跨学科综合技术。随着工业自动化发展的需要,机械手在工业应用中越来越重要。文章主要叙述了机械手的设计过程 ,文章中介绍了机械手的设计理论与方法。本设计以AT89C51 单片机为核心,采用LMD18200 电机控制芯片达到控制直流电机的启停、速度和方向,完成了筛选机械手基本要求和发挥部分的要求。在筛选机械手设计中,采用了PWM 技术对电机进行控制,通过对占空比的计算达到精确调速的目的。【关键词】:筛选机械手,AT89C51 单片机,LMD18200 电机控制芯
2、片,PWM技术,电机控制。AbstractThe manipulator technology involves to the electron, mechanics, the automatic control technology,the sensor technology and the computer technology and so on scientific field, is an interdisciplinarycomprehensive technology. Along with the industrial automation need to develop, t
3、he manipulator isgetting more and more important in the industrial application. The article mainly narratedmanipulators design process, in the article introduced manipulators design theory and the method.This design take at89C51 monolithic integrated circuit as a core, uses the LMD18200 motorcontrol
4、 chip to achieve the control direct current machine to open stops, the speed and the direction,completed has screened the manipulator essential requirements and the display part request. Inscreens the manipulator to design, used the PWM technology to carry on the control to the electricalmachinery,
5、through the computation achieved the precise velocity modulation to the dutyfactor thegoal【Key words】Screening manipulator, AT89C51 monolithic integrated circuit, LMD18200motor control chip, PWM technology, motor control. 1 前言1.1 机械手概述机械化、自动化已成在现代工业中突出的主题。化工等连续性生产过程的自动化已基本得到解决。但在机械工业中,加工、装配等生产是不连续的,
6、机器人的出现并得到应用,为这些作业的机械化奠定了良好的基础。机械手,多数是指程序可变(编)的独立的自动抓取、搬运工件、操作工具的装置(国内称作工业机械手或通用机械手)。机械手是一种具有人体上肢的部分功能,工作程序固定的自动化装置。机械手具有结构简单、成本低廉、维修容易的优势,但功能较少,适应性较差。目前我国常把具有上述特点的机械手称为专用机械手,而把工业机械手称为通用机械手。简而言之,机械手就是用机器代替人手,把工件由某个地方移向指定的工作位置,或按照工作要求以操纵工件进行加工。机械手一般分为三类。第一类是不需要人工操作的通用机械手,也即本文所研究的对象。它是一种独立的、不附属于某一主机的装置
7、,可以根据任务的需要编制程序,以完成各项规定操作。它是除具备普通机械的物理性能之外,还具备通用机械、记忆智能的三元机械。第二类是需要人工操作的,称为操作机(Manipulator)。工业中采用的锻造操作机也属于这一范畴。第三类是专业机械手,主要附属于自动机床或自动生产线上,用以解决机床上下料和工件传送。这种机械手在国外通常被称之为“Mechanical Hand”,它是为主机服务的,由主机驱动。除少数外,工作程序一般是固定的,因此是专用的。机械手按照结构形式的不同又可分为多种类型,其中关节型机械手以其结构紧凑,所占空间体积小,相对工作空间最大,甚至能绕过基座周围的一些障碍物等这样一些特点,成为
8、机械手中使用最多的一种结构形式。要机械手像人一样拿取东西,最简单的基本条件是要有一套类似于指、腕、臂、关节等部分组成的抓取和移动机构执行机构;像肌肉那样使手臂驱动传动系统;像大脑那样指挥手动作的控制系统。这些系统的性能就决定了运动的机械手的性能。一般而言,机械手通常就是由执行机构、驱动传动系统和控制系统这三部分组成,如图 1-1 所示。 图1-1 机械手的一般组成对于现代智能机械手而言,还具有智能系统,主要是感觉装置、视觉装置和语言识别装置等。目前研究主要集中在赋予机械手“眼睛”,使它能识别物体和躲避障碍物,以及机械手的触觉装置。机器人的这些组成部分并不是各自独立的,或者说并不是简单的叠加在一
9、起,从而构成一个机械手的。要实现机械手所期望实现的功能,机械手的各部分之间必然还存在着相互关联、相互影响和相互制约。它们之间的相互关系如图1-2 所示。机械手的机械系统主要由执行机构和驱动传动系统组成。执行机构是机械手赖以完成工作任务的实体,通常由连杆和关节组成,由驱动传动系统提供动力,按控制系统的要求完成工作任务。驱动传动系统主要包括驱动机构和传动系统。驱动机构提供机械手各关节所需要的动力,传动系统则将驱动力转换为满足机械手各关节力矩和运动所要求的驱动力或力矩。有的文献则把机械手分为机械系统、驱动系统和控制系统三大部分。其中的机械系统又叫操作机(Manipulator),相当于本文中的执行机
10、构部分。2 总体方案设计2.1 设计要求生产线上有红黑两种直径为2cm 厚1cm 的圆铁片,设计一种机械手,该手能自动机械手的机械系统主要由执行机构和驱动传动系统组成。执行机构是机械手赖以完成工作任务的实体,通常由连杆和关节组成,由驱动传动系统提供动力,按控制系统的要求完成工作任务。驱动传动系统主要包括驱动机构和传动系统。驱动机构提供机械手各关节所需要的动力,传动系统则将驱动力转换为满足机械手各关节力矩和运动所要求的驱动力或力矩。有的文献则把机械手分为机械系统、驱动系统和控制系统三大部分。其中的机械系统又叫操作机(Manipulator),相当于本文中的执行机构部分。2 总体方案设计2.1 设
11、计要求生产线上有红黑两种直径为2cm 厚1cm 的圆铁片,设计一种机械手,该手能自动筛选出红色铁片,并把红色铁片放到指定位置。机械手有上行/下行、左行/右行、放松/夹紧几个运行方式。并要求机械手有判别铁片颜色的功能,且能准确把握铁片位置、重量、形状等因素。该手运行路径合理,接近指定位置时能够减速运行。整个过程无人工操作,系统通过传感装置检测工件,工作结束后能自动停止。2.2 基本设计思路总体设计框图如下: 图2-1 总体设计框图2.2.1 CPUCPU 部分有两种选择:单片机控制和PLC 控制。2.2.2 传动机构传动机构种类繁多,常见的有齿轮传动、齿条传动、丝杆传动、链条传动。由于一般的电机
12、驱动系统输出的力矩较小,需要通过传动机构来增加力矩,提高带负载能力。对机械手的传动机构的一般要求有:(1)结构紧凑,即具有相同的传动功率和传动比时体积最小,重量最轻;(2)传动刚度大,即由驱动器的输出轴到连杆关节的转轴在相同的扭矩时角度变形要小,这样可以提高整机的固有频率,并大大减轻整机的低频振动;(3)回差要小,即由正转到反转时空行程要小,这样可以得到较高的位置控制精度;(4)寿命长、价格低。2.2.3 机械手1.机械手的组成机械手一般由执行机构、控制系统、驱动系统三个部分组成。(1)执行机构1) 手腕 手腕是联接手臂与末端执行器的部件,用以调整末端执行器的方位和姿态。2) 手臂 手臂是支承
13、手腕和末端执行器的部件。它由动力关节和连杆组成,用来改变末端执行器的位置。3) 机座 机座是机械手的基础部件,并承受相应的载荷,机座分为固定式和移动式两类。(2)控制系统控制系统用来控制机械手按规定要求动作,可分为开环控制系统和闭环控制系统。大多数工业机械手采用计算机控制,这类控制系统分为决策级,策略级和执行级三级:决策级的功能是识别环境、建立模型、将工作任务分解为基本动作序列;策略级将基本动作变为关节坐标协调变化的规律,分配给各关节的伺服系统;执行级给出各关节伺服系统的具体指令。(3)驱动系统驱动系统是按照控制系统发出的指令将信号放大,驱动执行机构运动的传动装置。常用的由电气、液压、气动和机
14、械等四种驱动方式。除此之外,机械手可以配置多种传感器(如位置、力,触觉,视觉等传感器),用以检测其运动位置和工作状态。2.机械手的分类机械手按坐标形式、控制方式、驱动方式和信号输入方式四种分类方法。(1)按坐标形式分坐标形式是指执行机构的手臂在运动时所取的参考坐标系的形式。1) 直角坐标式 直角坐标机械手的末端执行器在空间位置的改变式通过三个互相垂直的轴线移动来实现的,即沿X 轴的纵向移动、沿Y 轴的横向移动及沿Z 轴的升降。这种机械手位置精度最高,控制无耦合,比较简单,避障性好,但结构较庞大,动作范围小,灵活性差。2) 圆柱坐标式 圆柱坐标机械手是通过两个移动和一个转动来实现末端执行器空间位
15、置的改变,其手臂的运动由在垂直立柱的平面伸缩和沿立柱升降两个直线运动及手臂绕立柱转动复合而成。这种机械手位置精度较高,控制简单,避障性好,但结构也较庞大。3) 极坐标式 极坐标机械手的运动式由一个直线运动和两个转动组成,即沿手臂方向X 的伸缩,绕Y 轴的俯仰和绕Z 轴的回转。这种机械手占地面积小,结构紧凑,位置精度尚可,但避障性差,有平衡问题。4) 关节坐标式 关节坐标机械手主要是由立柱、大臂和小臂组成,立柱绕Z轴旋转,形成腰关节,立柱和大臂形成肩关节,大臂和小臂形成肘关节,大臂和小臂作俯仰运动。这种机械手工作范围大,动作灵活,避障性好,但位置精度低,有平衡问题,控制耦合比较复杂,目前应用越来
16、越多。(2)按控制方式分1) 点位控制 采用点位控制的机械手,其运动为空间点到点之间的直线运动,不涉及两点之间的移动轨迹,只在目标点处控制机械手末端执行器的位置和姿态。这种控制方式简单,适用于上下料、点焊等作业。2) 连续轨迹控制 采用连续轨迹控制的机械手,其运动轨迹可以是空间的任意连续曲线。机器人在空间的整个运动过程都要控制,末端执行器在空间任何位置都可以控制姿态。(3)按驱动方式分1) 电力驱动 电力驱动式目前采用最多的一种。早期多采用步进电机驱动,后来发展了直流伺服电动机,现在交流伺服电动机的应用也得到了迅速发展。这类驱动单元可以直接驱动机构运动,也可以通过谐波减速器装置减速后驱动机构运
17、动,结构简单紧凑。2) 液压驱动 液压驱动的机械手具有很大的抓起能力,可抓取质量达上百公斤的物体,油压可达7MPa,液压传动平稳,动作灵敏,但对密封性要求较高,不宜在高温或低温现场工作,需配备一套液压系统。3) 气压驱动 气压驱动的机械手结构简单,动作迅速,价格低廉,由于空气可压缩性,导致工作速度稳定性差,气源压力一般为0.7MPa,因此抓取力小,只能抓取重量为几公斤到十几公斤的物体。(4)按信号输入方式分1) 人操作机械手 是一种由操作人员直接进行操作的具有几个自由度的机械手。2) 固定程序操作机械手 按预先规定的顺序、条件和位置,逐步地重复执行给定的作业任务的机械手。3) 可变程序操作机械
18、手 它与固定程序机械手基本相同,但其工作次序等信息易于修改。4) 程序控制机械手 它的作业指令是由计算机程序向机械手提供的,其控制方式与数控机床一样。5) 示教再现机械手 这类机械手能够按照记忆装置存储的信息来复现由人示教的动作,其示教动作可自动地重复执行。6) 智能机械手 采用传感器来感知工作环境或工作条件的变化,并借助其自身的决策能力,完成相应的工作任务。2.2.4 抓取机构抓取机构是机械手执行工作的装置,可安装夹持器、工具、传感器等。抓取机构可分为机械夹紧、真空抽吸、液压夹紧、磁力吸附等。2.2.5 机械手的驱动方式该机械手一共具有三个独立的运动关节,连同末端机械手的运动,一共需要三个动
19、力源。机械手常用的驱动方式有液压驱动、气压驱动和电机驱动三种类型。这三种方法各有所长,各种驱动方式的特点见表:方便 较复杂表2-1 三种驱动方式的特点对照机械手驱动系统各有其优缺点,通常对机械手的驱动系统的要求有:(1) 驱动系统的质量尽可能要轻,单位质量的输出功率要高,效率也要高;(2) 反应速度要快,即要求力矩质量比和力矩转动惯量比要大,能够进行频繁地起、制动,正、反转切换;(3) 驱动尽可能灵活,位移偏差和速度偏差要小;(4) 安全可靠;(5) 操作和维护方便;(6) 对环境无污染,噪声要小;(7) 经济上合理。2.2.6 设计方案的定型1.CPU 的选择由于单片机体积小,价格便宜且具有
20、高稳定性和很强的抗干扰能力,因此本设计中用单片机取代PLC 控制。2.机械手坐标形式的选择由于本设计中精度要求较高,首先排除了极坐标式和关节坐标式,而且它们还存在平衡问题,直角坐标式灵活性差,不利于提高工作效率。因此为了使其工作方式更加简单直观,机械手坐标类型选择为圆柱坐标机械手。3.传动机构的选择本设计要求传动方式为电机的转动带动机械手臂的上下、左右移动,即圆周运动转换为直线运动,首先排除了带传动。与此同时,由于设计精度要求较高,所以链条传动也不作考虑。剩下丝杆传动和齿轮传动,从零件的加工方面考虑,最终确定了加工较为简单的齿轮传动。4.抓取机构的选择目前工业上较长采用的抓取机构为手爪。但是本
21、次设计要求的工件为直径2cm厚1cm 的圆形铁片,抓取精度要求高,操作难度较大。考虑到材质,因此选择了电磁阀作为抓取机构。通过电磁阀的通断来控制工件的抓取和放下,操作方便。5.驱动方式的选择在选择驱动方式阶段,我首先考虑的是液压、气压传动,但方案存在一定缺陷。其中,液压装置体积太过庞大,需要专门配置一套液压系统,且对密封性要求高,不宜在高温、低温下工作。而气压传动由于空气的可压缩性导致工作速度、稳定性较差,且有一定噪音。电机选择相对较为简单,由于步进电机有步距角误差,机械手在齿轮传动和摆动时会进一步放大该误差,因此选择伺服电机驱动。3 硬件结构设计3.1 机械手尺寸的确定由于本次设计对工作场地
22、要求并没有明确的限制,因此机械手的尺寸也就没有明确的规定,为了设计的方便,将机械手大臂有效距离长为280mm,小臂有效距离长为170mm,机械手3D 图如下: 图3-1 机械手3D 图3.2 传动部分设计(1) 机械手是有三台伺服电机驱动:电机M1 控制大臂在Z 轴旋转摆动,电机M2 控制小臂在Z 轴的旋转摆动,电机C 控制末端执行器在Z 轴的上下移动。为了设计的方便,控制方式采用点位控制。通过分别控制三台电机的正反转来确定末端执行器在空间上的具体位置。由于三台电机不是同时控制,因此不存在相互间的干扰,从而增强了整个系统的稳定性。(2) 具体传动环节:基座部分装有服电机M1,通过齿轮传动控制大
23、臂旋转,基座与大臂底座用轴承连接;大臂座装有伺服电机M2,通过齿轮、传动控制小臂的旋转摆动;末端执行器部分装有伺服电机M3,同样通过齿轮、丝杆传动控制末端执行器的上下移动。(3) 伺服电机一个伺服电机内部包括了一个小型直流马达;一组变速齿轮组;一个反馈可调电位器;及一块电子控制板。其中,高速转动的直流马达提供了原始动力,带动变速(减速)齿轮组,使之产生高扭力的输出,齿轮组的变速比愈大,伺服马达的输出扭力也愈大,也就是说越能承受更大的重量,但转动的速度也愈低 图3-2 伺服电机图(4)微行伺服马达的工作原理一个微型伺服马达是一个典型闭环反馈系统,其原理可由下图表示: 图3-3 伺服电机原理图减速
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 单片机 控制 机械手
限制150内