TMSF的机械手控制平台文档格式.docx
《TMSF的机械手控制平台文档格式.docx》由会员分享，可在线阅读，更多相关《TMSF的机械手控制平台文档格式.docx（11页珍藏版）》请在冰点文库上搜索。
能够基本满足许多工厂的任务要求，使用2812芯片的机械手系统因为体积小，价格便宜，可以在大量的场合使用。
机械手精确的角度把握，使得流水作业质量大大提升。
2.系统方案
2.1机械手控制系统功能概述
机械手模型如图2-1所示：
图2-1机械手模型
1.水平方向的腰部步进电机360度全方位运动，垂直方向的手臂步进电机可以360度全方位运动，机械手在两个自由度内角度任意变换，角步速度、精度均可调，使得机械手臂能精确到位。
2.液晶显示屏记录转动圈速和运行时间，显示当前运行情况，根据任务的不同，机械手抓举部分可以选用电磁吸棒，机械抓等，具有很强的通用性。
操作者可通过手动、循环自动和远程遥控多种形式控制机械手。
2.2总体设计
根据设计功能要求，基于DSP的机械手控制系统的结构框图如图2-2所示。
如图2-2基于DSP的机械手的结构框图
基于DSP的机械手控制系统的主要功能模块为：
DSP最小系统、步进电机驱动电路、按键电路、显示电路和电源电路。
2.3具体方案
1.核心控制芯片
系统需要选用一个控制芯片来控制整个系统的运行，有如下三种方案：
方案一：
采用PLC可编程控制器
优点：
寿命长，运行可靠，可多台同时控制，技术已经成熟，在大型机械手中广泛使用。
缺点：
体积大，价格昂贵，编程限制于梯形图，算法繁琐。
方案二：
采用STC89C51单片机
体积小，价格便宜，编程简单
缺点:
扩展能力有限，输出口较少。
方案三：
采用TMS320F2812DSP控制
体积小，运行可靠，输出端口多，可供多台同时使用，编程语言先进，算法简单，能通过算法使机械手精确定位。
芯片推出时间不长，技术可能不成熟。
考虑到多台步进电机之间的协调操作，所以采用DSP2812为本次设计的核心芯片。
2．步进电机驱动电路
由于要使用两台功率不一样的步进电机，而DSP芯片产生的电流很小，驱动不了步进电机，所以需要步进电机驱动电路，步进电机驱动电路通常可以采用如下方案实现：
利用达林顿管ULN2003放大电路来驱动步进电机
驱动电路简单，驱动小功率电机足够
驱动电流比较小，驱动步进电机时需考虑步进电机驱动电流。
采用L298组成的驱动电路
驱动能力比2003强，能带动大功率步进电机，基本不用考虑电流问题。
电路较为复杂。
比较以上两个方案，考虑到这次设计需要使用一台12V/0.4A的步进电机，所以采用方案二选用L298组成的驱动电路。
3．显示接口电路
因为需要显示步进电机转动模式，以及圈数、精度等情况，所以需要显示模块，可以采用以下方案实现：
采用六位LED数码管
优点：
电路简单，不需编程只需一个译码器
缺点：
显示数据太少，只能显示单位数字，不能充分说明步进电机的实时数据。
采用液晶显示屏12864
优点：
因为可以多行显示，可以充分显示步进电机的实时数据。
缺点：
电路较为复杂，需要编程，成本较高。
考虑到本次需要使用多台步进电机，所以需要显示的数据比较多，用数码管实现不方便，所以采用液晶屏12864组成的显示模块。
4.电源电路
机械手由步进电机组成，所以需要两台功率不一样的步进电机，可以采用如下两个电机驱动电源方案：
方案一：
采用CW7812稳压电路
优点：
电路简单，只需稳压芯片和电容滤波即可，内部包含电流限制、有过流保护和安全区保护，基本不会损坏。
缺点：
最大输出电流1.5A，驱动能力有限，如果使用，每台步进电机都将配一套12V电源。
采用LM2596开关电压调节器
输出电流能达到3A，驱动能力强，完全满足两台步进电机
与CW7812稳压电路相比，电路较复杂。
考虑到要使用两台电机，输出电流比较大，后期不能带动别的电机，适用性差，所以选用LM2596直流斩波电路。
2.4版面设计
考虑到系统的稳定性，DSP工作频率高受外部易干扰，所以单独把CPU主控电路设计为一块PCB板，步进电机驱动电路、按键电路单独设计为一块PCB板，电源为一块PCB板。
如此设计还可使CPU控制卡用在别的场合，使它的通用性更强。
3.系统硬件设计
基于DSP的机械手控制系统主要由DSP最小系统、步进电机驱动电路、按键电路、显示电路和电源电路等组成。
3.1DSP2812最小系统
DSP最小应用系统包括了时钟电路、复位电路、SRAM、JTAG仿真接口电路及D/A转换电路，电路原理图如图3-1所示。
电路主要由DSP2812、30M无源晶振和电源芯片TPS767D318等组成，外加少量电阻、电容和电感。
TPS767D318为+5V输入，可产生+3.3V和1.8V的输出电压供DSP使用；
同时该芯片产生的复位信号也可供JTAG仿真口使用，另外还需加一个14脚的JTAG仿真口以便烧写程序。
该系统不管是在仿真模式下，还是在实时运行模式下都可正常使用。
图3-1DSP2812最小系统原理图
3.1.1TMS320F2812芯片
TMS320F2812DSP芯片是在原有TMS320C2XX系列芯片的基础上推出的，它是目前TI公司C2000系列中较高档的一款DSP芯片。
它的主频为150MHZ,内含事件管理器、AD转换，总体性价比高。
它可以广泛应用于工业马达驱动，数字电源系统，光网络技术，轮胎压力测试系统，显示屏技术，汽车电子动力转向装置，打印机办公产品和一些潮流的产品开发等等。
振荡器、锁相环主要为处理器CPU及相关外设提供可编程的时钟，每个外设的时钟都可以通过相应的寄存器进行编程设置。
看门狗可以监控程序的运行状态，提高系统的可靠性。
DSP除了提供基本的锁相环电路外，还可以根据处理器内部外设单元的工作要求配置需要的时钟信号。
处理器还将集成的外设分成高速和低速两组，可以方便地设置不同模块的工作频率，从而提高处理器的灵活性和可靠性。
3.1.2时钟电路设计
如图3-1所示时钟电路，因为TMS320F2812DSP内置振荡器电路，只需外加晶体和负载电容即可以产生时钟基准来满足TMS320F2812DSP的时钟输入要求。
TMS320F2812DSP带有片内锁相环（PLL）时钟模块，其最大的预设比例因子为5，因此只要配置U2为30MHz的晶振就可以满足DSP的频率工作要求，电容C2、C3都为10pF。
3.1.3复位电路设计
DSP有三种复位方式：
上电复位、手动复位、软件复位，前两种是通过硬件电路实现的复位，后一种是通过指令方式实现的复位。
图3-1所示复位电路，利用RC电路的延迟特性给出复位所需要的低电平时间。
在上电瞬间，由于电容C上的电压不能突变，所以通过电阻R进行充电，充电时间有RC的乘积值决定，一般要求大于5个外部时钟周期，可根据具体情况选择。
为防止复位不完全，参数可选择大一些。
其中电阻R5为10KΩ，电容C6为10µ
F。
按钮的作用是当按钮按下时，将电容C上的电荷通过按钮串接的电阻释放掉，使电容C上的电压降为零；
当按钮松开时，电容C的充电过程与上电复位相同，从而实现手动按钮复位。
3.1.4SRAM设计
在电机系统的实验阶段，实时控制软件必须经过反复调试和不断优化，而DSP内部自带的RAM一共只有18K×
16位，对于复杂的控制算法将不能胜任，如果直接把不完善的程序烧入到DSP芯片内部的Flash中，这样频繁地烧写和擦除Flash不仅会浪费调试的时间，而且还会影响Flash的使用寿命。
采用的外部SRAM芯片是ISSI公司的IS61LV6416，IS61LV6416有16根数据总线和16根地址总线，最大存储空间为64K×
16位，同时具有10ns的快速读写速度。
IS61LV6416为静态随机存储器，一般由存储矩阵、地址译码器和读/写控制电路组成。
外扩RAM设计电路图如图3-2所示。
图3-2外扩RAM设计电路图
3.1.5D/A转换电路设计
系统中设置了两路D/A输出通道，用来在实验过程中检测相关的物理量，将需要观测的量如电压、电流、转速、磁链、转矩等DSP的计算结果转化成模拟量，用示波器观测结果，将使调试过程更加直接和感性。
D/A转换器电路连接如图3-3所示。
图3-3D/A转换器电路连接图
当5V电源电压工作时，TLC7528C的数字输入提供TTL兼容性。
TLC7528C可以用5V至15V范围内的任何电源电压工作；
但是5V以上输入逻辑电平不与TTL兼容。
3.2步进电机驱动电路
步进电机的驱动模块采用SGS-THMOSONMicroelectronics所生产的双全桥步进电机专用驱动芯片L298N,经过总线驱动器的步进电机驱动信号后，经过光耦隔离接入L298N再接入步进电机控制信号端。
步进电机驱动电路如图3-4所示。
图3-4步进电机驱动电路
L298N内部包含4信道逻辑驱动电路，是一种二相和四相步进电机的专用驱动器，可同时驱动2个二相或1个四相步进电机，内含二个H-Bridge的高电压、大电流双全桥式驱动器，接受标准TTL逻辑准备信号，可驱动46V、2A以下的步进电机，且可以直接通过电流来调节输出电压。
3.3显示接口电路
显示模块采用的是LCD12864液晶模块，具有显示当前步进电机运行状态，显示电机运行步数，以及当前速度标志。
12864显示模块接口电路如图3-5所示。
图3-512864显示模块电路
用12864多行显示对当前步进电气运行状况时时进行监控，因为涉及多台步进电机，需要显示的数据较多，所以选择采用可以多行显示的12864液晶显示屏。
3.4电源模块
220V交流电经过整流，滤波，稳压，输出一路5V，一路12V稳定电压。
如图3-6电源电路所示。
图3-6电源电路
TPS767D318电源电路如图3-7所示。
当采用双电源器件芯片设计系统时，需要考虑系统上电或掉电操作过程中内核和I/O供电的相对电压和上电次序。
通常情况下，在芯片内部内核和外部I/O模块采用独立的供电结构，如果在上电或掉电过程中两个电压的供电起点和上升速度不同，就会在独立的结构（内核和外部I/O模块）之间产生电流，从而影响系统初始化状态，甚至影响器件的寿命，而且隔离模块之间的电流还会触发器件本身的闭锁保护，尽管TI公司的DSP上电过程中允许两种供电有一定的时间差。
为了提高系统的稳定性和延长器件的使用寿命，在设计时必须考虑上电、掉电次序问题。
对于DSP内核和外设供电次序控制可以采用多种方法，主要有两种方法：
采用分离原件P通道MOSFET管和TI公司提供的电源分配开关。
5V再用CW7805稳压芯片，电路简单，供给电源芯片TPS767D318。
输出1.8V/3.3V电压。
另外一路采用LM2596直流斩波，恒定输出12V电压提供给两台步进电机，图3-8为LM2596直流斩波电路。
图3-7TPS767D318电源电路
图3-8LM2596直流斩波电路
4.系统软件设计
系统软件主要实现步进电机在运行时的调速、步数、运行顺序。
在整个系统中用到了TMS320F2812芯片的主要资源有：
通用定时器、GPIOA口、GPIOB口等。
系统软件包括以下模块：
主程序、键盘中断处理程序、液晶显示程序、电机运行程序。
4.1主程序
为了实现系统处理数据和控制的实时性，系统主要功能在中断程序中完成，主程序的功能是实现系统初始化、LCD显示系统启动信息和开启中断等功能。
主控程序流程图如图4-1所示。
系统初始化中，完成的任务：
1.系统时钟配置为30MHZ；
2.将GPIOA口设置为普通IO口，将GPIOB口设置为普通IO口，将GPIOD口设置为普通IO口；
3.对初始值进行清零初始化；
4.对LCD液晶显示屏进行初始化控制；
5.开启系统总中断；
图4-1主控程序流程图
4.2键盘中断处理程序
图4-2键盘中断处理程序流程图
键盘中断处理程序流程图如图4-2所示。
键盘中断处理程序用来实现对键盘有键按下时键值的读取。
键盘接口占用的是TMS320F2812的GPIOD口的资源，当有键按下时，定时器向CPU发出中断请求，CPU进入中断处理程序。
4.3液晶显示程序
液晶显示程序是用来实时显示步进电机运行状态的，液晶接口占用的是TMS320F2812的GPIOB口的资源，每当按键按下时都要执行一步display。
液晶显示程序流程图如图4-3所示。
图4-3液晶显示程序流程图
5系统创新
基于DSP的机械手控制系统具有以下创新处：
1.机械手由腰部步进电机与手臂步进电机组成，在两个自由度的空间内能自由旋转，没有死角。
2.可流水线作业，速度可调，旋转精度可调，稳定性高，抗干扰能力强。
3.采用高端控制芯片，可执行冗长、复杂的程序，能更好的进行二次开发。
3.小巧精致，适合很多场合，通用性强。
4.功耗低，高效率，节能减排。
6评测与结论
系统设计制作完成后，进过运行和调试后，我们以12V/0.4A和9V/0.2A的步进电机进行调试，两台步进电机已经可以实现机械手的功能。
不足与改进：
在测试过程中，短期运行效果很好，在长时间运行时候，步进电机驱动器会很烫，这里采用的L298可能还是不适合驱动这种功率大的步进电机，如果要驱动大功率的步进电机应该采用H桥驱动器，用晶闸管代替效果会更好，液晶显示反应比较缓慢，这是我们下面要改进和完善之处。
后期制作：
步进电机各个部分工作正常，一切正在向我们预期的目标前进，下面的设计任务主要对两台步进电机之间的动作相协调，最终制成机械手平台，机械手抓物部分（电磁吸棒）将在后期制作中完成，另外液晶显示模块也将在后期工作中完成。
CPU控制卡如图6-1所示。
基于DSP的机械手控制系统如图6-2、6-3所示。
版权申明
本文部分内容，包括文字、图片、以及设计等在网上搜集整理。
版权为潘宏亮个人所有
Thisarticleincludessomeparts,includingtext,pictures,anddesign.CopyrightisPanHongliang'
spersonalownership.
用户可将本文的内容或服务用于个人学习、研究或欣赏，以及其他非商业性或非盈利性用途，但同时应遵守著作权法及其他相关法律的规定，不得侵犯本网站及相关权利人的合法权利。
除此以外，将本文任何内容或服务用于其他用途时，须征得本人及相关权利人的书面许可，并支付报酬。
Usersmayusethecontentsorservicesofthisarticleforpersonalstudy,researchorappreciation,andothernon-commercialornon-profitpurposes,butatthesametime,theyshallabidebytheprovisionsofcopyrightlawandotherrelevantlaws,andshallnotinfringeuponthelegitimaterightsofthiswebsiteanditsrelevantobligees.Inaddition,whenanycontentorserviceofthisarticleisusedforotherpurposes,writtenpermissionandremunerationshallbeobtainedfromthepersonconcernedandtherelevantobligee.
转载或引用本文内容必须是以新闻性或资料性公共免费信息为使用目的的合理、善意引用，不得对本文内容原意进行曲解、修改，并自负版权等法律责任。
Reproductionorquotationofthecontentofthisarticlemustbereasonableandgood-faithcitationfortheuseofnewsorinformativepublicfreeinformation.Itshallnotmisinterpretormodifytheoriginalintentionofthecontentofthisarticle,andshallbearlegalliabilitysuchascopyright.
升级会员 