CN111474908A - 一种集成CANopen协议的运动控制从站的实现方法、系统及介质 - Google Patents
一种集成CANopen协议的运动控制从站的实现方法、系统及介质 Download PDFInfo
- Publication number
- CN111474908A CN111474908A CN202010327121.2A CN202010327121A CN111474908A CN 111474908 A CN111474908 A CN 111474908A CN 202010327121 A CN202010327121 A CN 202010327121A CN 111474908 A CN111474908 A CN 111474908A
- Authority
- CN
- China
- Prior art keywords
- communication
- data
- cia301
- canopen
- motion control
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 55
- 238000004891 communication Methods 0.000 claims abstract description 116
- 230000002093 peripheral effect Effects 0.000 claims abstract description 19
- 230000006870 function Effects 0.000 claims description 28
- 238000013500 data storage Methods 0.000 claims description 25
- 230000008569 process Effects 0.000 claims description 16
- 230000001360 synchronised effect Effects 0.000 claims description 15
- 238000012545 processing Methods 0.000 claims description 14
- 238000004590 computer program Methods 0.000 claims description 13
- 238000004458 analytical method Methods 0.000 claims description 9
- 230000001133 acceleration Effects 0.000 claims description 7
- 238000003860 storage Methods 0.000 claims description 6
- 238000001514 detection method Methods 0.000 claims description 4
- 238000013461 design Methods 0.000 abstract description 10
- 230000010354 integration Effects 0.000 abstract description 6
- 238000006243 chemical reaction Methods 0.000 abstract description 4
- 238000010586 diagram Methods 0.000 description 6
- 230000005540 biological transmission Effects 0.000 description 3
- 238000001914 filtration Methods 0.000 description 2
- 238000012423 maintenance Methods 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 238000011161 development Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000003754 machining Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000005192 partition Methods 0.000 description 1
- 230000008439 repair process Effects 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 238000002054 transplantation Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/418—Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS] or computer integrated manufacturing [CIM]
- G05B19/4185—Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS] or computer integrated manufacturing [CIM] characterised by the network communication
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/33—Director till display
- G05B2219/33139—Design of industrial communication system with expert system
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Engineering & Computer Science (AREA)
- General Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Quality & Reliability (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Programmable Controllers (AREA)
Abstract
本发明公开了一种集成CANopen协议的运动控制从站的实现方法、系统及介质，本发明方法包括初始化CiA301协议栈的定时器、通信外设和CiA301协议栈；如果检测到通信帧，则将通信数据帧转化进入CiA301协议栈并按需返回通讯数据，设置CiA402执行周期，在每一次通信中断若达到伺服周期执行条件则通过预设的控制算法模型生成对应的运动控制算法模块并将其集成到CiA402的执行周期中。本发明提供了集成CANopen标准协议的运动控制从站的标准化设计方法，可用于解决标准的CiA301通信协议集成、链路层与应用层协议数据转换、CiA402及运动控制算法模块的设计的标准化问题。
Description
技术领域
本发明涉及机器人的运动控制技术，具体涉及一种集成CANopen协议的运动控制从站的实现方法、系统及介质，应用于符合CANopen协议的PLC运动控制从站底层实现。
背景技术
CANopen协议是一种广泛应用于工业现场控制的应用层协议，常在嵌入式系统中使用，包括通讯子协议和设备子协议。CANopen协议可以集成于多种链路层总线上，具有对多个节点进行过程数据与服务数据的传输、设备状态监控、检错等功能；使用对象字典为现场控制主站与从站数据交换提供了标准的数据接口，是一种数据传输可靠、标准化程度极高、功能完善的现场总线应用层协议。
工业现场往往需要对工业设备的多个运动轴进行相关的运动控制，用以操作机械相关部件精确地实现位置、速度、力矩闭环控制。这使得控制过程中多个运动控制设备之间实时过程数据与非实时服务数据之间需要建立一个完善的数据传输使用通道，以满足多个设备协同控制的需要；此外由于各种运动控制器的软件结构的差异，不同设备的上位机程序、指令操作、维护存在差异，因此需要建立一种标准的运动控制程序架构，使编程方式、指令操作、维护维修方法趋于一致。在移植性上来说，运动控制器在设计时已经将程序固化，使用过程中无法改动，更难以实现跨平台移植；从应用领域的角度出发，适用于某一应用的运动控制器可能不能适应其他应用，也就是说一种运动控制器只能应用于单一应用场景；因此，针对运动控制器标准化、可重构、总线式控制等要求，通过结合CANopen的CiA301通信协议集成、CiA402设备子协议集成，基于模型的运动控制算法设计等方法，并形成一种标准化程度高的总线式运动控制从站的设计方法，已经成为一项亟待解决的关键技术问题。
发明内容
本发明要解决的技术问题：针对现有技术的上述问题，提供一种集成CANopen协议的运动控制从站的实现方法、系统及介质，本发明提供了集成CANopen标准协议的运动控制从站的标准化设计方法，可用于解决标准的CiA301通信协议集成、链路层与应用层协议数据转换、CiA402及运动控制算法模块的设计的标准化问题。
为了解决上述技术问题，本发明采用的技术方案为：
一种集成CANopen协议的运动控制从站的实现方法，实施步骤包括：
1）将CiA301协议栈的定时器与处理器内部的定时器进行连接，初始化通信外设和CiA301协议栈；
2）检测系统接收到数据存储指令和是否存在错误，如果检测到数据存储指令则进行数据存储，如果检测到错误则进行报警；
3）检测通信帧，如果检测到通信帧，则将总线链路层上传输的通信数据帧格式解析并转化为CANopen标准的帧格式进入CiA301协议栈，通过CiA301协议栈将数据帧进行处理并把相应结果存储；
4）判断数据存储指令是否需要返回通信数据，如果需要返回通讯数据则将CiA301协议栈返回的CANopen标准帧解析并生成通信链路上传的数据帧格式并向总线发出；
5）通过计算同步帧发送次数及同步周期，设置基于CANopen通信周期的CiA402执行周期，所述CiA402执行周期为伺服周期；
6）在每一次通信中断时，判断同步帧接收次数是否达到伺服周期执行条件，若达到伺服周期执行条件则通过预设的符合CiA402功能要求的控制算法模型生成对应的运动控制算法模块并将其集成到CiA402的执行周期中，若没达到伺服周期执行条件则退出此次通信中断。
可选地，步骤1）的详细步骤包括：上电后首先将处理器内部的定时器与CiA301协议栈中的定时器TimeDispatch相关联以为CiA301协议栈提供时间基准，然后初始化处理器外设和CiA301协议栈，所述初始化处理器外设时包括获取处理器的通信外设及节点号。
可选地，步骤2）的详细步骤包括：检测是否出现系统异常或者收到数据存储指令，如果出现系统异常或者收到数据存储指令则将对象字典中关键信息存到闪存Flash中；检测从站是否出现错误状态，当检测到错误状态时进行报警提示，所述对象字典是一组具有16位地址长度的数据链表，分区间定义了从站的在运行过程中需要使用的数据、配置参数，所述配置参数包括：通信模式相关参数、从站通信的通道类型和数量配置参数、通道中传输的对象类型和索引号的配置等参数、运动控制指令和反馈及控制参数等由于运动控制过程需要使用的参数、便于功能扩充与升级的预定义参数。
可选地，步骤3）的详细步骤包括：判断是否接收到通信数据，在确定接收到通信数据后将接收的数据进行解析得到ID、帧类型、数据，再将解析结果组合成为CANopen标准数据帧，然后将组合后和结果放入CiA301协议栈进行处理。
可选地，步骤4）的详细步骤包括：判断协议栈是否需要发送数据帧，当需要发送数据帧时将要发送的数据进行解析得到ID、帧类型、数据，再将解析结果组合成为CANopen标准数据帧，然后将组合后和结果发送至链路层，以通过微处理器的通信接口发送到总线上。
可选地，步骤6）中通过预设的符合CiA402功能要求的控制算法模型生成对应的运动控制算法模块并将其集成到CiA402的执行周期中的详细步骤包括：根据系统使能要求判断从站处于位置、速度、转矩、插补、回零中的何种运动模式；根据每一种模式的实际控制方式对指令进行解析并转换成为三环控制器中的位置指令或速度指令或电流指令；根据模式和指令，执行三环控制器中的电流环或速度环或位置环；所述三环控制器分别包括位置环、速度环和电流环，电机的反馈位置和规划位置一起作为位置环的位置环控制器的输入，位置环控制器的输出和速度指令一起作为第一模式选择器的输入，第一模式选择器的输出作为加减速规划模块的输入以生成规划速度；电机的速度通过反馈滤波器后与规划速度一起作为速度换的速度环控制器的输入，速度环控制器的输出和电流指令作为第二模式选择器的输入，第二模式选择器的输出则作为规划电流；电机的电流和规划电流一起作为电流环的电流环控制器的输入，电流环控制器的输出则通过输出陷波器输出给电机。
此外，本发明还提供一种集成CANopen协议的运动控制从站的实现系统，包括：
初始化模块，用于将CiA301协议栈的定时器与处理器内部的定时器进行连接，初始化通信外设和CiA301协议栈；
主程序循环模块，用于检测检测是否出现系统异常或者收到数据存储指令，如果收到数据存储指令则将对象字典中关键信息存到闪存Flash中；检测从站是否出现错误状态，当检测到错误状态则进行报警提示；
通信数据接收模块，用于将总线链路层上传输的通信数据帧格式解析并转化为CANopen标准的帧格式进入CiA301协议栈，通过CiA301协议栈将数据帧进行处理并把相应结果存储；
对象字典模块，用于存储CiA301协议栈处理后的数据帧；
通信数据发送模块，用于判断数据存储指令是否需要返回通信数据，如果需要返回通讯数据则将CiA301协议栈返回的CANopen标准帧解析并生成通信链路上传的数据帧格式并向总线发出；
CiA402执行模块，用于通过计算同步帧发送次数及同步周期，设置基于CANopen通信周期的CiA402执行周期，所述CiA402执行周期为伺服周期；
运动控制算法模块，用于在每一次通信中断时，判断同步帧接收次数是否达到伺服周期执行条件，若达到伺服周期执行条件则通过预设的符合CiA402功能要求的控制算法模型生成对应的运动控制算法模块并将其集成到CiA402的执行周期中，若没达到伺服周期执行条件则退出此次通信中断。
此外，本发明还提供一种集成CANopen协议的运动控制从站的实现系统，包括计算机设备，该计算机设备被编程或配置以执行所述集成CANopen协议的运动控制从站的实现方法的步骤。
此外，本发明还提供一种集成CANopen协议的运动控制从站的实现系统，包括计算机设备，该计算机设备的存储器上存储有被编程或配置以执行所述集成CANopen协议的运动控制从站的实现方法的计算机程序。
此外，本发明还提供一种计算机可读存储介质，该计算机可读存储介质上存储有被编程或配置以执行所述集成CANopen协议的运动控制从站的实现方法的计算机程序。
和现有技术相比，本发明具有下述优点：本发明通过在通用MCU芯片中集成CANOpen通信协议和运动控制设备子协议的方式，形成了高度标准的运动控制从站，为工业控制领域中运动控制从站的设计与研发提供了可靠的方法。使用该方法不仅能够实现多节点分布式控制，还能方便的增加同步功能，使整个控制系统的过程数据与服务数据有序的传输。本发明提出的方法不局限于CAN通信链路层网络，通过CiA301协议栈与通信数据接口集成方法，可以方便的将CAN链路层替换成EtherCAT等其他总线。通过采用CiA402标准的集成及基于模型的控制算法设计方法，可以为所有运动控制设备提供一个标准的软件架构和控制算法架构，使运动控制相关设备开发周期大大减小。使用本专利所述的软件架构标准化程度高、便于在各硬件平台移植、可替换性好，能够广泛应用于精密加工、机器人、工业控制等领域。
附图说明
图1为本发明实施例方法的基本实现原理示意图。
图2为本发明实施例的系统结构框图。
图3是本发明实施例中主程序模块流程图。
图4是本发明实施例中通信数据接收模块流程图。
图5是本发明实施例中通信数据发送模块流程图。
图6是本发明实施例中运动控制算法整体框图。
具体实施方式
如图1所示，本实施例集成CANopen协议的运动控制从站的实现方法的实施步骤包括：
1）将CiA301协议栈的定时器与处理器内部的定时器进行连接，初始化通信外设和CiA301协议栈；
2）检测系统接收到数据存储指令和是否存在错误，如果检测到数据存储指令则进行数据存储，如果检测到错误则进行报警；
3）检测通信帧，如果检测到通信帧则进行，将总线链路层上传输的通信数据帧格式解析并转化为CANopen标准的帧格式进入CiA301协议栈，通过CiA301协议栈将数据帧进行处理并把相应结果存储；
4）判断通信帧类型是否需要返回通信数据，如果需要返回通讯数据则将CiA301协议栈返回的CANopen标准帧解析并生成通信链路上传的数据帧格式并向总线发出；
5）通过计算同步帧发送次数及同步周期，设置基于CANopen通信周期的CiA402执行周期，所述CiA402执行周期为伺服周期；
6）在每一次通信中断时，判断同步帧接收次数是否达到伺服周期执行条件，若达到伺服周期执行条件则通过预设的符合CiA402功能要求的控制算法模型生成对应的运动控制算法模块并将其集成到CiA402的执行周期中，若没达到伺服周期执行条件则退出此次通信中断。
本实施例中，步骤1）的详细步骤包括：上电后首先将处理器内部的定时器与CiA301协议栈中的定时器TimeDispatch相关联以为CiA301协议栈提供时间基准，然后初始化处理器外设和CiA301协议栈，所述初始化处理器外设时包括获取处理器的通信外设及节点号。
本实施例中，步骤2）的详细步骤包括：检测是否出现系统异常或者收到数据存储指令，如果出现系统异常或者收到数据存储指令则将对象字典中关键信息存到闪存Flash中；检测从站是否出现错误状态，当检测到错误状态时进行报警提示，所述对象字典是一组具有16位地址长度的数据链表，分区间定义了从站的在运行过程中需要使用的数据、配置参数，所述配置参数包括：通信模式相关参数、从站通信的通道类型和数量配置参数、通道中传输的对象类型和索引号的配置等参数、运动控制指令和反馈及控制参数等由于运动控制过程需要使用的参数、便于功能扩充与升级的预定义参数。
本实施例中，步骤3）的详细步骤包括：判断是否接收到通信帧，在确定接收到通信帧后将接收的数据进行解析得到ID、帧类型、数据，再将解析结果组合成为CANopen标准数据帧，然后将组合后和结果放入CiA301协议栈进行处理。
本实施例中，步骤4）的详细步骤包括：判断协议栈是否需要发送数据帧，当需要发送数据帧时将要发送的数据进行解析得到ID、帧类型、数据，再将解析结果组合成为CANopen标准数据帧，然后将组合后和结果发送至链路层，以通过微处理器的通信接口发送到总线上。
本实施例中，步骤6）中通过预设的符合CiA402功能要求的控制算法模型生成对应的运动控制算法模块并将其集成到CiA402的执行周期中的详细步骤包括：根据系统使能要求判断从站处于位置、速度、转矩、插补、回零中的何种运动模式；根据每一种模式的实际控制方式对指令进行解析并转换成为三环控制器中的位置指令或速度指令或电流指令；根据模式和指令，执行三环控制器中的电流环或速度环或位置环；所述三环控制器分别包括位置环、速度环和电流环，电机的反馈位置和规划位置一起作为位置环的位置环控制器的输入，位置环控制器的输出和速度指令一起作为第一模式选择器的输入，第一模式选择器的输出作为加减速规划模块的输入以生成规划速度；电机的速度通过反馈滤波器后与规划速度一起作为速度换的速度环控制器的输入，速度环控制器的输出和电流指令作为第二模式选择器的输入，第二模式选择器的输出则作为规划电流；电机的电流和规划电流一起作为电流环的电流环控制器的输入，电流环控制器的输出则通过输出陷波器输出给电机。
如图2所示，本实施例还提供一种集成CANopen协议的运动控制从站的实现系统，包括：
初始化模块1，用于将CiA301协议栈的定时器与处理器内部的定时器进行连接，初始化通信外设和CiA301协议栈；
主程序循环模块2，检测系统接收到数据存储指令和是否存在错误，如果检测到数据存储指令则进行数据存储，如果检测到错误则进行报警；
通信数据接收模块3，用于判断是否接收到通信帧，在接收到通信帧后，将总线链路层上传输的通信数据帧格式解析并转化为CANopen标准的帧格式进入CiA301协议栈，通过CiA301协议栈将数据帧进行处理并把相应结果存储；
对象字典模块4，用于存储CiA301协议栈处理后的数据帧；
通信数据发送模块5，用于判断通信帧是否需要返回通信数据，如果需要返回通讯数据则将CiA301协议栈返回的CANopen标准帧解析并生成通信链路上传的数据帧格式并向总线发出；
CiA402执行模块6，用于通过计算同步帧发送次数及同步周期，设置基于CANopen通信周期的CiA402执行周期，所述CiA402执行周期为伺服周期；
运动控制算法模块7，用于在每一次通信中断时，判断同步帧接收次数是否达到伺服周期执行条件，若达到伺服周期执行条件则通过预设的符合CiA402功能要求的控制算法模型生成对应的运动控制算法模块并将其集成到CiA402的执行周期中，若没达到伺服周期执行条件则退出此次通信中断。
本实施例中，初始化模块1采用MCU的定时器作为时间基准，将CiA301协议栈中与时间相关的函数与MCU定时器相关联，为协议栈相关的收发帧计时判断提供可靠的时间基准。
本实施例中，主程序循环模块2是在主程序循环中设计关键数据存储和错误状态监测、报警的功能模块。在接收到数据保存指令或其它极端情况后将OD中数据保存到Flash中，并且在检测到从站错误状态后产生错误报警帧和与其他外设相关的报警。
初始化模块1、主程序循环模块2都是主程序部分的构成。如图2所示，主程序部分流程图是在MCU上电后，主程序模块的整个程序流程，包括初始化和循环部分。首先上电后，将MCU定时器与CiA301协议栈中TimeDispatch相关联，为协议栈提供时间基准。然后初始化MCU外设和CiA301协议栈。在循环部分不断检测是否出现数据存储指令，若收到则将OD中关键数据存入Flash。同时检测CANopen相关功能是否出现错误状态，若出现则启动错误报警机制。
本实施例中，通信数据接收模块3用于将接收到的链路层通信帧进行解析并按照CANopen帧格式重组，并将重组后的帧放入CiA301协议栈进行处理。如图3所示为通信数据接收模块3的通信终端服务函数中通信接收相关程序和CiA402功能执行相关程序执行的程序流程。首先在确定接收到通信数据后将接收的数据进行解析得到ID、帧类型、数据等，再将解析结果组合成为CANopen标准数据帧，然后见组合后和结果放入CiA301协议栈进行处理，如此则完成了通信接收相关功能。此时，CiA401功能执行程序开始判断同步帧接收次数是否达到伺服周期执行条件，若达到条件则启动CiA402逻辑框架并运行控制算法，若没达到条件则退出此次通信中断。
本实施例中，对象字典模块4用于存储CiA301协议栈处理后的数据帧以及其他数据（例如指令和错误信息等），具体为采用对象字典进行存储。对象字典是一组具有16位地址长度的数据链表，分区间定义了从站的在运行过程中需要使用的数据、配置的参数。主要包括：通信模式相关参数、从站通信的通道类型和数量配置参数、通道中传输的对象类型和索引号的配置等参数、运动控制指令和反馈及控制参数等由于运动控制过程需要使用的参数、便于功能扩充与升级的预定义参数。主站可通过总线对对象字典中参数进行修改操作，而从站在执行功能时，直接从对象字典中取出指令、配置等参数实现相应功能。
通信数据发送模块5是实现在CANopen协议栈输出模块中，将输出的CANopen帧转换成为通信链路层中传输的帧格式并发送到链路层的功能模块。如图4所示为通信数据发送模块5将协议栈返回的数据发送到总线上的过程，在协议栈发送出口位置判断协议栈是否需要发送数据，若有则将要发送的数据帧进行解析，然后将解析结果按照链路层数据帧格式进行重组，然后再通过MCU相关外设将重组帧发送到总线上。
本实施例中，CiA402执行模块6主要目的就是确定CiA402设备子协议执行的周期。为尽可能避免中断嵌套带来的通信中断与定时中断的竞争，利用CANopen协议周期性发送的过程数据和同步数据的传输特点，以此作为时间基准成为CiA402执行时间的相关参数。
本实施例中，运动控制算法模块7采用Matlab基于模型的设计方法，在simulink中建立用于转矩控制的电流环控制器作为内环。内环之上设计具有指令刻度转换、反馈低通滤波、加减速规划等功能的速度环。外环是具有指令刻度转换模块、输出陷波器、轨迹规划模块的位置环。将三环控制器所有配置参数、指令参数等都对照对象字典中相关对象进行命名，通过代码生成控制算法中的配置、指令等参数就能够与对象字典进行对应、即可集成在CiA402执行模块中。运动控制算法模块7采通过建立符合CiA402标准的运动控制执行逻辑，该逻辑通过分析CiA402规定的位置模式、速度模式、转矩模式、插补模式、回零模式的实现原理，通过建立指令解析机制，将5种模式统一于三环运动控制体系中进行处理。
如图5所示，在运动控制算法模块7运行之初，首先根据系统使能要求判断从站处于位置、速度、转矩、插补、回零中的何种运动模式。然后根据每一种模式的实际控制方式对指令进行解析并转换成为三环控制体系中的位置指令或速度指令或电流指令。
插补模式是将插补指令转换成为每个控制周期被控对象的位置增量；回零模式先使用速度闭环控制搜索零点，在找到零点后记录下零点位置并使用位置闭环使控制运行至零点处。位置、速度、转矩三种模式下，则根据模式的指令，执行三环控制（电流环、速度环、位置环）中的某一环，或是某几环。其中三环控制器中设有速度环反馈滤波器，可对反馈速度信号进行低通滤波，滤除高频噪声；输出通道具有输出陷波器，能够通过设置陷波参数，使输出值避开被控对象机械系统的共振频率区间，使其平稳运行；速度指令通道上设计有加减速规划模块，能够通过设置加减速度使被控对象在运行过程中以设置的加减速运行，减少启停时产生的冲击；位置指令通道上设计有轨迹规划模块，预设有多种运行轨迹曲线，通过选择可使被控对象能够按照设置的轨迹运行。
此外，本实施例还提供一种集成CANopen协议的运动控制从站的实现系统，包括计算机设备，该计算机设备被编程或配置以执行前述集成CANopen协议的运动控制从站的实现方法的步骤。
此外，本实施例还提供一种集成CANopen协议的运动控制从站的实现系统，包括计算机设备，该计算机设备的存储器上存储有被编程或配置以执行前述集成CANopen协议的运动控制从站的实现方法的计算机程序。
此外，本实施例还提供一种计算机可读存储介质，该计算机可读存储介质上存储有被编程或配置以执行前述集成CANopen协议的运动控制从站的实现方法的计算机程序。
本领域内的技术人员应明白，本申请的实施例可提供为方法、系统、或计算机程序产品。因此，本申请可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且，本申请可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质（包括但不限于磁盘存储器、CD-ROM、光学存储器等）上实施的计算机程序产品的形式。本申请是参照根据本申请实施例的方法、设备（系统）、和计算机程序产品的流程图和／的处理器执行的指令产生用于实现在流程图一个流程或多个流程和／或方框图一个方框或多个方框中指定的功能的装置。这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中，使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品，该指令装置实现在流程图一个流程或多个流程和／或方框图一个方框或多个方框中指定的功能。这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上，使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理，从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和／或方框图一个方框或多个方框中指定的功能的步骤。
以上所述仅是本发明的优选实施方式，本发明的保护范围并不仅局限于上述实施例，凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出，对于本技术领域的普通技术人员来说，在不脱离本发明原理前提下的若干改进和润饰，这些改进和润饰也应视为本发明的保护范围。
Claims (10)
1.一种集成CANopen协议的运动控制从站的实现方法，其特征在于实施步骤包括：
1）将CiA301协议栈的定时器与处理器内部的定时器进行连接，初始化通信外设和CiA301协议栈；
2）检测系统接收到数据存储指令和是否存在错误，如果检测到数据存储指令则进行数据存储，如果检测到错误则进行报警提示；
3）检测通信帧，如果检测到通信帧，则将总线链路层上传输的通信数据帧格式解析并转化为CANopen标准的帧格式进入CiA301协议栈，通过CiA301协议栈将数据帧进行处理并把相应结果存储；
4）判断通信帧类型是否需要返回通信数据，如果需要返回通讯数据则将CiA301协议栈返回的CANopen标准帧解析并生成通信链路上传的数据帧格式并向总线发出；
5）通过计算同步帧发送次数及同步周期，设置基于CANopen通信周期的CiA402执行周期，所述CiA402执行周期为伺服周期；
6）在每一次通信中断时，判断同步帧接收次数是否达到伺服周期执行条件，若达到伺服周期执行条件则通过预设的符合CiA402功能要求的控制算法模型生成对应的运动控制算法模块并将其集成到CiA402的执行周期中，若没达到伺服周期执行条件则退出此次通信中断。
2.根据权利要求1所述的集成CANopen协议的运动控制从站的实现方法，其特征在于，步骤1）的详细步骤包括：上电后首先将处理器内部的定时器与CiA301协议栈中的定时器TimeDispatch相关联以为CiA301协议栈提供时间基准，然后初始化处理器外设和CiA301协议栈，所述初始化处理器外设时包括获取处理器的通信外设及节点号。
3.根据权利要求1所述的集成CANopen协议的运动控制从站的实现方法，其特征在于，步骤2）的详细步骤包括：检测是否出现系统异常或者收到数据存储指令，如果出现系统异常或者收到数据存储指令则将对象字典中关键信息存到闪存Flash中；检测从站是否出现错误状态，当检测到错误状态时进行报警提示，所述对象字典是一组具有16位地址长度的数据链表，分区间定义了从站的在运行过程中需要使用的数据、配置参数，所述配置参数包括：通信模式相关参数、从站通信的通道类型和数量配置参数、通道中传输的对象类型和索引号的配置等参数、运动控制指令和反馈及控制参数等由于运动控制过程需要使用的参数、便于功能扩充与升级的预定义参数。
4.根据权利要求1所述的集成CANopen协议的运动控制从站的实现方法，其特征在于，步骤3）的详细步骤包括：判断是否接收到通信数据，在确定接收到通信数据后将接收的数据进行解析得到ID、帧类型、数据，再将解析结果组合成为CANopen标准数据帧，然后将组合后和结果放入CiA301协议栈进行处理。
5.根据权利要求1所述的集成CANopen协议的运动控制从站的实现方法，其特征在于，步骤4）的详细步骤包括：判断协议栈是否需要发送数据帧，当需要发送数据帧时将要发送的数据进行解析得到ID、帧类型、数据，再将解析结果组合成为CANopen标准数据帧，然后将组合后和结果发送至链路层，以通过微处理器的通信接口发送到总线上。
6.根据权利要求1所述的集成CANopen协议的运动控制从站的实现方法，其特征在于，步骤6）中通过预设的符合CiA402功能要求的控制算法模型生成对应的运动控制算法模块并将其集成到CiA402的执行周期中的详细步骤包括：根据系统使能要求判断从站处于位置、速度、转矩、插补、回零中的何种运动模式；根据每一种模式的实际控制方式对指令进行解析并转换成为三环控制器中的位置指令或速度指令或电流指令；根据模式和指令，执行三环控制器中的电流环或速度环或位置环；所述三环控制器分别包括位置环、速度环和电流环，电机的反馈位置和规划位置一起作为位置环的位置环控制器的输入，位置环控制器的输出和速度指令一起作为第一模式选择器的输入，第一模式选择器的输出作为加减速规划模块的输入以生成规划速度；电机的速度通过反馈滤波器后与规划速度一起作为速度换的速度环控制器的输入，速度环控制器的输出和电流指令作为第二模式选择器的输入，第二模式选择器的输出则作为规划电流；电机的电流和规划电流一起作为电流环的电流环控制器的输入，电流环控制器的输出则通过输出陷波器输出给电机。
7.一种集成CANopen协议的运动控制从站的实现系统，其特征在于包括：
初始化模块（1），用于将CiA301协议栈的定时器与处理器内部的定时器进行连接，初始化通信外设和CiA301协议栈；
主程序循环模块（2），用于检测数据存储指令与系统错误，如果检测到数据存储指令则将对象字典中的关键参数进行保存，如果检测到系统错误则进行报警提示；
通信数据接收模块（3），用于将总线链路层上传输的通信数据帧格式解析并转化为CANopen标准的帧格式进入CiA301协议栈，通过CiA301协议栈将数据帧进行处理并把相应结果存储；
对象字典模块（4），用于存储CiA301协议栈处理后的数据帧；
通信数据发送模块（5），用于判断通信帧是否需要返回通信数据，如果需要返回通讯数据则将CiA301协议栈返回的CANopen标准帧解析并生成通信链路上传的数据帧格式并向总线发出；
CiA402执行模块（6），用于通过计算同步帧发送次数及同步周期，设置基于CANopen通信周期的CiA402执行周期，所述CiA402执行周期为伺服周期；
运动控制算法模块（7），用于在每一次通信中断时，判断同步帧接收次数是否达到伺服周期执行条件，若达到伺服周期执行条件则通过预设的符合CiA402功能要求的控制算法模型生成对应的运动控制算法模块并将其集成到CiA402的执行周期中，若没达到伺服周期执行条件则退出此次通信中断。
8.一种集成CANopen协议的运动控制从站的实现系统，包括计算机设备，其特征在于，该计算机设备被编程或配置以执行权利要求1～6中任意一项所述集成CANopen协议的运动控制从站的实现方法的步骤。
9.一种集成CANopen协议的运动控制从站的实现系统，包括计算机设备，其特征在于，该计算机设备的存储器上存储有被编程或配置以执行权利要求1～6中任意一项所述集成CANopen协议的运动控制从站的实现方法的计算机程序。
10.一种计算机可读存储介质，其特征在于，该计算机可读存储介质上存储有被编程或配置以执行权利要求1～6中任意一项所述集成CANopen协议的运动控制从站的实现方法的计算机程序。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010327121.2A CN111474908B (zh) | 2020-04-23 | 2020-04-23 | 一种集成CANopen协议的运动控制从站的实现方法、系统及介质 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010327121.2A CN111474908B (zh) | 2020-04-23 | 2020-04-23 | 一种集成CANopen协议的运动控制从站的实现方法、系统及介质 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN111474908A true CN111474908A (zh) | 2020-07-31 |
| CN111474908B CN111474908B (zh) | 2021-04-02 |
Family
ID=71761616
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202010327121.2A Active CN111474908B (zh) | 2020-04-23 | 2020-04-23 | 一种集成CANopen协议的运动控制从站的实现方法、系统及介质 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN111474908B (zh) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN112383457A (zh) * | 2020-09-23 | 2021-02-19 | 卡斯柯信号有限公司 | 一种基于CANopen协议的安全从站系统 |
| CN112590880A (zh) * | 2020-12-21 | 2021-04-02 | 中国铁道科学研究院集团有限公司通信信号研究所 | 一种ats控制权切换方法 |
Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20030084216A1 (en) * | 2001-10-26 | 2003-05-01 | Schneider Automation Inc. | Hybrid change of state protocol for CANOpen networks |
| CN103268259A (zh) * | 2013-04-28 | 2013-08-28 | 东方电气集团东方汽轮机有限公司 | 一种canopen从站实现方法及装置 |
| US20140164504A1 (en) * | 2012-12-10 | 2014-06-12 | Parlant Technology, Inc. | System and method for providing customizable communications |
| CN105306326A (zh) * | 2015-11-13 | 2016-02-03 | 上海新时达电气股份有限公司 | 驱动器集成多种工业总线的实现方法 |
| CN106647571A (zh) * | 2016-12-15 | 2017-05-10 | 中国科学院沈阳自动化研究所 | 一种支持认知的运动控制系统及方法 |
| CN106909128A (zh) * | 2015-12-23 | 2017-06-30 | 中国科学院沈阳自动化研究所 | 一种支持运动控制模块在线升级的运动控制方法 |
| CN208015623U (zh) * | 2018-02-05 | 2018-10-26 | 深圳市青蓝自动化科技有限公司 | 一种基于can总线的步进驱动器 |
-
2020
- 2020-04-23 CN CN202010327121.2A patent/CN111474908B/zh active Active
Patent Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20030084216A1 (en) * | 2001-10-26 | 2003-05-01 | Schneider Automation Inc. | Hybrid change of state protocol for CANOpen networks |
| US20140164504A1 (en) * | 2012-12-10 | 2014-06-12 | Parlant Technology, Inc. | System and method for providing customizable communications |
| CN103268259A (zh) * | 2013-04-28 | 2013-08-28 | 东方电气集团东方汽轮机有限公司 | 一种canopen从站实现方法及装置 |
| CN105306326A (zh) * | 2015-11-13 | 2016-02-03 | 上海新时达电气股份有限公司 | 驱动器集成多种工业总线的实现方法 |
| CN106909128A (zh) * | 2015-12-23 | 2017-06-30 | 中国科学院沈阳自动化研究所 | 一种支持运动控制模块在线升级的运动控制方法 |
| CN106647571A (zh) * | 2016-12-15 | 2017-05-10 | 中国科学院沈阳自动化研究所 | 一种支持认知的运动控制系统及方法 |
| CN208015623U (zh) * | 2018-02-05 | 2018-10-26 | 深圳市青蓝自动化科技有限公司 | 一种基于can总线的步进驱动器 |
Non-Patent Citations (1)
| Title |
|---|
| 张林: "基于EtherCAT的伺服电机控制和应用", 《现代信息科技》 * |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN112383457A (zh) * | 2020-09-23 | 2021-02-19 | 卡斯柯信号有限公司 | 一种基于CANopen协议的安全从站系统 |
| CN112383457B (zh) * | 2020-09-23 | 2022-01-28 | 卡斯柯信号有限公司 | 一种基于CANopen协议的安全从站系统 |
| CN112590880A (zh) * | 2020-12-21 | 2021-04-02 | 中国铁道科学研究院集团有限公司通信信号研究所 | 一种ats控制权切换方法 |
| CN112590880B (zh) * | 2020-12-21 | 2023-07-18 | 中国铁道科学研究院集团有限公司通信信号研究所 | 一种ats控制权切换方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN111474908B (zh) | 2021-04-02 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN111474908B (zh) | 一种集成CANopen协议的运动控制从站的实现方法、系统及介质 | |
| KR102235166B1 (ko) | 실시간 로봇 시스템, 로봇 시스템 제어 장치 및 로봇 시스템 제어 방법 | |
| US10071480B2 (en) | Real-time interference check system of machine tool and robot | |
| Ramesh et al. | Intelligent automation of design and manufacturing in machine tools using an open architecture motion controller | |
| Lechler et al. | Software defined manufacturing extends cloud-based control | |
| JP2021536055A (ja) | 人工知能計算装置、制御方法および制御装置、エンジニアステーションおよび産業オートメーションシステム | |
| Regulin et al. | Model based design of knowledge bases in multi agent systems for enabling automatic reconfiguration capabilities of material flow modules | |
| Lesi et al. | Towards plug-n-play numerical control for reconfigurable manufacturing systems | |
| Barbosa et al. | Implementation of a multi-agent system to support zdm strategies in multi-stage environments | |
| US9323242B2 (en) | Method for setting an operating status | |
| CN109454641B (zh) | 一种运动控制器多任务分工及数据交互方法 | |
| Kashevnik et al. | Development of a prototype Cyber Physical Production System with help of Smart-M3 | |
| CN101699361B (zh) | 一种标准化控制机 | |
| Alcaina et al. | Energy‐Efficient Control for an Unmanned Ground Vehicle in a Wireless Sensor Network | |
| CN112346750A (zh) | 组态软件控制方法、系统和存储介质 | |
| CN114995536B (zh) | 一种用于伺服电机的运动控制器 | |
| CN113119105A (zh) | 机器人多机联动控制方法、多机联动控制设备和控制系统 | |
| CN114925607B (zh) | 一种信息物理同步的工业网络管理系统及其预规划方法 | |
| CN114505853B (zh) | 一种工业机器人的远程分层管控方法及系统 | |
| Wagner et al. | Interaction between FeasibilityCheck, PreconditionCheck and SkillExecution in skill-based machining | |
| Truong et al. | Control and implementation of positioning system with symmetrical topology for precision manufacturing | |
| Catalán et al. | Communication types for manufacturing systems. A proposal to distributed control system based on IEC 61499 | |
| Popović et al. | Some robotics concepts for the Industry 4.0 applications | |
| Trkaj | Users introduce component based automation solutions | |
| Fernández et al. | Communication framework for sensor-actuator data in mobile robots |
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 |