基于can环网的模块化焊接机器人控制系统的制作方法

文档序号:10783694阅读:888来源:国知局
基于can环网的模块化焊接机器人控制系统的制作方法
【专利摘要】本实用新型公开了一种基于CAN环网的模块化焊接机器人控制系统,包括示教器、主控制板、伺服电机控制板、伺服驱动器和伺服电机,示教器、主控制板、伺服电机控制板、伺服驱动器和伺服电机之间通过CAN环网进行通讯;示教器生成运动指令,主控制板根据运动指令,通过其内部的核心芯片计算焊接机器人各个轴对应的电机运动的位置、速度和力矩,伺服电机控制板将焊接机器人各个轴对应的电机运动的位置、速度和力矩发送给伺服驱动器,伺服驱动器控制伺服电机完成相应的动作。本实用新型可靠性和实时性好、成本低、安装和维护方便。
【专利说明】
基于CAN环网的模块化焊接机器人控制系统
技术领域
[0001]本实用新型涉及机器人自动化控制领域,特别是涉及一种基于CAN环网的模块化焊接机器人控制系统。
【背景技术】
[0002]随着工业生产对焊接质量和焊接效率要求的不断提高,以及满足改善工人工作环境、降低工人劳动强度的需求,焊接机器人在各种工业焊接场合得到了广泛的应用。多轴型焊接机器人具有机械结构紧凑、灵活性好、占用空间小和实时性好等优点。
[0003]随着工业局域网技术以及大型工业控制网络的发展,焊接自动化系统也正朝着模块化、网络化的方向发展。为适应这一发展趋势,最新的伺服系统都配置了 CAN总线、485总线等总线接口。这些接口的设置,显著地增强了伺服单元与其它控制设备间的互联能力,从而实现了焊接机器人伺服控制系统与控制中心以及其他网络节点之间的通信互联。模块化的设计不仅方便安装和维护,也降低了开发成本。
[0004]CAN通讯因其诸多的优势在机器人控制数据传输中得到了广泛应用,采用基于CAN环网的控制系统结构,可以根据需要便捷的增减控制模块的数量,具有良好的扩展功能;运行过程中,各控制模块互不干扰,具有可重组性、可替代性和高稳定性等特点;CAN环网将各个控制模块连接起来并形成封闭的环形控制网络,这种设计只需要一条主干线,在大大减少线缆数量,降低布线难度的同时,保证了控制网络可靠性,提高了整个系统的稳定性。
[0005]然而,现有技术中的焊接机器人控制系统的可靠性和实时性较差,成本较高,安装和维护难度较大。
【实用新型内容】
[0006]实用新型目的:本实用新型的目的是提供一种可靠性和实时性好、成本低、安装和维护方便的基于CAN环网的模块化焊接机器人控制系统。
[0007]技术方案:为达到此目的,本实用新型采用以下技术方案:
[0008]本实用新型所述的基于CAN环网的模块化焊接机器人控制系统,包括示教器、主控制板、伺服电机控制板、伺服驱动器和伺服电机,示教器、主控制板、伺服电机控制板、伺服驱动器和伺服电机之间通过CAN环网进行通讯;示教器生成运动指令,主控制板根据运动指令,通过其内部的核心芯片计算焊接机器人各个轴对应的电机运动的位置、速度和力矩,伺服电机控制板将焊接机器人各个轴对应的电机运动的位置、速度和力矩发送给伺服驱动器,伺服驱动器控制伺服电机完成相应的动作。
[0009]进一步,所述伺服电机控制板上安装有多个CAN智能接口,其中,一个CAN智能接口连接两个伺服驱动器,采用嵌入式软件实现一个CAN通讯周期内的两个伺服驱动器之间的通讯。
[0010]进一步,示教器、主控制板、伺服电机控制板、伺服驱动器和伺服电机均采用全局广播的通信方式,在接收到CAN环网传输的数据时解析数据包的地址,判断是否是发给自己的,如果是则做进一步处理,否则就直接丢弃。
[0011]进一步,所述CAN环网采用单环双向的网络模型。
[0012]有益效果:本实用新型采用基于CAN环网的模块化控制系统,可以根据系统需要,增减伺服电机控制板的数量,便于扩充功能;示教器、主控制板、伺服电机控制板、伺服驱动器和伺服电机各自独立工作,在运行时互不干扰,即使其中一个设备出现故障,由于CAN环网的设计,依旧可以保证系统的正常工作,提高了系统的稳定性和可靠性;采用模块化设计的控制系统开发周期短,故障率低;CAN环网只需要一条主干线,大大减少了线缆数量,提高了系统的实时性,降低了布线难度,节约了开发成本;此外,系统的安装和维护方便,难度小。
【附图说明】
[0013]图1为本实用新型的方法流程图;
[0014]图2为CAN环网的结构不意图;
[0015]图3为伺服电机控制板的CAN智能接口的结构示意图;
[OO10]图4为信号流程图。
【具体实施方式】
[0017]下面结合【具体实施方式】对本实用新型的技术方案作进一步的介绍。
[0018]本实用新型公开了一种基于CAN环网的模块化焊接机器人控制系统,包括示教器、主控制板、伺服电机控制板、伺服驱动器和伺服电机,示教器、主控制板、伺服电机控制板、伺服驱动器和伺服电机之间通过CAN环网进行通讯。示教器生成运动指令,主控制板根据运动指令,通过其内部的核心芯片计算焊接机器人各个轴对应的电机运动的位置、速度和力矩,伺服电机控制板将焊接机器人各个轴对应的电机运动的位置、速度和力矩发送给伺服驱动器,伺服驱动器控制伺服电机完成相应的动作。伺服电机控制板上安装有多个CAN智能接口,如图3所示,其中,一个CAN智能接口连接两个伺服驱动器,采用嵌入式软件实现一个CAN通讯周期内的两个伺服驱动器之间的通讯。
[0019]本系统中的CAN环网是单环双向的网络模型,如图2所示,同时配置适合的控制策略,当环网中任一节点或某处电缆断开时,整个网络依然能够正常通信。机器人各个轴的伺服电机的数据信息通过CAN智能接口发送到CAN环网中,并按两个方向传输。系统各节点采用全局广播的通信方式,支持多点同时进行数据传输,系统各节点在接收到CAN总线的数据时只解析数据包地址,是发给自己的作进一步处理,不是发给自己的直接丢弃,而不用侦听等待某一节点传输完数据,待该节点传输结束后才允许其他节点进行数据传输与通信,提高了系统的实时性和总线利用率。在传输模型中,因为单个节点是同时向两个方向将数据发送到CAN环网上的,当该节点与监控处理设备相连的CAN环网一个方向的链路断开时,待发送数据可以通过另一个方向到达监控节点,避免了单条线路断开时系统瘫痪的危险,从而提高系统的可靠性。
[0020]CAN环网上的节点数是根据焊接机器人各个轴的伺服电机数量决定的,本实用新型采用模块的设计结构,可以根据实际情况扩展CAN节点,以实现扩展系统功能。伺服电机通过伺服驱动器控制,伺服驱动器通过CAN智能接口将数据传送给伺服电机控制板。CAN智能接口安装在电机控制电路板上,一块伺服电机控制板上安装若干个CAN智能接口。为了既节约资源,又保证系统的实时性和稳定性,采用一个CAN接口连接两个伺服驱动器,利用一个嵌入式软件实现在一个CAN通讯周期内完成两个伺服驱动器的通讯。一块伺服电机控制板安装CAN智能接口的数量是有限制的,当达到上限,则需要扩展伺服电机控制板来实现伺服控制和通讯。CAN环网各个节点数据传输的实时性通过伺服电机控制板上的FPGA保证。
[0021]结合图4可知,主控板所负责计算的机器人位置、速度及力矩参数通过CAN总线发给伺服电机控制板,伺服电机控制板中的Micro Blaze IP核通过Bus Bridge将伺服驱动器所需的信息通过CAN总线发给伺服驱动器。其中,伺服电机控制板中的Micro Blaze IP核是在统一时刻将各个伺服驱动器所需的信息通过CAN通信打包发送的,比传统的逐一发送具有更尚的实时性。
[0022]本实用新型还公开了一种基于CAN环网的模块化焊接机器人控制方法,如图1所示,包括以下的步骤:
[0023]S1:示教器发出运动指令;
[0024]S2:主控制板按照运动指令计算焊接机器人各个轴对应的电机运动的位置、速度和力矩,并通过CAN环网传输至伺服电机控制板;
[0025]S3:伺服电机控制板将从主控制板得到的焊接机器人各个轴对应的电机运动的位置、速度和力矩通过CAN环网传输至伺服驱动器;
[0026]S4:伺服驱动器将控制信息通过CAN环网传输至伺服电机;
[0027]S5:伺服电机按照控制信息完成相应的动作。
【主权项】
1.一种基于CAN环网的模块化焊接机器人控制系统,其特征在于:包括示教器、主控制板、伺服电机控制板、伺服驱动器和伺服电机,示教器、主控制板、伺服电机控制板、伺服驱动器和伺服电机之间通过CAN环网进行通讯;示教器生成运动指令,主控制板根据运动指令,通过其内部的核心芯片计算焊接机器人各个轴对应的电机运动的位置、速度和力矩,伺服电机控制板将焊接机器人各个轴对应的电机运动的位置、速度和力矩发送给伺服驱动器,伺服驱动器控制伺服电机完成相应的动作。2.根据权利要求1所述的基于CAN环网的模块化焊接机器人控制系统,其特征在于:所述伺服电机控制板上安装有多个CAN智能接口,其中,一个CAN智能接口连接两个伺服驱动器,采用嵌入式软件实现一个CAN通讯周期内的两个伺服驱动器之间的通讯。3.根据权利要求1所述的基于CAN环网的模块化焊接机器人控制系统,其特征在于:示教器、主控制板、伺服电机控制板、伺服驱动器和伺服电机均采用全局广播的通信方式,在接收到CAN环网传输的数据时解析数据包的地址,判断是否是发给自己的,如果是则做进一步处理,否则就直接丢弃。4.根据权利要求1所述的基于CAN环网的模块化焊接机器人控制系统,其特征在于:所述CAN环网采用单环双向的网络模型。
【文档编号】B25J9/16GK205466213SQ201620035935
【公开日】2016年8月17日
【申请日】2016年1月14日
【发明人】王富林, 徐晗, 付磊
【申请人】南京熊猫电子股份有限公司, 南京熊猫电子装备有限公司, 南京熊猫仪器仪表有限公司
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1