基于单片机控制的机械手设计.docx

1、基于单片机控制的机械手设计 摘 要机械手技术涉及到电子、机械学、自动控制技术、传感器技术和计算机技术等科学领域，是一门跨学科综合技术。随着工业自动化发展的需要，机械手在工业应用中越来越重要。文章主要叙述了机械手的设计过程 ，文章中介绍了机械手的设计理论与方法。本设计以AT89C51 单片机为核心，采用LMD18200 电机控制芯片达到控制直流电机的启停、速度和方向，完成了筛选机械手基本要求和发挥部分的要求。在筛选机械手设计中，采用了PWM 技术对电机进行控制，通过对占空比的计算达到精确调速的目的。【关键词】：筛选机械手，AT89C51 单片机，LMD18200 电机控制芯片，PWM技术，电机控

2、制。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, the manipula

3、tor 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 chip to ac

4、hieve 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, through the

5、 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)，相当于本文中的执行机构部分。2 总体方案设

10、计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轴旋转，形成腰关节，立柱和大臂形成肩关节，大臂和小臂形成肘关节，大臂和小臂作俯仰运动。这种机械手工作范围大，动作灵活，避障性好，但位置精度低，有平衡问题，控制耦合比较复杂，目前应用越来越多。（2）按控制方式

16、分1) 点位控制 采用点位控制的机械手，其运动为空间点到点之间的直线运动，不涉及两点之间的移动轨迹，只在目标点处控制机械手末端执行器的位置和姿态。这种控制方式简单，适用于上下料、点焊等作业。2) 连续轨迹控制 采用连续轨迹控制的机械手，其运动轨迹可以是空间的任意连续曲线。机器人在空间的整个运动过程都要控制，末端执行器在空间任何位置都可以控制姿态。（3）按驱动方式分1) 电力驱动 电力驱动式目前采用最多的一种。早期多采用步进电机驱动，后来发展了直流伺服电动机，现在交流伺服电动机的应用也得到了迅速发展。这类驱动单元可以直接驱动机构运动，也可以通过谐波减速器装置减速后驱动机构运动，结构简单紧凑。2)

17、 液压驱动 液压驱动的机械手具有很大的抓起能力，可抓取质量达上百公斤的物体，油压可达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 伺服电机原理图减速齿轮组由马达驱动，其终

24、端（输出端）带动一个线性的比例电位器作位置检测，该电位器把转角坐标转换为一比例电压反馈给控制线路板，控制线路板将其与输入的控制脉冲信号比较，产生纠正脉冲，并驱动马达正向或反向地转动，使齿轮组的输出位置与期望值相符，令纠正脉冲趋于为0，从而达到使伺服马达精确定位的目的。（5）伺服马达的控制标准的微型伺服马达有三条控制线，分别为：电源、地及控制。电源线与地线用于提供内部的直流马达及控制线路所需的能源，电压通常介于4V6V 之间，该电源应尽可能与处理系统的电源隔离（因为伺服马达会产生噪音）。甚至小伺服马达在重负载时也会拉低放大器的电压，所以整个系统的电源供应的比例必须合理。输入一个周期性的正向脉冲信

25、号，这个周期性脉冲信号的高电平时间通常在1ms2ms 之间，而低电平时间应在5ms 到20ms 之间，并不很严格，下表表示出一个典型的20ms 周期性脉冲的正脉冲宽度与微型伺服马达的输出臂位置的关系：（6）选用的伺服马达我选用的伺服马达为TowPro 的，型号为SG303。其主要技术参数如下：转速：0.23 秒60 度。 力矩：3.2kgcm。 尺寸：40.4mm19.8mm36mm。 重量：0.6kg。 12V 和24V 电源供电。控制周期脉冲宽度为20ms。送出不同的正脉冲宽度是，就可以得到不同的控制效果。控制正脉冲宽度如下：（7）增量式编码器编码器是把角位移或直线位移转换成电信号的一种装

26、置。前者成为码盘，后者称码尺按照读出方式编码器可以分为接触式和非接触式两种接触式采用电刷输出，一电刷接触导电区或绝缘区来表示代码的状态是“”还是“”；非接触式的接受敏感元件是光敏元件或磁敏元件，采用光敏元件时以透光区和不透光区来表示代码的状态是“”还是“”。按照工作原理编码器可分为增量式和绝对式两类。增量式编码器是将位移转换成周期性的电信号，再把这个电信号转变成计数脉冲，用脉冲的个数表示位移的大小。绝对式编码器的每一个位置对应一个确定的数字码，因此它的示值只与测量的起始和终止位置有关，而与测量的中间过程无关。旋转增量式编码器以转动时输出脉冲，通过计数设备来知道其位置，当编码器不动或停电时，依靠

27、计数设备的内部记忆来记住位置。这样，当停电后，编码器不能有任何的移动，当来电工作时，编码器输出脉冲过程中，也不能有干扰而丢失脉冲，不然，计数设备记忆的零点就会偏移，而且这种偏移的量是无从知道的，只有错误的生产结果出现后才能知道。解决的方法是增加参考点，编码器每经过参考点，将参考位置修正进计数设备的记忆位置。在参考点以前，是不能保证位置的准确性的。为此，在工控中就有每次操作先找参考点，开机找零等方法。比如，打印机扫描仪的定位就是用的增量式编码器原理，每次开机，我们都能听到噼哩啪啦的一阵响，它在找参考零点，然后才工作。增量式编码器特点：增量式编码器转轴旋转时，有相应的脉冲输出，其计数起点任意设定，

28、可实现多圈无限累加和测量。编码器轴转一圈会输出固定的脉冲，脉冲数由编码器光栅的线数决定。需要提高分辨率时，可利用 90 度相位差的 A、B 两路信号进行倍频或更换高分辨率编码器。（8）丝杆及螺母副(1).主要确定丝杆的外径d，及长度，选择螺纹的类型，牙型角，计算出螺纹中径d2，螺纹升角，定出螺距P，求出螺纹导程S。可用下式进行计算此公式也用来计算齿轮等圆形零件的转动惯量i -由电机轴到丝杠一级齿轮减速器的传动比，（10）滚动轴承滚动轴承的类型、尺寸和公差等级均已制定有国家标准，在机械设计中只需根据工作条件选择合适的轴承类型，尺寸和公差等级等，并进行轴承的组合结构设计。按滚动轴承承受载荷的作用方

29、向，常用轴承可分为三类，即径向接触轴承、向心角接触球轴承和轴向接触轴承。在机械手的设计中，通常使用角接触球轴承、圆锥滚子轴承或深沟球轴承和推力球轴承的组合件。选择轴承要根据它所支承的轴的粗度（一般轴径的设计要先由计算的强度来确定基本尺寸，再根据GB/T2822-81 来选取标准尺寸，也可以根据标准件如轴承等决定）来决定的，选定轴承后，还要进行轴承的寿命计算，可以根据下面的经验公式来计算。轴承的寿命：4 软件电路部分设计4.1 单片机的选择（1） 单片机的概念单片机是将计算机的基本部件微型化并集成到一块芯片上的微型计算机。通常在芯片内含有CPU、ROM、RAM、并行I/O 口、串行口、定时/计数

30、器、中断控制系统、系统时钟及系统总线等。（2） 单片机特点1) 优异的性能价格比。2) 高、体积小、可靠性高。单片机把各功能部件集成在一块芯片上，内部采用总线结构，减少了各芯片之间的连线，大大提高了计算机的可靠性与抗干扰能力。另外，其体积小，对于强磁场环境易于采取屏蔽措施，适合在恶劣环境下工作。3) 控制功能强。为了满足工业控制的要求，一般单片机的指令系统种均有极丰富的转移指令、I/O 口的逻辑操作及位处理功能，单片机的逻辑控制功能及运行速度均高于同一档次的微机。4) 低功耗、低电压，便于生产便携式产品。5) 单片机的系统扩展和系统配置叫典型、规范，容易构成各种规模的应用系统。（3） 单片机硬件结构1) 89C52 系列单片机基本配置如下：a) 微处理器该单片机中有一个8 位的微处理器，与通用的微处理器基本相同，同样包括了运算器和控制器两大部分，只是增加了面向控制的处理功能，不仅可处理数据，还可以进行位变量的处理。b) 数据存储器片内为128 个字节，片外最多可外扩至64k 字节，用来存储程序在运行期间的工作变量、运算的中间结果、数据暂存和缓冲、标志位等，所以称为数据存储器。c) 程序存储器由于受集成度限制，片内只读存储器一般容量较小，如果片内的只读存储器的容量不够，则需用扩展片外的只读存储器，片外最多