一种五轴中速全自动锡焊机器人伺服控制系统技术方案

本发明专利技术公开了一种五轴中速全自动锡焊机器人伺服控制系统，包括电源、控制单元、多个电机和锡焊机器人，电源与控制单元连接，控制单元包括DSP和LM629运动控制芯片，LM629运动控制芯片生成脉冲宽度调制波信号并发送给多个电机，其中5个电机控制锡焊机器人的五自由度伺服运动，一个电机控制锡焊机器人的出锡量。通过上述方式，本发明专利技术提供的一种五轴中速全自动锡焊机器人伺服控制系统，LM629把DSP从复杂的伺服算法中解脱出来，大大提高了运算速度，也使得所述控制器设计简单，缩短了开发周期短，在整个锡焊过程中充分考虑了锡焊机器人的运行速度和烙铁头温度对出锡系统参数的影响，保证了焊接过程的完成。

【技术实现步骤摘要】

本专利技术涉及锡焊机器人
，特别是涉及一种五轴中速全自动锡焊机器人伺服控制系统。
技术介绍
众所周知，锡焊加工是一种劳动条件差、烟尘多、热辐射大、危险性高的工作，还要求焊工要有熟练的操作技能、丰富的实践经验、稳定的焊接水平。同时焊接工的焊接技能、焊接速度和情绪波动对焊接质量有一定影响，也无法量化每天使用焊接辅料，因此对工厂来说人工极大的提高了生产成本并延长了焊接时间,这使新型的自动化焊接生产将成为新世纪接受市场挑战的重要方式。一般锡焊加工需要五自由度锡焊机器人，一台完整的五自由度锡焊机器人基本包括电机、算法和微处理器几个部分，但现有的自动锡焊机器人长时间运行存在着很多安全问题: (O自动锡焊机器人的电源采用的是一般交流电源整流后的直流电源，当突然停电时会使整个锡焊运动失败。(2)锡焊机器人的主控芯片采用的多是8位的单片机，计算能力不够，导致焊接系统运行速度较慢。由于自动锡焊机器人在焊点间的频繁点焊，要频繁的刹车和启动，加重了单片机的工作量，单一的单片机无法满足自动锡焊机器人快速启动和停止的要求。由于受周围环境不稳定因素干扰，单片机控制器经常会出现异常，引起锡焊机器人失控，抗干扰能力较差。由于受单片机容 量和算法影响，普通锡焊机器人对已经经过的焊点信息没有存储，当遇到掉电情况或故障重启时所有的信息将消失，这使得整个锡焊过程要重新开始或者人工更新路径信息。对于五自由度锡焊机器人的点焊过程来说，一般要求控制其轨迹运动的五个电机的PWM控制信号要同步，由于受单片机计算能力的限制，单一单片机伺服系统很难满足这一条件。(3)由于受单片机容量和算法影响，普通锡焊机器人对已经经过的焊接点信息没有存储，当遇到掉电情况或故障重启时所有的信息将消失，这使得整个锡焊过程要重新开始或者人工更新路径信息。在焊接的时候虽然可根据被焊物体的焊点大小来调整送锡量的大小，但没有考虑焊点的温度，导致焊点不一致。(4)作为自动锡焊机器人的执行电机多采用步进电机，经常会遇到丢失脉冲造成电机失步现象发生，导致系统对于焊点出锡量不一致。步进电机使得机体发热比较严重，有的时候需要对电机本体进行散热。步进电机使系统运转的机械噪声大大增加，不利于环境保护。步进电机的本体一般都是多相结构，控制电路需要采用多个功率管，使得控制电路相对比较复杂，并且增加了控制器价格，并且由于多相之间的来回切换，使得系统的脉动转矩增大，不利于系统动态性能的提高。(5)在焊接的时候虽然可根据被焊物体的焊点大小来调整送锡量的大小，但是没有考虑焊点的温度，导致焊点不一致。在锡焊过程中，忽略了对烙铁头的清洗，经常导致因为烙铁头上的残留焊锡而产生焊接不良或焊点污秽的情况发生。由于大量采用体积较大的插件元器件，使得伺服控制器的体积较大。
技术实现思路
本专利技术主要解决的技术问题是提供一种五轴中速全自动锡焊机器人伺服控制系统，能提高运算速度，保证锡焊机器人系统的稳定性和可靠性。为解决上述技术问题，本 专利技术采用的一个技术方案是:提供一种五轴中速全自动锡焊机器人伺服控制系统，包括电源、控制单元、第一电机、第二电机、第三电机、第四电机、第五电机、第六电机和锡焊机器人，所述电源与所述控制单元连接，所述控制单元包括数字信号处理芯片和LM629运动控制芯片，所述LM629运动控制芯片生成脉冲宽度调制波信号并发送给所述第一电机、所述第二电机、所述第三电机、所述第四电机、所述第五电机和所述第六电机，所述第一电机、所述第二电机、所述第三电机、所述第四电机和所述第五电机分别与所述锡焊机器人上的五个位置连接，所述第六电机与所述锡焊机器人上的出锡位置连接。在本专利技术一个较佳实施例中，所述数字信号处理芯片与人机界面单元、路径读取单元、轨迹参数预设单元、温度检测单元、数据存储单元和I/o控制单元连接。在本专利技术一个较佳实施例中，所述第一电机、所述第二电机、所述第三电机、所述第四电机、所述第五电机和所述第六电机是装有512线光电编码盘的永磁直流伺服电机。在本专利技术一个较佳实施例中，所述电源为交流电源或锂离子电池。本专利技术的有益效果是:本专利技术的五轴中速全自动锡焊机器人伺服控制系统，采用基于DSP和LM629的双核控制模式，LM629把DSP从复杂的伺服算法中解脱出来，大大提高了运算速度，也使得所述控制器设计简单，缩短了开发周期短，在整个锡焊过程中充分考虑了锡焊机器人的运行速度和烙铁头温度对出锡系统参数的影响，保证了焊接过程的完成。附图说明图1是本专利技术现有技术中锡焊机器人伺服控制系统的原理 图2是本专利技术五轴中速全自动锡焊机器人伺服控制系统一较佳实施例的原理 图3是图2中所述五轴中速全自动锡焊机器人伺服控制系统的控制器的程序框 图4是图2中所述五轴中速全自动锡焊机器人伺服控制系统的系统框图。具体实施例方式下面结合附图对本专利技术的 较佳实施例进行详细阐述，以使本专利技术的优点和特征能更易于被本领域技术人员理解，从而对本专利技术的保护范围做出更为清楚明确的界定。数字信号处理芯片(DSP)具有快速的计算能力，其中TMS320F2812是美国TI公司推出的C2000平台上的定点32位DSP芯片。DSP运行时钟可达150MHz，处理性能可达150MIPS，每条指令周期6.67ns，IO 口丰富，对用户的一般应用足够，具有12位的0 3.3v的AD转换、128kX16位的片内FLASH和18KX16位的SRAM，一般的应用系统可以不要外扩存储器。具有独立的算术逻辑单元，拥有强大的数字信号处理能力。此外，大容量的RAM被集成到该芯片内，可以极大地简化外围电路设计，降低系统成本和系统复杂度，也大大提高了数据的存储处理能力。LM629是National semiconductor生产的一款用于精密运动控制的专用芯片，有24脚和28脚二种表面安装式封装，在一个芯片内集成了数字式运动控制的全部功能，使得设计一个快速、准确的运动控制系统的任务变得轻松、容易，它的工作频率为6MHz和8MHz，工作温度范围为_40°C 85°C，使用5V电源，具有32位的位置、速度和加速度存器、8位分辨率的PWM脉宽调制输出、16位可编程数字PID控制器和内部的梯形速度发生器。LM629运动控制芯片可实时修改速度、目标位置和PID控制参数，能实时可编程中断、可编程微分项采样间隔和对增量码盘信号进行四倍频，可设置于速度或位置伺服两种工作状态。请参阅图2，本专利技术提供了一种五轴中速全自动锡焊机器人伺服控制系统，包括电源、控制单元、电机X、电机Z、电机U、电机R、电机W、电机Y和锡焊机器人。所述电源与所述控制单元连接，所述电源为交流电源或锂离子电池，当伺服控制系统遇到交流电源断电时，锂离子电池会立即提供能源，避免了锡焊系统伺服系统运动的失败，且在电池提供电源的过程中，时刻对电池的电流进行观测并保护，避免了大电流的产生，从根本上解决了大电流对锂离子电池的冲击。所述控制单元包括数字信号处理芯片和LM629运动控制芯片，所述LM629运动控制芯片生成脉冲宽度调制波信号并发送给所述电机X、所述电机Z、所述电机U、所述电机R、所述电机W和所述电机Y，所述电机X、所述电机Z、所述电机U、所述电机R和所述电机W控制所述锡焊机器人的五自由度伺服运动，所述电机Y控制所述锡焊机器人的出锡量。所本文档来自技高网...

【技术保护点】
一种五轴中速全自动锡焊机器人伺服控制系统，其特征在于，包括电源、控制单元、第一电机、第二电机、第三电机、第四电机、第五电机、第六电机和锡焊机器人，所述电源与所述控制单元连接，所述控制单元包括数字信号处理芯片和LM629运动控制芯片，所述LM629运动控制芯片生成脉冲宽度调制波信号并发送给所述第一电机、所述第二电机、所述第三电机、所述第四电机、所述第五电机和所述第六电机，所述第一电机、所述第二电机、所述第三电机、所述第四电机和所述第五电机分别与所述锡焊机器人上的五个位置连接，所述第六电机与所述锡焊机器人上的出锡位置连接。

【技术特征摘要】

【专利技术属性】
技术研发人员：张好明，王应海，
申请(专利权)人：苏州工业园区职业技术学院，
类型：发明
国别省市：