CN107317529B - 基于EtherCAT的全闭环步进电机伺服控制系统 - Google Patents

基于EtherCAT的全闭环步进电机伺服控制系统 Download PDF

Info

Publication number
CN107317529B
CN107317529B CN201610264289.7A CN201610264289A CN107317529B CN 107317529 B CN107317529 B CN 107317529B CN 201610264289 A CN201610264289 A CN 201610264289A CN 107317529 B CN107317529 B CN 107317529B
Authority
CN
China
Prior art keywords
motor
ethercat
module
closed
loop
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.)
Active
Application number
CN201610264289.7A
Other languages
English (en)
Other versions
CN107317529A (zh
Inventor
沈钢群
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shanghai Anpu Mingzhi Automation Equipment Co ltd
Original Assignee
Shanghai Anpu Mingzhi Automation Equipment Co ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Shanghai Anpu Mingzhi Automation Equipment Co ltd filed Critical Shanghai Anpu Mingzhi Automation Equipment Co ltd
Priority to CN201610264289.7A priority Critical patent/CN107317529B/zh
Publication of CN107317529A publication Critical patent/CN107317529A/zh
Application granted granted Critical
Publication of CN107317529B publication Critical patent/CN107317529B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • HELECTRICITY
    • H02GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02PCONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P8/00Arrangements for controlling dynamo-electric motors rotating step by step
    • H02P8/12Control or stabilisation of current
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/04Programme control other than numerical control, i.e. in sequence controllers or logic controllers
    • G05B19/042Programme control other than numerical control, i.e. in sequence controllers or logic controllers using digital processors
    • G05B19/0421Multiprocessor system
    • HELECTRICITY
    • H02GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02PCONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P8/00Arrangements for controlling dynamo-electric motors rotating step by step
    • H02P8/14Arrangements for controlling speed or speed and torque

Landscapes

  • Engineering & Computer Science (AREA)
  • Power Engineering (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Stepping Motors (AREA)

Abstract

本发明涉及一种基于EtherCAT的全闭环步进电机伺服控制系统,包括共享内存以及分别与共享内存连接的基于ARM的EtherCAT通信子系统和基于DSP的电机驱动全闭环控制子系统;所述的基于ARM的EtherCAT通信子系统接收EtherCAT主站的数据,并按照应用层协议解析命令,发送给电机驱动全闭环控制子系统,或者从电机驱动全闭环控制子系统中获取电机状态信息,并打包成EtherCAT通信数据帧传输回EtherCAT主站;所述的基于DSP的电机驱动全闭环控制子系统检测共享内存中通过EtherCAT通信子系统的控制命令,根据得到的反馈信息并结合用户的配置,闭环或者全闭环伺服控制步进电机。与现有技术相比,本发明具有低成本、高通信速率、高精度、高性能、高可靠性、全速率等优点。

Description

基于EtherCAT的全闭环步进电机伺服控制系统
技术领域
本发明涉及一种步进电机伺服控制系统,尤其是涉及一种基于EtherCAT的全闭环步进电机伺服控制系统。
背景技术
目前,工业现场对于现场总线的需求越来越频繁,对于总线的功能和性能也要求越来越高。
传统的工业现场总线,如RS485,CAN等总线,速率低,数据量传输小,特别是在远距离传输时更加的需要降低速率来实现传输的可靠性,否者需要额外增加中继器来减小信号的衰减,从而提高速率,但同时增加布线难度和繁琐,并增加成本。另外,传统的工业实时以太网协议Modbus/TCP、EtherNet/IP等,由于未修改以太网协议并通过软件协议栈来实现通信,数据包的打包和解析必然会导致一定意义上的延时,所以也未能达到真正意义上的实时性。
另外,基于高性能高速率的现场总线动作执行机构,目前大多数为交流伺服驱动器,但在某些应用场合,如测量仪、雕刻机、木工加工等,需要低功率大力矩,高精度,且多轴联动和多轴同步控制的设备,如果使用伺服系统,则需要配备减速器等,大大增加了成本。
发明内容
本发明的目的就是为了克服上述现有技术存在的缺陷而提供一种基于EtherCAT的全闭环步进电机伺服控制系统,基于响应时间小于1ms的硬实时工业以太网EtherCAT实时工业以太网现场总线,基于自定义协议或者标准CoE协议,采用高精度编码器位置反馈,配备第二编码器输入接口,实现真正意义上的低成本、高通信速率、高精度、高性能、高可靠性、全速率的全闭环步进伺服控制驱动系统。
本发明的目的可以通过以下技术方案来实现:
一种基于EtherCAT的全闭环步进电机伺服控制系统,该系统与EtherCAT主站通信连接,其特征在于,所述的控制系统包括共享内存以及分别与共享内存连接的基于ARM的EtherCAT通信子系统和基于DSP的电机驱动全闭环控制子系统;
所述的基于ARM的EtherCAT通信子系统接收EtherCAT主站的数据,并按照应用层协议解析命令,发送给电机驱动全闭环控制子系统,或者从电机驱动全闭环控制子系统中获取电机状态信息,并打包成EtherCAT通信数据帧传输回EtherCAT主站;
所述的基于DSP的电机驱动全闭环控制子系统检测共享内存中通过EtherCAT通信子系统的控制命令,根据得到的反馈信息并结合用户的配置,闭环或者全闭环伺服控制步进电机。
所述的基于ARM的EtherCAT通信子系统包括依次连接的EtherCAT通信模块和EtherCAT应用层协议模块,所述的EtherCAT通信模块与EtherCAT主站通信连接,所述的EtherCAT应用层协议模块与电机驱动全闭环控制子系统连接;
所述的EtherCAT通信模块,用于基于EtherCAT协议的数据帧发送和接收,根据协议规定和用户配置,处理并解析相应的数据块,并存储至通信模块所对应的存储内存;
所述的EtherCAT应用层协议模块,从EtherCAT通信模块的存储内存中,获取数据,根据不同的输入定义,处理EtherCAT通信协议状态机的运行以及数据包的解析和打包,并在此基础上,处理用户应用层协议包。
所述的EtherCAT通信模块设有用于实现多轴同步控制的DC同步信号输出端。
所述的应用层协议包括用户自定义协议或标准协议。
所述的基于DSP的电机驱动全闭环控制子系统包括电机控制驱动模块、功率放大器模块、步进电机模块、以及检测与反馈模块,所述的电机控制驱动模块、功率放大器模块、步进电机模块依次连接,所述的检测与反馈模块分别与步进电机模块、电机控制驱动模块连接;
所述的电机控制驱动模块根据电机位置信息、电机电流反馈信息、驱动输入电压信息,结合用户通过EtherCAT通信子系统的参考命令,实时计算输出控制信号;
所述的功率放大器模块对电机控制驱动模块输入的控制信号进行放大,并输入至步进电机模块;
所述的步进电机模块根据功率放大器的输出信号,控制电机新的位置;
所述的检测与反馈模块检测电机的电流电压信号、位置信息和执行机构位置信息,计算电机的速度、位置或者执行机构的位置,反馈给电机控制驱动模块。
所述的电机控制驱动模块根据不同用户使用不同模式:
力矩模式下,所述的电机控制驱动模块包括电流环闭环算法、模数转换算法、滤波算法以及根据I/O功能提供的报警或是保护功能;
速度模式下,所述的电机控制驱动模块包括电流闭环算法、速度闭环算法、模数转换算法、各个环路的滤波算法以及根据I/O功能提供的报警或是保护功能;
位置模式下,所述的电机控制驱动模块包括电流闭环算法、速度闭环算法、位置闭环算法、模数转换算法、运动轨迹生成算法、各个环路的滤波算法以及根据I/O功能提供的报警或是保护功能。
所述的步进电机模块中设有用于反映电机位置信息的编码器。
与现有技术相比,本发明具有以下优点:
1)通信速率高,基于EtherCAT通信总线,数据的收发速率快,且高有效;
2)布线灵活简单,支持各种网路拓扑结构,布线简单,几乎无距离限制;
3)多轴同步性高,EtherCAT的同步信号输出可以实现很高的多轴同步性;
4)高精度、高响应性能,配备高精度的编码器位置信号部件,采用闭环或者全闭环控制系统,可以达到很高的定位精度和高响应性能;
5)电机温升低寿命长,步进电机采用伺服控制算法,实时根据负载信息动态调整电机电流输出,从而可以实现电机的低温升,加长电机的寿命;
6)低速大力矩,驱动本体为步进电机,相对于伺服电机系统,在低速本身有大力矩特性。另外,本系统伺服控制算法,在boost情况下,加大电机过载能力,实现短时大力矩的输出。
附图说明
图1为本发明的结构示意图;
图2为本发明详细的结构示意图;
图3为本发明后台运行程序流程图;
图4为本发明中断流程图。
其中1为基于ARM的EtherCAT通信子系统,2为基于DSP的电机驱动全闭环控制子系统,3为共享内存,4为EtherCAT主站,5为机械系统执行机构,11为EtherCAT通信模块,12为EtherCAT应用层协议模块,21电机控制驱动模块,22为功率放大器模块,23为步进电机模块,24为检测与反馈模块。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明的一部分实施例,而不是全部实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例,都应属于本发明保护的范围。
实施例
如图1所示,一种基于EtherCAT的全闭环步进电机伺服控制系统,该系统与EtherCAT主站4通信连接,所述的控制系统包括共享内存3以及分别与共享内存连接的基于ARM的EtherCAT通信子系统1和基于DSP的电机驱动全闭环控制子系统2;
所述的基于ARM的EtherCAT通信子系统1接收EtherCAT主站的数据,并按照应用层协议解析命令,发送给电机驱动全闭环控制子系统,或者从电机驱动全闭环控制子系统中获取电机状态信息,并打包成EtherCAT通信数据帧传输回EtherCAT主站;
所述的基于DSP的电机驱动全闭环控制子系统2检测共享内存中通过EtherCAT通信子系统的控制命令,根据得到的反馈信息并结合用户的配置,闭环或者全闭环伺服控制步进电机。此外,本子系统还包含I/O控制模块、系统保护模块,如过温、过流、过压等异常保护。
如图2所示,所述的基于ARM的EtherCAT通信子系统1包括依次连接的EtherCAT通信模块11和EtherCAT应用层协议模块12,所述的EtherCAT通信模块11与EtherCAT主站4通信连接,所述的EtherCAT应用层协议模块与12电机驱动全闭环控制子系统2连接;
所述的EtherCAT通信模块11,用于基于EtherCAT协议的数据帧发送和接收,根据协议规定和用户配置,处理并解析相应的数据块,并存储至通信模块所对应的存储内存;
所述的EtherCAT应用层协议模块12,从EtherCAT通信模块的存储内存中,获取数据,根据不同的输入定义,处理EtherCAT通信协议状态机的运行以及数据包的解析和打包,并在此基础上,处理用户应用层协议包。
所述的EtherCAT通信模块11设有用于实现多轴同步控制的DC同步信号输出端。
所述的应用层协议包括用户自定义协议或标准协议,譬如CoE、SoE、FoE、EoE等,最后形成有效的控制命令数据,如位置控制命令、速度控制命令、力矩控制命令等。
所述的基于DSP的电机驱动全闭环控制子系统2包括电机控制驱动模块21、功率放大器模块22、步进电机模块23、以及检测与反馈模块24,所述的电机控制驱动模块21、功率放大器模块22、步进电机模块23依次连接,所述的检测与反馈模块24分别与步进电机模块21、电机控制驱动模块23连接;
所述的电机控制驱动模块21根据电机位置信息、电机电流反馈信息、驱动输入电压信息,结合用户通过EtherCAT通信子系统的参考命令,实时计算输出控制信号;如果用户配置启用全闭环控制模式,则还需输入机械系统执行机构的位置信息,全闭环控制输入控制信号。
所述的功率放大器模块22对电机控制驱动模块输入的控制信号进行放大,并输入至步进电机模块;
所述的步进电机模块23根据功率放大器的的输出信号,控制电机新的位置;步进电机包含2相、3相和5相电机。
所述的检测与反馈模块24检测电机的电流电压信号、位置信息和执行机构位置信息,计算电机的速度、位置或者执行机构的位置,反馈给电机控制驱动模块。
所述的电机控制驱动模块根据不同用户使用不同模式:
力矩模式下,所述的电机控制驱动模块包括电流环闭环算法、模数转换算法、滤波算法以及根据I/O功能提供的报警或是保护功能;
速度模式下,所述的电机控制驱动模块包括电流闭环算法、速度闭环算法、模数转换算法、各个环路的滤波算法以及根据I/O功能提供的报警或是保护功能;
位置模式下,所述的电机控制驱动模块包括电流闭环算法、速度闭环算法、位置闭环算法、模数转换算法、运动轨迹生成算法、各个环路的滤波算法以及根据I/O功能提供的报警或是保护功能。
所述的步进电机模块中设有用于反映电机位置信息的编码器。
本发明系统采用双核DSP/ARM架构,通信系统和驱动系统独立在不同的平台运行,DSP进行闭环电机控制,而ARM核做EtherCAT通信系统,通过共享内存形式进行数据交互。也可以采用DSP+ARM双处理器架构,同样的DSP为电机控制,而ARM核可以做EtherCAT通信系统。本系统所采用的架构包括但不限于此设计方案,其它如单核系统机构也在此发明保护之中。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到各种等效的修改或替换,这些修改或替换都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应以权利要求的保护范围为准。

Claims (5)

1.一种基于EtherCAT的全闭环步进电机伺服控制系统,该系统与EtherCAT主站通信连接,其特征在于,所述的控制系统包括共享内存以及分别与共享内存连接的基于ARM的EtherCAT通信子系统和基于DSP的电机驱动全闭环控制子系统;
所述的基于ARM的EtherCAT通信子系统接收EtherCAT主站的数据,并按照应用层协议解析命令,发送给电机驱动全闭环控制子系统,或者从电机驱动全闭环控制子系统中获取电机状态信息,并打包成EtherCAT通信数据帧传输回EtherCAT主站;
所述的基于DSP的电机驱动全闭环控制子系统检测共享内存中通过EtherCAT通信子系统的控制命令,根据得到的反馈信息并结合用户的配置,闭环或者全闭环伺服控制步进电机;
所述的基于DSP的电机驱动全闭环控制子系统包括电机控制驱动模块、功率放大器模块、步进电机模块、以及检测与反馈模块,所述的电机控制驱动模块、功率放大器模块、步进电机模块依次连接,所述的检测与反馈模块分别与步进电机模块、电机控制驱动模块连接;
所述的电机控制驱动模块根据电机位置信息、电机电流反馈信息、驱动输入电压信息,结合用户通过EtherCAT通信子系统的参考命令,实时计算输出控制信号;
所述的功率放大器模块对电机控制驱动模块输入的控制信号进行放大,并输入至步进电机模块;
所述的步进电机模块根据功率放大器的输出信号,控制电机新的位置;
所述的检测与反馈模块检测电机的电流电压信号、位置信息和执行机构位置信息,计算电机的速度、位置或者执行机构的位置,反馈给电机控制驱动模块;
所述的步进电机模块中设有用于反映电机位置信息的编码器。
2.根据权利要求1所述的一种基于EtherCAT的全闭环步进电机伺服控制系统,其特征在于,所述的基于ARM的EtherCAT通信子系统包括依次连接的EtherCAT通信模块和EtherCAT应用层协议模块,所述的EtherCAT通信模块与EtherCAT主站通信连接,所述的EtherCAT应用层协议模块与电机驱动全闭环控制子系统连接;
所述的EtherCAT通信模块,用于基于EtherCAT协议的数据帧发送和接收,根据协议规定和用户配置,处理并解析相应的数据块,并存储至通信模块所对应的存储内存;
所述的EtherCAT应用层协议模块,从EtherCAT通信模块的存储内存中,获取数据,根据不同的输入定义,处理EtherCAT通信协议状态机的运行以及数据包的解析和打包,并在此基础上,处理用户应用层协议包。
3.根据权利要求2所述的一种基于EtherCAT的全闭环步进电机伺服控制系统,其特征在于,所述的EtherCAT通信模块设有用于实现多轴同步控制的DC同步信号输出端。
4.根据权利要求2所述的一种基于EtherCAT的全闭环步进电机伺服控制系统,其特征在于,所述的应用层协议包括用户自定义协议或标准协议。
5.根据权利要求1所述的一种基于EtherCAT的全闭环步进电机伺服控制系统,其特征在于,所述的电机控制驱动模块根据不同用户使用不同模式:
力矩模式下,所述的电机控制驱动模块包括电流环闭环算法、模数转换算法、滤波算法以及根据I/O功能提供的报警或是保护功能;
速度模式下,所述的电机控制驱动模块包括电流闭环算法、速度闭环算法、模数转换算法、各个环路的滤波算法以及根据I/O功能提供的报警或是保护功能;
位置模式下,所述的电机控制驱动模块包括电流闭环算法、速度闭环算法、位置闭环算法、模数转换算法、运动轨迹生成算法、各个环路的滤波算法以及根据I/O功能提供的报警或是保护功能。
CN201610264289.7A 2016-04-26 2016-04-26 基于EtherCAT的全闭环步进电机伺服控制系统 Active CN107317529B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610264289.7A CN107317529B (zh) 2016-04-26 2016-04-26 基于EtherCAT的全闭环步进电机伺服控制系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610264289.7A CN107317529B (zh) 2016-04-26 2016-04-26 基于EtherCAT的全闭环步进电机伺服控制系统

Publications (2)

Publication Number Publication Date
CN107317529A CN107317529A (zh) 2017-11-03
CN107317529B true CN107317529B (zh) 2023-11-03

Family

ID=60184356

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610264289.7A Active CN107317529B (zh) 2016-04-26 2016-04-26 基于EtherCAT的全闭环步进电机伺服控制系统

Country Status (1)

Country Link
CN (1) CN107317529B (zh)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107992109B (zh) * 2017-12-06 2021-03-09 深圳易能电气技术股份有限公司 全闭环定位控制系统及方法
CN110912474A (zh) * 2018-09-17 2020-03-24 深圳市雷赛智能控制股份有限公司 基于EtherCAT协议的闭环步进电机控制系统与驱动装置
CN109032044B (zh) * 2018-09-25 2020-11-27 珠海格力电器股份有限公司 控制系统及设备
CN114691178B (zh) * 2022-05-31 2022-09-06 深圳市杰美康机电有限公司 一种基于EtherCAT通讯驱动器的固件升级方法及装置
CN117811442A (zh) * 2023-11-24 2024-04-02 钛玛科(北京)工业科技有限公司 一种基于EtherCAT的纠偏电机控制系统

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007267480A (ja) * 2006-03-28 2007-10-11 Yaskawa Electric Corp サーボ制御装置とそれを利用するサーボシステム
CN103336471A (zh) * 2013-06-14 2013-10-02 华南理工大学 一种基于EtherCAT网络通信的伺服运动控制卡
CN103425106A (zh) * 2013-08-08 2013-12-04 华南理工大学 一种基于Linux的EtherCAT主/从站控制系统及方法

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007267480A (ja) * 2006-03-28 2007-10-11 Yaskawa Electric Corp サーボ制御装置とそれを利用するサーボシステム
CN103336471A (zh) * 2013-06-14 2013-10-02 华南理工大学 一种基于EtherCAT网络通信的伺服运动控制卡
CN103425106A (zh) * 2013-08-08 2013-12-04 华南理工大学 一种基于Linux的EtherCAT主/从站控制系统及方法

Also Published As

Publication number Publication date
CN107317529A (zh) 2017-11-03

Similar Documents

Publication Publication Date Title
CN107317529B (zh) 基于EtherCAT的全闭环步进电机伺服控制系统
CN103538065B (zh) 减振控制机器人系统
WO2002052715A1 (fr) Systeme de commande d'entrainement d'un servomoteur
WO2022148328A1 (zh) 关节执行器及其控制方法、机器人、存储介质及电子设备
CN108448948A (zh) 基于位置补偿的网络化多直线开关磁阻电机跟踪控制系统
CN104112872B (zh) 动力锂离子方双针电池卷绕机张力同步控制器
CN109676633B (zh) 三轴机械臂定点控制系统及方法
CN111866020B (zh) 一种通讯卡以及一种通讯方法
CN113485205B (zh) 一种基于canbus总线的伺服驱动器时钟同步和位置重构方法
CN102520678A (zh) 一种射电望远镜主动反射面板远程控制系统
CN210780852U (zh) 一种多协议转换网关
CN202583811U (zh) 一种基于EtherCAT总线技术的多轴同步运动控制系统
CN109491332B (zh) 一种用于机电伺服的高速高精密多轴并行控制系统
CN201467053U (zh) 步进同步驱动系统
CN203466758U (zh) 一种缝纫机的双电机位置反馈控制系统
CN117614318A (zh) 一种基于dsp和fpga双处理器的伺服驱动器
CN205622559U (zh) 基于EtherCAT的全闭环步进电机伺服控制系统
KR101349939B1 (ko) 변전소 자동화 시스템용 프로토콜 변환장치
Li et al. Predictive current control of a switched reluctance machine in the direct-drive manipulator of cloud robotics
Yoon et al. Gateway between high-performance Fieldbus and serial communication
CN116009484A (zh) 多轴伺服控制系统
CN111740681A (zh) 一种多功能电机控制器及其应用的双电爪电机控制器
Gu et al. Control system design of 6-DOFs serial manipulator based on real-time ethernet
CN207281569U (zh) 一种叠片机
CN105867881A (zh) 一种用于机器人的通讯方法及数据交互装置

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