专利名称：两轴全自动高速点胶机器人伺服控制系统的制作方法
技术领域：
两轴全自动高速点胶机器人伺服控制系统技术领域[0001]本实用新型是有关于点胶机器人的技术领域，且特别是有关于两轴全自动高速点 胶机器人伺服控制系统。[0002]背景技术[0003]在高技术迅猛发展的今天，传统的生产方式已日趋落后，新型的自动化生产将成 为新世纪接受市场挑战的重要方式。自动化不仅是提高劳动生产率的手段，对企业未来的 长远发展战略起着重要的作用。由于机器人是新型的自动化的主要工具，工业机器人及其 应用工程的开发，将机器人变为直接生产力，它在改变传统的生产模式，提高生产率及对市 场的适应能力方面显示出极大的优越性。同时它将人从恶劣危险的工作环境中替换出来， 进行文明生产，这对促进经济发展和社会进步都具有重大意义。随着制造业对机器人装备 的需求及绿色环保和改善劳动者的工作环境要求越来越高，专门对流体进行控制，并将流 体点滴、涂覆于产品表面或产品内部的自动化机器点胶机器人随即产生。[0004]点胶机器人主要用于产品工艺中的胶水、油漆以及其他液体精确点、注、涂、点滴 到每个产品精确位置，可以用来实现打点、画线、圆型或弧型。“点胶机器人”的研究开发将 对我国制鞋行业、PCB板绑定封胶、IC封胶、PDA封胶、IXD封胶、IC封装、IC粘接等行 业产生巨大的经济效益和社会效益。有的时候，点胶机器人只是需要反复在一条直线上或 者一个二维的平面上进行简单的直线或圆弧涂胶或者是按照一定的规律对一些位置进行 点对点的涂胶，这个时候一台两轴的点胶机器人可以很快的完成上述动作。一台完整的两 轴点胶机器人大致分为以下几个部分[0005]I)电机执行电机是点胶机器人的动力源，它根据微处理器的指令来执行点胶机 器人在加工部件二维的平面上行走的相关动作；[0006]2)算法算法是点胶机器人的灵魂，点胶机器人必须采用一定的智能算法才能准 确快速的从一点到达另外一点，形成点对点，或曲线运动；[0007]3)微处理器微处理器是点胶机器人的核心部分，是点胶机器人的大脑，点胶机器 人所有的信息，包括胶点大小，位置信息，和电机状态信息等都需要经过微处理器处理并做 出相应的判断。[0008]点胶机器人结合了多学科知识，对于提升在校学生的动手能力、团队协作能力和 创新能力，促进学生课堂知识的消化和扩展学生的知识面都非常有帮助。点胶机器人技术 的开展可以培养大批相关领域的人才，进而促进相关领域的技术发展和产业化进程。但是 由于国内研发此点胶机器人的单位较少，相对研发水平比较落后，研发的两轴点胶机器人 伺服控制系统的结构框图，如图1，长时间运行发现存在着很多安全问题，即[0009]( I)在点胶初期，都是人工运动点胶阀到起始位置，然后仅仅依靠人眼进行初始位 置的校正，使得精确度大大降低；[0010](2)作为点胶机器人的电源采用的是一般交流电源整流后的直流电源，当突然停 电时会使整个点胶运动失败；[0011](3)作为点胶机器人的执行机构采用的是步进电机，经常会遇到丢失脉冲的问题出现，导致对位置的记忆出现错误；[0012](4)由于采用步进电机，使得机体发热比较严重，有的时候需要进行散热；[0013](5)由于采用步进电机，使得系统运转的机械噪声大大增加，不利于环境保护；[0014](6)由于采用步进电机，其电机本体一般都是多相结构，控制电路需要采用多个功 率管，使得控制电路相对比较复杂，并且增加了控制器价格；[0015](7)由于采用步进电机，使得系统一般不适合在高速运行；[0016](8)由于采用步进电机，使得系统的力矩相对较小；[0017](9)由于控制不当的原因，导致有的时候步进电机产生共振；[0018]( 10)相对采用的都是一些体积比较大的插件元器件，使得自动点胶机器人控制系 统占用较大的空间，重量相对都比较重；[0019](11)由于受周围环境不稳定因素干扰，单片机控制器经常会出现异常，引起点胶 机器人失控，抗干扰能力较差；[0020](12)对于点胶机器人的点胶过程来说，一般要求其两个电机的PWM控制信号要同 步，由于受单片机计算能力的限制，单一单片机伺服系统很难满足这一条件，使得点胶机器 人点胶量不一致，特别是对于快速行走时；[0021](13)由于受单片机容量和算法影响，点胶机器人对胶点的信息没有存储，当遇到 掉电情况时所有的信息将消失，这使得整个点胶过程要重新开始；[0022](14)点胶系统一旦开始，就要完成整个点胶运动，中间没有任何暂停或缓冲的占.[0023](15)由于点胶机器人要频繁的关闭和启动，加重了单片机的工作量，单一的单片 机无法满足自动点胶机器人快速启动和停止的要求；[0024](16)在所有的点胶过程中，没有对点胶过的结果进行自动观测和补偿，有的时候 使得整个曲线上胶量不一致，然后采用人工二次补胶。[0025]为了满足高速、高效生产的需要，必须对现有的基于单片机控制的两轴自动点胶 机器人控制系统进行重新设计，寻求一种高速、高效的点胶伺服系统。实用新型内容[0026]针对上述问题，本实用新型的目的是提供一种两轴全自动高速点胶机器人伺服控 制系统，解决了现有技术中两轴点胶机器人控制系统高速和高效性能差的缺陷。[0027]为解决上述技术问题，本实用新型采用的一个技术方案是提供一种两轴全自动 高速点胶机器人伺服控制系统，包括电池、交流电源、第一信号处理器、第二信号处理器、处 理器单元、图像采集单元、第一高速直流电机、第二高速直流电机以及点胶机器人，所述的 第一信号处理器通过交流电源或者电池单独提供电流驱动所述的处理器单元，所述的处理 器单元分别发出第一控制信号和第二控制信号，所述的第一控制信号和第二控制信号分别 控制所述的第二高速直流电机和第一高速直流电机，通过所述的第一高速直流电机的第二 控制信号和通过所述的第二高速直流电机的第一控制信号经过第二信号处理器合成之后， 控制点胶机器人的运动，所述的处理器单元还连接至图像采集单元。[0028]在本实用新型一个较佳实施例中，所述的处理器单元为一双核处理器，包括DSP 处理器、FPGA处理器以及设于DSP处理器和FPGA处理器的上位机系统和运动控制系统，所述的上位机系统包括人机界面模块、路径读取模块以及在线输出模块，所述的运动控制系 统包括伺服控制模块、数据存储模块、I/O控制模块以及图像采集单元，其中，DSP处理器用 于控制人机界面模块、路径读取模块、在线输出模块、数据存储模块、I/O控制模块以及图像 采集单元，FPGA处理器用于控制伺服控制模块，且DSP处理器及FPGA处理器之间实时进行 数据交换和调用。[0029]在本实用新型一个较佳实施例中，所述的处理器单元进一步与高速直流电机的输 出端连接。[0030]在本实用新型一个较佳实施例中，所述的伺服控制模块还包括转换模块，所述的 转换模块用于把数字信号转换成模拟信号。[0031]在本实用新型一个较佳实施例中，所述的伺服控制模块还包括编码器模块，所述 的编码器模块用于检测点胶机器人的实际转速，判断是否符合速度要求，是否过快或过慢， 并发出控制信号。[0032]在本实用新型一个较佳实施例中，所述的伺服控制模块还包括电流模块，所述的 电流模块用于调整电池的供电功率达到点胶机器人需要的范围。[0033]在本实用新型一个较佳实施例中，所述的伺服控制模块还包括速度模块，所述的 速度模块与编码器模块通讯连接，当编码器模块检测点胶机器人实际转速过快或过慢，速 度模块根据编码器模块检测的结果来调节点胶机器人实际转速。[0034]在本实用新型一个较佳实施例中，所述的伺服控制模块还包括位移模块，所述的 位移模块用于检测点胶机器人是否到达既定位移，如果离既定过远，发出加速指令至控制 器；如果离既定位移过近，则发出减速指令至控制器。[0035]本实用新型的两轴全自动高速点胶机器人伺服控制系统，为了提高运算速度，保 证两轴全自动高速点胶机器人伺服控制系统的稳定性和可靠性，本实用新型在单片的DSP 处理器中引入FPGA处理器，形成基于DSP+FPGA的双核处理器，此处理器把原有的单片机实 现的多控制器系统集中设计，并充分考虑电池在这个系统的作用，实现单一控制器同步控 制两轴的功能，把两轴全自动高速点胶机器人伺服控制系统中工作量最大的两轴伺服系统 交给FPGA处理器控制，充分发挥FPGA处理器数据处理速度较快的特点，而人机界面模块、 路径读取模块、在线输出模块、数据存储模块、I/O控制模块以及图像采集单元等功能交给 DSP处理器控制，这样就实现了 DSP处理器与FPGA处理器的分工，把DSP处理器从繁重的工 作量中解脱出来，抗干扰能力大大增强。
[0036]图1为现有技术中两轴点胶机器人伺服控制系统的原理图；[0037]图2为本实用新型较佳实施例的两轴全自动高速点胶机器人伺服控制系统的原 理图；[0038]图3为图2中处理器单元的方框图；[0039]图4为点胶机器人的速度运动曲线。
具体实施方式
[0040]
以下结合附图对本实用新型的较佳实施例进行详细阐述，以使本实用新型的优点和特征能更易于被本领域技术人员理解，从而对本实用新型的保护范围做出更为清楚明确 的界定。[0041]随着微电子技术和计算机集成芯片制造技术的不断发展和成熟，数字信号处理芯 片(DSP)由于其快速的计算能力，不仅广泛应用于通信与视频信号处理，也逐渐应用在 各种高级的控制系统中。TMS320F2812是美国TI公司推出的C2000平台上的定点32位 DSP处理器，适合用于工业控制，电机控制等，用途广泛。运行时钟也快可达150MHz，处理性 能可达150MIPS，每条指令周期6. 67ns，IO 口丰富，对用户一般的应用来说足够了，两个串 口。具有12位的0 3. 3v的AD转换等。具有片内128kX16位的片内FLASH，18K X 16位 的SRAM，一般的应用系统可以不要外扩存储器。加上独立的算术逻辑单元，拥有强大的数字 信号处理能力。此外，大容量的RAM被集成到该芯片内，可以极大地简化外围电路设计，降 低系统成本和系统复杂度，也大大提高了数据的存储处理能力。[0042]基于现场可编程门阵列(FPGA)及现代电子设计自动化(EDA)技术的硬件实现方 法是最近几年出现了一种全新的设计思想。虽然FPGA本身只是标准的单元阵列，没有一般 的集成电路所具有的功能，但用户可以根据自己的设计需要，通过特定的布局布线工具对 其内部进行重新组合连接，在最短的时间内设计出自己的专用集成电路，这样就减小成本、 缩短开发周期。由于FPGA处理器采用软件化的设计思想实现硬件电路的设计，这样就使得 基于FPGA处理器设计的系统具有良好的可复用和修改性，这种全新的设计思想已经逐渐 应用在高性能的交流驱动控制上，并快速发展。[0043]如图2所示，为本实用新型较佳实施例的两轴全自动高速点胶机器人伺服控制系 统的原理图。本实施例中，两轴全自动高速点胶机器人伺服控制系统包括电池、交流电源、 第一信号处理器、第二信号处理器、处理器单元、图像采集单元、第一高速直流电机、第二高 速直流电机以及点胶机器人。其中，所述电池为锂离子电池，是一种供电装置，为整个系统 的工作提供工作电压。[0044]本实用新型中，所述的第一信号处理器通过交流电源或者电池单独提供电流驱动 所述的处理器单元，所述的处理器单元分别发出第一控制信号和第二控制信号，所述的第 一控制信号和第二控制信号分别控制所述的第二高速直流电机和第一高速直流电机，通过 所述的第一高速直流电机的第二控制信号和通过所述的第二高速直流电机的第一控制信 号经过第二信号处理器合成之后，控制点胶机器人的运动，所述的处理器单元还连接至图 像米集单兀。[0045]本实用新型为克服现有技术中单片机不能满足两轴点胶机器人行走的稳定性和 快速性的要求，舍弃了国产点胶机器人所采用的单片机的工作模式，提供了 DSP+FPGA处理 器的全新控制模式，控制板以FPGA处理器为处理核心，实现数字信号的实时处理，把DSP处 理器从复杂的工作当中解脱出来，实现部分的信号处理算法和响应中断，实现数据通信和 存储实时信号。[0046]请参阅图3，所述处理器单元为一双核处理器，其包括DSP处理器及FPGA处理器， 二者可相互通讯，实时进行数据交换和调用。所述的处理器单元还包括设于DSP处理器和 FPGA处理器的上位机系统和运动控制系统，所述的上位机系统包括人机界面模块、路径读 取模块以及在线输出模块，所述的运动控制系统包括伺服控制模块、数据存储模块、I/O控 制模块以及图像采集单元。其中，DSP处理器用于控制人机界面模块、路径读取模块、在线输出模块、数据存储模块、I/O控制模块以及图像采集单元，FPGA处理器用于控制伺服控制 模块。[0047]上位机系统包括人机界面模块、路径读取模块以及在线输出模块。人机界面模块 包括开始/重启按键及功能选择键；路径读取模块用于读出已经已经预设好的速度，加速 度，位置等参数设置；在线输出模块用于提示点胶机器人的工作状态，比如是点胶机器人工 作过程中或到站状态提示。[0048]运动控制系统包括伺服控制模块、数据存储模块、I/O控制模块以及图像采集单 元。其中，数据存储模块模块为一存储器；1/0控制模块包括RS-232串行接口、ICE端口等； 所述的图像采集单元用于采集点胶的位置和发现故障点的情况；伺服控制模块进一步包括 转换模块、编码器模块、电流模块、速度模块以及位移模块。[0049]其中，所述转换模块包括模拟数字转换器(ADC, Analog to Digital Converter) 及数字模拟转换器(DAC, Digital to Analog Converter);所述编码器模块用于检测点胶 机器人的实际转速，判断是否符合速度要求，是否过快或过慢，并发出控制信号。[0050]所述电流模块与电池和控制器、转换模块连接。转换模块根据电池和控制器的电 流，判断工作功率，并把功率状况反馈至电池，电流模块用于调整电池的供电功率达到点胶 机器人需要的范围。[0051]所述速度模块与编码器模块通讯连接，当编码器模块检测点胶机器人实际转速过 快或过慢，速度模块根据编码器模块检测的结果来调节点胶机器人的实际转速。[0052]所述位移模块检测点胶机器人是否到达既定位移，如果离既定过远，发出加速指 令至控制器；如果离既定位移过近，则发出减速指令至控制器。[0053]对于处理器单元为一双核处理器，在电源打开状态下，点胶机器人先进入自锁状 态，第一高速直流电机和第二高速直流电机同时工作将执行机构(包括胶刷和出胶头)自 动移动到废胶回收处，然后自动打开点胶阀门胶体自动流出，等均匀后自动移动执行结构 到起始点，此时图像采集单元开启，自动校正点胶头与起始点的对准位置，点胶机器人把储 存的实际路径传输参数给控制器中的DSP处理器，DSP处理器把这些环境参数转化为点胶 机器人在指定运动轨迹下第一高速直流电机和第二高速直流电机要运行的距离，DSP处理 器然后与FPGA处理器通讯，FPGA处理器再根据电机电流和光码盘信息处理两个独立电机 的伺服控制，并把处理数据通讯给DSP处理器，由DSP处理器继续处理后续的运行状态。[0054]结合以上描述，上位机系统包括人机界面模块、路径读取模块、在线输出模块等功 能；运动控制系统包括伺服控制模块、数据存储模块、I/o控制模块以及图像采集单元等功 能。其中工作量最大的伺服控制模块交给FPGA处理器控制，其余的包括上位机系统交给 DSP处理器控制，这样就实现了 DSP处理器与FPGA处理器的分工，同时二者之间也可以进行 通讯，实时进行数据交换和调用。[0055]本实用新型中两轴全自动高速点胶机器人伺服控制系统具体的功能实现如下[0056]I)打开电源，自动传送装置把安装在夹具上的加工部件自动传送到工作区域；[0057]2)打开电源，在打开电源瞬间DSP处理器会对电源电压来源进行判断，当确定是 电池供电时，如果电池电压低压的话，将封锁FPGA处理器的PWM波输出，此时第一高速直流 电机和第二高速直流电机不能工作，同时电压传感器将工作，双核控制器会发出低压报警 信号，人机界面提示更换电池；[0058]3)启动点胶机器人自动控制程序，通过控制器的232串口通讯接口输入任务或者 从硬盘装载任务；[0059]4)第一高速直流电机和第二高速直流电机同时工作将执行机构(包括胶刷和出 胶头)移动到废胶回收出，开始开启阀门，然后调整胶体到均匀状态，然后移动执行机构到 起始点上方，此时图像采集单元再次开启，然后通过图像采集结果使得点胶头对准初始位 置，系统开始准备点胶；[0060]5)在出胶信号有效条件下，控制器调出点胶机器人需要行走的路径，然后传输给 FPGA处理器，由FPGA处理器生成点胶机器人开始工作的运动曲线，保证点胶机器人平稳工 作；[0061]6)为了能够驱动两轴点胶机器人运动，本控制系统引入FPGA处理器，由其生成两 轴电机运动的PWM波，但是通过I/O 口与DSP处理器进入实时通讯，由DSP处理器控制其 PWM波形的输出和封锁；[0062]7)在点胶机器人运动过程中，DSP处理器会时刻储存所经过的距离或者是经过 的点胶点，并根据这些距离信息确定对下一个工作点点胶机器人两轴电第一高速直流电机 和第二高速直流电机要运行的距离，DSP处理器然后与FPGA处理器通讯，传输这些参数给 FPGA处理器，然后由FPGA处理器根据第一高速直流电机和第二高速直流电机分别的电流 和光码盘信息生成控制电机运动的速度梯形图，如图4所示，这些梯形图包含的面积就是 点胶机器人第一高速直流电机和第二高速直流电机要运行的距离；[0063]8)在运动过程中如果点胶机器人发现胶点距离求解出现死循环将向DSP处理器 发出中断请求，DSP处理器会对中断做第一时间响应，如果DSP处理器的中断响应没有来得 及处理，点胶机器人的第一高速直流电机和第二高速直流电机将原地自锁；[0064]9)装在第一高速直流电机和第二高速直流电机上的光码盘会输出其位置信号A 和位置信号B，光码盘的位置信号A脉冲和B脉冲逻辑状态每变化一次，FPGA处理器内的位 置寄存器会根据第一高速直流电机和第二高速直流电机的运行方向加I或者是减I ;[0065]10)光码盘的位置信号A脉冲和B脉冲和Z脉冲同时为低电平时，就产生一个位置 信号给FPGA处理器，记录电机的绝对位置，然后换算成点胶机器人在点胶部件中的具体位 置；[0066]11)在运动过程中，如果控制器收到了高速点胶命令，控制器会根据点胶机器人在 点胶部件的具体位置和应该存在的位置，送相应的位置数据等给FPGA处理器，FPGA处理器 根据外围传感信号自动调取相应的PID调节模式，由FPGA处理器计算出点胶机器人的第一 高速直流电机和第二高速直流电机需要更新的PWM控制信号，控制点胶机器人高速点胶；[0067]12)在点胶过程中，如果图像采集单元发现有任何位置的点胶出现问题，数据存储 模块记录下当前位置信息，然后控制器根据点胶机器人在点胶部件的具体位置，送相应的 位置数据等给FPGA处理器，然后由FPGA处理器生成点胶机器人到达更新点需要的实际加 速度、速度和位置信号，然后控制第一高速直流电机和第二高速直流电机进行二次点胶补 偿，然后再回到当初寄存下的位置，重新继续原有的工作；[0068]13)如果点胶机器人在运行过程中遇到突然断电时，电池会自动开启立即对点胶 机器人进行供电，当电机的运动电流超过设定值时，此时控制器会立即封锁FPGA处理器的 PWM波输出，第一高速直流电机和第二高速直流电机停止工作，从而有效地避免了电池大电流放电的发生；[0069]14)为了方便点胶工作系统加入了自动暂停点，如果在点胶过程中读到了自动暂 停点，DSP处理器会通知FPGA处理器生成的PWM波可以使点胶机器人以最大的加速度停车， 使加工过程出现自动暂停并存储当前信息，直到控制器读到再次按下“开始”按钮信息才可 以使FPGA处理器重新工作，并调取存储信息使点胶机器人从自动暂停点可以继续工作；[0070]15)点胶机器人在运行过程会时刻检测电池电压，当系统出现低压时，传感器会通 知控制器开启并发出报警提示，有效地保护了电池；[0071]16)当完成整个加工部件的点胶运动后，点胶阀会停止出胶，然后控制点胶机器人 走出运动轨迹；[0072]17)点胶机器人根据新的工作部件具体位置，重新设定位置零点，等待下一周期新 的工作。[0073]本实用新型两轴全自动高速点胶机器人伺服控制系统具有的有益效果是[0074]1:加入了图形采集单元，可以帮助自动运动控制系统定位和发现故障点，自动化 程度大大提高；[0075]2:由于采用高性能的DSP，使得系统处理速度大大增加，可以很好满足点胶系统 快速性的要求；[0076]3 :在初期运动过程中，由自动装置把点胶阀门推到初始位置，然后图像采集单元 开启，帮助点胶头对准初始位置，使得初始位置定位极其精确。[0077]4 :在运动过程中，充分考虑了电池在这个系统中的作用，基于DSP+FPGA双核控制 器时刻都在对点胶机器人的运行状态进行监测和运算，当遇到交流电源断电时，电池会立 即提供能源，避免了自动点胶系统伺服系统运动的失败，并且在电池提供电源的过程中，时 刻对电池的电流进行观测并保护，避免了大电流的产生，所以从根本上解决了大电流对电 池的冲击，避免了由于大电流放电而引起的电池过度老化现象的发生；[0078]5 由FPGA处处理器处理点胶机器人的两只电机的独立伺服控制，使得控制比较 简单，大大提高了运算速度，解决了现有技术中单片机运行较慢的瓶颈，缩短了开发周期 短，并且系统可移植能力强；[0079]6:基本实现全贴片元器件材料，实现了单板控制，不仅节省了控制板占用空间，而 且有利于点胶机器人体积和重量的减轻；[0080]7 :为了提高运算速度和精度，本点胶机器人采用了高速直流电机替代了传统系统 中常用的步进电机，使得运算精度大大提高；[0081]8 :由于本控制器采用FPGA处理器处理两轴伺服系统全部的数据与算法，把DSP处 理器从繁重的工作量中解脱出来，有效地防止点胶机器人失控，抗干扰能力大大增强；[0082]9 :由于两路电机的控制信号是通过FPGA处理器输出，这样由FPGA处理器可以同 时输出PWM调制信号和方向信号，通过驱动电路可以直接驱动电机，不仅减轻了 DSP处理器 的负担，简化了接口电路，而且省去了 DSP处理器内部编写位置、速度控制程序，以及各种 PID算法的麻烦，使得系统的调试简单，并且实现了两轴伺服控制的同步性；[0083]10:在点胶机器人运行过程中，控制器会对电机的转矩进行在线辨识并利用电机 力矩与电流的关系进行补偿，减少了快速行走时电机转矩抖动对自动点胶机器人动态性能 的影响；[0084]11 :在FPGA处理器内部伺服控制中，集成了多种PID调节模式，可以根据点胶机器 人外围运行情况自动调整其内部的PID参数，轻松实现分段P、ro、PID控制和非线性PID控 制，由于没有单片机参与此运算，使得其运动过程具有一定的自适应的功能，而且运算速度 比专用运动芯片控制的系统高，有利于提高高速点胶系统的点胶速度；[0085]12:由于具有存储功能，这使得点胶机器人掉电后可以轻易的调取已经涂胶好的 路径信息，即使出现故障后也可以轻易的二次点胶；[0086]13:在整个点胶过程中，如果图像采集单元发现有任何位置或任何胶点出现点胶 问题，控制器会对上述位置或点胶点进行二次补偿；[0087]14:由于采用效率更高的高速直流电机，使得系统的能源利用率更高，有利于节约 能源。[0088]以上所述仅为本实用新型的实施例，并非因此限制本实用新型的专利范围，凡是 利用本实用新型说明书及附图内容所作的等效结构或等效流程变换，或直接或间接运用在 其他相关的技术领域，均同理包括在本实用新型的专利保护范围内。
权利要求1.一种两轴全自动高速点胶机器人伺服控制系统，其特征在于，包括电池、交流电源、 第一信号处理器、第二信号处理器、处理器单元、图像采集单元、第一高速直流电机、第二高速直流电机以及点胶机器人，所述的第一信号处理器通过交流电源或者电池单独提供电流驱动所述的处理器单元，所述的处理器单元分别发出第一控制信号和第二控制信号，所述的第一控制信号和第二控制信号分别控制所述的第二高速直流电机和第一高速直流电机， 通过所述的第一高速直流电机的第二控制信号和通过所述的第二高速直流电机的第一控制信号经过第二信号处理器合成之后，控制点胶机器人的运动，所述的处理器单元还连接至图像采集单元。
2.根据权利要求1所述的两轴全自动高速点胶机器人伺服控制系统，其特征在于，所述的处理器单元为一双核处理器，包括DSP处理器、FPGA处理器以及设于DSP处理器和 FPGA处理器的上位机系统和运动控制系统，所述的上位机系统包括人机界面模块、路径读取模块以及在线输出模块，所述的运动控制系统包括伺服控制模块、数据存储模块、I/O控制模块以及图像采集单元，其中，DSP处理器用于控制人机界面模块、路径读取模块、在线输出模块、数据存储模块、I/O控制模块以及图像采集单元，FPGA处理器用于控制伺服控制模块，且DSP处理器及FPGA处理器之间实时进行数据交换和调用。
3.根据权利要求2所述的两轴全自动高速点胶机器人伺服控制系统，其特征在于，所述的伺服控制模块还包括转换模块，所述的转换模块用于把数字信号转换成模拟信号。
4.根据权利要求2所述的两轴全自动高速点胶机器人伺服控制系统，其特征在于，所述的伺服控制模块还包括编码器模块，所述的编码器模块用于检测点胶机器人的实际转速，判断是否符合速度要求，是否过快或过慢，并发出控制信号。
5.根据权利要求2所述的两轴全自动高速点胶机器人伺服控制系统，其特征在于，所述的伺服控制模块还包括电流模块，所述的电流模块用于调整电池的供电功率达到点胶机器人需要的范围。
6.根据权利要求4所述的两轴全自动高速点胶机器人伺服控制系统，其特征在于，所述的伺服控制模块还包括速度模块，所述的速度模块与编码器模块通讯连接，当编码器模块检测点胶机器人实际转速过快或过慢，速度模块根据编码器模块检测的结果来调节点胶机器人实际转速。
7.根据权利要求2所述的两轴全自动高速点胶机器人伺服控制系统，其特征在于，所述的伺服控制模块还包括位移模块，所述的位移模块用于检测点胶机器人是否到达既定位移，如果离既定过远，发出加速指令至控制器；如果离既定位移过近，则发出减速指令至控制器。
专利摘要本实用新型公开了一种两轴全自动高速点胶机器人伺服控制系统，包括电池、交流电源、第一信号处理器、第二信号处理器、处理器单元、图像采集单元、第一高速直流电机、第二高速直流电机以及点胶机器人，所述的第一信号处理器通过交流电源或者电池单独提供电流驱动所述的处理器单元，所述的处理器单元分别发出第一控制信号和第二控制信号，所述的第一控制信号和第二控制信号分别控制所述的第二高速直流电机和第一高速直流电机，通过所述的第一高速直流电机的第二控制信号和通过所述的第二高速直流电机的第一控制信号经过第二信号处理器合成之后，控制点胶机器人的运动，所述的处理器单元还连接至图像采集单元。
文档编号B05C5/00GK202837909SQ201220494139
公开日2013年3月27日 申请日期2012年9月26日 优先权日2012年9月26日
发明者张好明, 王应海, 贡亚丽 申请人:苏州工业园区职业技术学院