[发明专利]一种机器人控制系统

说明书

本发明实施例公开一种机器人控制系统，涉及工业自动化技术领域。所述机器人控制系统包括主站控制器、从站节点、机器轴模组和EtherCAT总线；所述主站控制器通过所述EtherCAT总线与所述从站节点连接；所述从站节点与所述机器轴模组连接；其中，所述总站控制器通过所述EtherCAT总线向所述从站节点发送控制指令，所述从站节点接收所述控制指令，并根据所述控制指令控制所述机器轴模组工作；所述从站节点采集所述机器轴模组的状态反馈信息，并将所述状态反馈信息通过所述EtherCAT总线发送至所述主站控制器，所述主站控制器根据所述状态反馈信息向所述从站节点发送控制指令；本发明实施例提供的机器人控制系统具体有实时性、可靠性和模块化扩展性的特点。

技术领域

本发明实施例属于工业自动化技术领域，尤其涉及一种机器人控制系统。

背景技术

目前的机器人控制系统大都采用CANbus(ControLLer Area Net-work Bus控制器局域网)总线或者Rs485(485信号通用串口协议)总线，CANbus或者Rs485总线虽然通信稳定，有较高的抗干扰性能，但其无法满足高档数控装置对实时性和可靠性的要求；另外，目前的机器人控制系统所采用CANbus总线或者Rs485总线可拓展性较差，硬件接线复杂。

发明内容

基于上述背景，本发明实施例提供一种机器人控制系统，以解决现有机器人控制方案实时性差、可靠性低，不方便进行模块化扩展的问题。

本发明实施例采用的技术方案为：

一种机器人控制系统，所述机器人控制系统包括主站控制器、从站节点、机器轴模组和EtherCAT(Ether Control Automation Technology，以太网控制自动化技术)总线；所述主站控制器通过所述EtherCAT总线与所述从站节点连接；所述从站节点与所述机器轴模组连接；

其中，所述总站控制器通过所述EtherCAT总线向所述从站节点发送控制指令，所述从站节点接收所述控制指令，并根据所述控制指令控制所述机器轴模组工作；

所述从站节点采集所述机器轴模组的状态反馈信息，并将所述状态反馈信息通过所述EtherCAT总线发送至所述主站控制器，所述主站控制器根据所述状态反馈信息向所述从站节点发送控制指令。

进一步的，所述从站节点至少一个，且每个所述从站节点对应地设有至少一个所述机器轴模组。

进一步的，所述从站节点包括模组引导状态机，所述模组引导状态机根据所述控制指令进行状态转换，从而控制所述机器轴模组进行工作状态转换。

进一步的，所述从站节点包括至少一个所述模组引导状态机，且每个所述模组引导状态机对应一个所述机器轴模组。

进一步的，所述系统还包括三环控制装置，所述三环控制装置根据所述控制指令对所述机器轴模组进行参数设置，控制所述机器轴模组工作。

进一步的，所述从站节点至少一个，每个所述从站节点对应地设有至少一个所述机器轴模组，且每个所述机器轴模组对应一个所述三环控制装置。

进一步的，所述三环控制装置包括位置环控制装置、速度环控制装置和电流环控制装置；

所述位置环控制装置根据输入位置与反馈位置差值对所述机器轴模组进行位置调整，包括位置检测装置、速度前馈装置、位置环调节装置；

所述速度环控制装置根据所述位置环控制装置的输出与反馈速度差值对所述机器轴模组进行速度调节，包括速度检测装置、位置转矩前馈装置、速度环调节装置；

所述电流环控制装置根据所述速度环的输出驱动并调节所述机器轴模组，包括转矩滤波装置、转矩调节装置。