一种支持运动控制模块在线升级的运动控制方法技术

本发明专利技术涉及一种支持运动控制模块在线升级的运动控制方法，包括以下步骤：主控单元执行运动控制主进程，并触发EtherCAT总线通信线程和监听线程；通过EtherCAT总线通信线程，根据EtherCAT总线通信层协议检查网络结构、初始化伺服驱动器；通过监听线程进行监听：当监听到运动控制模块更新信号时，进行在线更新；同时，通过运动控制主进程解析上位机发来的运动控制任务确定参数列表和运动控制指令；根据EtherCAT总线应用层协议实时采集伺服驱动器状态信息，并解析运动控制模型生成控制命令实时传输。本设计通过监听线程的方式实现了运动功能模块的在线更新，使得运动控制器能够最大限度的应用于复杂运动控制场景，同时依托EtherCAT总线接口实现实时控制，网络结构非常灵活。

Motion control method for supporting movement control module on-line upgrading

The invention relates to a control module online upgrade movement a motion control method, which comprises the following steps: the main control unit to perform motion control of main process, and trigger the EtherCAT bus communication thread and monitor thread; through the EtherCAT bus communication thread, according to the EtherCAT bus communication protocol to check the network structure, initialization of servo drive; listening by listening thread: when listening to the motion control module to update the signal when the online update; at the same time, the motion control of the main process analysis of PC to determine the parameter list and motion motion control command and control task; according to the real-time status information of servo driver of EtherCAT bus application layer protocol, and resolves the motion control model to generate real-time transmission control command. This design through the realization of the online monitoring of motion function module update, motion controller can make the maximum used in complex motion control scene, while relying on the EtherCAT bus interface to realize the real-time control of network structure is very flexible.

【技术实现步骤摘要】
一种支持运动控制模块在线升级的运动控制方法
本专利技术涉及一种支持运动控制模块在线升级的运动控制方法。本专利技术适用于各种运动控制应用场景，尤其适用于对实时数据通信有要求的控制领域。
技术介绍
随着运动控制领域的飞速发展，实时通信需求的不断提升，工业控制器方向由传统的以秒为单位的同步控制演变到微秒级控制。EtherCAT总线技术就是为了适应于更高速的通信速度而提出。目前工业领域主流的总线技术包括Powerlink、CAN总线等，配合不同的厂商多领域的涉及，已经将实时通信技术延展到了更多的领域。针对运动控制领域，各大厂家都提出了基于快速总线通信的解决方案。运动控制产品主要以运动控制卡和运动模型库为主。但现有运动控制器多固化了运动控制模块，多数产品无法支持在线升级，每次更新都需要重新编译固化，因此大大的限制了运动控制器的灵活性。同时现有运动控制器与驱动器之间通信协议种类繁多，因此需要一套标准的通信协议定义出一套通用性的应用层协议格式。综上所述，运动控制器在实现运动控制功能的基础上，还应该支持运动控制模块的在线升级，实现对实际运动控制效果的在线调整。另一方面针对通信协议各异、标准不统一的问题，设计基于CANopen应用层协议的运动控制器，将运动控制参数统一映射到构建的统一地址模型中，并通过通信层EtherCAT接口进行实时控制。
技术实现思路
针对现有技术中存在的上述不足之处，本专利技术要解决的技术问题是克服现有控制器存在的不足，提供一种基于EtherCAT技术的运动控制方法，不仅能够将伺服驱动器所需数据进行实时采集和传输，还能将数据定义出CANopen应用层模型进行统一管理。同时本专利技术还提出了一套支持运动功能块在线升级的解决方案。本专利技术为实现上述目的所采用的技术方案是：一种支持运动控制模块在线升级的运动控制方法，包括以下步骤：主控单元执行运动控制主进程，并触发EtherCAT总线通信线程和监听线程；通过EtherCAT总线通信线程，根据EtherCAT总线通信层协议检查网络结构、初始化伺服驱动器；通过监听线程对信号量进行监听：当监听到中断信号，则主控单元重置；当监听到上位机发送的运动控制模块更新信号时，进行在线更新；同时，通过运动控制主进程解析上位机发来的运动控制任务：根据运动控制任务确定伺服驱动器状态信息参数列表和运动控制指令；根据EtherCAT总线应用层协议实时采集伺服驱动器状态信息，并解析运动控制模型生成控制命令实时传输给伺服驱动器。所述伺服驱动器状态信息根据CIA402应用层协议封装，包括状态字、实时速度信息、实时扭矩信息、实时末端位置信息、当前运动控制模式。所述运动控制指令根据CIA402应用层协议封装，包括指令字、速度信息、扭矩信息、末端位置信息、运动控制模式。所述进行在线更新包括以下步骤：当监听到上位机发送的运动控制模块更新信号时，停止当前运动控制任务，接收上位机发来的运动控制模块更新文件；向主进程发送接收完成信号；主进程调用系统更新服务，将运动控制模块更新文件替换当前运动控制模块中的待更新部分的目标代码文件，重新连接生成可调用的运动控制模块；当主进程接收到更新完成信号时，继续解析上位机发来的运动控制任务。所述主进程调用系统更新服务，将运动控制模块更新文件替换当前运动控制模块中的待更新部分的目标代码文件，重新连接生成可调用的运动控制模块包括以下步骤：系统更新服务首先检索运动控制功能模块名称，查找运动控制模块在内存中的起始地址及偏移量；然后根据起始地址及偏移量调用内存访问接口，将运动控制模块更新文件写入当前内存；最后通过运动控制模块原有连接方法，实现运动控制功能模块的更新，并向主进程发送更新完成信号。本专利技术具有以下优点及有益效果：1.采用支持运动控制模块在线升级的运动控制器进行运动控制，适用于运动控制研究阶段、调试阶段以及后期维护阶段，覆盖整个运动控制产品的生命周期，使运动控制器能够最大限度的适配不同被控对象，大大的降低了维护成本，同时适应于算法研究过程中对在线调试的要求，复用性强。2.本设计通过监听线程的方式实现了运动功能模块的在线更新，使得运动控制器能够最大限度的应用于复杂运动控制场景，同时依托EtherCAT总线接口实现实时控制，网络结构非常灵活。3.能够真正实现运动控制应用层接口的统一化。运动控制器内置EtherCAT通信协议，并通过CANopen应用层协议将伺服驱动器状态参数和控制命令实时进行通信，并且能够保障同步周期在100微秒以内，实现快速有效的运动控制解决方案。附图说明图1是本专利技术实施例的组成框图；图2是本专利技术实施例的工作原理图；图3是本专利技术实施例的工作状态机示意图。具体实施方式下面通过附图和实施例，对本专利技术的技术方案做进一步的详细描述。如图1所示，本专利技术的运动控制器硬件装置主要包括以太网接口单元、以太网控制单元、SRAM存储单元、主控单元、控制按键和指示灯单元和供电单元。数据处理单元中主控单元与以太网控制单元、SRAM存储单元、通信接口转换模块、控制按键、指示灯单元、供电单元呈星形连接；所述供电单元为数据处理单元中其他所有单元供电。所述主控单元由TI公司生产的AM335x系列Cortex-A8处理器及其外围电路组成；所述SRAM存储器单元由ISSI公司生产的IS61WV102416BLL芯片及其外围电路组成；所述以太网控制单元由TI公司生产的DP83848CVV芯片及其外围电路组成；所述指示灯单元由贴片LED组成；所述供电单元由金升阳公司生产的降压开关电源模块及其外围保护、滤波、稳压电路组成。在降压开关电源模块的输入端连接有防浪涌电路，使本网关具有抗雷击和冲击的性能；降压开关电源模块将输入的220V交流电压变为5V直流电压，由于上述各单元工作电压都为3.3V,因此采用AS1117线性稳压器将电压降为3.3V，在降压开关电源模块和线性稳压器的输出端都设计了滤波电路。本专利技术的运动应用程序主要包括运动控制功能库、控制主进程、EtherCAT总线通信线程和程序监听线程组成。所述的运动控制功能库，是根据被控对象的控制模型建立的控制算法库；所述的控制主进程，是控制被控对象执行运动指令的应用程序主逻辑进程。所述的EtherCAT总线通信线程，是控制器和伺服驱动器之间的总线通信，包括状态采集和指令传输。所述的程序监听线程，是处理运动控制器的请求响应，其中包括基于网络的更新请求和基于硬件按键的中断请求。如图2所示，支持运动控制模块在线升级的运动控制器，其执行过程包含以下步骤：步骤S1：上电，初始化运动控制器；步骤S2：执行运动控制主程序，同时触发执行监听线程和EtherCAT总线通信线程；步骤S3：通过EtherCAT总线协议，检查网络结构，初始化伺服驱动器，实时采集伺服驱动器状态信息；步骤S4：读取伺服驱动器状态参数和运动控制指令解析运动控制模型，生成运动控制指令，若运动控制指令为空，则等待；步骤S5：实时传输运动控制指令，重复步骤S3；步骤S6：若触发硬件中断触发，则执行步骤S1；若触发网络更新请求，则执行程序下载，完毕后执行步骤S1.下面就本专利技术的运动控制应用程序部分具体实施方式做进一步详细说明。本实施例中要求确保运动控制器与伺服驱动器之间保持稳定连接。图3给出了本文档来自技高网...

【技术保护点】
一种支持运动控制模块在线升级的运动控制方法，其特征在于包括以下步骤：主控单元执行运动控制主进程，并触发EtherCAT总线通信线程和监听线程；通过EtherCAT总线通信线程，根据EtherCAT总线通信层协议检查网络结构、初始化伺服驱动器；通过监听线程对信号量进行监听：当监听到中断信号，则主控单元重置；当监听到上位机发送的运动控制模块更新信号时，进行在线更新；同时，通过运动控制主进程解析上位机发来的运动控制任务：根据运动控制任务确定伺服驱动器状态信息参数列表和运动控制指令；根据EtherCAT总线应用层协议实时采集伺服驱动器状态信息，并解析运动控制模型生成控制命令实时传输给伺服驱动器。

【技术特征摘要】
1.一种支持运动控制模块在线升级的运动控制方法，其特征在于包括以下步骤：主控单元执行运动控制主进程，并触发EtherCAT总线通信线程和监听线程；通过EtherCAT总线通信线程，根据EtherCAT总线通信层协议检查网络结构、初始化伺服驱动器；通过监听线程对信号量进行监听：当监听到中断信号，则主控单元重置；当监听到上位机发送的运动控制模块更新信号时，进行在线更新；同时，通过运动控制主进程解析上位机发来的运动控制任务：根据运动控制任务确定伺服驱动器状态信息参数列表和运动控制指令；根据EtherCAT总线应用层协议实时采集伺服驱动器状态信息，并解析运动控制模型生成控制命令实时传输给伺服驱动器。2.根据权利要求1所述的一种支持运动控制模块在线升级的运动控制方法，其特征在于所述伺服驱动器状态信息根据CIA402应用层协议封装，包括状态字、实时速度信息、实时扭矩信息、实时末端位置信息、当前运动控制模式。3.根据权利要求1所述的一种支持运动控制模块在线升级的运动控制方法，其特征在于所述运动控制指令根据CIA402应用层协议封装，包括指令字、速度信息、...

【专利技术属性】
技术研发人员：杨帆，张华良，曾鹏，于海斌，
申请(专利权)人：中国科学院沈阳自动化研究所，
类型：发明
国别省市：辽宁,21