CN111213099B - 一种运动控制卡、运动控制系统、机器人系统及数控机床 - Google Patents

一种运动控制卡、运动控制系统、机器人系统及数控机床 Download PDF

Info

Publication number
CN111213099B
CN111213099B CN201780091087.XA CN201780091087A CN111213099B CN 111213099 B CN111213099 B CN 111213099B CN 201780091087 A CN201780091087 A CN 201780091087A CN 111213099 B CN111213099 B CN 111213099B
Authority
CN
China
Prior art keywords
module
motion control
upper computer
servo driver
control card
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201780091087.XA
Other languages
English (en)
Other versions
CN111213099A (zh
Inventor
姚守强
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shenzhen A&E Intelligent Technology Institute Co Ltd
Original Assignee
Shenzhen A&E Intelligent Technology Institute Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Shenzhen A&E Intelligent Technology Institute Co Ltd filed Critical Shenzhen A&E Intelligent Technology Institute Co Ltd
Publication of CN111213099A publication Critical patent/CN111213099A/zh
Application granted granted Critical
Publication of CN111213099B publication Critical patent/CN111213099B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
    • G05B19/414Structure of the control system, e.g. common controller or multiprocessor systems, interface to servo, programmable interface controller

Landscapes

  • Engineering & Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Numerical Control (AREA)

Abstract

公开了一种运动控制卡、以及使用该运动控制卡的运动控制系统、机器人系统和数控机床,该运动控制卡包括:数字信号处理器(101)、上位机连接模块(102)、RTEX总线模块(103)、复位模块(104)以及电源模块(105),数字信号处理器(101)通过上位机连接模块(102)从上位机(2)获取经解析的运动控制命令,并根据通过RTEX总线模块获取的伺服驱动器(3)的不同状态将运动控制命令通过RTEX总线模块发送至伺服驱动器;或者,数字信号处理器(101)通过RTEX总线模块接收来自伺服驱动器的运行状态信息并通过上位机连接模块(102)发送至上位机(2),能够实现对支持RTEX总线型伺服驱动器的控制。

Description

一种运动控制卡、运动控制系统、机器人系统及数控机床
技术领域
本申请实施例涉及机械自动化技术领域,尤其涉及一种运动控制卡、运动控制系统、机器人系统及数控机床。
背景技术
开放式数控系统,采用了在工控机主板的插槽插入运动控制板卡的结构,具有架构灵活、可移植性强、可扩展性强等优势,近年来获得了极大的发展。为了保证控制系统的高实时性,需要选用匹配的传输总线,使得控制系统的实时性不被传输部分局限。
随着以太网技术的迅猛发展,以太网开始被应用在越来越多的工业领域。在国内外伺服技术都在向以太网总线化发展的背景下,日本松下公司发布的RTEX高速实时以太网通讯协议,成为新一代数控系统的控制总线,具有拓扑结构灵活、抗干扰能力优异以及配线成本低廉等优点。支持RTEX总线型伺服驱动器使得多轴控制系统的总线连接方式得以简易实现,并且成本低廉。
但是现有的运动控制卡通常为支持MIII总线(并行总线)或CAN总线(控制器局域网总线)的运动控制卡,无法实现对支持RTEX总线型伺服驱动器的控制,不利于降低数控系统的成本。
发明内容
本发明提供一种运动控制卡、运动控制系统、机器人系统及数控机床,用于解决现有运动控制卡无法实现对支持RTEX总线型伺服驱动器的控制的问题。
本发明实施例的一方面提供了一种运动控制卡,包括:
数字信号处理器、上位机连接模块、RTEX总线模块、复位模块以及电源模块;
所述数字信号处理器分别与所述上位机连接模块、所述RTEX总线模块、所述复位模块以及所述电源模块相连;
所述电源模块用于为所述运动控制卡供电;
所述复位模块用于对所述运动控制卡进行复位;
所述上位机连接模块用于与上位机进行通信连接;
所述RTEX总线模块用于与伺服驱动器进行通信连接;
所述数字信号处理器通过所述上位机连接模块从所述上位机获取经解析的运动控制命令,并根据通过所述RTEX总线模块获取的所述伺服驱动器的不同状态将所述运动控制命令通过所述RTEX总线模块发送至所述伺服驱动器;或者,所述数字信号处理器通过所述RTEX总线模块接收来自所述伺服驱动器的运行状态信息并通过所述上位机连接模块发送至所述上位机。
结合第一方面,在第一方面的第一种可能的实现方式中,所述上位机连接模块包括USB功能模块和/或PCI功能模块;所述USB(通用串行总线)功能模块用于连接示教器;所述PCI(外围器件互联)功能模块用于连接工控机。
结合第一方面或第一方面的第一种可能的实现方式,在第一方面的第二种可能的实现方式中,所述数字信号处理器包括:
上位机通讯模块、状态机控制模块以及RTEX总线通讯模块;
所述上位机通讯模块分别与所述上位机连接模块和所述状态机控制模块相连,所述状态机控制模块与所述RTEX总线通讯模块相连,所述RTEX总线通讯模块与所述RTEX总线模块相连;
所述上位机通讯模块用于接收上位机解析后的控制命令,并将控制命令发送给状态机控制模块;
所述状态机控制模块用于以轮询的方式接收上位机通过上位机通讯模块发送的解析后的控制命令,根据所述伺服驱动器的不同状态,以中断的方式将所述控制命令通过RTEX总线通讯模块发送到所述伺服驱动器中;
所述RTEX总线通讯模块用于接收所述状态机控制模块发送的控制命令,并将所述控制命令进行封装后发送给所述RTEX总线模块。
结合第一方面的第二种可能的实现方式,在第一方面的第三种可能的实现方式中,所述RTEX总线通讯模块还用于接收所述RTEX总线模块发送的所述伺服驱动器的运行状态信息,并对所述运行状态信息进行解析,发送给所述状态机控制模块;
所述状态机控制模块还用于以中断的方式获取来自所述RTEX总线通讯模块的所述伺服驱动器的运行状态信息,并将所述运行状态信息发送给所述上位机通讯模块;
所述上位机通讯模块还用于接收所述状态机控制模块发送的所述伺服驱动器的运行状态信息,并将所述运行状态信息发送至所述上位机。
结合第一方面、第一方面的第一种可能的实现方式、第一方面的第二种可能的实现方式和第一方面的第三种可能的实现方式之中任意一种,在第一方面的第四种可能的实现方式中,所述运动控制卡还包括串口模块,所述串口模块与所述数字信号处理器相连,并且与数字量输入输出模块进行通信。
结合第一方面的第四种可能的实现方式,在第一方面的第五种可能的实现方式中,所述数字信号处理器还包括串口通讯模块,所述串口通讯模块分别与所述状态机控制模块以及所述串口模块相连。
结合第一方面、第一方面的第一种可能的实现方式、第一方面的第二种可能的实现方式、第一方面的第三种可能的实现方式、第一方面的第四种可能的实现方式和第一方面的第五种可能的实现方式之中任意一种,在第一方面的第六种可能的实现方式中,所述数字信号处理器还包括安全逻辑处理模块,所述安全逻辑处理模块与所述状态机控制模块相连,用于当所述伺服驱动器或者数字量输入输出模块出现故障或者通讯故障时,针对故障进行安全处理。
结合第一方面、第一方面的第一种可能的实现方式、第一方面的第二种可能的实现方式、第一方面的第三种可能的实现方式、第一方面的第四种可能的实现方式、第一方面的第五种可能的实现方式和第一方面的第六种可能的实现方式之中任意一种,在第一方面的第七种可能的实现方式中,所述上位机通讯模块包括对外应用程序编程接口API接口函数单元,所述对外API接口函数单元用于对外提供可供调用的API接口函数,所述API接口函数包括用于获取伺服驱动器状态的函数、用于选择伺服驱动器运行状态的函数以及用于写入伺服驱动器位置数据的函数。
结合第一方面、第一方面的第一种可能的实现方式、第一方面的第二种可能的实现方式、第一方面的第三种可能的实现方式、第一方面的第四种可能的实现方式、第一方面的第五种可能的实现方式、第一方面的第六种可能的实现方式和第一方面的第七种可能的实现方式之中任意一种,在第一方面的第八种可能的实现方式中,所述数字信号处理器还包括远程通讯模块,所述远程通讯模块与所述对外API接口函数单元相连,用于通过以太网口接收远程的升级程序,并根据所述升级程序对固件程序进行升级。
结合第一方面的第八种可能的实现方式,在第一方面的第九种可能的实现方式中,所述远程通讯模块还用于获取固件程序内的日志文件,并通过所述上位机通讯模块发送至所述上位机。
本发明实施例的第二方面提供了一种运动控制系统,包括:
本发明实施例的第一方面提供的上述任意一种运动控制卡,与所述运动控制卡的上位机连接模块相连的上位机,以及与所述运动控制卡的RTEX总线模块相连的伺服驱动器。
结合第二方面,在第二方面的第一种可能的实现方式中,所述上位机包括工控机和/或示教器。
结合第二方面或者第二方面的第一种可能的实现方式,在第二方面的第二种可能的实现方式中,所述运动控制系统还包括与所述运动控制卡的串口模块相连的数字量输入输出模块。
结合第二方面、第二方面的第一种可能的实现方式和第二方面的第二种可能的实现方式之中任意一种,在第二方面的第三种可能的实现方式中,所述数字量输入输出模块为可编程逻辑控制器的数字量输入输出模块。
本发明实施例的第三方面提供了一种机器人系统,包括:
机器人主体、本发明实施例的第一方面提供的上述任意一种运动控制卡,与所述运动控制卡的上位机连接模块相连的示教器,以及与所述运动控制卡的RTEX总线模块相连的伺服驱动器。
本发明实施例的第四方面提供了一种数控机床,包括:
机床本体、本发明实施例的第一方面提供的上述任意一种运动控制卡,与所述运动控制卡的上位机连接模块相连的工控机,以及与所述运动控制卡的RTEX总线模块相连的伺服驱动器。
本申请实施例提供的运动控制卡包括数字信号处理器、上位机连接模块、RTEX总线模块、复位模块以及电源模块,运动控制卡的数字信号处理器通过所述上位机连接模块从所述上位机获取经解析的运动控制命令,并根据通过所述RTEX总线模块获取的所述伺服驱动器的不同状态将所述运动控制命令通过所述RTEX总线模块发送至所述伺服驱动器;或者,所述数字信号处理器通过所述RTEX总线模块接收来自所述伺服驱动器的运行状态信息并通过所述上位机连接模块发送至所述上位机,能够实现对支持RTEX总线型伺服驱动器的控制,以降低成本。
附图说明
图1是本发明运动控制卡一个实施例示意图;
图2是本发明运动控制卡另一个实施例示意图;
图3是本发明运动控制卡另一个实施例示意图;
图4是本发明运动控制卡中数字信号处理器一个实施例示意图;
图5是本发明运动控制卡中数字信号处理器另一个实施例示意图;
图6是本发明运动控制卡中数字信号处理器的逻辑框图;
图7是本发明运动控制系统一个实施例示意图;
图8是本发明运动控制系统另一个实施例示意图;
图9是本发明机器人系统一个实施例示意图;
图10是本发明数控机床一个实施例示意图。
具体实施方式
本发明实施例提供了一种运动控制卡、运动控制系统、机器人系统及数控机床,用于实现对支持RTEX总线型伺服驱动器的控制,以降低成本。
为了使本技术领域的人员更好地理解本发明方案,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分的实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都应当属于本发明保护的范围。
本发明的说明书和权利要求书及上述附图中的术语“第一”、“第二”、“第三”、“第四”等(如果存在)是用于区别类似的对象,而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换,以便这里描述的实施例能够以除了在这里图示或描述的内容以外的顺序实施。此外,术语“包括”和“具有”以及他们的任何变形,意图在于覆盖不排他的包含,例如,包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元,而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
为便于理解,下面对本发明实施例中的具体流程进行描述,请参阅图1,本发明实施例中运动控制卡1一个实施例包括:
数字信号处理器101、上位机连接模块102、RTEX(高速实时以太网通讯协议)总线模块103、复位模块104以及电源模块105;
数字信号处理器101分别与上位机连接模块102、RTEX总线模块103、复位模块104以及电源模块105相连;
电源模块105用于为运动控制卡1供电;
复位模块104用于对运动控制卡1进行复位;
上位机连接模块102用于与上位机进行通信连接;
RTEX总线模块103用于与伺服驱动器进行通信连接;
数字信号处理器101通过上位机连接模块102从上位机获取经解析的运动控制命令,并根据通过RTEX总线模块103获取的伺服驱动器的不同状态将运动控制命令通过RTEX总线模块103发送至伺服驱动器;或者,数字信号处理器101通过RTEX总线模块103接收来自伺服驱动器的运行状态信息并通过上位机连接模块102发送至上位机,能够实现对支持RTEX总线型伺服驱动器的控制,以降低成本。
本发明实施例中的运动控制卡以数字信号处理器101为核心,具体的,作为举例,可以选用TMS320C6205芯片,在实际使用中也可以选用其他型号的芯片,此处不做限定。
其中,上位机连接模块102可以为USB(通用串行总线)功能模块(图中未标识出),或者为PCI(外围器件互联)功能模块,或者包括USB功能模块和PCI功能模块。USB功能模块用于连接示教器;PCI功能模块用于连接工控机。在本发明实施例中,以上位机连接模块102为PCI功能模块1021为例进行说明。
PCI功能模块1021用于负责与工控机的连接,完成来自工控机的命令接收和伺服驱动器的运行状态信息的发送。选用的TMS320C6205芯片自带PCI(外围器件互联)电路,所以对于PCI功能模块1021的设计可以直接使用数字信号处理器101的电路。并且在外围添加BUFFER(缓冲器)可以增强其驱动能力,同时添加EEPROM(电可擦除只读存储器),用来存放对于PCI的PID(产品识别码)和VID(供应商编号)等信息,PCI的PID和VID等信息用于编写板卡的驱动。
RTEX总线模块103用于与伺服驱动器进行通信连接,RTEX总线模块103可以选用RTEX协议芯片MNM1221来实现总线的物理层功能,然后通过MII接口(介质独立接口)连接PHY(物理层)芯片RTL8201,最后通过隔离变压器对外提供两个RJ45接口(标准8位模块化接口),分别负责发送数据和接收数据。
复位模块104用于对运动控制卡中的电路进行复位,具体的,复位模块104可以对数字信号处理器101(TMS320C6205)、RTEX协议芯片(MNM1221)、PHY芯片(RTL8201)进行复位,作为举例,在本发明实施例中,复位模块104可以选用TPS3808G01芯片。
电源模块105用于为运动控制卡供电,作为举例,可以选用TPS54325芯片。整个运动控制卡的电路可以采用基于PCI的供电方式,从PCI获取5V板级电源,然后通过TPS54325芯片,将5V电源转换板子所需要的内核电压1.5V和外围电压3.3V。对于1.5V和3.3V电压的上电时序通过复位电路进行控制,先产生1.5V电压,然后在产生3.3V电压。
进一步的,本实施例中的运动控制卡1还可以包括外围存储模块106,外围存储模块106可以包括SDRAM(同步动态随机存储器)和Flash(闪存)。Flash可以用来存储固件程序,整个系统从Flash启动,作为举例,可以选用ST39VF1601芯片。SDRAM用来存放程序运行过程中的程序以及数据,包括数字信号处理器101与上位机的命令和运行状态信息,本电路中选用MT48LC4M32B。
请参阅图2,以上位机连接模块102为工控机为例,本发明实施例中运动控制卡1另一个实施例包括:
数字信号处理器101、PCI功能模块1021、RTEX总线模块103、复位模块104、电源模块105、外围存储模块106以及串口模块107。
串口模块107与数字信号处理器101相连,并且与数字量输入输出模块进行通信。作为举例,串口模块可以提供RS485硬件电路,在应用层实现Modbus标准通讯协议,实现Modbus主站功能,能够与支持Modbus协议的数字量输入输出模块,优选的,与支持Modbus协议的PLC IO设备直接进行通讯。优选的,使用TMS320C6205的McBSP接口(多通道缓冲串行口)模拟UART(通用异步收发传输器)接口,能够省掉专门的UART接口芯片,节省了成本。同时,串口模块107还可以对外提供RS232接口(异步传输标准接口),用来做调试输出使用。
需要说明的是,本发明中编号相同的器件或模块具有相同的含义,因此此处对于本发明实施例中与前述图1对应的实施例中编号相同的模块不再赘述。
作为举例,图2对应的运动控制卡的总体电路设计可以如图3所示。
运动控制卡1用于将上位机发送的控制命令转发至与运动控制卡1相连的各个伺服驱动器,从而使得各个伺服驱动器能及时对来自上位机的控制命令进行响应。此外,运动控制卡1还用于将来自各个伺服驱动器的运行状态信息转发给上位机,以使得上位机能及时显示各个伺服驱动器的状态。运动控制卡1的上述职能主要通过数字信号处理器101来实现。请参阅图4,本发明数字信号处理器101的一个实施例包括:
上位机通讯模块1011、状态机控制模块1012以及RTEX总线通讯模块1013;
上位机通讯模块1011分别与上位机连接模块102和状态机控制模块1012相连,状态机控制模块1012与RTEX总线通讯模块1013相连,RTEX总线通讯模块1013与RTEX总线模块103相连;
上位机通讯模块1011用于接收上位机解析后的控制命令,并将控制命令发送给状态机控制模块1012;
状态机控制模块1012用于以轮询的方式接收上位机通过上位机通讯模块1011发送的解析后的控制命令,根据伺服驱动器的不同状态,以中断的方式将控制命令通过RTEX总线通讯模块1013发送到伺服驱动器中;
RTEX总线通讯模块1013用于接收状态机控制模块1012发送的控制命令,并将控制命令进行封装后发送给RTEX总线模块103,从而使得RTEX总线模块103将控制命令发送给与之相连的伺服驱动器,进而使得伺服驱动器根据接收到的控制命令进行相应的操作。
为了执行将伺服驱动器发送的运行状态信息发送至上位机,数字信号处理器101中的各个模块还需具有如下功能:
RTEX总线通讯模块1013还用于接收RTEX总线模块103发送的伺服驱动器的运行状态信息,并对运行状态信息进行解析,发送给状态机控制模块1012;
状态机控制模块1012还用于以中断的方式获取来自RTEX总线通讯模块103的伺服驱动器的运行状态信息,并将运行状态信息发送给上位机通讯模块1011;
上位机通讯模块1011还用于接收状态机控制模块1012发送的伺服驱动器的运行状态信息,并将运行状态信息发送至上位机。
优选的,数字信号处理器101还可以包括安全逻辑处理模块1014,安全逻辑处理模块1014与状态机控制模块1012相连,用于当伺服驱动器或者数字量输入输出模块出现故障或者通讯故障时,针对故障进行安全处理。具体的,当伺服驱动器故障时,安全逻辑处理模块1014可以主动给伺服驱动器发送停机指令,从而使得伺服驱动器给电机断电并停止驱动器的工作,等待进一步对故障进行处理;当通讯故障时,可以主动对内部芯片进行复位并重新连接,如果连接不上,可以向上位机上报通讯故障,等待进一步检测处理。
请参阅图5,本发明数字信号处理器101的另一个实施例包括:
上位机通讯模块1011、状态机控制模块1012以及RTEX总线通讯模块1013、安全逻辑处理模块1014、串口通讯模块1015、远程通讯模块1016。
其中,串口通讯模块1015分别与状态机控制模块1012以及串口模块107相连,用于实现标准的Modbus通讯协议,和串口模块107一起负责与支持Modbus协议的PLC IO设备(可编程逻辑控制器的输入输出设备)进行通讯。
优选的,上位机通讯模块1011可以包括对外API接口函数(应用程序编程接口)单元10111,对外API接口函数单元10111用于对外提供可供调用的API接口函数10111,实现通过API接口函数对支持RTEX总线伺服驱动器以及支持Modbus总线协议PLC IO设备的控制。其中,API接口函数包括用于获取伺服驱动器状态的函数、用于选择伺服驱动器运行状态的函数以及用于写入伺服驱动器位置数据的函数。同时,API接口函数中还可以对外提供标准算法的回调函数,上位机软件开发人员可以将算法核心部分放到上位机软件中实施。
设置对外API接口函数单元10111的优点在于,可以使得本发明提供的运动控制卡1的开放性更好、运行速度更高。具体的,在本发明运动控制卡1中运行的插补、前瞻等算法可以通过对外API函数,以回调函数的形式开放给上位机软件开发人员,对于软件开发人员而言,能够将核心算法自行开发,提高了开放性,同时由于运动控制卡功能简单,其支持的插补周期等指标可以做到更高。
数字信号处理器101还设有远程通讯模块1016,远程通讯模块1016与对外API接口函数单元10111相连,用于通过以太网口接收远程的升级程序,并根据升级程序对固件程序进行升级,方便对固件程序的维护与更新。
远程通讯模块1016还可以用于获取固件程序内的日志文件,并通过上位机通讯模块1011发送至上位机,方便现场出现异常时进行异常检查。
以图5对应的实施例中的数字信号处理器101为例,请参阅图6,为本发明运动控制卡中DSP(数字信号处理)芯片的逻辑框图。
上面对本发明实施例中的运动控制卡进行了描述,下面对本发明实施例中的运动控制系统进行描述。
请参阅图7,本发明运动控制系统一个实施例包括:
运动控制卡1、上位机2以及伺服驱动器3,运动控制卡1分别与上位机2和伺服驱动器3相连。
其中,运动控制卡1可以包括数字信号处理器101、上位机连接模块102、RTEX总线模块103、复位模块104、电源模块105以及外围存储模块106,上位机连接模块102、RTEX总线模块103、复位模块104、电源模块105以及外围存储模块106分别与数字信号处理器101相连。上位机2与上位机连接模块102相连,伺服驱动器3与RTEX总线模块103相连,RTEX总线模块103可支持的控制轴数多并且可以扩展,可以与多个伺服驱动器3相连,图中以三个伺服驱动器3为例。
数字信号处理器101包括上位机通讯模块1011、状态机控制模块1012以及RTEX总线通讯模块1013。
运动控制卡1、上位机2以及伺服驱动器3三者间的数据通讯过程主要涉及上位机控制命令的通讯和伺服驱动器运行状态信息的通讯。
运动控制卡1、上位机2以及伺服驱动器3三者间的控制命令通讯的具体流程包括:
上位机2获取用户的控制命令并将该控制命令进行解析,再将解析后的控制命令发送给运动控制卡1;运动控制卡1接收上位机2发送的控制命令后,将控制命令转发给伺服驱动器3;伺服驱动器3接收控制命令并执行该控制命令。
运动控制卡1、上位机2以及伺服驱动器3三者间的运行状态信息的通讯包括:
运动控制卡1接收伺服驱动器3发送的运行状态信息之后,对其进行解封装与解析,之后将解析后的运行状态信息发送给上位机2。
运动控制卡1伺服驱动器3发送的运行状态信息发送给上位机2的步骤,以及运动控制卡将上位机2发送的控制命令转发给驱动器3的步骤,主要是通过数字信号处理器1来实现的,数字信号处理器1内用于实现上述步骤的模块请参阅图3对应的实施例,此处不再赘述。
进一步的,数字信号处理器101还可以包括安全逻辑处理模块1014。安全逻辑处理模块1014与状态机控制模块1012相连,用于当伺服驱动器或者数字量输入输出模块出现故障或者通讯故障时,针对故障进行安全处理。具体的,当伺服驱动器故障时,安全逻辑处理模块1014可以主动给伺服驱动器发送停机指令,从而使得伺服驱动器给电机断电并停止驱动器的工作,等待进一步对故障进行处理;当通讯故障时,可以主动对内部芯片进行复位并重新连接,如果连接不上,可以向上位机上报通讯故障,等待进一步检测处理。
上位机2可以包括工控机201和/或示教器202,相对应的,上位机连接模块102也包括USB功能模块和/或PCI功能模块1021。USB功能模块用于连接示教器;PCI功能模块1021用于连接工控机。请参阅图8,以上位机2为工控机201,上位机连接模块102为PCI功能模块1021为例进行说明,本发明运动控制系统另一个实施例包括:
运动控制卡1、工控机201、伺服驱动器3、数字量输入输出模块4,其中运动控制卡1分别与上位机2、伺服驱动器3以及数字量输入输出模块4相连。
其中,运动控制卡1可以包括数字信号处理器101、PCI功能模块1021、RTEX总线模块103、复位模块104、电源模块105、外围存储模块106以及串口模块107,PCI功能模块1021、RTEX总线模块103、复位模块104、电源模块105、外围存储模块106以及串口模块107分别与数字信号处理器101相连。上位机2与PCI功能模块1021相连,数字量输入输出模块4与串口模块107相连,伺服驱动器3与RTEX总线模块103相连,RTEX总线模块103可支持的控制轴数多并且可以扩展,可以与多个伺服驱动器3相连。
其中,数字量输入输出模块4可以为可编程逻辑控制器PLC的数字量输入输出IO设备。
数字信号处理器101包括上位机通讯模块1011、状态机控制模块1012以及RTEX总线通讯模块1013、安全逻辑处理模块1014、串口通讯模块1015、远程通讯模块1016。
优选的,数字信号处理器上位机通讯模块1011可以包括对外API接口函数单元10111,对外API接口函数单元10111用于对外提供可供调用的API接口函数10111,实现通过API接口函数对支持RTEX总线伺服驱动器以及支持Modbus总线协议PLC IO设备的控制。其中,API接口函数包括用于获取伺服驱动器状态的函数、用于选择伺服驱动器运行状态的函数以及用于写入伺服驱动器位置数据的函数。同时,API接口函数中还可以对外提供标准算法的回调函数,上位机软件开发人员可以将算法核心部分放到上位机软件中实施。
设置对外API接口函数单元10111的优点在于,可以使得本发明提供的运动控制卡1的开放性更好、运行速度更高。具体的,在本发明运动控制卡1中运行的插补、前瞻等算法可以通过对外API函数,以回调函数的形式开放给上位机软件开发人员,对于软件开发人员而言,能够将核心算法自行开发,提高了开放性,同时由于运动控制卡功能简单,其支持的插补周期等指标可以做到更高。
远程通讯模块1016与对外API接口函数单元10111相连,用于通过以太网口接收远程的升级程序,并根据升级程序对固件程序进行升级,方便对固件程序的维护与更新。
远程通讯模块1016还可以用于获取固件程序内的日志文件,并通过上位机通讯模块1011发送至上位机,方便现场出现异常时进行异常检查。
请参阅图9,本发明还提供一种机器人系统,机器人系统包括:
机器人本体4、运动控制卡1、示教器202以及伺服驱动器3。
其中,运动控制卡1可以为图1至图3对应的实施例中任意一个实施例所述的运动控制卡,应至少包括数字信号处理器101、上位机连接模块102、RTEX总线模块103、复位模块104、电源模块105以及外围存储模块106,上位机连接模块102、RTEX总线模块103、复位模块104、电源模块105以及外围存储模块106分别与数字信号处理器101相连。
示教器202与运动控制卡1的上位机连接模块102相连,具体的,上位机连接模块102可以为USB功能模块。伺服驱动器3与运动控制卡的RTEX总线模块103相连,伺服驱动器3与机器人本体4相连,用于控制机器人本体4的运动。RTEX总线模块103可支持的控制轴数多并且可以扩展,可以与多个伺服驱动器3相连,图9中以三个伺服驱动器3为例。
运动控制卡1、示教器202以及伺服驱动器3三者间的数据通讯过程主要涉及示教器控制命令的通讯和伺服驱动器运行状态信息的通讯。
运动控制卡1、示教器202以及伺服驱动器3三者间的控制命令通讯的具体流程包括:
示教器202获取用户的控制命令并将该控制命令进行解析,再将解析后的控制命令发送给运动控制卡1;运动控制卡1接收示教器202发送的控制命令后,将控制命令转发给伺服驱动器3;伺服驱动器3接收控制命令并按照控制命令对机器人本体4进行控制。
请参阅图10,本发明还提供一种数控机床,数控机床包括:
机床本体5、运动控制卡1、工控机201以及伺服驱动器3。
其中,运动控制卡1可以为图1至图3对应的实施例中任意一个实施例所述的运动控制卡,应至少包括数字信号处理器101、上位机连接模块102、RTEX总线模块103、复位模块104、电源模块105以及外围存储模块106,上位机连接模块102、RTEX总线模块103、复位模块104、电源模块105以及外围存储模块106分别与数字信号处理器101相连。
工控机201与运动控制卡1的上位机连接模块102相连,具体的,上位机连接模块102可以为PCI功能模块。伺服驱动器3与运动控制卡的RTEX总线模块103相连,伺服驱动器3与机床本体5相连,用于控制机床本体5的运动。RTEX总线模块103可支持的控制轴数多并且可以扩展,可以与多个伺服驱动器3相连,图10中以三个伺服驱动器3为例。
运动控制卡1、工控机201以及伺服驱动器3三者间的数据通讯过程主要涉及工控机控制命令的通讯和伺服驱动器运行状态信息的通讯。
运动控制卡1、工控机201以及伺服驱动器3三者间的控制命令通讯的具体流程包括:
工控机201获取用户的控制命令并将该控制命令进行解析,再将解析后的控制命令发送给运动控制卡1;运动控制卡1接收工控机201发送的控制命令后,将控制命令转发给伺服驱动器3;伺服驱动器3接收控制命令并按照控制命令对机床本体5进行控制。
所属领域的技术人员可以清楚地了解到,为描述的方便和简洁,上述描述的系统,装置和单元的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。
在本申请所提供的几个实施例中,应该理解到,所揭露的系统,装置和方法,可以通过其它的方式实现。例如,以上所描述的装置实施例仅仅是示意性的,例如,单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口,装置或单元的间接耦合或通信连接,可以是电性,机械或其它的形式。
作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。
另外,在本发明各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现,也可以采用软件功能单元的形式实现。
集成的单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的全部或部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。
以上,以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。

Claims (15)

1.一种运动控制卡,其特征在于,包括:
数字信号处理器、上位机连接模块、高速实时以太网通讯协议RTEX总线模块、复位模块以及电源模块;
所述数字信号处理器分别与所述上位机连接模块、所述RTEX总线模块、所述复位模块以及所述电源模块相连;
所述电源模块用于为所述运动控制卡供电;
所述复位模块用于对所述运动控制卡进行复位;
所述上位机连接模块用于与上位机进行通信连接;
所述RTEX总线模块用于与伺服驱动器进行通信连接;
所述数字信号处理器通过所述上位机连接模块从所述上位机获取经解析的运动控制命令,并根据通过所述RTEX总线模块获取的所述伺服驱动器的不同状态将所述运动控制命令通过所述RTEX总线模块发送至所述伺服驱动器;或者,所述数字信号处理器通过所述RTEX总线模块接收来自所述伺服驱动器的运行状态信息并通过所述上位机连接模块发送至所述上位机;
所述数字信号处理器包括:上位机通讯模块、状态机控制模块以及RTEX总线通讯模块;
所述上位机通讯模块分别与所述上位机连接模块和所述状态机控制模块相连,所述状态机控制模块与所述RTEX总线通讯模块相连,所述RTEX总线通讯模块与所述RTEX总线模块相连;
所述上位机通讯模块用于接收上位机解析后的控制命令,并将控制命令发送给状态机控制模块;
所述状态机控制模块用于以轮询的方式接收上位机通过上位机通讯模块发送的解析后的控制命令,根据所述伺服驱动器的不同状态,以中断的方式将所述控制命令通过RTEX总线通讯模块发送到所述伺服驱动器中;
所述RTEX总线通讯模块用于接收所述状态机控制模块发送的控制命令,并将所述控制命令进行封装后发送给所述RTEX总线模块。
2.根据权利要求1所述的运动控制卡,其特征在于,所述上位机连接模块包括通用串行总线USB功能模块和/或外围器件互联PCI功能模块;
所述USB功能模块用于连接示教器;
所述PCI功能模块用于连接工控机。
3.根据权利要求1所述的运动控制卡,其特征在于,所述RTEX总线通讯模块还用于接收所述RTEX总线模块发送的所述伺服驱动器的运行状态信息,并对所述运行状态信息进行解析,发送给所述状态机控制模块;
所述状态机控制模块还用于以中断的方式获取来自所述RTEX总线通讯模块的所述伺服驱动器的运行状态信息,并将所述运行状态信息发送给所述上位机通讯模块;
所述上位机通讯模块还用于接收所述状态机控制模块发送的所述伺服驱动器的运行状态信息,并将所述运行状态信息发送至所述上位机。
4.根据权利要求3所述的运动控制卡,其特征在于,所述运动控制卡还包括串口模块,所述串口模块与所述数字信号处理器相连,并且与数字量输入输出模块进行通信。
5.根据权利要求4所述的运动控制卡,其特征在于,所述数字信号处理器还包括串口通讯模块,所述串口通讯模块分别与所述状态机控制模块以及所述串口模块相连。
6.根据权利要求1至5中任一项所述的运动控制卡,其特征在于,所述数字信号处理器还包括安全逻辑处理模块,所述安全逻辑处理模块与所述状态机控制模块相连,用于当所述伺服驱动器或者数字量输入输出模块出现故障或者通讯故障时,针对故障进行安全处理。
7.根据权利要求1至5中任一项所述的运动控制卡,其特征在于,所述上位机通讯模块包括对外应用程序编程接口API接口函数单元,所述对外API接口函数单元用于对外提供可供调用的API接口函数,所述API接口函数包括用于获取伺服驱动器状态的函数、用于选择伺服驱动器运行状态的函数以及用于写入伺服驱动器位置数据的函数。
8.根据权利要求7所述的运动控制卡,其特征在于,所述数字信号处理器还包括远程通讯模块,所述远程通讯模块与所述对外API接口函数单元相连,用于通过以太网口接收远程的升级程序,并根据所述升级程序对固件程序进行升级。
9.根据权利要求8所述的运动控制卡,其特征在于,所述远程通讯模块还用于获取固件程序内的日志文件,并通过所述上位机通讯模块发送至所述上位机。
10.一种运动控制系统,其特征在于,包括如权利要求1至9中任一项所述的运动控制卡,与所述运动控制卡的上位机连接模块相连的上位机,以及与所述运动控制卡的RTEX总线模块相连的伺服驱动器。
11.根据权利要求10所述的运动控制系统,其特征在于,所述上位机包括工控机和/或示教器。
12.根据权利要求10所述的运动控制系统,其特征在于,所述运动控制系统还包括与所述运动控制卡的串口模块相连的数字量输入输出模块。
13.根据权利要求12所述的运动控制系统,其特征在于,所述数字量输入输出模块为可编程逻辑控制器的数字量输入输出模块。
14.一种机器人系统,其特征在于,包括机器人本体、如权利要求1至9中任一项所述的运动控制卡,与所述运动控制卡的上位机连接模块相连的示教器,以及与所述运动控制卡的RTEX总线模块相连的伺服驱动器。
15.一种数控机床,其特征在于,包括机床本体、如权利要求1至9中任一项所述的运动控制卡,与所述运动控制卡的上位机连接模块相连的工控机,以及与所述运动控制卡的RTEX总线模块相连的伺服驱动器。
CN201780091087.XA 2017-06-05 2017-06-05 一种运动控制卡、运动控制系统、机器人系统及数控机床 Active CN111213099B (zh)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2017/087133 WO2018223253A1 (zh) 2017-06-05 2017-06-05 一种运动控制卡、运动控制系统、机器人系统及数控机床

Publications (2)

Publication Number Publication Date
CN111213099A CN111213099A (zh) 2020-05-29
CN111213099B true CN111213099B (zh) 2022-02-18

Family

ID=64566372

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201780091087.XA Active CN111213099B (zh) 2017-06-05 2017-06-05 一种运动控制卡、运动控制系统、机器人系统及数控机床

Country Status (2)

Country Link
CN (1) CN111213099B (zh)
WO (1) WO2018223253A1 (zh)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113534746B (zh) * 2020-04-21 2024-06-21 国奥科技(深圳)有限公司 基于5g通信的运动控制卡及其控制方法、驱动控制系统
CN112859727A (zh) * 2021-01-11 2021-05-28 苏州华兴源创科技股份有限公司 一种外观检pc运动控制操作系统和运动方法
CN113545845A (zh) * 2021-07-19 2021-10-26 天津大学 可穿戴式骨折复位与康复机器人控制系统及控制方法
CN114488955B (zh) * 2021-12-27 2023-07-04 北京遥测技术研究所 一种多轴驱动控制装置
CN114326519B (zh) * 2021-12-31 2024-05-17 中国石油化工股份有限公司 排管自动指梁锁控制系统及其控制方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0272397A2 (en) * 1986-10-27 1988-06-29 Vickers Incorporated Electrohydraulic system with distributed control
CN101008842A (zh) * 2007-01-24 2007-08-01 大连光洋科技工程有限公司 用于集成手动脉冲发生器和总线式机床控制面板的装置
CN101013311A (zh) * 2007-01-15 2007-08-08 大连光洋科技工程有限公司 专用于全数字环形总线数控系统的总线控制器
JP2009072028A (ja) * 2007-09-14 2009-04-02 Sanyo Denki Co Ltd 多軸駆動用ドライバ
JP2009258790A (ja) * 2008-04-11 2009-11-05 Nst:Kk 制御装置及び制御装置の制御方法
CN102830654A (zh) * 2012-09-12 2012-12-19 深圳华中数控有限公司 基于Android平台的开放式数控系统及其中进行二次开发的方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0272397A2 (en) * 1986-10-27 1988-06-29 Vickers Incorporated Electrohydraulic system with distributed control
CN101013311A (zh) * 2007-01-15 2007-08-08 大连光洋科技工程有限公司 专用于全数字环形总线数控系统的总线控制器
CN101008842A (zh) * 2007-01-24 2007-08-01 大连光洋科技工程有限公司 用于集成手动脉冲发生器和总线式机床控制面板的装置
JP2009072028A (ja) * 2007-09-14 2009-04-02 Sanyo Denki Co Ltd 多軸駆動用ドライバ
JP2009258790A (ja) * 2008-04-11 2009-11-05 Nst:Kk 制御装置及び制御装置の制御方法
CN102830654A (zh) * 2012-09-12 2012-12-19 深圳华中数控有限公司 基于Android平台的开放式数控系统及其中进行二次开发的方法

Also Published As

Publication number Publication date
CN111213099A (zh) 2020-05-29
WO2018223253A1 (zh) 2018-12-13

Similar Documents

Publication Publication Date Title
CN111213099B (zh) 一种运动控制卡、运动控制系统、机器人系统及数控机床
CN103559053B (zh) 一种板卡系统及通信接口卡fpga在线升级方法
CN203786723U (zh) 基于x86 pc/104嵌入式cpu模块的双机冗余系统
CN101132328A (zh) 实时工业以太网EtherCAT通信控制器
CN100386754C (zh) 对usb接口设备进行操作的装置及方法
CN102540982B (zh) 一种运动控制卡和运动控制方法
CN102411539B (zh) 一种手机外部设备在线调试方法及系统
CN107885517B (zh) 嵌入式系统处理器程序加载电路
CN103412836B (zh) 热插拔处理方法、装置以及系统
CN104698950A (zh) 一种外围设备控制方法、微控制器、上位机及系统
CN101013315A (zh) 基于全数字环形总线式通用型数控系统
CN108508812B (zh) 一种agv控制器io端口复用配置系统及其方法
CN110399328B (zh) 一种板载图形处理器控制方法与装置
CN103580975A (zh) 一种在线可重配置的通用化总线数据转换方法
CN102445981B (zh) 数据传输系统以及数据传输方法
CN102122238B (zh) 计算机管理系统与方法
CN101751323A (zh) 微处理器芯片仿真器及断点设置的方法
KR101481296B1 (ko) 원격 단말 장치 및 그의 동작 방법
CN104635633A (zh) 一种具有WiFi无线通讯的多总线式工业机器人控制系统
CN106547218B (zh) 直流输电现场层实时模拟系统、仿真系统和闭环试验系统
CN107538484B (zh) 一种应用于机器人电机的上位机调试装置
CN104698916A (zh) 用于操作自动化装置的方法
CN212324117U (zh) 一种rs485总线多主机竞争切换系统
CN103795857A (zh) 信息处理方法及电子设备
CN205015664U (zh) 一种光伏驱动模拟装置

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant