基于单片机的机械手控制系统设计说明

1、渤海船舶职业学院 毕业设计（论文） 题目：基于单片机的机械手控制系统设计 系：机电工程系 :洪伟 班级：11G451 学号：04 专业：机电一体化 指导教师：凯 评阅教师：凯 完成日期：2014. 6. 6 毕业设计说明书（论文）中文摘要 摘要：机械手技术涉及到电子、机械学、自动控制技术、传感器技术和计算机 技术等科学领域，是一门跨学科综合技术。随着工业自动化发展的需要，机械手 在工业应用中越来越重要。文章主要叙述了机械手的设计过程，本文中介绍了 机械手的设计理论与方法。 本设计以AT89C51单片机为核心，采用LMD18200电机控制芯片达到控制直 流电机的启停、速度和方向，完成了筛选机械手

2、基本要求和发挥部分的要求。在 筛选机械手设计中，采用了PWM技术对电机进行控制，通过对占空比的计算达到 精确调速的目的。 关键词：机械手;AT89C51； LMD18200； PWM技术;电机控制 第一章前言 1.1机械手概述1 第二章总体方案设计3 2. 1设计要求3 2.2基本设计思路3 第三章硬件结构设计5 3. 1机械手尺寸的确定5 3.2传动部分设计5 第四章软件电路部分设计9 4.1单片机的选择9 4.2接口电路10 4.3电路图12 4.4程序流程14 4.5程序编 写 14 结论20 参考文献21 第一章前言 1.1机械手概述 机械化、自动化已成在现代工业中突出的主题。化工等连

3、续性生产过程的自动化已 基本得到解决。但在机械工业中，加工、装配等生产是不连续的，机器人的出现并得到 应用，为这些作业的机械化奠定了良好的基础。机械手，多数是指程序可变（编）的独 立的自动抓取、搬运工件、操作工具的装置（国称作工业机械手或通用机械手）。机械 手是一种具有人体上肢的部分功能，工作程序固定的自动化装置。机械手具有结构简单、 成本低廉、维修容易的优势，但功能较少，适应性较差。目前我国常把具有上述特点的 机械手称为专用机械手，而把工业机械手称为通用机械手。简而言之，机械手就是用机 器代替人手，把工件由某个地方移向指定的工作位置，或按照工作要求以操纵工件进行 加工。 一般而言，机械手通常

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

5、任务的实体，通常由连杆和关节组成，由驱动一传动系统提供动力，按控制系 统的要求完成工作任务。驱动一传动系统主要包括驱动机构和传动系统。驱动机构提供 机械手各关节所需要的动力，传动系统则将驱动力转换为满足机械手各关节力矩和运动 所要求的驱动力或力矩。有的文献则把机械手分为机械系统、驱动系统和控制系统三大 部分。其中的机械系统又叫操作机(Manipulator),相当于本文中的执行机构部分。 第二章总体方案设计 2. 1设计要求 生产线上有红黑两种直径为2cm厚lcm的圆铁片，设计一种机械手，该手能自动筛 选出红色铁片，并把红色铁片放到指定位置。机械手有上行/下行、左行/右行、放松/ 夹紧几个运行

6、方式。并要求机械手有判别铁片颜色的功能，且能准确把握铁片位置、重 量、形状等因素。该手运行路径合理，接近指定位置时能够减速运行。整个过程无人工 操作，系统通过传感装置检测工件，工作结束后能自动停止。 2. 2基本设计思路 总体设计框图如下： 1. CPU CPU部分有两种选择：单片机控制和PLC控制。 2. 传动机构 传动机构种类繁多，常见的有齿轮传动、齿条传动、丝杆传动、链条传动。 由于一般的电机驱动系统输出的力矩较小，需要通过传动机构来增加力矩，提高带 负载能力。对机械手的传动机构的一般要求有： （1）结构紧凑，即具有相同的传动功率和传动比时体积最小，重量最轻； （2）传动刚度大，即由驱动

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

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

9、确定 由于本次设计对工作场地要求并没有明确的限制，因此机械手的尺寸也就没有明确 的规定，为了设计的方便，将机械手大臂有效距离长为280mm,小臂有效距离长为170叽 机械手3D图如下： 3-1机械手图 3. 2传动部分设计 （1）机械手是有三台伺服电机驱动：电机Ml控制大臂在Z轴旋转摆动，电机H2控 制小臂在Z轴的旋转摆动，电机C控制末端执行器在Z轴的上下移动。为了设计的方便, 控制方式采用点位控制。通过分别控制三台电机的正反转来确定末端执行器在空间上的 具体位置。由于三台电机不是同时控制，因此不存在相互间的干扰，从而增强了整个系 统的稳定性。 （2）具体传动环节：基座部分装有服电机Ml,通过

10、齿轮传动控制大臂族转，基座 与大臂底座用轴承连接；大臂座装有伺服电机M2,通过齿轮、传动控制小臂的旋转摆动; 末端执行器部分装有伺服电机M3,同样通过齿轮、丝杆传动控制末端执行器的上下移动。 （3）伺服电机 一个伺服电机部包括了一个小型直流马达；一组变速齿轮组；一个反馈可调电位器; 及一块电子控制板。其中，高速转动的直流马达提供了原始动力，带动变速（减速）齿 轮组，使之产生高扭力的输出，齿轮组的变速比愈大，伺服马达的输出扭力也愈大，也 就是说越能承受更大的重量，但转动的速度也愈低 小型直流马达 变速齿轮组 可调电位器 电子控制板 图3-2伺服电机图 （4）微行伺服马达的工作原理 一个微型伺服马

11、达是一个典型闭环反馈系统，其原理可由下图表示: 图3-3伺服电机原理图 减速齿轮组由马达驱动，其终端（输出端）带动一个线性的比例电位器作位置检测, 该电位器把转角坐标转换为一比例电压反馈给控制线路板，控制线路板将其与输入的控 制脉冲信号比较，产生纠正脉冲，并驱动马达正向或反向地转动，使齿轮组的输出位置 与期望值相符，令纠正脉冲趋于为0,从而达到使伺服马达精确定位的目的。 （5）伺服马达的控制 标准的微型伺服马达有三条控制线，分别为：电源、地及控制。电源线与地线用于 提供部的直流马达及控制线路所需的能源，电压通常介于4V-6V之问，该电源应尽可 能与处理系统的电源隔离（因为伺服马达会产生噪音）。

12、甚至小伺服马达在重负载时也 会拉低放大器的电压，所以整个系统的电源供应的比例必须合理。 输入一个周期性的正向脉冲信号，这个周期性脉冲信号的高电平时间通常在1ms 2ms之间，而低电平时间应在5ms到20ms之间，并不很严格，下表表示出一个典型的 20ms周期性脉冲的正脉冲宽度与微型伺服马达的输出臂位置的关系： 表3T位置关系图 输入正脉冲宽度C圈期为25G 伺服马达输出世使宣 0.5mP q90度 l.Omf 补 45度 1 呂。度 厂 2 Oms 丁45度 2J 昌9。度 （6）选用的伺服马达 我选用的伺服马达为TowPro的，型号为SG303o其主要技术参数如下： 转速：0. 23秒/60

13、度。 力矩：3. 2kg* cm。 尺寸：40. 4mmX 19. 8mmX36mm。 重量:0. 6kg0 12V和24V电源供电。 控制周期脉冲宽度为20ms。送出不同的正脉冲宽度是，就可以得到不同的控制效果。 控制正脉冲宽度如下： （7）增量式编码器 编码器是把角位移或直线位移转换成电信号的一种装置。 前者成为码盘，后者称码尺.按照读出方式编码器可以分为接触式和非接触式两 种.接触式采用电刷输出，一电刷接触导电区或绝缘区来表示代码的状态是“ 1 ”还是 “OS非接触式的接受敏感元件是光敏元件或磁敏元件，釆用光敏元件时以透光区和 不透光区来表示代码的状态是“1 还是“ 0 第四章电路部分设

14、计 4.1单片机的选择 （1）单片机的概念 单片机是将计算机的基本部件微型化并集成到一块芯片上的微型计算机。通常在芯 片含有CPU、ROM、RAM、并行I/O 口、串行口、定时/计数器、中断控制系统、系统时钟 及系统总线等。 （2）单片机特点 1）优异的性能价格比。 2）高、体积小、可靠性高。单片机把各功能部件集成在一块芯片上，部采用总线 结构，减少了各芯片之间的连线，大大提高了计算机的可靠性与抗干扰能力。另外，其 体积小，对于强磁场环境易于采取屏蔽措施，适合在恶劣环境下工作。 3）控制功能强。为了满足工业控制的要求，一般单片机的指令系统种均有极丰富 的转移指令、I/O 口的逻辑操作及位处理功

15、能，单片机的逻辑控制功能及运行速度均髙 于同一档次的微机。 4）低功耗、低电压，便于生产便携式产品。 5）单片机的系统扩展和系统配置叫典型、规，容易构成各种规模的应用系统。 （3）单片机硬件结构 1） 89C52系列单片机基本配置如下： a）微处理器 该单片机中有一个8位的微处理器，与通用的微处理器基本相同，同样包括了运算 器和控制器两大部分，只是增加了面向控制的处理功能，不仅可处理数据，还可以进行 位变量的处理。 b）数据存储器 片为128个字节，片外最多可外扩至64k字节，用来存储程序在运行期间的工作变 量、运算的中间结果、数据暂存和缓冲、标志位等，所以称为数据存储器。 c）程序存储器 由

16、于受集成度限制，片只读存储器一般容量较小，如果片的只读存储器的容量不够, 则需用扩展片外的只读存储器，片外最多可外扩至64k字节。 d）中断系统 具有5个中断源，2级中断优先权。 e）定时器/计数器 片有2个16位的定时器/计数器，具有四种工作方式。 f）串行口 1个全双工的串行口，具有四种工作方式。可用来进行串行通讯，扩展并行I/O 口， 甚至与多个单片机相连构成多机系统，从而使单片机的功能更强且应用更 广。 g）P1 口、P2 口、P3 口、P4 口为4 个并行8 位I/O 口。 h）特殊功能寄存器 共有21个，用于对片的个功能的部件进行管理、控制、监视。实际上是一些控制 寄存器和状态寄存

17、器，是一个具有特殊功能的RAM区。 2）引脚及其功能 a）电源及时钟引脚 VCC：接+5V电源正端； VSS：接+5V电源地端； XI：接外部晶体振荡器的一端； X2：接外部晶体振荡器的另一端。 b）控制引脚 RESET：单片机上电复位端。 ALE：当访问外部存储器时，ALE 每机器周期两次的信号输出，用于锁存出现在 P0 口的低8位地址。 PSEN：为片外程序存储器读选通信号输出端。 EA :为访问外部程序存储器控制信号，低电平有效。 c）输入/输出引脚 P3 口的第二功能： P3. 0： RXD,串行输入通道； P3. 1： TXD,串行输出通道； P3. 2： INTO,外部中断0； P

18、3. 3： INTI,外部中断1; P3.4： TO,计数器0外部输入； P3.5： T1,计数器1外部输入； P3.6： WR ,外部数据存储器写选通; P3. 7： RD,外部数据存储器读选通。 2 3 4 5 6 7 8 1 12 - 15 14 31 19 18 9 17 a 4 1 P10 POO P11 P01 P12 P02 P13 P03 P14 P04 P15 P05 P16 P06 P17 P07 INT1 P20 INTO P21 T1 P22 P23 TO P24 EAArp P25 P26 XI P27 VSS X2 VCC RESET RXD RD TXD ALE/

19、P WR PSEN AT39C51 39 38 37 36 35 34 33 32 21 77 23 24 25 26 28 40 4? 10 7T 30 29 图4-1 89c51引脚图 4. 2接口电路 1. 串行通信的基本原理 计算机的数据传送有并行和串行两种方式。并行数据传送的特点是：各数据同时传 送，传送速度快，效率高。但并行数据传送有多少数据位就需要多少根数据线，因此传 送成本高。并行数据传送的距离通常小于30米，计算机部的数据传送通常都是并行的; 串行数据传送的特点是：数据传送按位顺序进行，最少只需一根线即可完成，成本低但 速度慢。计算机与外界的数据传送大多是串行的，其传送的距离

20、可以从几米到几千公里。 串行通信又分为异步和同步两种方式。单片机中使用的串行通信通常都是异步方式的。 （1）串行通信的数据传送格式 异步串行通信以字符为单位，即一个一个字符地传送。其字符格式通常表示如下： 它用一个起始位表示字符的开始，用停止位表示字符的结束构成一帧。异步通信的特点 是每次只传送一个字符，每个字符由起始位（规定为低电平）、数据位、奇偶校验位、 停止位（规定为高电平广2位）组成。由于单片机的停止位规定为1位，为了与单片机 相匹配，PC机的一帧数据的停止位我们采用1位。 （2）串行通信的收发过程 发送方发送数据时，通过发送低电平起始位开始一个字符的传送，起始位之 后便按特定的速率发

21、送数据位（包括奇偶校验位），当最后一位数（对于采用奇偶 个高电平停止位用以标志一个字符传送结束，这样就完成了一帧数据发送。如果不再发 送新数据或数据尚未准备好，就将传输线钳在高电平状态。接收方不断检测传输线的电 平状态，当发现传输线由高电平变为低电平时（起始位标志位），即认为有数据传入， 进入接收状态，然后以相同的速率检测传输线的电平状态，接收随后送来的数据位，奇 偶校验位和停止位。可见在异步通信方式中，发送方是靠控制传输线的电平状态来完成 数据的发送。接收方通过不断检测数据线的状态来完成数据的接收，只要发送率和接收 检测速率相同，即能准确接收和发送数据。发送与接收设备可以使用各自的时钟源完成

22、 数据的发送与接收，无需使用相同的时钟信号。 （3）串行通信的传送速率 传送速率用于说明数据传送的快慢。在串行通信中，数据是按位进行传送的，因此 传送速率用每秒钟传送二进制数码的位数来表示，称之为波特率。在串行通信中常用波 特率来衡量通信速率的快慢，每秒钟传送一位就是一波特，一般异步通信波特率为110 9 6 0 OKHZo在选择通信的波特率时，不要盲目追髙，要以满足数据传输要求为原则。 因为波特率越高，对发送和接收时钟信号频率的一致性要求就越高。 （4）串行通信的电平转换 PC机与单片机是通过串行口进行通信的。由于单片机的输入、输出是TTL电平（+5V 表示逻辑1,电平低于2V便不能被识别为

23、逻辑1; 0V表示逻辑0）, TTL电平一般不能用 于远距离传输，因为传输过程中电平的衰减会使传输数据不准确。 而PC机配置的是RS-232串行接口，因此，单片机与PC机之间进行通信时，要进 行电平的转换，需要将TTL电平转换为RS232电平（-5-15V表示逻辑1, +5V+15V 表示逻辑0）,在传输线上传送的RS-232电平可高达12V,比TTL电平有更强的抗衰减 能力及抗干扰能力，可用于远距离传输。常用的电平转换芯片为MAX2232,此芯片能实 现以上两种电平的相互转换。另外，信号传输的介质最好使用双绞线，有利于抑制外界 共模信号的干扰。 2. 单片机与PC机串行通信实现手段 由于PC

24、机中集成了串行异步通信的可编程芯片8250,我们可以通过PC机的串行通 信口COM1或COM2对它进行控制，因而不需要再单独做实验板。我们可以把单片机的部 电平转换接口与PC机的串行通信口COH1或COM2通过串行连接线连接起来，然后用软 件对它们进行初始化，使它们运行各自的接收或发送程序。 在具体编程的时候，我们可以实现很多的功能。例如，我们可以从PC机和单片机 中读其RAM或ROM的容，对它们进行在线修改。PC机的程序可以用汇编程序MASM6.0、 VB、C+Bilder或VC+进行编写。控制电路与计算机通讯能够在计算机上作监控界面， 使机械手控制更加人性化。 U2 图4-3串行通讯电路

25、4.3电路图绘制 Kll:l:-r去 a T JI - C2 Il 9 9 i 口51 _3_ n XJ CfffST TEXT D3 UT2 aura D2 . INT1 4 P3/VTO P3“n Pie P3gR P17 P3.7W 图4-4系统电路图控制 （1）电路说明：PC机通过电频转换器将程序传送至单片机，单片机通过驱动芯片控 制步进电机正反转，使传感器到达指定位置。传感器检测工件颜色，并发射相应信号给 单片机（红色，进行下一步；黑色，停止、延时；无反射，程序结束）。单片机通过已 设定的程序完成相应步骤。 （2）单片机电路 1）看门狗复位电路 复位操作通常有两种基本形式：上电复位和

26、按钮复位。本电路中采用的是上电复位, 其工作原理为：上电瞬间，RC电路充电，RST引脚端出现正脉冲，只要RST端保持两 个时钟周期以上的高电平，就能使单片机有效的复位。 看门狗又叫watchdog timer,是一个定时器电路，一般有一个输入，叫喂狗，一个输 出到ICU的RST端,MCU正常工作的时候，每隔一端时问输出一个信号到喂狗端，给WDT 清零，如果超过规定的时间不喂狗，（一般在程序跑飞时）,WDT定时超过，就回给出一个 复位信号到MCU,是MCU复位.防止MCU死机.看门狗的作用就是防止程序发生死循环，或者说程序跑飞。工作原理：在系统运行以后也就启动了看门狗的计数器，看门狗就开 始自动

27、计数，如果到了一定的时间还不去清看门狗，那么看门狗计数器就会溢出从而引 起看门狗中断，造成系统复位。所以在使用有看门狗的芯片时要注意清看门狗。硬件看 门狗是利用了一个定时器，来监控主程序的运行，也就是说在主程序的运行过程中，我 们要在定时时间到之前对定时器进行复位如果出现死循环，或者说PC指针不能回来。 那么定时时间到后就会使单片机复位。 看门狗复位电路图如下。 VCC 22uf MR WDO VCC RST GND TOI PFI PFO 1 8 2 ? 3 6 5 MAX813L 4 图4-5看门狗复位电路 2）晶振电路 MCS-51系列单片机的时钟信号通常用两种电路形式得到：部振荡方式和

28、外部振荡 方式。在引脚XTAL1和XTAL2外接晶体振荡器，就构成了部振荡电路，如下图所示。图 中Cl、C2起稳定振荡频率、快速起振的作用，电容值一般为530pFo晶振常选用频率 为6MHz. 12MHz或24MHz的,釆用串口时常使用频率为11. 0592MHz的晶振。部振荡方 式所得到的时钟信号比较稳定，应用较多。 30pF 30pF CRYSTAL 12.00MHz 为4-6振荡电路 4. 4程序流程 程序开始运行后，系统初始化，机械手回到原始位置。传送带将工件运送过来，到 达指定位置后延时Is。这时，传感器开始检验，向工件位置发射光线，通过是否有收到 反射光来判断工件是否到达指定位置。

29、如果有发射光，则运行下一步程序，开始搬运工 件。如此循环，直到传感器不再接受到反射光，则加工停止，程序结束。 4. 5程序编写 #include ttdefine THO TLO (65536-1000)/设定中断的间隔时长 unsigned char count。 = 0； unsigned char countl = 0； bit Flag = 1;/电机正反转标志位，1正转，0反转 sbit Key_add=P3 2； 电机减速 sbit Key dec=P3 3； 电机加速 sbit Key turn=P3 4； 电机换向 sbit PWM1=P3 6；PWM 通道 1 sbit PW

30、M2二P3 7；/PWM 通道 2 unsigned char Timedelay； 函数声明 void Delay(unsigned char x): void Motorspeed high(void): void Motor_speed low(void)； void Motorturn(void)； void TimerO init(void)； void Delay (unsigned char x)/延时处理 Time delay = x； while(Time_delay != 0)； void TimerO int (void) interrupt 1 using 1/定时 0 中断处理 TRO = 0； TLO += (THO_TLO + 9) % 256； THO += (THO_TLO + 9) / 256 + (char)CY； TRO = 1； if(Time_delay != 0)/延时函数用 Time delay-； if (Flag = 1)/电机正转 PWM1 = 0： if(+countl = 100) countl=0； else /电机反转 PWM2 = 0； if(+countl = 100) countl=0； 反转 void Motor speed high(void)/按键处理加pwm占空比，电机加速