单片机控制机械手

1、XX大学课程设计说明书题目：机械手的单片机控制学院（系）：电院自动化系年级专业： XXXXXX学 号： 09学生姓名：指导教师：王振臣陈志旺教师职称：教授 讲师XX大学课程设计（论文）任务书院（系）：基层教学单位:学号学生姓名专业（班级）设计题目设 计 技 术 参 数设 计 要 求工作量工作 计 划参 考 资 料指导教师签字基层教学单位主任签字说明：此表一式四份，学生、指导教师、基层教学单位、系部各一份。 年 月 日摘要摘要机械手技术涉及到电子、机械学、自动控制技术、传感器技术和计算机技术 等科学领域，是一门跨学科综合技术。随着工业自动化发展的需要，机械手 在工业应用中越来越重要。文章主要叙述

2、了机械手的设计过程，文章中介绍了机械手的设计理论与方法。本设计以AT89C51单片机为核心，采用L298电机控制芯片达到控制直流 电机的启停和方向，完成了筛选机械手基本要求和发挥部分的要求。【关键词】：筛选机械手，AT89C51单片机，L298电机控制芯片，电机控 制。目录目录摘要I第一章绪论11 1机械手概述1机械手当代应用1机械手工作方式 1机械手的分类11.2机械手的一般组成 1第二章总体方案设计 32.1设计要求32.2基本设计思路32 2 1 CPU32 2 2传动机构32 2 3机械手42 2 3 1机械手组成42 2 3 1机械手分类42 2 4抓取机构52. 2. 5机械手的驱

3、动方式 62 3设计方案的总结82 3 1 CPU 的选择82 3 2机械手坐标形式的选择 82 3 3传动机构的选择 82 3 4驱动方式的选择 8第三章硬件结构设计93 1机械手尺寸的确定 93 2传动部分设计 93 3硬件部分总结 9第四章 软件电路部分设计 104 1单片机的选择104 . 1 . 1单片机的概念104 . 1 . 2单片机特点104 . 1 . 3单片机硬件结构 114 . 1 . 3 . 1 89C51 基本配置114 . 1 . 3 . 2引脚及其功能124 . 2 驱动芯片选择 134 . 2 . 1驱动芯片概念 134. 2. 2驱动芯片原理 134 . 3流

4、程图134 . 4 汇编程序4 . 5本章小结结论参考文献第一章绪论1.1机械手概述1.1.1机械手的当代应用机械化、自动化已成在现代工业中突出的主题。 化工等连续性生产过程的自 动化已基本得到解决。但在机械工业中，加工、装配等生产是不连续的，机 器人的出现并得到应用，为这些作业的机械化奠定了良好的基础。机械手，多数是指程序可变（编）的独立的自动抓取、搬运工件、操作工具 的装置（国内称作工业机械手或通用机械手）。1.1. 2机械手工作方式机械手是一种具有人体上肢的部分功能，工作程序固定的自动化装置。机械 手具有结构简单、成本低廉、维修容易的优势，但功能较少，适应性较差。 目前我国常把具有上述特

5、点的机械手称为专用机械手， 而把工业机械手称为 通用机械手。1 . 1 . 3机械手的分类简而言之，机械手就是用机器代替人手，把工件由某个地方移向指定的工作 位置，或按照工作要求以操纵工件进行加工。机械手一般分为三类。第一类是不需要人工操作的通用机械手，也即本文所 研究的对象。它是一种独立的、不附属于某一主机的装置，可以根据任务的 需要编制程序，以完成各项规定操作。它是除具备普通机械的物理性能之外， 还具备通用机械、记忆智能的三元机械。第二类是需要人工操作的，称为操 作机（Manipulator ）。工业中采用的锻造操作机也属于这一范畴。第三类 是专业机械手，主要附属于自动机床或自动生产线上，

6、 用以解决机床上下料 和工件传送。这种机械手在国外通常被称之为“ Mechanical Hand ”，它是 为主机服务的，由主机驱动。除少数外，工作程序一般是固定的，因此是专 用的。机械手按照结构形式的不同又可分为多种类型， 其中关节型机械手以其结构 紧凑，所占空间体积小，相对工作空间最大，甚至能绕过基座周围的一些障 碍物等这样一些特点，成为机械手中使用最多的一种结构形式。1 . 2机械手的一般组成要机械手像人一样拿取东西，最简单的基本条件是要有一套类似于指、腕、 臂、关节等部分组成的抓取和移动机构一一执行机构；像肌肉那样使手臂 驱动-传动系统；像大脑那样指挥手动作的控制系统。这些系统的性能就

7、决 定了运动的机械手的性能。一般而言，机械手通常就是由执行机构、驱动- 传动系统和控制系统这三部分组成，如图 1-1 所示。图1-1机械手的一般组成对于现代智能机械手而言，还具有智能系统，主要是感觉装置、视觉装置和 语言识别装置等。目前研究主要集中在赋予机械手“眼睛”，使它能识别物 体和躲避障碍物，以及机械手的触觉装置。机器人的这些组成部分并不是各 自独立的，或者说并不是简单的叠加在一起， 从而构成一个机械手的。要实 现机械手所期望实现的功能，机械手的各部分之间必然还存在着相互关联、 相互影响和相互制约。它们之间的相互关系如图 1-2所示。机械手的机械系统主要由执行机构和驱动-传动系统组成。执

8、行机构是机械手赖以完成工作任务的实体，通常由连杆和关节组成，由驱动一传动系统提 供动力，按控制系统的要求完成工作任务。驱动-传动系统主要包括驱动机 构和传动系统。驱动机构提供机械手各关节所需要的动力，传动系统则将驱 动力转换为满足机械手各关节力矩和运动所要求的驱动力或力矩。有的文献则把机械手分为机械系统、驱动系统和控制系统三大部分。其中的机械系统 又叫操作机(Manipulator)，相当于本文中的执行机构部分。第2章 系统总体设计和关键技术2.1设计要求工厂某处有一批不同型号的零件，设计一种机械手，该手能在识别零件类型 后按照其类别自动放置在规定的地点。机械手有上行 /下行、左行/右行运行方

9、式。机械手能根据信号将零件运送到制定地点后放下， 自动归位。 回到原点后自动校正位置。等待下一次信号的到来。开机后，不论机械手处 于什么位置，它能在上电后自动归到原点。有指示灯可以指示机械手目前的 位置，方便控制人员管理。2.2基本设计思路A 何服电机驱动芯片总体设计框图如下：单片机佚动和件限位器图2-1总体设计框图CPU部分有两种选择：单片机控制和PLC控制。传动机构传动机构种类繁多，常见的有齿轮传动、齿条传动、丝杆传动、链条传动。 由于一般的电机驱动系统输出的力矩较小，需要通过传动机构来增加力矩, 提高带负载能力。对机械手的传动机构的一般要求有：(1 )结构紧凑，即具有相同的传动功率和传动

10、比时体积最小，重量最轻;（2）传动刚度大，即由驱动器的输出轴到连杆关节的转轴在相同的扭矩时角度变形要小，这样可以提高整机的固有频率，并大大减轻整机的低频振动；（3 ）回差要小，即由正转到反转时空行程要小，这样可以得到较高的位置 控制精度；（4）寿命长、价格低。机械手2. 2 . 3. 1机械手的组成机械手一般由执行机构、控制系统、驱动系统三个部分组成。（1 ）执行机构1）手腕 手腕是联接手臂与末端执行器的部件，用以调整末端执行器的方 位和姿态。2）手臂手臂是支承手腕和末端执行器的部件。它由动力关节和连杆组成，用来改变末端执行器的位置。3）机座机座是机械手的基础部件，并承受相应的载荷，机座分为固

11、定式 和移动式两类。（2 ）控制系统控制系统用来控制机械手按规定要求动作， 可分为开环控制系统和闭环控制 系统。大多数工业机械手采用计算机控制，这类控制系统分为决策级，策略 级和执行级三级：决策级的功能是识别环境、建立模型、将工作任务分解为 基本动作序列；策略级将基本动作变为关节坐标协调变化的规律，分配给各关节的伺服系统；执行级给出各关节伺服系统的具体指令。（3 ）驱动系统驱动系统是按照控制系统发出的指令将信号放大，驱动执行机构运动的传动装置。常用的由电气、液压、气动和机械等四种驱动方式。除此之外，机械手可以配置多种传感器（如位置、力，触觉，视觉等传感器）， 用以检测其运动位置和工作状态。2

12、. 2. 3. 2机械手的分类机械手按坐标形式、控制方式、驱动方式和信号输入方式四种分类方法。（1）按坐标形式分坐标形式是指执行机构的手臂在运动时所取的参考坐标系的形式。1）直角坐标式 直角坐标机械手的末端执行器在空间位置的改变式通过三 个互相垂直的轴线移动来实现的，即沿 X轴的纵向移动、沿Y轴的横向 移动及沿Z轴的升降。这种机械手位置精度最高，控制无耦合，比较简单， 避障性好，但结构较庞大，动作范围小，灵活性差。2）圆柱坐标式圆柱坐标机械手是通过两个移动和一个转动来实现末端执 行器空间位置的改变，其手臂的运动由在垂直立柱的平面伸缩和沿立柱升 降两个直线运动及手臂绕立柱转动复合而成。这种机械手

13、位置精度较高， 控制简单，避障性好，但结构也较庞大。3）极坐标式 极坐标机械手的运动式由一个直线运动和两个转动组成，即沿手臂方向X的伸缩，绕丫轴的俯仰和绕Z轴的回转。这种机械手占地面 积小，结构紧凑，位置精度尚可，但避障性差，有平衡问题。4）关节坐标式关节坐标机械手主要是由立柱、大臂和小臂组成，立柱绕 Z 轴旋转，形成腰关节，立柱和大臂形成肩关节，大臂和小臂形成肘关节，大臂和小臂作俯仰运动。这种机械手工作范围大，动作灵活，避障性好， 但位置精度低，有平衡问题，控制耦合比较复杂，目前应用越来越多。（2）按控制方式分1）点位控制 采用点位控制的机械手，其运动为空间点到点之间的直线运 动，不涉及两点

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

15、压可达7MPa，液压传动平稳，动作灵敏，但对密封性 要求较高，不宜在高温或低温现场工作，需配备一套液压系统。3）气压驱动 气压驱动的机械手结构简单，动作迅速，价格低廉，由于空气可压缩性，导致工作速度稳定性差，气源压力一般为0.7MPa，因此抓取力小，只能抓取重量为几公斤到十几公斤的物体。（4）按信号输入方式分1）人操作机械手 是一种由操作人员直接进行操作的具有几个自由度的机械手。2）固定程序操作机械手 按预先规定的顺序、条件和位置，逐步地重复执 行给定的作业任务的机械手。3）可变程序操作机械手它与固定程序机械手基本相同，但其工作次序等 信息易于修改。4）程序控制机械手 它的作业指令是由计算机程

16、序向机械手提供的，其控 制方式与数控机床一样。5）示教再现机械手这类机械手能够按照记忆装置存储的信息来复现由 人示教的动作，其示教动作可自动地重复执行。6）智能机械手采用传感器来感知工作环境或工作条件的变化，并借助其自身的决策能力，完成相应的工作任务。抓取机构抓取机构是机械手执行工作的装置，可安装夹持器、工具、传感器等。抓取 机构可分为机械夹紧、真空抽吸、液压夹紧、磁力吸附等。机械手的驱动方式该机械手一共具有三个独立的运动关节， 连同末端机械手的运动，一共需要 三个动力源。机械手常用的驱动方式有液压驱动、 气压驱动和电机驱动三种 类型。这三种方法各有所长，各种驱动方式的特点见表：内容驱动方式淹

17、fl谑动兀动胴动电机型动很火.压丿丿范国人压力池田力牧人输出功率为 50 -1-1 DPa48BDPz,疑人冷ii Pil利用液休的不町压气怵压缩性人桔矩制祜倉商，功率较性*控制粋度牧度低，虽把效人*能幣确定位，反控制性陡离，输出功率人.低速不易控制弟应灵轨川实现舟速、口|无级调魂、反应以实理高連、高精吕桔疗的连纯轨逊控顾町实现连绒座的连续轨逸控制制.伺服待性好.揑轨迹控制制察统it菸庙速度很高较高很高給构性能及结构适出-执仃机结构适当押亍机何服电功机易于标准休积构町标准化、构町标准化、模扣化.绪构扎能好*噪化.屍玄现n復腋化.易实现貢接职声低电动机般需动&功率/质童比Jo功率/质吊比

18、配总减姓後?L除血安仝性防爆件能壮好.用 液压油作传动介 氐在一足条件F 仃火灾危险帀爆炸能好.髙干 lOOOkPadO牛人气 压）时应注倉设备 的抗压性设备口身无爆炸利火 灾危险，理流冇刷电 动机换向时有火龙, 对环境的防爆it能较对环境的膨液乐系统易漏油.排气时冇噪声f _r无响对坏境右污染&T.业机械适用4书、低速适用于中小负载驱适用于中小负载、耍严中应用范驱动.电液伺服系动、辎度蹙求较低求具仃校高的位置控鬧统适用于嗪涂机械的存限点位程序控制楮度和轨逊控制粘珀点焊机械F和制机械几如冲压度、速度牧髙的机械托运机械手机械匸本体的岂动F，如ACH可服喷涂机平衡及装配机林r械F-、点焊机

19、械応气动夹具弧焊机械兵装配机械手等成本液压元件成本较高成本低维修及使用庁便.但油液对环方便较复杂境温度有一定要求表2-1三种驱动方式的特点对照机械手驱动系统各有其优缺点，通常对机械手的驱动系统的要求有：（1）驱动系统的质量尽可能要轻，单位质量的输出功率要高，效率也要高；（2）反应速度要快，即要求力矩质量比和力矩转动惯量比要大， 能够进行 频繁地起、制动，正、反转切换；（3）驱动尽可能灵活，位移偏差和速度偏差要小；（4）安全可靠；(5) 操作和维护方便；(6) 对环境无污染，噪声要小；(7) 经济上合理。2.3设计方案的总结2. 3. 1 CPU的选择由于单片机体积小，价格便宜且具有高稳定性和很

20、强的抗干扰能力，因此本设计中用单片机取代PLC控制。2. 3 . 2机械手坐标形式的选择由于本设计中精度要求较高，首先排除了极坐标式和关节坐标式，而且它们 还存在平衡问题。考虑到工厂应用要易于扩展其功能，本机械手采用直角坐 标形式。2 . 3. 3传动机构的选择本设计要求传动方式为电机的转动带动机械手臂的上下、左右移动，适合采用带传动。2 . 3 . 4驱动方式的选择在选择驱动方式阶段，我首先考虑的是液压、气压传动，但方案存在一定缺 陷。其中，液压装置体积太过庞大，需要专门配置一套液压系统，且对密封 性要求高，不宜在高温、低温下工作。而气压传动由于空气的可压缩性导致 工作速度、稳定性较差，且有

21、一定噪音。电机选择相对较为简单，由于步进 电机有步距角误差，机械手在齿轮传动和摆动时会进一步放大该误差，因此选择伺服电机驱动。第三章硬件结构设计3.1机械手尺寸的确定由于本次设计对工作场地要求并没有明确的限制， 因此机械手的尺寸也就没 有明确的规定，为了设计的方便，将机械手横向有效距离长为280mm，纵向有效距离长为170mm。3.2传动部分设计（1）机械手是有2台伺服电机驱动：电机M1控制机械手纵向运动，电机M2控制机械手在横向运动。为了设计的方便，控制方式采用限位器限位控制。由于2台电机不是同时控制，因此不存在相互间的干扰，从而增强 了整个系统的稳定性。（2） 具体传动环节：基座部分装有服

22、电机 M1和电机M2，通过齿轮传动 控制带条运动。（3）直流电机：（i）调速性能好，电动机在一定负载条件下，根据需要，人为改变电 动机的转速，直流电动机可以在重负载条件下实现均匀平滑无级调速。调速范围宽。(ii)起动力矩大可以均匀而经济的实现转速调节，故凡是在重负载条件下启动的机械都用直流电机拖动。3. 3硬件部分总结：为了实现电动机能准确的将部件送到制定的位置，我采用了限位器控制机械 手的位置。机械手碰到限位器，限位器返回信号给单片机，单片机发送信号 控制电机驱动芯片，从而达到机械手到位停止。电动机采用的是直流电动机， 因为其性能价格比较高，适合工作在对输出力矩比较大的环境下。 通过齿条 传

23、送装置，使机械手在电机的控制下能够精准的到达规定的位置。并且易于 将来扩展其工作方式。第四章 软件电路部分设计4.1单片机的选择4.1.1单片机的概念单片机是将计算机的基本部件微型化并集成到一块芯片上的微型计算机。 通 常在芯片内含有CPU、ROM、RAM、并行I/O 口、串行口、定时/计数器、 中断控制系统、系统时钟及系统总线等。4 . 1 . 2单片机特点1）优异的性能价格比。2）高、体积小、可靠性高。单片机把各功能部件集成在一块芯片上，内部 采用总线结构，减少了各芯片之间的连线，大大提高了计算机的可靠性与抗 干扰能力。另外，其体积小，对于强磁场环境易于采取屏蔽措施，适合在 恶劣环境下工作

24、。3）控制功能强。为了满足工业控制的要求，一般单片机的指令系统种均有 极丰富的转移指令、I/O 口的逻辑操作及位处理功能，单片机的逻辑控制功 能及运行速度均高于同一档次的微机。4）低功耗、低电压，便于生产便携式产品。5）单片机的系统扩展和系统配置叫典型、规范，容易构成各种规模的应用 系统。4. 1 . 3单片机硬件结构4. 1 . 3. 1 89C51系列单片机基本配置1）微处理器该单片机中有一个8位的微处理器，与通用的微处理器基本相同，同样包括 了运算器和控制器两大部分，只是增加了面向控制的处理功能，不仅可处理 数据，还可以进行位变量的处理。2）数据存储器片内为128个字节，片外最多可外扩至

25、64k字节，用来存储程序在运行期 间的工作变量、运算的中间结果、数据暂存和缓冲、标志位等，所以称为数 据存储器。3）程序存储器由于受集成度限制，片内只读存储器一般容量较小，如果片内的只读存储器 的容量不够，则需用扩展片外的只读存储器，片外最多可外扩至 64k字节。4）中断系统具有5个中断源，2级中断优先权。5）定时器/计数器片内有2个16位的定时器/计数器，具有四种工作方式。6）串行口1个全双工的串行口，具有四种工作方式。可用来进行串行通讯，扩展并行 I/O 口，甚至与多个单片机相连构成多机系统，从而使单片机的功能更强且 应用更广。7）P1 口、P2 口、P3 口、P4 口为4个并行8位I/O

26、 口。8）特殊功能寄存器共有21个，用于对片内的个功能的部件进行管理、控制、监视。实际上是 一些控制寄存器和状态寄存器，是一个具有特殊功能的 RAM区。4. 1 . 3. 2引脚及其功能1）电源及时钟引脚VCC:接+5V 电源正端；VSS:接+5V电源地端；X1 :接外部晶体振荡器的一端；X2 :接外部晶体振荡器的另一端。2）控制引脚RESET:单片机上电复位端。ALE :当访问外部存储器时，ALE 一每机器周期两次的信号输出，用于 锁存出现在P0 口的低8位地址。PSEN:为片外程序存储器读选通信号输出端。EA :为访问外部程序存储器控制信号，低电平有效3）输入/输出引脚P3 口的第二功能：

27、P3.0 :RXD，串行输入通道；P3.1 :TXD，串行输出通道；P3.2 :INTO，外部中断0；P3.3 :INT1，外部中断1 ；P3.4 :TO，计数器0外部输入；P3.5 :T1，计数器1外部输入；P3.6 :WR ，外部数据存储器写选通；P3.7 :RD，外部数据存储器读选通。P10POOF11F01P12P02P13PQ3F14PCMP15PQ5PldP06P17F071NT1FZOINTOP21P22T1FZ3TOP24P25EAA7PPMFZ7XIvssX2vccRESETNDRDALE/PWRPSEN31AT89C510,77d1915430373635343332212

28、2232-425262728404110M3029 039图4-1 89c51 引脚图4.2驱动芯片的选择4 . 2. 1驱动芯片概念在微机控制系统中，还要处理另一类数字量，即开关信号、脉冲信号。它们是以二进制的逻辑“ 1 ”和“ 0”，即电平的高和低出现的。如开关触电 的闭合和断开，指示灯的亮和灭，继电器和接触器的吸合和释放，马达的启 动和停止，晶闸管的通和断，阀门的打开和关闭等，我们称为开关量。开关 量所控制的执行器所要求的控制电压一般都比较高，电流一般都较大，有的是直流驱动，有的是交流驱动，必须根据具体对象采用适当的接口。 开关量 的输出接口实质上是利用计算机做“弱电”控制“强电”。它需

29、要解决两个重要问题：隔离和驱动。用单片机控制各种各样的高压、大电流负载，如电动机、电磁铁、继电 器、灯泡等时，不能用单片机的I/O线来直接驱动。P0、P1、P2、P3四 个口都可以做输出口，但其驱动能力不同。P0 口的驱动能力较大，当其输出高电平时，可提供400 m A的电流；当其输出低电平(0.45V )时，则可 提供3.2mA的灌电流，如低电平允许提高，灌电流会相应加大。P1、P2、P3 口的每一位只能驱动四个LSTTL,即可提供的电流只有P0 口的一半。 所以，用低电平输出可获得比高电平输出更大的驱动能力。目前，一些 MCS-51系列单片机的引脚驱动能力有所提高，如 89C2051，一些

30、引脚可 提供20mA的灌入电流。但大多数场合，单片机I/O 口的驱动能力是不够 的，必须通过各种驱动电路的开关电路来提高驱动能力。4 . 2 . 2 L298芯片原理22INI £411L298N为SGS-THOMSON Microelectro nics所出产的双全桥步进电机专用驱动芯片(Dual Full-Bridge Driver ) ，内部包含4信道逻辑驱动电路， 是一种二相和四相步进电机的专用驱动器，可同时驱动2个二相或1个四相步进电机，内含二个H-Bridge 的高电压、大电流双全桥式驱动器，接收标 准TTL逻辑准位信号，可驱动46V、2A以下的步进电机，且可以直接透过

31、电源来调节输出电压；此芯片可直接由单片机的IO端口来提供模拟时序信号。L298N之接脚如图所示，Pin1和Pin15可与电流侦测用电阻连 接来 控制负载的电路；OUTI、OUT2和OUT3、OUT4之间分别接2个步进电机；input1input4输入控制电位来控制电机的正反转；Enable则控XX大学本科生课程设计（论文）制电机停转。4 . 3流程图：4 . 4start:汇编程序org OOOOhIjmp startorg 0100hIcall m2IIcall m1umov a,#Offhmov pO,a;使2电机反转，达到回归原点的目的;先X轴方向电机反转，后丫轴方向电动机反转xjac:

32、jnb p1.6,goa;循环监测去向信息jnb p1.7,gocajmp xjacgoa:lcall m1d;去A处lcall delay;在A处等待2秒，方便添加中断，执行中断lcall m1uljmp startgoc:lcall m2r;去C处lcall m1dlcall delaylcall m1ulcall m2lljmp start;M1正转子程序mid:mov a,#OOO1OOO1bmov pO,aloop:jnb p1.0,stopm1jnb p1.5,stopm1 mov b,#2 ajmp loopstopml: Icall sdelaydjnz b,loop mov a,#Offh mov pO,amov a,p1mov p2,aret;M1反转子程序m1u:mov a,#OOO1OO1Obmov pO,aloop1:jnb p1.1,stopm2 jnb p1.4,stopm2 mov b,#2 ajmp loop1stopm2:lcall sdelay djnz b,loop1 mov a,#Offh mov pO,a mov a,p1 mov p2,aret;M2正转子程序m2r:mov a,#OO1OO1OObmov pO,aIoop2:jnb p