工艺雕刻同步仿形控制系统设计的控制系统.doc

工艺雕刻同步仿形控制系统设计的控制系统

61
2020年5月29日
文档仅供参考

一:工艺雕刻同步仿形控制系统的总体设计

1.1,对同步仿形控制系统的分析

课题设计任务:根据工艺雕刻大师雕刻动作和工艺雕刻流程,要求能同步把工艺雕刻师的动作和工艺雕刻流程同步到多台同步仿形工艺雕刻机上,在工艺雕刻师完成一件作品同时,在同步工作台上同时完成或同步完成多个一模一样工艺产品的自动化同步雕刻产品。根据工艺雕刻大师雕刻动作和工艺雕刻工艺流程和过程,根据机械系统运动原理,分析和设计能满足同步雕刻机电控制系统。

课题要求根据工艺雕刻大师雕刻动作和雕刻工艺流程,能把工艺雕刻师的动作和工艺雕刻流程同步到多台同步仿形工艺雕刻机上,并把所检测信号转换和处理系统,传递给同步仿形雕刻工作台接收信号处理系统,转换成同步仿形机构、刀库和换刀机械手同步信号。

根据课题要求,控制系统要对机械臂多自由度的实时控制,同步仿形的控制,以及对刀库与自动换刀的控制。

具体的说,根据机械臂模块的要求,机械臂是采用5自由度的关节式机器人的结构。因此,多自由度的控制即对机械臂5自由度运动的控制。同步控制是要求把雕刻大师的动作,力度,速度等同步到机械臂上去,其实就是刀具位置路径的同步。仿形控制是把雕刻大师雕刻作品时的走刀形状仿形到机械生产的毛坯上去,也是刀具位置路径的控制。刀库和换刀自动控制是当雕刻大师更换刀具时,要求系统能采集实时信号控制刀库旋转到换刀位置同时机械臂也到达换刀位置进行自动换刀。

1.2 ,控制方法的选择

1.2.1,两种控制器件的比较

在雕刻机电控制系统中,工程上主要应用PLC、单片机等作为主控器件来搭建动力系统的控制电路和其它辅助电路。下面对几种控制器的性能特点和应用范围作一下比较。

PLC控制:可编程控制器是在继电器接触器控制技术和计算机技术的基础上发展起来的。当前随着PLC在处理速度、控制功能、通讯能力及控制领域诸方面的不断拓展,它已成为自动化系统的基本装置。PLC的基本功能包括:条件控制、步进控制、定时,计数控制、数据处理、A／D与D／A转换、运动控制、过程控制、通讯联网、远程I／O和状态脏控等。PLC是面向用户的专用工业控制计算机,其控制功能是经过存放在存储器内的程序来实现的。它的特点是可靠性高、抗干扰能力强,软件简单易学,扩展方便、组合灵活,使用维护方便,体积小、质量轻、功耗低。

PLC已广泛应用于冶金、采矿、建材、石油、化工、电力、机械制造、轻工、纺织等行业中。其应用大致可分为以下几种类型。
(1)用于开关逻辑控制:这是PLC最基本的应用场合,用PLC可取代传统的继电
器控制,也可取代顺序控制。总之,PLC可用于单机、多机群以及生产线的自动控制。
(2)用于机械加工的数字控制:PLC和计算机数控装置组合成一体,可实现数字
控制,组成数控机床。
(3)用于机器人或机械手控制。
(4)用于闭环过程控制。
(5)PLC可与集散控制系统进行通讯连接组成多级控制系统,实现工厂自动化网络。

单片机控制:单片机以其卓越的性能,得到了广泛的应用,已深入到各个领域。它的特点如下:
(1)小巧灵活、成本低、易于产品化。它能方便组装成各种智能式测、控设备及
各种智能仪器仪表。
(2)处理能力较强。MCS--51单片机指令系统中有加、减、乘、除及各种逻辑运
算和转移指令,还具有位操作功能,这在检测、控制中特别有用。
(3)易扩展,很容易构成各种规模的应用系统,控制功能强。单片机的逻辑控制
功能很强,指令系统有各种控制功能用指令。
(4)能够很方便地实现多机和分布式控制。
单片机的应用范围很广,从家用电器、智能仪器仪表、通讯、计算机外部设备、
多机分布系统、工业控制直到火箭导航尖端技术领域,单片机都发挥着十分重要的作用。

1.2.2控制系统控制器的确定

结合课题要求和前面对两种控制器件的比较,从经济和控制要求方面考虑,拟选用单片机作为主控芯片。单片机的体积小、价格低、可扩展余地较大。由于本例中的演示型机器人对运行的要求并不高,使用单片机扩展一些常见的芯片,可使机械臂完成相应动作和系统的自动换刀。而且与单片机配用的芯片一般都比较便宜,体积也较小,能够满足安装空间的要求。

1.3, 控制系统方案的确定

1.3.1控制方案的确定

机械手的控制方式有很多,就位置控制而言,有点位控制,连续轨迹控制。本控制系统的机械手臂控制要求同步仿形雕刻大师的动作,要完成各种复杂的动作任务,对手爪的运动轨迹也有严格的要求,因此采用连续轨迹控制方式。

1.3.2 驱动方式的确定
机械臂的驱动方式主要有液压、气动和电动三种,前两种所需辅助器件多,不易实现。而电机便于控制,能实现较复杂的运动,很适合在程序控制下做驱动部件,因此选择电机驱动方式。为满足雕刻系统控制要求,我们选用步进电机和直流电机两种步进电机在臂部旋转、臂部伸缩、腕部 升降、手爪开合 以及刀库刀盘的旋转,而腕部旋转采用直流电机,利用光电码盘做反馈元件,实现闭环控制、手部回转采用直流电机。

1.3.3 步进电机控制方式的确定

在控制精度要求较高的情况下,步进电机也可采用闭环控制,但由于步进电机有步距,难以实现很精确的闭环控制。在步进电机能自动调节步距误差而且步进电机在控制精度不太高的情况下,完全能够采用开环控制,本系统电机控制的速度、位置等要求精度高,而为降低成本,采用开环控制方式。

1.3.4 直流电机控制方式的确定

直流电机的控制方式很多如:数字控制、软件控制等,前者硬件结构复杂、成本高,后者硬件结构简单,成本低,控制灵活,改变软件程序,就能够使电机实现多种运动,因此我们采用软件伺服方式。增量式光电编码盘,能够实现直接输出数字脉冲信号,在软件伺服系统中,适合做反馈元件。本系统采用增量式光电码盘做直流电机的反馈元件。

1.4,控制系统总的方案设计

由同步仿形控制系统的分析结合所学知识设计出控制系统总的设计方案框图如图1.1所示。

反馈检测
反馈检测

反馈检测

采集的模拟信号
A/D转换
上位单片机
换刀中断

1号刀库与换刀自动
下位单片机1

机械臂1

2号刀库与换刀自动
下位单片机3

机械臂3
3号刀库与换刀自动
机械臂2

下位单片机2

图1.1 控制系统总的设计方案框图

1.5,控制系统总设计方案的论证

控制系统把采集到的模拟信号经过A/D转换变成相应的数字信号输送到上位单片机中进行复杂算法的信号处理。经过上位单片机的处理后把数字信号传输到各下位单片机上对机械臂进行动作控制。这说明机械臂的控制是由具体的空间位置量决定的,理论上和实际上都是可行的。由于机械手臂的独立变量是关节变量,而刀具位置轨迹一般是在参考坐标系中说明的,因此要较频繁地用到运动学正问题和运动学逆问题。表示两种问题关系地简单方框图如图1.2所示。

运动学逆问题
单片机处理
x,y,z位置数字量
x,y,z位置模拟量
运动学正问题

图1.2 运动学正问题和逆问题

刀库和换刀的自动经过上位单片机外部中断的形式实现。已经编码的刀具上装有相应的传感器,当工艺雕刻大师需要更换刀具接触到另外的刀具时,刀具传感器发出中断信号。上位单片机得到换刀中断信号后立即中断同步仿形的雕刻转去判断刀库需要旋转的度数和下降量以及机械臂需要的动作并调用相关的中断处理子程序完成自动换刀和刀库自动运动。刀库和换刀自动控制框图如图1.3所示。
换刀中断信号
单片机处理
刀库运动和机械臂换刀
同步仿形雕刻暂停

图1.3 刀库和换刀自动控制框图

二,控制系统的硬件设计

本控制系统主要由单片机本体部分、输出口扩展部分、驱动部分、检测部分组成。控制系统的总的硬件组成如图2.1所示。

机械臂
步进电机驱动器
步进电机

直流电机驱动器

直流电机
检测电路
信息输入
89C51单片机为核心,
8255为扩展口的控制
光电耦合
刀盘旋转
检测电路

图2.1 控制系统的总的硬件组成

2.1单片机的选择

选择AT89C51单片机为核心的控制器,AT89C51单片机引脚图如图2.2所示。89C51是一种带4K字节闪烁可编程可擦除只读存储器的低电压,高性能8位微处理器,俗称单片机。89C2051是一种带2K字节闪烁可编程可擦除只读存储器的单片机。单片机的可擦除只读存储器能够重复擦除100次。该器件采用ATMEL高密度非易失存储器制造技术制造,与工业标准的MCS-51指令集和输出管脚相兼容。

图2.2 AT89C51单片机引脚图

AT89C51单片机管脚说明:   
   VCC:供电电压。    
  GND:接地。 
    P0口:P0口为一个8位漏级开路双向I/O口,每脚可吸收8TTL门电流。当P1口的管脚第一次写1时,被定义为高阻输入。P0能够用于外部程序数据存储器,它能够被定义为数据/地址的第八位。在FIASH编程时,P0 口作为原码输入口,当FIASH进行校验时,P0输出原码,此时P0外部必须被拉高。 
     P1口:P1口是一个内部提供上拉电阻的8位双向I/O口,P1口缓冲器能接收输出4TTL门电流。P1口管脚写入1后,被内部上拉为高,可用作输入,P1口被外部下拉为低电平时,将输出电流,这是由于内部上拉的缘故。在FLASH编程和校验时,P1口作为第八位地址接收。  
     P2口:P2口为一个内部上拉电阻的8位双向I/O口,P2口缓冲器可接收,输出4个TTL门电流,当P2口被写”1”时,其管脚被内部上拉电阻拉高,且作为输入。并因此作为输入时,P2口的管脚被外部拉低,将输出电流。这是由于内部上拉的缘故。P2口当用于外部程序存储器或16位地址外部数据存储器进行存取时,P2口输出地址的高八位。在给出地址”1”时,它利用内部上拉优势,当对外部八位地址数据存储器进行读写时,P2口输出其特殊功能寄存器的内容。P2口在FLASH编程和校验时接收高八位地址信号和控制信号。 
     P3口:P3口管脚是8个带内部上拉电阻的双向I/O口,可接收输出4个TTL门电流。当P3口写入”1”后,它们被内部上拉为高电平,并用作输入。作为输入,由于外部下拉为低电平,P3口将输出电流(ILL)这是由于上拉的缘故。 P3口也可作为AT89C51的一些特殊功能口,如下表所示: 口管脚 备选功能 P3.0 RXD(串行输入口) P3.1 TXD(串行输出口) P3.2 /INT0(外部中断0) P3.3 /INT1(外部中断1) P3.4 T0(记时器0外部输入) P3.5 T1(记时器1外部输入) P3.6 /WR(外部数据存储器写选通) P3.7 /RD(外部数据存储器读选通) P3口同时为闪烁编程和编程校验接收一些控制信号。 
     RST:复位输入。当振荡器复位器件时,要保持RST脚两个机器周期的高电平时间。 ALE/PROG:当访问外部存储器时,地址锁存允许的输出电平用于锁存地址的地位字节。在FLASH编程期间,此引脚用于输入编程脉冲。在平时,ALE端以不变的频率周期输出正脉冲信号,此频率为振荡器频率的1/6。因此它可用作对外部输出的脉冲或用于定时目的。然而要注意的是:每当用作外部数据存储器时,将跳过一个ALE脉冲。如想禁止ALE的输出可在SFR8EH地址上置0。此时, ALE只有在执行MOVX,MOVC指令是ALE才起作用。另外,该引脚被略微拉高。如果微处理器在外部执行状态ALE禁止,置位无效。 
/PSEN:外部程序存储器的选通信号。在由外部程序存储器取指期间,每个机器周期两次/PSEN有效。但在访问外部数据存储器时,这两次有效的/PSEN信号将不出现。    
  /EA/VPP:当/EA保持低电平时,则在此期间外部程序存储器(0000H-FFFFH),不论是否有内部程序存储器。注意加密方式1时,
/EA将内部锁定为RESET;当/EA端保持高电平时,此间内部程序存储器。在FLASH编程期间,此引脚也用于施加12V编程电源(VPP)。    
 XTAL1:反向振荡放大器的输入及内部时钟工作电路的输入。   
 XTAL2:来自反向振荡器的输出。

2.2 扩展口的选择

扩展输出芯片选择所学的8255芯片就能满足系统要求,8255简介如下:

8255是Intel公司生产的可编程并行I/O接口芯片,有3个8位并行I/O口。具有3个通道3种工作方式的可编程并行接口芯片(40引脚)。 其各口功能可由软件选择,使用灵活,通用性强。8255可作为单片机与多种外设连接时的中间接口电路。

8255作为主机与外设的连接芯片,必须提供与主机相连的3个总线接口,即数据线、地址线、控制线接口。同时必须具有与外设连接的接口A、B、C口。由于8255可编程,因此必须具有逻辑控制部分,因而8255内部结构分为3个部分:与CPU连接部分、与外设连接部分、控制部分。

8255的天猫截图如图2.3所示:

图2.3 8255的天猫截图

8255的引脚图如图2.4所示:

图2.4 8255的引脚图

RESET:复位输入线,当该输入端处于高电平时,所有内部寄存器(包括控制寄存器)均被清除,所有I/O口均被置成输入方式。
CS:芯片选择信号线,当这个输入引脚为低电平时,即/CS=0时,表示芯片被选中,允许8255与CPU进行通讯;/CS=1时,8255无法与CPU做数据传输.
RD:读信号线,当这个输入引脚为低跳变沿时,即/RD产生一个低脉冲且/CS=0时,允许8255经过数据总线向CPU发送数据或状态信息,即CPU从8255读取信息或数据。
WR:写入信号,当这个输入引脚为低跳变沿时,即/WR产生一个低脉冲且/CS=0时,允许CPU将数据或控制字写入8255。
D0～D7:三态双向数据总线,8255与CPU数据传送的通道,当CPU 执行输入输出指令时,经过它实现8位数据的读/写操作,控制字和状态信息也经过数据总线传送。
8255具有3个相互独立的输入/输出通道端口,用+5V单电源供电,能在以下三种方式下工作。
方式0————基本输入输出方式;方式1————选通输入/出方式;方式2————双向选通输入/输出方式;
PA0～PA7:端口A输入输出线,一个8位的数据输出锁存器/缓冲器, 一个8位的数据输入锁存器。 工作于三种方式中的任何一种;
PB0～PB7:端口B输入输出线,一个8位的I/O锁存器, 一个8位的输入输出缓冲器。 不能工作于方式二;
PC0～PC7:端口C输入输出线,一个8位的数据输出锁存器/缓冲器, 一个8位的数据输入缓冲器。端口C能够经过工作方式设定而分成2个4位的端口, 每个4位的端口包含一个4位的锁存器,分别与端口A和端口B配合使用,可作为控制信号输出或状态信号输入端口。'不能工作于方式一或二。
A1,A0:地址选择线,用来选择8255的PA口,PB口,PC口和控制寄存器.
当A1=0,A0=0时,PA口被选择;
当A1=0,A0=1时,PB口被选择;
当A1=1,A0=0时,PC口被选择;
当A1=1.A0=1时,控制寄存器被选择.

2.3 单片机控制口的分配

本系统有七个电机需要控制,其中步进电机五个,直流电机一个。步进电机需要的环行脉冲由单片机系统直接发出,五个步进电机工15条控制线,直流电机的PWM功放电路驱动控制信号也由单片机直接发出,光电码盘反馈回的两路信号输入给单片机系统。其具体的分配如下:

1.腰部回转: 8255A     PA0～PA2 
2.大臂俯仰:  8255A     PA3～PA5 
3.腕部俯仰: 8255A     PB2～PB4 
4 .小臂回转: 8255A     PB5～PB7
5.腕部回转:8255A     PA6～PA7 
6.刀具的松夹:8255A     PB0～PB1 
7.刀库刀盘回转:8255A PC0~PC2
8.码盘反馈信号线:外部计数器T0,T1

2.4 机械臂与刀盘控制的硬件设计

根据控制系统总的设计方案和控制系统硬件总图,设计单个机械臂和刀盘控制的硬件框图如图2.5所示。单片机发送指令控制电机驱动器,驱动器获取信息后驱动相应的电机正传,反转,停止等,以实现机械手臂各部位的相应运动。需要反馈检测的位置设计反馈电路让控制更加精确。

直流电机
腕部回转
步进电机
步进电机
步进电机
步进电机
直流电机
步进电机
腰部回转
大臂俯仰
腕部俯仰
小臂回转
刀具的松夹
刀库刀盘旋转
步进电机驱动器

步进电机驱动器

步进电机驱动器

步进电机驱动器

直流电机驱动器

步进电机驱动器

码盘反馈
直流电机驱动器
单片机核心控制以及8255的扩展控制
检测反馈

图2.5 机械臂和刀盘控制的硬件框图

其中各部分驱动电机的性能参数 
1、 臂部旋转:机械传动机构为蜗轮蜗杆,传动比为1:62,选用电机90BF003性能参数 :
(1) 相数:3 
（2）  分配方式3向6拍步距角1。5度 
(3) 相电流:5安  
(4) 电压:60V 
(5) 最大静转距:15Kg.cm 

2、臂部伸缩:: 其结构采用丝杠(T26×4)螺母结构,选用电机75BFOO3其性能参数 
(1)相数:3 
(2)分配方式3向6拍 (3)步距角1.5度
(4)相电流:4安  (5)电压:30V 
(6)最大静转距:10Kg.cm 
3、腕部升降:其传动副采用丝杠螺母传动(T18*4)电机选用55BF003参数 :
(1)相数:3 
(2)分配方式3向6拍 
(3)步距角1.5度 
(4)相电流:3安  
(5)电压:27V 
(6)最大静转距:7Kg.cm 
4、腕部旋转此部分需电机长工作在堵转状态,选用直流力矩电机60LY003参数: 
(1)连续堵转电压:30V 
(2)连续堵转电流1.5安 
(3)连续堵转转距:2kg.cm 
(4)峰值电压:45V 
(5)峰值堵转电流1.5安 (
6)空载转速:1200/min  5 、部回转同上 
6、手爪:传动机构采用丝杠螺母结构,选用电机45BF003性能参数  
(1)相数:3 
(2)分配方式3向6拍 
(3)步距角1.5度 
(4)相电流2.5安  
(5)电压:27V 
(6)最大静转距2Kg.cm

三,控制系统驱动电路的设计

3.1步进电机开环控制的设计

机器人三个自由度和手爪开合以及刀库刀盘的旋转驱动采用了步进电机开环控制,其核心采用80C51单片机,步进电机驱动所需的环形脉冲直接由80C51输出口输出,省掉环形分配器,控制框图如图3.1所示。

单
片
机
步进
电机
驱动
电路
步进
电机
机器人相应自由度
刀库刀盘的旋转

图3.1 步进电机开环控制框图

3.1.1驱动电路的选择 

步进电机驱动电路,有的结构简单但性能较差,如基本型,有的性能好,但结构复杂、造价高,且难以调试,如晶闸管型、斩波型等。机械臂控制精度要求高,工作频率在几百赫兹左右,工作电流在1-5A,为简化电路,降低成本,我们选定单电压、恒流源功放电路,用晶体管及相关电路构成的恒流源代替基本型中的Rc,组成恒流源型步进电机驱动电路。这种电路不太复杂,安装、调试简单,改变电阻Re,增减串联二极管个数,能够很方便的改变工作电流,以适用不同步进电机。
恒流源型功率放大电路原理图如图3.2所示。

图3.2 恒流源型功率放大电路原理图

3.2 直流电机的闭环控制系统的设计
由直流电机的驱动电路和辨向电路,以及控制核心器单片机,形成直流电机的闭环控制系统。直流电机闭环控制系统框图如图3.3所示。

单
片
机
电机PWN功放电路
直流电机
机械臂手腕
光电码盘
辨向电路

图3.3 直流电机闭环控制系统框图

在本系统中,直流电机用在机械臂的腕部回转和手爪回转上。考虑到结构特点,减少手部、腕部的质量,直流电机与其直接相连,直流电机采用直接驱动方式。在这种方式下,要求电机输出较高的转距,较低的转速,因此我们选用直流力矩电机。 
  我们用软件实现电机闭环伺服控制,由单片机输出脉冲信号,启动
PWM功率放大电路,驱动直流电机转动。光电码盘将转动的角位移转化成脉冲信号,经辨向电路输入给单片机的两个计数器,单片机读取计数器的值,并转化成角位移,然后与直流电机的预期位置进行比较,利用其差值的正负和大小来补偿直流电机的正反转的位置。当差值的绝对值小于直流电机位置容许误差时,停止转动。这样就实现了直流电机位置的闭环控制。

3.2.1 双极型PWM直流力矩电机的驱动电路的设计

双极型PWM功放电路如图3.4所示。 

图 3.4 双极型PWM功率放大器原理图

N1,P1为达林顿管,N1为NPN型TIP31C,最大电流3A,最大耗散功率为40W,耐反电压100V,,P1与N1管参数相同,但为PNP型TIP32B,D1,D2为泄放二极管,用以保护N1,P1不被击穿。光电偶合管为TLP521,将数字电路与模拟电路隔开,7401为二输入与非门,正逻辑;7414为六反向器,正逻辑。下面介绍工作原理:
光电偶合管前部分的数字电路逻辑功能为¢, 真
值表如表格 3.1直流电机控制信号逻辑电路真值表:

表格 3.1直流电机控制信号逻辑电路真值表
A
B
A’
B’
0
0
1
1
0
1
1
0
1
0
0
1
1
1
1
1

当输入信号A,B为0,1时,A¢=1,B¢=0,此时B¢路光偶导通R3电阻有电流经过,a 点电位升高,达林顿管N1饱和导通,P1截止,+45V电压几乎全加在直流电机上,使直流电机正转。 
当输入信号A,B为1,0时,A¢=0,B¢=1,此时A¢路光偶导通R4电阻有电流经过,达林顿管P1饱和导通,N1截止,-45V电压几乎全加在直流电机上,使直流电机反转。 
当输入信号A,B为00或11时,A¢=1,B¢=1,即高电平,此时两路全截止,两达林顿管基极军无电流经过而截止,此时电机绕组无电流经过,即停止。 
当输入信号为相位相反的脉冲信号时,达林顿管N1,P1交替导通,截止,调整脉冲频率可使直流电机处于所定状态,改变输入脉冲的占空比,可改变电机运行方向和速度。

3.2.2光电码盘的选择和辩向电路的设计
（1） 光电码盘的选择 :
  机械臂运动控制系统位置精度要求高,直流电机反馈选用从长春光学仪器厂生产的分辨率 的光电码盘器作为位置反馈元件,其输出为TTL电平,5V方波脉冲信号,所需电源电压+5V输出波形为:

(2)辨向电路的设计 
   光电码盘直接安装在直流电机的主轴上,在直流电机转动的过程中,即有正转也有反转,这样光电码盘输出的脉冲信号即有正转的也有反转的 。为了准确的检测电机的转动角度,必须辨别光电码盘的转动方向。这种辨别码盘转动方向的电路称为辨向电路,原理如图3.5所示。

图3.5 辨向电路原理图

从码盘输出的两路信号Ue,Uf在相位上互差90度。设正向运动时Uf超前于Ue90度,则此时Ue的上升沿AA¢对应于Uf的高电平,反向移动时Ue超前于Uf90度,这时Ue的上升沿BB¢对应着Uf的低电平。据此能够判别码盘的转动的方向。 
我们采用一片单稳态触法器74LS221和一片与非门74LS00来够成辨向电路如图3.6所示:

图3.6 辨向电路原理图

单稳态触法器74LS221只有一个稳定状态。当没有外加信号时,输出Q为低电平;在出发脉冲的作用下,输出Q为高电平,并停留一段时间自动返回低电平。此处”停留”时间在数十毫秒到数十秒范围内变化。它由外加电阻Rext和外加电容Cext决定,能够大致按以下公式计算:   Tw=Rext*Cext*Ln2 
 其中  :  电容C单位为法拉 ,  Tw单位为秒 。
    将第一路方波信号同时送入74LS221的上升沿触发端A和下降沿触发端B能够得到两路窄脉冲(其中脉冲宽度由外接电阻,电容调节)e上 ,e下,将e上、e下分别与第二路方波信号Uf进行与非运算,输出分别送入两个计数器,进行计数,这样当码盘正向运动时,计数器1有脉冲,而计数器2没有脉冲输入;当反向运动时,计数器1无脉冲输入而计数器2有脉冲输入,由此达到辨向的目的。

四,控制系统模拟信号A/D转换的设计

2.1 A/D转换器的选型

根据采集的模拟信号种类计算出A/D转换时所需要的模拟信号通道满足控制系统要求,以及考虑实际经济情况(ADC0809较实惠,天猫上的价格一般在5到6元之间),因此选择ADC0809转换器。

ADC0809的天猫截图如图4.1所示:

图4 .1 ADC0809的天猫截图

ADC0809引脚结构功能说明图如图4.2所示:

图4.2 ADC0809引脚结构功能说明图
1~5、26~28,IN0～IN7:8路模拟量输入端。
14~15、8、17~21,D0~D7:8位数字量输出端。
23~25,ADDA、ADDB、ADDC:3位地址输入线,用于选通8路模拟输入中的一路
22,ALE:地址锁存允许信号,输入,高电平有效,对应ALE上跳沿,A、B、C地址状态送入地址锁存器中。
6,START:A／D转换启动信号,输入高电平有效,START上升沿时,复位ADC0809;START下降沿时启动芯片,开始进行A/D转换;在A/D转换期间,START应保持 低电平。本信号有时简写为ST.
7,EOC:A／D转换结束信号,输出,当A／D转换结束时,此端输出一个高电平(转换期间一直为低电平)。
9,OE:数据输出允许信号,输入,高电平有效。当A／D转换结束时,此端输入一个高电平,才能打开输出三态门,输出数字量,用于控制三态输出锁存器向单片机输出转换得到的数据。OE=0,输出数据线呈高阻;OE=1,输出转换得到的数据。
10,CLK:时钟脉冲输入端。要求时钟频率不高于640KHZ,EOC=0,正在进行转换;EOC=1,转换结束。使用中该状态信号即可作为查询的状态标志,又可作为中断请求信号使用。
12、16,REF(+)、REF(-):基准电压。
11,Vcc:电源,单一＋5V。
13,GND:地。

2.2,ADC0809的工作原理

ADC0809是带有8位A/D转换器、8路多路开关以及微处理机兼容的控制逻辑的CMOS组件。它是逐次逼近式A/D转换器,能够和单片机直接接口。
2.2..1 ,ADC0809的内部逻辑结构
由下图可知,ADC0809由一个8路模拟开关、一个地址锁存与译码器、一个A/D转换器和一个三态输出锁存器组成。多路开关可选通8个模拟通道,允许8路模拟量分时输入,共用A/D转换器进行转换。三态输出锁器用于锁存A/D转换完的数字量,当OE端为高电平时,才能够从三态输出锁存器取走转换完的数据。ADC0809的内部逻辑结构如图4.3所示。

图4.3 ADC0809的内部逻辑结构
ADC0809对输入模拟量要求:信号单极性,电压范围是0－5V,若信号太小,必须进行放大;输入的模拟量在转换过程中应该保持不变,如若模拟量变化太快,则需在输入前增加采样保持电路。
地址输入和控制线:4条
ALE为地址锁存允许输入线,高电平有效。当ALE线为高电平时,地址锁存与译码器将A,B,C三条地址线的地址信号进行锁存,经译码后被选中的通道的模拟量进入转换器进行转换。A,B和C为地址输入线,用于选通IN0－IN7上的一路模拟量输入。通道选择表如下表所示。

C
B
A
选择的通道
0
0
0
IN0
0
0
1
IN1
0
1
0
IN2
0
1
1
IN3
1
0
0
IN4
1
0
1
IN5
1
1
0
IN6
1
1
1
IN7

数字量输出及控制线:11条
    ST为转换启动信号。当ST上跳沿时,所有内部寄存器清零;下跳沿时,开始进行A/D转换;在转换期间,ST应保持低电平。EOC为转换结束信号。当EOC为高电平时,表明转换结束;否则,表明正在进行A/D转换。OE为输出允许信号,用于控制三条输出锁存器向单片机输出转换得到的数据。OE＝1,输出转换得到的数据;OE＝0,输出数据线呈高阻状态。D7－D0为数字量输出线。
CLK为时钟输入信号线。因ADC0809的内部没有时钟电路,所需时钟信号必须由外界提供,一般使用频率为500KHZ,
VREF(＋),VREF(－)为参考电压输入。

2.2.2 ,ADC0809的应用说明

(1)． ADC0809内部带有输出锁存器,能够与AT89C51单片机直接相连。
(2)． 初始化时,使ST和OE信号全为低电平。
(3)． 送要转换的哪一通道的地址到A,B,C端口上。
(4)． 在ST端给出一个至少有100ns宽的正脉冲信号。
(5)． 是否转换完毕,我们根据EOC信号来判断。
(6)． 当EOC变为高电平时,这时给OE为高电平,转换的数据就输出给单片机了。

2.3,ADC0809的软件编程设计

数据采集系统A/D转换器与单片机的连接P2.7接启动信号,ADDC、B、A接CPU的地址A2、A1、A0。分别对x,y,z三个位置量,a,b,c三个角度量(a代表x轴的夹角,b代表y轴的夹角,c代表z轴的夹角)以及v速度量共7路模拟量输入信号检测,并将采集的数据存入片内数据存储器30H～36H单元。
模拟信息数据采集采用外部中断1中断方式采集,ADC0809工作在串行从模式下的硬件接线图如图4.4所示 ,核心汇编源程序转换结果存在 30H到36H空间里。

图4.4 ADC0809与单片机的硬件接线图

汇编源程序如下 :
ORG 0000H
LJMP MAIN
ORG 0013H
LJMP INT_R1 ;中断服务程序入口
ORG 0030H
MAIN:MOV SP, #60H ;设堆栈指针
MOV R0, #30H ;设片内RAM首地址
MOV R7,#08 ;通道计数器
SETB IT1 ;边沿触发
SETB EX1 ;开外部中断1
SETB EA ;开CPU中断
MOV DPTR,#7FF8H ;指向ADC0809的IN0
MOVX @DPTR,A ;起动A/D
SJMP $

INT_R1:MOVX A,@DPTR ;读A/D转换结果
MOV @R0,A ;存入片内RAM
INC R0 ;下一单元
INC DPTR ;下一通道
MOVX @DPTR,A ;起动A/D转换
RETI
END

五,机械臂的控制设计
控制系统要求机械臂能同步仿形工艺大师的雕刻动作,其控制原理是上位单片机采集和暂存AD转换后的数字信号,然后将相应的数字信号传输到各下位单片机里,相应的数字信号在下位单片机经过复杂的算法(即逆运动学)与检测信号的综合处理后控制相应的电机驱动器达到机械臂运动的实时控制。当产生换刀中断时,机械臂停止雕刻转去执行换刀动作。因此机械臂实时控制包含了机械手位置控制的正、逆运动学问题,上、下位单片机通信问题,机械臂换刀问题。

5.1 机械手的位置控制
5.1.1 机械手几何模型
设计一种五自由度机械手模型。该机械手几何模型如图5.1所示。其中,θl为肩关节偏航自由度, θ2为肩关节俯仰自由度,θ3为肘关节偏航自由度为, θ4为腕关节偏航自由度,θ5为腕关节俯仰自由度。L1、l2分别为机械手上、下臂的长度,l3为腕关节中心到抓手中心的距离。

图5.1 机械手几何模型及D-H坐标

5.1.2机械手运动学模型
1 运动学方程
假定机械手伸直状态下所处位置为停止位置,根据D-H方法建立各坐标系,如图3-1所示;相应的各连杆及关节的参数如表5.1所示。

表5.1
连 杆
θ
α/()
a
d
cosα
sinα
1
θ
360
0
0
1
0
2
θ
180
l
0
-1
0
3
θ
180
l
0
-1
0
4
θ
360
0
0
1
0
5
θ
180
l
0
-1
0
将参数代入D-H齐次变换矩阵得:
T= (1)
T= (2)
T=