一种基于CANopen的CNC机械臂控制系统及其方法技术方案

一种基于CANopen的CNC机械臂控制系统，包括机械臂运动控制硬件平台核心芯片、CAN总线收发器、搭载有CANopen协议的机械臂运动控制主电路板和机械臂的每个轴伺服电机，所述核心芯片采用基于Cortex-M3架构的微处理器，机械臂运动控制硬件平台核心芯片依次与CAN总线收发器连接、机械臂运动控制主电路板连接，机械臂运动控制主电路板通过CAN总线与机械臂的每个轴伺服电机连接；搭载有CANopen协议的机械臂运动控制主电路板作为CANopen主站，机械臂的每个轴伺服电机作为一个CANopen从站。以及提供了一种基于CANopen的CNC机械臂控制方法。本发明专利技术安全可靠性高、可拓展性强、成本低。

【技术实现步骤摘要】
—种基于CANopen的CNC机械臂控制系统及其方法
本专利技术属于基于现场总线的运动控制领域,一种CANopen协议应用于多轴运动控制系统及其方法。
技术介绍
在国内传统的数控机床加工生产制造业，机床加工的原料的放置和成品的获取都是靠人为操作完成，这种人力操作导致生产效率低，且容易发生安全事故，数控机床生产的自动化是发展的必然趋势。目前，有部分规模较大的企业和团队在这方面已经做出了一定的成果，实现了生产加工的全自动化，但是大部分的实现方案都是采用控制器直接发送脉冲的方式对机械臂进行控制。这种方案直接明了，但是扩展性低，当需要扩展机械轴或者料仓等其他模块时，又需要增加额外的脉冲发送模块；在轴数较多或者运动控制要求较复杂的场合下，直接脉冲控制方案往往难以实现或者过于繁杂；且在生产车间一些干扰较多的恶劣环境下，直接脉冲控制方案不稳定，易丢失脉冲导致控制出错。
技术实现思路
为了克服在数控机床加工生产自动化过程中采用直接脉冲运动控制方案拓展性差，成本较高，可靠性低等问题，本专利技术提供一种安全可靠性高、可拓展性强、成本低的基于CANopen的CNC机械臂控制系统及其方法。针对上述问题，本专利技术解决其技术问题所采用的解决方案是:一种基于CANopen的CNC机械臂控制系统，包括机械臂运动控制硬件平台核心芯片、CAN总线收发器、搭载有CANopen协议的机械臂运动控制主电路板和机械臂的每个轴伺服电机，其中，机械臂运动控制硬件平台核心芯片采用基于Cortex-M3架构的微处理器，所述机械臂运动控制硬件平台核心芯片与所述CAN总线收发器连接，所述CAN总线收发器与机械臂运动控制主电路板连接，所述机械臂运动控制主电路板通过CAN总线与机械臂的每个轴伺服电机连接；所述搭载有CANopen协议的机械臂运动控制主电路板作为CANopen主站，所述机械臂的每个轴伺服电机作为一个CANopen从站,所述CANopen主站和CANopen从站形成运动控制网络。进一步，所述机械臂运动控制硬件平台核心芯片包括围电路和扩展电路，所述扩展电路包括I/O 口和通信接口。所述CANopen主站和CANopen从站之间采用非同步非周期PDO通信模式。所述CNC机械臂控制系统还包括附加CANopen从站，所述附加CANopen从站为除了机械臂轴之外的装置，所述除了机械臂轴之外的装置包括料仓和远程IO扩展点。一种基于CANopen的CNC机械臂控制方法，机械臂运动控制硬件平台核心芯片与CAN总线收发器连接，CAN总线收发器与搭载有CANopen协议的机械臂运动控制主电路板连接，所述机械臂运动控制主电路板通过CAN总线与机械臂的每个轴伺服电机连接；所述搭载有CANopen协议的机械臂运动控制主电路板作为CANopen主站，所述机械臂的每个轴伺服电机作为一个CANopen从站,所述CANopen主站和CANopen从站形成运动控制网络；所述控制方法包括以下步骤:(I) CANopen主站初始化，CAN总线收发器初始化；(2)主站通过NMT功能对从站开始进行管理，从站启动正常之后发送Boot up报文，进入预操作状态，主站接收到报文通过SDO(Service Data Object,服务数据对象)功能配置从站为回原点模式(Homing Mode)，并将关键控制变量进行TOO (Process DataObject,过程数据对象)映射；(3)完成从站初始化后，从站进入操作模式，CANopen总线协议通信配置完成；(4)在系统运动控制过程中，首先各机械臂轴采用方式21 (Method21)回原点，主站发送SDO报文将从站切换到位置模式，进行机械臂和料仓等轴的位置模式控制。进一步，通过PDO协议每次发送8字节的关键控制变量给各从站，进行实时控制。更进一步，使用CANopen的安全机制进行错误检测；确保系统运行正常。本专利技术的技术构思为:针对现有技术的问题，采用CANopen总线协议构建电机运动控制系统网络进行管理控制可以使问题得到有效解决。CANopen协议是基于CAN(ControIIer Area Network)总线的应用高层协议,具有实时性强、可靠性高、抗干扰能力强、可拓展性好等优点，且CANopen协议是公开免费协议，透明度高，会大大降低运动控制系统的成本。本专利技术的优点表现在:(I)开发搭载有CAN总线收发器的嵌入式运动控制硬件平台，并扩展常规外设和10，硬件平台可适用于大多数机械臂运动控制场合。(2)利用CANopen总线协议将运动控制系统网络化，使控制系统更加安全可靠、易于管理。(3)将机械臂各轴的运动控制关键量都映射到RPD0，提高运动控制的实时性。(4)可在现有系统上通过CANopen协议总线方便的拓展机械臂轴和其他节点，例如料仓伺服从站和远程IO点等，不需要增加额外的控制器，使系统构架简洁，成本大大减少。【附图说明】:图1基于CANopen协议的运动控制系统网络构架图。图2基于CANopen总线的数控机床机械臂控制系统示意图。图3基于CANopen的机械臂控制流程图。【具体实施方式】:下面结合附图对本专利技术作进一步描述。实施例1参照图1和图2，一种基于CANopen的CNC机械臂控制系统，包括机械臂运动控制硬件平台核心芯片、CAN总线收发器、搭载有CANopen协议的机械臂运动控制主电路板和机械臂的每个轴伺服电机，其中，机械臂运动控制硬件平台核心芯片采用基于CorteX-M3架构的微处理器，所述机械臂运动控制硬件平台核心芯片与所述CAN总线收发器连接，所述CAN总线收发器与机械臂运动控制主电路板连接，所述机械臂运动控制主电路板通过CAN总线与机械臂的每个轴伺服电机连接；所述搭载有CANopen协议的机械臂运动控制主电路板作为CANopen主站,所述机械臂的每个轴伺服电机作为一个CANopen从站,所述CANopen主站和CANopen从站形成运动控制网络。进一步，所述机械臂运动控制硬件平台核心芯片包括围电路和扩展电路，所述扩展电路包括I/O 口和通信接口。所述CANopen主站和CANopen从站之间采用非同步非周期PDO通信模式。所述CNC机械臂控制系统还包括附加CANopen从站，所述附加CANopen从站为除了机械臂轴之外的装置，所述除了机械臂轴之外的装置包括料仓和远程IO扩展点。本实施例中，如图1所示。采用基于Cortex_M3架构的STM32F103ZET6微处理器作为机械臂运动控制硬件平台核心芯片，采用SN65HVD230D芯片作为CAN总线收发器，硬件平台扩展有串口，手持器接口，一定数量的I/O接口；I/O接口都使用光耦EL817隔离，使电路板内部保持纯净的GND ;同时，输出端口使用ULN2803达林顿管驱动器增加输出驱动能力。在控制器上搭载CANopen总线协议作为网络构建主站，将数控机床自动取卸料机械臂的X轴、Y轴、Z轴伺服器作为CANopen机械臂从站，同时可以将可能需要增加的设备，比如放置原料和成品的料仓、远程I/O监测点等作为从站；控制器主站通过CANopen协议与从站进行通信，通过NMT (Network Management Objects)功能对从站进行统一管理，控制从站状态，实现保护机制；通过SD本文档来自技高网...

【技术保护点】
一种基于CANopen的CNC机械臂控制系统，其特征在于：包括机械臂运动控制硬件平台核心芯片、CAN总线收发器、搭载有CANopen协议的机械臂运动控制主电路板和机械臂的每个轴伺服电机，其中，机械臂运动控制硬件平台核心芯片采用基于Cortex‑M3架构的微处理器，所述机械臂运动控制硬件平台核心芯片与所述CAN总线收发器连接，所述CAN总线收发器与机械臂运动控制主电路板连接，所述机械臂运动控制主电路板通过CAN总线与机械臂的每个轴伺服电机连接；所述搭载有CANopen协议的机械臂运动控制主电路板作为CANopen主站，所述机械臂的每个轴伺服电机作为一个CANopen从站，所述CANopen主站和CANopen从站形成运动控制网络。

【技术特征摘要】
1.一种基于CANopen的CNC机械臂控制系统，其特征在于:包括机械臂运动控制硬件平台核心芯片、CAN总线收发器、搭载有CANopen协议的机械臂运动控制主电路板和机械臂的每个轴伺服电机，其中，机械臂运动控制硬件平台核心芯片采用基于CorteX-M3架构的微处理器，所述机械臂运动控制硬件平台核心芯片与所述CAN总线收发器连接，所述CAN总线收发器与机械臂运动控制主电路板连接，所述机械臂运动控制主电路板通过CAN总线与机械臂的每个轴伺服电机连接； 所述搭载有CANopen协议的机械臂运动控制主电路板作为CANopen主站，所述机械臂的每个轴伺服电机作为一个CANopen从站,所述CANopen主站和CANopen从站形成运动控制网络。2.如权利要求1所述的基于CANopen的CNC机械臂控制系统，其特征在于:所述机械臂运动控制硬件平台核心芯片包括围电路和扩展电路，所述扩展电路包括I/O 口和通信接□。3.如权利要求1或2所述的基于CANopen的CNC机械臂控制系统，其特征在于:所述CANopen主站和CANopen从站之间采用非同步非周期PDO通信模式。4.如权利要求1或2所述的基于CANopen的CNC机械臂控制系统，其特征在于:所述CNC机械臂控制系统还包括附加CANopen从站，所述附加CANopen从站为除了机械臂轴之外的装置，所述除了机械臂轴之外的装置包括料仓和远程IO扩展点。5.—种基于CANopen的CNC机...

【专利技术属性】
技术研发人员：董辉，吴祥，罗立锋，赖宏焕，仲晓帆，高阳，马祖杰，
申请(专利权)人：杭州金人自动控制设备有限公司，
类型：发明
国别省市：浙江;33