一种多轴运动控制器及控制方法技术

本发明专利技术公开了一种基于三核处理器的多轴运动控制器及控制方法。所述包括独立设置的上位机，用于接收上位机控制命令包的下位机；上位机与下位机之间通过EtherCAT总线实现通信连接，下位机用于数据处理以及将处理结果通过EtherCAT总线再上传到上位机；下位机包括ARM处理器、DSP处理器、FPGA处理器以及以三核处理器为控制核心的外围模块，所述外围模块包括电源模块、伺服电机控制输出模块、伺服电机状态反馈模块、编码器反馈模块、AD/DA模块、EtherCAT通讯模块、串口通信模块、控制信号输入输出模块和人机交互通信模块。所述运动控制器充分利用上下位机的各自优势资源，实现高速高精控制、输出，控制各个电机协调运动，使得机器人或机械手获得较高的定位精度，从而实现机器人的精确运动控制。

A multi axis motion controller and control method

The invention discloses a multi axis motion controller and a control method based on the three core processor. The host computer includes independent set, PC control commands for receiving packets between PC and PC; the lower machine is connected by EtherCAT bus, MCU for data processing and the results through the EtherCAT bus and then uploaded to the host computer; the next machine includes the ARM processor, DSP processor, FPGA processor and the three core processor as the control core of the peripheral module, the peripheral module includes power module, servo motor control output module, servo motor feedback module, encoder feedback module, AD/DA module, EtherCAT communication module, serial communication module, control signal input and output module and man-machine communication module. The motion controller makes full use of the superior resources of the upper and lower computers to achieve high speed, high precision control and output, control the coordinated movement of each motor, and make the robot or manipulator get high positioning accuracy, so as to achieve the precise motion control of the robot.

【技术实现步骤摘要】
一种多轴运动控制器及控制方法
本专利技术涉及数控技术与自动化控制
，具体涉及一种高速高精的多轴伺服电机运动控制器，充分利用上下位机的各自优势资源，实现高速高精控制、输出，控制各个电机协调运动，使得机器人获得较高的定位精度，从而实现机器人的精确运动控制。
技术介绍
运动控制系统是一种利用数字信号对执行机构的位移、速度、加速度和动作顺序等实现自动控制的控制系统，广泛应用于机器人、智能化加工技术和CAD/CAM技术，包括各类数控检测设备、数控加工设备、串并联机器人等自动化设备。运动控制系统的实现，目前多采用嵌入式控制器和基于PC(个人电脑)的控制器的形式。基于PC的控制器又分为两大类：使用高速现场总线和“PC+运动控制卡”。高速现场总线即PC机端通过通讯线缆走总线协议与控制板卡连接；PC+运动控制卡即将运动控制卡插入主机PCI插槽中。基于PC的控制器可以将PC机的信息处理能力和开放式的特点与运动控制卡的运动轨迹控制能力有机地结合在一起。目前的运动控制器普遍存在以下缺点：嵌入式控制器受所选核心处理器芯片的性能限制，其运算能力和存储容量有限，造成升级、扩展困难。整机系统开发周期长，跟不上芯片更新换代的速度。因此，目前高端市场主要以基于PC的系统为主。基于PC使用高速现场总线的控制器，很多总线协议裁剪复杂，开发周期长，开发成本高；对已有的伺服驱动器基本不兼容，无法通信。PC+运动控制卡式的运动控制器需要将运动控制卡插入计算机主板，占用PCI总线带宽，占用CPU资源，对控制主机的硬件要求高。还需要从PCI卡上引出控制线连接到扩展卡，成本高，引出脚的数量也相当有限，硬件不可裁剪，可扩展性不强。因此，提供一种通讯速度快、控制精度高的运动控制器和运动控制系统为本领域技术人员需要解决的技术问题。
技术实现思路
本专利技术所要解决的技术问题是提供一种基于PC使用EtherCAT总线通讯和三核处理器（ARM+DSP+FPGA）运算处理的控制器，上位PC机只需要发送一些运动相关数据参数至下位机，如终点坐标与设定速度等，以及档位、启动、暂停、停止等命令，真正意义上把运动控制在下位机实现，而且在某一些特定应用上可以依靠通用输入输出端子操作实现脱机运行。本专利技术是通过以下技术方案来实现的：一种基于EtherCAT通信与三核处理器（ARM+DSP+FPGA）的多轴伺服电机运动控制器，其特征在于，包括独立设置的上位机，用于接收上位机控制命令包的下位机；上位机与下位机之间通过EtherCAT总线实现通信连接，下位机用于数据处理以及将处理结果通过EtherCAT总线再上传到上位机；下位机包括ARM处理器、DSP处理器、FPGA处理器以及以三核处理器为控制核心的外围模块，所述外围模块包括电源模块、伺服电机控制输出模块、伺服电机状态反馈模块、编码器反馈模块、AD/DA模块、EtherCAT通讯模块、通用输入输出模块。优选地，所述伺服电机控制输出模块包括多个原理相同的对应每个轴的脉冲与方向控制输出单元，控制电机的运行速度、方向与定位。伺服电机状态反馈模块用于反馈当个各个电机的运行状态；编码器接口模块用于反馈各个电机当前位置；AD/DA模块包括AD/DA转换电路和信号调节电路；EtherCAT通讯模块用于上位机与下位机的高速通讯；通用输入模块用于其他信号的读取，如限位等，输入模块用于其他控制输出，如气缸等。优选地，所述上位机为通用的带以带网网络接口的电脑，可以是台式机，也可以是笔记本电脑。优选地，所述下位机采用高性能双核处理器主控芯片TMS320DM8148或TMS320DM8168，该芯片内部集成了1GHz主频Cortex-A8ARM核与800主频C674x的DSP核，通过EtherCAT总线与上位机进行通信，同时通过并行总线连接FPGA处理器。优选地，所述上位机解析标准数控G代码，再通过EtherCAT总线发送控制命令包至下位机；下位机将运动代码进行轨迹规划后进行插补控制输出，同时将处理结果及状态反馈等通过EtherCAT总线再上传到上位机。优选地，所述双核处理器主控芯片的ARM核主要用于与上位机通讯，接收运动代码；双核处理器内部主控芯片的ARM核与DSP核通过共享内存进行数据交互；DSP核进行运动控制轨迹规划、运动控制算法处理、插补运算，并将插补值填入插补缓冲区。优选地，所述DSP与FPGA通过32位并行总线进行数据交互；FPGA通过中断触发DSP进行插补输出，FPGA接收DSP插补缓冲区传送过来的各轴脉冲值与方向值，进行各轴同步插补，实现多轴联动。优选地，所述FPGA实时读取外围伺服电机状态反馈值、编码器反馈值并通过并行总线传送至双核处理器。优选地，所述上位机通过协议查询命令，实时查询当前下位机各电机的工作状态和警报信息，以便于监控。优选地，所述下位机通过EtherCAT接口接收上位机命令，对其进行解析，得到各电机需要运动到的空间位置；双核处理器利用空间曲线的轨迹插补方法在相邻坐标点之间插补出多个点，经过轨迹插补方法后生成每个插补周期的每个电机需要运动的位置、速度、加速度和加加速度等，存入插补缓冲区；DSP通过FPGA产生的外部中断触发插补输出，将插补缓冲区的数据通过并行总线交互至FPGA，FPGA通过伺服电机控制输出模块控制伺服电机运动，同时通过编码器模块读回每个电机位置进行显示，通过控制信号输入输出模块控制外部设备配合多轴机器人进行作业。附图说明通过阅读参照以下附图所作的对非限制性实施例所作的详细描述，本专利技术的其它特征、目的和优点将会变得更明显：图1是本专利技术中基于三核处理器的多轴运动控制器的结构框图。图2是本专利技术中基于三核处理器的多轴运动控制器控制方法流程示意图。图3是本专利技术中基于三核处理器的多轴运动控制器数据交互流程图。具体实施方式现在将参考附图更全面地描述示例实施方式。然而，示例实施方式能够以多种形式实施，且不应被理解为限于在此阐述的范例；相反，提供这些实施方式使得本专利技术将更加全面和完整，并将示例实施方式的构思全面地传达给本领域的技术人员。附图仅为本专利技术的示意性图解，并非一定是按比例绘制。图中相同的附图标记表示相同或类似的部分，因而将省略对它们的重复描述。此外，所描述的特征、结构或特性可以以任何合适的方式结合在一个或更多实施方式中。在下面的描述中，提供许多具体细节从而给出对本专利技术的实施方式的充分理解。然而，本领域技术人员将意识到，可以实践本专利技术的技术方案而省略所述特定细节中的一个或更多，或者可以采用其它的方法、组元、装置、步骤等。在其它情况下，不详细示出或描述公知结构、方法、装置、实现或者操作以避免喧宾夺主而使得本专利技术的各方面变得模糊。下面结合附图对本专利技术进行进一步说明。如图1，本专利技术提出了一种基于三核处理器的多轴运动控制器，其特征在于，包括独立设置的上位机1，用于接收上位机控制命令包的下位机2；上位机与下位机之间通过EtherCAT总线实现通信连接，下位机2用于数据处理以及将处理结果通过EtherCAT总线再上传到上位机1；下位机2包括双核处理器模块3（内部集成ARM处理器4、DSP处理器5）、FPGA处理器6以及以三核处理器为控制核心的外围模块，所述外围模块包括电源模块7、伺服电机控制输出模块8、伺服电机状态反馈模块9、编码本文档来自技高网...

【技术保护点】
一种基于EtherCAT通信与三核处理器（ARM+DSP+FPGA）的多轴伺服电机运动控制器，其特征在于，包括独立设置的上位机，用于接收上位机控制命令包的下位机；上位机与下位机之间通过EtherCAT总线实现通信连接，下位机用于数据处理以及将处理结果通过EtherCAT总线再上传到上位机；下位机包括ARM处理器、DSP处理器、FPGA处理器以及以三核处理器为控制核心的外围模块，所述外围模块包括电源模块、伺服电机控制输出模块、伺服电机状态反馈模块、编码器反馈模块、AD/DA模块、EtherCAT通讯模块、通用输入输出模块；所述的伺服电机控制输出模块包括多个原理相同的对应每个轴的脉冲与方向控制输出单元，控制电机的运行速度、方向与定位；所述的伺服电机状态反馈模块用于反馈当个各个电机的运行状态；所述的编码器接口模块用于反馈各个电机当前位置；所述的AD/DA模块包括AD/DA转换电路和信号调节电路；所述EtherCAT通讯模块用于上位机与下位机的高速通讯；所述通用输入模块用于其他信号的读取，如限位等，输出模块用于其他控制输出，如电磁阀、气缸等。

【技术特征摘要】
1.一种基于EtherCAT通信与三核处理器（ARM+DSP+FPGA）的多轴伺服电机运动控制器，其特征在于，包括独立设置的上位机，用于接收上位机控制命令包的下位机；上位机与下位机之间通过EtherCAT总线实现通信连接，下位机用于数据处理以及将处理结果通过EtherCAT总线再上传到上位机；下位机包括ARM处理器、DSP处理器、FPGA处理器以及以三核处理器为控制核心的外围模块，所述外围模块包括电源模块、伺服电机控制输出模块、伺服电机状态反馈模块、编码器反馈模块、AD/DA模块、EtherCAT通讯模块、通用输入输出模块；所述的伺服电机控制输出模块包括多个原理相同的对应每个轴的脉冲与方向控制输出单元，控制电机的运行速度、方向与定位；所述的伺服电机状态反馈模块用于反馈当个各个电机的运行状态；所述的编码器接口模块用于反馈各个电机当前位置；所述的AD/DA模块包括AD/DA转换电路和信号调节电路；所述EtherCAT通讯模块用于上位机与下位机的高速通讯；所述通用输入模块用于其他信号的读取，如限位等，输出模块用于其他控制输出，如电磁阀、气缸等。2.如权利要求1所述的多轴伺服电机运动控制器，其特征在于：上位机为通用的带以带网网络接口的电脑，可以是台式机，也可以是笔记本电脑。3.如权利要求1所述的多轴伺服电机运动控制器，其特征在于：所述下位机采用高性能双核处理器主控芯片TMS320DM8148或TMS320DM8168，该芯片内部集成了1GHz主频Cortex-A8ARM核与800主频C674x的DSP核，通过EtherCAT总线与上位机进行通信，同时通过并行总线连接FPGA处理器。4.如权利要求1所述的多轴伺服电机运动控制器，其特征在于上位机解析标准数控G代码，再通过EtherC...

【专利技术属性】
技术研发人员：卢俊，
申请(专利权)人：卢俊，
类型：发明
国别省市：广东,44