CN111464073A - 一种双电机同步控制装置及方法 - Google Patents
一种双电机同步控制装置及方法 Download PDFInfo
- Publication number
- CN111464073A CN111464073A CN202010367158.8A CN202010367158A CN111464073A CN 111464073 A CN111464073 A CN 111464073A CN 202010367158 A CN202010367158 A CN 202010367158A CN 111464073 A CN111464073 A CN 111464073A
- Authority
- CN
- China
- Prior art keywords
- motor
- controller
- slave
- control
- main motor
- 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.)
- Pending
Links
Images
Classifications
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P5/00—Arrangements specially adapted for regulating or controlling the speed or torque of two or more electric motors
- H02P5/46—Arrangements specially adapted for regulating or controlling the speed or torque of two or more electric motors for speed regulation of two or more dynamo-electric motors in relation to one another
- H02P5/50—Arrangements specially adapted for regulating or controlling the speed or torque of two or more electric motors for speed regulation of two or more dynamo-electric motors in relation to one another by comparing electrical values representing the speeds
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
- H02P21/0003—Control strategies in general, e.g. linear type, e.g. P, PI, PID, using robust control
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
- H02P21/13—Observer control, e.g. using Luenberger observers or Kalman filters
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
- H02P21/22—Current control, e.g. using a current control loop
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P25/00—Arrangements or methods for the control of AC motors characterised by the kind of AC motor or by structural details
- H02P25/02—Arrangements or methods for the control of AC motors characterised by the kind of AC motor or by structural details characterised by the kind of motor
- H02P25/022—Synchronous motors
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P5/00—Arrangements specially adapted for regulating or controlling the speed or torque of two or more electric motors
- H02P5/46—Arrangements specially adapted for regulating or controlling the speed or torque of two or more electric motors for speed regulation of two or more dynamo-electric motors in relation to one another
- H02P5/52—Arrangements specially adapted for regulating or controlling the speed or torque of two or more electric motors for speed regulation of two or more dynamo-electric motors in relation to one another additionally providing control of relative angular displacement
- H02P5/56—Speed and position comparison between the motors by electrical means
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/04—Arrangements for controlling or regulating the speed or torque of more than one motor
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/04—Arrangements for controlling or regulating the speed or torque of more than one motor
- H02P2006/045—Control of current
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P2205/00—Indexing scheme relating to controlling arrangements characterised by the control loops
- H02P2205/01—Current loop, i.e. comparison of the motor current with a current reference
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P2205/00—Indexing scheme relating to controlling arrangements characterised by the control loops
- H02P2205/07—Speed loop, i.e. comparison of the motor speed with a speed reference
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P2207/00—Indexing scheme relating to controlling arrangements characterised by the type of motor
- H02P2207/05—Synchronous machines, e.g. with permanent magnets or DC excitation
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Control Of Multiple Motors (AREA)
Abstract
本发明实施例公开了一种双电机同步控制装置及方法,涉及机电控制技术领域,能够提高双电机同步控制精度,减小主从电机伺服***速度环与电流环的响应周期。本发明的方法包括:嵌入式控制器、FPGA控制器、主电机驱动电路、从电机驱动电路、主电机、从电机、主电机传感器和从电机传感器;所述嵌入式控制器与FPGA控制器通过总线相连接,所述FPGA控制器分别与所述主电机驱动电路和所述从电机驱动电路相连接,所述主电机与所述主电机驱动电路相连接,所述主电机传感器与所述主电机相连接,所述从电机与所述从电机驱动电路相连接,所述从电机传感器与所述从电机相连接。本发明适用于双电机同步控制***。
Description
技术领域
本发明涉及机电控制技术领域,尤其涉及一种双电机同步控制装置及方法,主要可以用于高精度双电机同步控制的场景。
背景技术
双电机同步控制技术是指控制***能够同时控制驱动两个电机运行,在运行过程中对电机运行状态进行监测,将两电机运行时的同步误差实时反馈到控制***进行同步误差补偿,通过同步控制器尽可能减小两电机之间的同步误差,提高控制精度。电机同步控制已广泛应用于制造与生产过程自动化控制***中,电机之间同步控制性能的优劣直接影响***的可靠性和控制精度。因此,电机同步控制具有非常重要的现实意义与应用价值。
在双电机同步控制***中一般采用交叉耦合同步控制结构。而运用先进的控制理论,同时结合交叉耦合控制理论,是双电机同步控制技术的一大发展趋势。但目前的控制理论应用在伺服***中存在一定的局限性,***超调量与快速性这一矛盾始终没有得到解决。
发明内容
本发明的实施例提供一种双电机同步控制装置及方法,能够提高双电机同步控制精度,减小主从电机伺服***速度环与电流环的响应周期。
为达到上述目的,本发明的实施例采用如下技术方案:
一方面,本发明的实施例提供一种双电机同步控制装置,包括:
嵌入式控制器、FPGA控制器、主电机驱动电路、从电机驱动电路、主电机、从电机、主电机传感器和从电机传感器;
所述嵌入式控制器与FPGA控制器通过总线相连接,所述FPGA控制器分别与所述主电机驱动电路和所述从电机驱动电路相连接,所述主电机与所述主电机驱动电路相连接,所述主电机传感器与所述主电机相连接,所述从电机与所述从电机驱动电路相连接,所述从电机传感器与所述从电机相连接。
另一方面,本发明的实施例提供一种双电机同步控制方法,包括:
所述主电机和所述从电机的伺服***,同时接受所述FPGA控制器发出的同一控制指令,并进行所述主电机和所述从电机的伺服***的位置的闭环控制;
在所述嵌入式控制器上运行改进型自抗扰控制器,并通过所述改进型自抗扰控制器,对所述主电机和所述从电机的控制***中的内外扰动进行观测,得到扰动数据后进行扰动补偿;
所述主电机传感器和所述从电机传感器,分别将当前各自的速度数据,反馈至所述嵌入式控制器;
所述嵌入式控制器根据主从电机速度误差进行分数阶控制,并对其进行同步误差补偿;
所述嵌入式控制器的位置环输出与补偿信息处理后的数据,输出至所述FPGA控制器,并作为所述主电机和所述从电机的伺服***的速度环的输入;
所述FPGA控制器同时向所述主电机驱动电路和所述从电机驱动电路,发送SVPWM(Space Vector Pluse Width Modulation,矢量脉宽调制)控制信号,控制所述主电机和所述从电机同步运行。
本发明公开一种双电机同步控制装置及方法。采用嵌入式控制器与FPGA控制器的控制架构,运用改进型自抗扰同步控制算法,可以有效提高双电机同步控制精度,减小主从电机伺服***速度环与电流环的响应周期。具体的,包括嵌入式控制器模块、FPGA控制器模块、主电机模块、从电机模块、主电机传感器模块、从电机传感器模块。其中嵌入式控制器进行伺服***位置环闭环控制,可进行相关算法研究,提高伺服驱动***自身精度;嵌入式控制器进行同步控制器算法研究,对主从电机运行过程中的误差进行补偿;FPGA控制器进行伺服***速度环与电流环硬件闭环控制,利用FPGA控制器高速并行处理能力,提高伺服***速度环与电流环的响应带宽,有利于同步控制器进行及时的误差补偿;主从电机通过传感器将当前与状态运行相关的数据(运行状态数据)传递给FPGA控制器与嵌入式控制器进行伺服***闭环控制与同步控制器进行误差补偿。同步控制器中采用改进型自抗扰控制算法进行误差补偿。本发明提高同步控制***的控制精度与鲁棒性,同时提高同步控制***的响应带宽,实现快速响应。
附图说明
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其它的附图。
图1为本发明实施例提供的双电机同步控制***总体框图;
图2为本发明实施例提供的双电机同步误差补偿原理示意图;
图3为本发明实施例提供的改进型自抗扰控制框图;
图4为本发明实施例提供的分数阶控制器框图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例,都属于本发明保护的范围。下文中将详细描述本发明的实施方式,所述实施方式的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施方式是示例性的,仅用于解释本发明,而不能解释为对本发明的限制。本技术领域技术人员可以理解,除非特意声明,这里使用的单数形式“一”、“一个”、“所述”和“该”也可包括复数形式。应该进一步理解的是,本发明的说明书中使用的措辞“包括”是指存在所述特征、整数、步骤、操作、元件和/或组件,但是并不排除存在或添加一个或多个其他特征、整数、步骤、操作、元件、组件和/或它们的组。应该理解,当我们称元件被“连接”或“耦接”到另一元件时,它可以直接连接或耦接到其他元件,或者也可以存在中间元件。此外,这里使用的“连接”或“耦接”可以包括无线连接或耦接。这里使用的措辞“和/或”包括一个或更多个相关联的列出项的任一单元和全部组合。本技术领域技术人员可以理解,除非另外定义,这里使用的所有术语(包括技术术语和科学术语)具有与本发明所属领域中的普通技术人员的一般理解相同的意义。还应该理解的是,诸如通用字典中定义的那些术语应该被理解为具有与现有技术的上下文中的意义一致的意义,并且除非像这里一样定义,不会用理想化或过于正式的含义来解释。为使本发明技术方案的优点更加清楚,下面结合附图和实施例对本发明作详细说明。
本实施例中所提及的FPGA(Field Programmable Gate Array,现场可编程逻辑门阵列)控制器,指的就是目前已经在很多领域获得广泛应用的FPGA产品。目前,在工业控制领域,FPGA控制器虽然起步较晚,但是发展势头迅猛。基于FPGA控制器的电机控制技术在国外已经得到了很多学者的关注。一些学者为了减轻嵌入式控制器(例如:DSP(数字信号处理)处理器)的计算压力,利用FPGA控制器实现了电机控制***中的某些必要环节:PWM(Pulsewidth modulation)脉冲宽度调制、光电脉冲编码器接口模块、AD(模数转换)采样接口等。一些学者不仅在FPGA控制器中实现了一些简单的电机控制算法,如:PI算法(比例积分算法)等,还基于FPGA控制器研究了一些复杂智能算法。还有一些学者探讨了基于FPGA控制器的无刷直流电机、永磁同步电机等的控制方法,开发出一些电机控制专用IP核,初步实现了基于FPGA控制器的片上***。而嵌入式芯片控制为目前伺服***中的一种主流的控制方式。因此,此***采用嵌入式控制器与FPGA控制器的控制架构,其中嵌入式控制器完成主从电机伺服***的位置环控制与同步误差补偿控制,FPGA控制器完成主从电机伺服***的速度环与电流环硬件闭环控制,此架构极大减小同步误差补偿的滞后时间,提高主从电机伺服***速度环与电流环的响应周期。一些国外专家学者提出了许多关于双电机同步、双电机跟踪的交叉耦合控制理论,Koren、KulKarni和Srinivasan等人发表了多篇关于交叉耦合控制的论文,为以后的双电机同步控制研究奠定了理论基础。近年来,国内的一些学者也对双电机同步控制进行了研究,年海威把重复控制理论和神经网络控制理论运用到双直线电机同步控制***中,同步性能较好,鲁棒性较强。唐雅萍把模糊控制结合神经网络理论运用到电机同步驱动***中,结合两者的优点,同步控制效果较好。由此可见,运用先进的控制理论,同时结合交叉耦合控制理论,是双电机同步控制技术的一大发展趋势。
此***设计的改进型自抗扰控制器是将自抗扰控制器中的非线性状态反馈误差控制律用分数阶PIαDλ控制器(简称分数阶控制器)代替,分数阶PIαDλ控制在响应速度与应用范围上与整数阶PID相比均存在明显优势,分数阶PIαDλ控制器对***不敏感,鲁棒性较强。分数阶积分改善整数阶积分导致***响应速度过慢,积分饱和引起控制量饱和等负面影响。分数阶微分控制对高频噪声有很好的抑制性,当误差变化率改变时,***响应不易产生突变。自抗扰控制是韩京清研究员在PID(比例积分微分)控制的基础上提出的通过扩张状态观测器(Extended State Observer,ESO)对***的内外扰动进行实时观测,在扰动影响***的最终输出前通过非线性状态反馈误差控制律(NLSEF)将其消除。韩京清研究员提出的自抗扰控制为非线性控制,存在待调参数较多、调节复杂及运算量较大等问题。高志强教授根据此问题在非线性自抗扰控制的基础上提出了线性自抗扰控制,将扩张状态观测器线性化,并将待调参数与观测器带宽相联系;将误差反馈控制律用PID控制代替。但是由于整数阶PID控制本身在伺服***中的局限性,***超调量与快速性这一矛盾始终没有得到解决。
因此本实施例的主要设计思路即在于:根据分数阶PIαDλ控制器与自抗扰控制器各自优点将两者相结合设计一种改进型自抗扰控制器。
本发明实施例提供一种双电机同步控制装置,如图1所示,其中包括:
嵌入式控制器、FPGA控制器、主电机驱动电路、从电机驱动电路、主电机、从电机、主电机传感器和从电机传感器。
所述嵌入式控制器与FPGA控制器通过总线相连接,所述FPGA控制器分别与所述主电机驱动电路和所述从电机驱动电路相连接,所述主电机与所述主电机驱动电路相连接,所述主电机传感器与所述主电机相连接,所述从电机与所述从电机驱动电路相连接,所述从电机传感器与所述从电机相连接。
本实施例中,嵌入式控制器为型号TMS320F28335的DSP控制器,具体可以采用TI公司的TMS320F28335 DSP控制器。
FPGA控制器为型号EP3C25E144C8N的FPGA控制器,具体可以采用Altera公司(现已被Intel公司收购)的EP3C25E144C8N FPGA控制器。
具体的,可以通过DC3.3V,DC2.5V和DC1.2V为EP3C25E114C8N FPGA控制模块提供电源。
主电机驱动电路为:交流220v电压经过整流桥进行AC-DC变换,为功率器件IPM提供母线电压,IPM为型号PM50RL1A120的IPM模块。IPM接收控制电路的控制信号,控制功率开关管的导通与关断,将直流电压转换为三相交流电压为主电机供电,具体可以采用IPM为三菱公司的PM50RL1A120 IPM模块。功率驱动过程中采用交-直-交变频电路,主要由整流电路、放电电路和逆变电路组成,整流电路主要是将输入的三相交流电转化为逆变电路的直流输入,选用IR公司的全桥整流模块。放电电路主要是用于将多余的电能释放掉,避免对器件造成损害,当电机停止时,也可以通过观察指示灯来知道滤波电容中的电荷是否释放完毕,而逆变电路中的功率模块则采用三菱公司的PM50RL1A120,这是一款IPM产品,它将功率管和驱动芯片电路整合到一起,且它的内部集成了很多保护电路,可以大大简化功率驱动部分的硬件设计。
从电机驱动电路为:交流220v电压经过整流桥进行AC-DC变换,为功率器件IPM提供母线电压,其中,所采用IPM为型号PM50RL1A120的IPM模块。交流220v电压经过整流桥进行AC-DC变换,为功率器件IPM提供母线电压。IPM接收控制电路的控制信号,控制功率开关管的导通与关断,将直流电压转换为三相交流电压为主电机供电,具体可以采用IPM为三菱公司的PM50RL1A120 IPM模块。
主电机,具体可以采用纳智公司的型号130ST-M06050的永磁同步电机,从电机,具体可以采用纳智公司的130ST-M06050的永磁同步电机。
主电机传感器为型号TS5700N8401的23位绝对值编码器;从电机传感器也为型号TS5700N8401的23位绝对值编码器。即多摩川23位绝对值编码器S5700N8401,多摩川23位绝对值编码器通过RS485总线通信,将电机信息传送给DSP控制模块与FPGA控制模块。
连接所述嵌入式控制器与FPGA控制器的总线为型号TMS320F28335的DSP模块的XINTF总线,DSP模块通过XINTF总线与FPGA进行通信。其他接线的型号:普通接线或电路板中正常走线。
具体的,所述主电机传感器,用于分别将所述主电机的运行状态数据传输至所述嵌入式控制器和FPGA控制器,其中,运行状态数据包括电机位置数据与电机速度数据。所述从电机传感器,用于分别将所述从电机的运行状态数据传递至所述嵌入式控制器和所述FPGA控制器。所述主从电机传感器,用于将运行状态数据传输至所述嵌入式控制器和所述FPGA控制器,并进行伺服***的闭环控制和双电机(即所述主电机和所述从电机)同步闭环控制。
所述嵌入式控制器,用于完成所述主电机和所述从电机的伺服***的位置环闭环控制。所述嵌入式控制器,用于完成同步控制并进行同步误差补偿。其中,所述嵌入式控制器仅需完成伺服***中位置环闭环控制,减轻嵌入式控制器运算负担,有利于开展位置环先进算法研究,提高主从电机伺服***自身精度。
具体的,所述嵌入式控制器的输出结果,作为所述FPGA控制器的速度环输入。所述FPGA控制器,用于发出所述主电机驱动电路和所述从电机驱动电路的控制信号,并控制所述主电机和所述从电机同步运行。所述FPGA控制器同时与主电机驱动电路和从电机驱动电路相连接,利用FPGA控制器的高速并行处理能力。所述FPGA控制器,用于独立完成所述主电机和所述从电机的伺服***的速度环与电流环的硬件闭环控制。所述嵌入式控制器将主从电机伺服***位置环输出与同步误差比较处理后,作为FPGA控制器中速度环输入。所述FPGA控制器独立完成主从电机伺服***的速度环与电流环的硬件闭环控制,可以大大提高***速度环与电流环响应周期,减小同步误差补偿的滞后时间。
本实施例中还提供一种双电机同步控制方法,该方法可以应用在上述双电机同步控制装置上。该方法的设计思路在于,在自抗扰控制的基础上融入分数阶控制理念,将分数阶控制律代替传统自抗扰控制中的非线性状态反馈误差控制律,实现改进型自抗扰控制。所述主从电机的伺服***通过同一个位置控制指令和相同的速度误差反馈控制,保持主从电机同步运行,从而实现了对整体***的控制。具体可以包括以下步骤:
所述主电机和所述从电机的伺服***,同时接受所述FPGA控制器发出的同一控制指令,并进行所述主电机和所述从电机的伺服***的位置的闭环控制。
在所述嵌入式控制器上运行改进型自抗扰控制器,并通过所述改进型自抗扰控制器,对所述主电机和所述从电机的控制***中的内外扰动进行观测,得到扰动数据后进行扰动补偿。其中,本实施例中所述的扰动补偿是指对***的内部与外部扰动的补偿处理,扰动补偿与误差补偿是两个不同的补偿处理。
所述主电机传感器和所述从电机传感器,分别将当前各自的速度数据,反馈至所述嵌入式控制器。
所述嵌入式控制器根据主从电机速度误差进行分数阶控制,并对其进行同步误差补偿。
所述嵌入式控制器的位置环输出与补偿信息处理后的数据,输出至所述FPGA控制器,并作为所述主电机和所述从电机的伺服***的速度环的输入,即位置环的输出作为速度环的输入。形成由FPGA控制器控制的速度环、电流环硬件闭环控制。
所述FPGA控制器同时向所述主电机驱动电路和所述从电机驱动电路,发送SVPWM(Space Vector Pulse Width Modulation,空间矢量脉宽调制)控制信号,控制所述主电机和所述从电机同步运行。
进一步的,还包括:通过所述改进型自抗扰控制器,将所述主电机和所述从电机的控制***的内外扰动提前观测,并进行补偿处理。同时,通过所述改进型自抗扰控制器,对所述主电机和所述从电机的控制***的同步误差进行补偿。
具体的,建立所述自抗扰控制器的运行过程包括:通过所述扩张状态观测器(ESO),将影响***输出的扰动扩张成新的状态变量,其中,新的状态变量主要包括***的内部与外部扰动。构建分数阶控制器,对所述主电机和所述从电机的控制***的同步误差进行补偿。其中,本实施例所涉及的自抗扰控制的原理中,扩张状态观测器和分数阶控制器都是组成部分,扩张状态观测器用来观测扰动,分数阶控制器用来误差补偿,如图3所示,为分数阶自抗扰控制器框图。通常来说,自抗扰控制器包含跟踪微分器(TrackingDifferentiator,TD)、扩张状态观测器和误差反馈控制律。本实施例中,则省去了跟踪微分器,实现省去跟踪微分器的原因在于:传统的自抗扰控制器包含有跟踪微分器(TD)这一环节,它的功能是安排理想过渡过程并给出过渡过程的微分信号,使起始阶段控制量慢慢增加,防止阶跃响应导致严重超调,但是其代价是上升时间延长,***响应变慢。本实施例中,根据被控对象的结构特征与快速性的控制要求,改进型自抗扰控制方法去掉了跟踪微分器,以借助一开始的大误差控制信号把对象激活起来为主要目的,使其可以实现被控***的快速跟踪。
具体的,所述通过所述扩张状态观测器(ESO),将影响***输出的扰动扩张成新的状态变量,包括:
构建所述扩张状态观测器其中,z1,z2为对***状态x1,x2的观测,x1,x2用于表示***状态的参数。β1,β2为扩张状态观测器增益,ε1为***输出与观测器输出误差,E*为***输出,b为***增益,u为控制器输出,表示Z1的微分,表示Z2的微分。
将所述扩张状态观测器中的极点全部配置为相同的重根,且所述扩张状态观测器特征多项式满足:s2+β1s+β2=(s+wo)2。其中,极点指的是传递函数的零极点,为一个通用的数学概念。其中wo为扩张状态观测器带宽,β1,β2为扩张状态观测器增益,s为拉普拉斯算子。
分数阶PIαDλ控制器的传递函数为:G(s)=KP+Kis-α+Kdsλ,其中,P指代比例、I指代积分和D指代微分,不分大小写的PID和pid都表示比例、积分、微分,α为积分阶次,λ为微分阶次。在时域中,所述分数阶控制器的输出为:
u(t)=KPe(t)+KiD-αe(t)+KdDλe(t),其中,误差e(t)即分数阶PIαDλ控制器的输入,u(t)为分数阶控制器输出。
举例来说,图2所示的位置控制器与同步控制器在图1中嵌入式控制器中实现。图2的速度控制器与电流控制器在图1中FPGA中实现。图3为图2中同步控制器的同步控制算法。图4为图3中FOPID具体结构框图。本实施例中所提及的改进型自抗扰控制器实现方式,具体包括以下步骤:
构建扩张状态观测器ESO,ESO为自抗扰控制的核心部分,将影响***输出的扰动扩张成新的状态变量,而且此过程不依赖生成扰动的模型,也不需要直接测量就能对***扰动进行观测。设计的速度扩张状态观测器如下:
将上式的极点全部配置为相同的重根,并使用观测器带宽wo的概念进行描述,即扩张观测器的特征多项式满足:
s2+β1s+β2=(s+wo)2
从而将观测器增益参数化为β1=2wo。β2=wo 2。由此可以看出观测器待调参数与带宽wo唯一相关,从而使得线性扩张状态观测器的设计变得简单。
构建分数阶控制器。分数阶PIαDλ控制器的传递函数为:Gc(s)=KP+Kis-α+Kdsλ
在时域中分数阶控制器的输出为:u(t)=KPe(t)+KiD-αe(t)+KdDλe(t),其中,误差e(t)即分数阶PIαDλ控制器的输入,u(t)为分数阶控制器输出。
本实施例中,以嵌入式控制器与FPGA控制器为控制核心,其中嵌入式控制器进行伺服***的位置环闭环控制与同步控制器的同步控制算法设计,实现双电机同步控制***的闭环控制。利用FPGA控制器的高速并行处理能力与丰富的外设接口,实现主从电机伺服***的速度环与电流环硬件闭环控制,提高***速度环与电流环的响应周期,可以大大减小同步控制器对同步误差的补偿周期。同时,***采用嵌入式控制器与FPGA控制器的架构,有利于减轻嵌入式控制器的运算负担,充分利用FPGA控制器的并行处理能力,提高***整体灵活性。主从电机驱动电路接收FPGA的控制信号,控制相关功率器件导通/关断,驱动主从电机运行。主从电机位置传感器将主从电机当前位置反馈到嵌入式控制器与FPGA控制器,形成伺服***闭环控制,并将主从电机位置误差传递到嵌入式控制器,进行双电机同步控制。
嵌入式控制器接收控制指令传递给主从电机伺服***的位置环输入信号接口,进行主从电机的位置环控制。位置传感器将主从电机的位置传递给嵌入式控制器,将主从电机的同步误差通过同步控制器进行误差补偿。嵌入式控制器中位置环的输出与同步误差进行处理后作为FPGA控制器中速度环的输入,由此进行同步控制。利用FPGA控制器的高速并行处理能力完成伺服***的速度环与电流环的硬件控制,可以大大提高伺服***的速度环与电流环响应周期,从而减小***误差补偿的滞后时间。主从电机的伺服***通过同一个位置控制指令和相同的速度反馈控制,从而保持主从电机同步运行。
基于上述硬件环境,一种双电机同步控制方法,包括如下步骤:
S1:建立单个永磁同步电机数学模型,采用id=0矢量控制方式,实现最大转矩输出。永磁同步电机在d-q旋转坐标系下的数学模型为:
其中:ud,uq分别为d-q坐标系上的定子电压分量;id,iq分别为d-q坐标系上的定子电流分量;Ld,Lq分别为d-q坐标系上的定子电感分量;Rs为定子电阻;w为转子角频率;J为伺服电机电机转动惯量;Ψf为永磁体对应的转子磁链。
S2:设计以嵌入式控制器与FPGA控制器联合控制架构的伺服***闭环控制。其中嵌入式控制器完成主从电机伺服***中的位置环闭环控制,FPGA控制器完成主从电机伺服***的速度环与电流环硬件闭环控制,利用FPGA控制器高速并行处理能力提高伺服***的速度环与电流环响应周期。
S3:设计改进型自抗扰控制器:。在自抗扰控制的基础上融入分数阶控制理念,将分数阶控制律代替传统自抗扰控制中的非线性状态反馈误差控制律,实现改进型自抗扰控制。改进型自抗扰控制器由自抗扰控制器中的扩张状态观测器ESO与分数阶控制律率组成。
ESO扩张状态观测器是自抗扰控制的核心部分,实现内外扰动的观测。根据状态观测器的思想,将影响***输出的扰动扩张成新的状态变量,而且此过程不依赖生成扰动的模型,也不需要直接测量就能对***扰动进行观测。其中,新的状态变量包括***内外扰动。设计的速度扩张状态观测器如下:
将上式的极点全部配置为相同的重根,并使用高志强教授提出的观测器带宽wo的概念进行描述,即扩张观测器的特征多项式满足:
s2+β1s+β2=(s+wo)2
从而将观测器增益参数化为β1=2wo;β2=wo 2。由此可以看出观测器待调参数与带宽wo唯一相关,从而使得线性扩张状态观测器的设计变得简单。
根据自抗扰控制各个部分之间的相互独立性,提出用分数阶控制器替代自抗扰控制器中的状态反馈误差控制律。
分数阶PIαDλ控制器的传递函数为:
G(s)=KP+Kis-α+Kdsλ
在时域中分数阶控制器的输出为:
u(t)=KPe(t)+KiDαe(t)+KdDλe(t)
S4:基于同步控制中的交叉耦合控制算法,通过主从电机传感器实时采集主从电机速度信息,通过同步控制器对速度差进行实时补偿,从而实现双电机精确同步控制。
本发明公开一种双电机同步控制装置及方法。采用嵌入式控制器与FPGA控制器的控制架构,运用改进型自抗扰同步控制算法,可以有效提高双电机同步控制精度,减小主从电机伺服***速度环与电流环的响应周期。
该***包括嵌入式控制器模块、FPGA控制器模块、主电机模块、从电机模块、主电机传感器模块、从电机传感器模块。其中嵌入式控制器进行伺服***位置环闭环控制,可进行相关算法研究,提高伺服驱动***自身精度;嵌入式控制器进行同步控制器算法研究,对主从电机运行过程中的误差进行补偿;FPGA控制器进行伺服***速度环与电流环硬件闭环控制,利用FPGA控制器高速并行处理能力,提高伺服***速度环与电流环的响应带宽,有利于同步控制器进行及时的误差补偿;主从电机通过传感器将当前运行数据传递给FPGA控制器与嵌入式控制器进行伺服***闭环控制与同步控制器进行误差补偿。同步控制器中采用改进型自抗扰控制算法进行误差补偿。本发明提高同步控制***的控制精度与鲁棒性,同时提高同步控制***的响应带宽,实现快速响应。
与现有技术相比本发明的有益效果在于:
本实施例公开一种双电机同步控制装置及方法,***以嵌入式控制器与FPGA控制器为控制核心,其中嵌入式控制器进行主从伺服***的位置环闭环控制与同步控制器的同步控制算法设计,实现双电机同步控制***的闭环控制。有利于减轻嵌入式控制器的运算负担,充分利用FPGA控制器的并行处理能力,提高***整体灵活性。
本实施例公开一种双电机同步控制装置及方法,利用FPGA控制器的高速并行处理能力与丰富的外设接口,实现主从电机伺服***的速度环与电流环硬件闭环控制,提高***速度环与电流环的响应周期,可以大大减小同步控制器对同步误差的补偿周期。有效的实现了双电机同步控制的低成本、高精度及易调试。
本实施例公开一种一种双电机同步控制装置及方法,同步控制补偿算法采用改进型自抗扰控制算法。将自抗扰控制技术与分数阶微积分理论相融合,把分数阶控制设计理念融入到自抗扰控制器中用于误差补偿的非线性状态反馈误差控制律中。***通过扩张状态观测器ESO将影响***输出的内外扰动进行观测与补偿;通过分数阶PIαDλ对***同步误差进行补偿。使控制器与控制对象在运行过程中拥有响应速度快和稳定特性高,鲁棒性能好,控制精度高,参数调节范围广等优点。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的程序可存储于一计算机可读取存储介质中,该程序在执行时,可包括如上述各方法的实施例的流程。其中,所述的存储介质可为磁碟、光盘、只读存储记忆体(Read-Only Memory,ROM)或随机存储记忆体(Random AccessMemory,RAM)等。
本说明书中的各个实施例均采用递进的方式描述,各个实施例之间相同相似的部分互相参见即可,每个实施例重点说明的都是与其他实施例的不同之处。尤其,对于设备实施例而言,由于其基本相似于方法实施例,所以描述得比较简单,相关之处参见方法实施例的部分说明即可。以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应该以权利要求的保护范围为准。
Claims (9)
1.一种双电机同步控制装置,其特征在于,包括:
嵌入式控制器、FPGA控制器、主电机驱动电路、从电机驱动电路、主电机、从电机、主电机传感器和从电机传感器;
所述嵌入式控制器与FPGA控制器通过总线相连接,所述FPGA控制器分别与所述主电机驱动电路和所述从电机驱动电路相连接,所述主电机与所述主电机驱动电路相连接,所述主电机传感器与所述主电机相连接,所述从电机与所述从电机驱动电路相连接,所述从电机传感器与所述从电机相连接。
2.根据权利要求1所述的双电机同步控制装置,其特征在于,包括:
所述主电机传感器,用于分别将所述主电机的运行状态数据传输至所述嵌入式控制器和FPGA控制器;
所述从电机传感器,用于分别将所述从电机的运行状态数据传递至所述嵌入式控制器和所述FPGA控制器;
所述主从电机传感器,用于将运行状态数据传输至所述嵌入式控制器和所述FPGA控制器,并进行伺服***的闭环控制和双电机同步闭环控制。
3.根据权利要求2所述的双电机同步控制装置,其特征在于,包括:
所述嵌入式控制器,用于完成所述主电机和所述从电机的伺服***的位置环闭环控制;
所述嵌入式控制器,用于完成同步控制并进行同步误差补偿。
4.根据权利要求3所述的双电机同步控制装置,其特征在于,包括:
所述嵌入式控制器的输出结果,作为所述FPGA控制器的速度环输入。
所述FPGA控制器,用于发出所述主电机驱动电路和所述从电机驱动电路的控制信号,并控制所述主电机和所述从电机同步运行;
所述FPGA控制器,用于独立完成所述主电机和所述从电机的伺服***的速度环与电流环的闭环控制。
5.一种双电机同步控制方法,其特征在于,所述方法用于一种双电机同步控制装置,
所述装置包括:嵌入式控制器、FPGA控制器、主电机驱动电路、从电机驱动电路、主电机、从电机、主电机传感器和从电机传感器;所述嵌入式控制器与FPGA控制器通过总线相连接,所述FPGA控制器分别与所述主电机驱动电路和所述从电机驱动电路相连接,所述主电机与所述主电机驱动电路相连接,所述主电机传感器与所述主电机相连接,所述从电机与所述从电机驱动电路相连接,所述从电机传感器与所述从电机相连接;
所述方法包括:
所述主电机和所述从电机的伺服***,同时接受所述FPGA控制器发出的同一控制指令,并进行所述主电机和所述从电机的伺服***的位置的闭环控制;
在所述嵌入式控制器上运行改进型自抗扰控制器,并通过所述改进型自抗扰控制器,对所述主电机和所述从电机的控制***中的内外扰动进行观测,得到扰动数据后进行扰动补偿;
所述主电机传感器和所述从电机传感器,分别将当前各自的速度数据,反馈至所述嵌入式控制器;
所述嵌入式控制器根据主从电机速度误差进行分数阶PIαDλ控制,并对其进行同步误差补偿;
所述嵌入式控制器的伺服***位置环输出与补偿信息,输出至所述FPGA控制器,并作为所述主电机和所述从电机的伺服***的速度环的输入;
所述FPGA控制器同时向所述主电机驱动电路和所述从电机驱动电路,发送矢量脉宽调制(SVPWM)控制信号,控制所述主电机和所述从电机同步运行。
6.根据权利要求5所述的双电机同步控制方法,其特征在于,还包括:
通过所述改进型自抗扰控制器,将所述主电机和所述从电机的控制***的内外扰动提前观测,并进行补偿处理;
同时,通过所述改进型自抗扰控制器,对所述主电机和所述从电机的控制***的同步误差进行补偿。
7.根据权利要求6所述的双电机同步控制方法,其特征在于,建立所述改进型自抗扰控制器的运行过程包括:
通过所述扩张状态观测器(ESO),将影响***输出的扰动扩张成新的状态变量进行观测,其中,新的状态变量包括***内外扰动;
构建分数阶控制器,对所述主电机和所述从电机的控制***的同步误差进行补偿。
9.根据权利要求7所述的双电机同步控制方法,其特征在于,分数阶PIαDλ控制器的传递函数为:G(s)=KP+Kis-α+Kdsλ,其中,P指代比例、I指代积分和D指代微分,α为积分阶次,λ为微分阶次;
在时域中,所述分数阶控制器的输出为:u(t)=KPe(t)+KiD-αe(t)+KdDλe(t)其,中,误差e(t)即分数阶PIαDλ控制器的输入,u(t)为分数阶控制器输出,Kp为控制器比例项系数,Ki为控制器积分项系数,Kd为控制器微分项系数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010367158.8A CN111464073A (zh) | 2020-04-30 | 2020-04-30 | 一种双电机同步控制装置及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010367158.8A CN111464073A (zh) | 2020-04-30 | 2020-04-30 | 一种双电机同步控制装置及方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN111464073A true CN111464073A (zh) | 2020-07-28 |
Family
ID=71678261
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010367158.8A Pending CN111464073A (zh) | 2020-04-30 | 2020-04-30 | 一种双电机同步控制装置及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111464073A (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112114539A (zh) * | 2020-09-25 | 2020-12-22 | 成都易慧家科技有限公司 | 一种双电机驱动推拉门窗的控制***及其方法 |
CN112147942A (zh) * | 2020-10-26 | 2020-12-29 | 西安工业大学 | 基于fpga+dsp的双运动平台同步控制***及控制方法 |
CN112821810A (zh) * | 2021-01-27 | 2021-05-18 | 苏州伟创电气科技股份有限公司 | 伺服电机的控制方法以及控制*** |
CN113479258A (zh) * | 2021-07-12 | 2021-10-08 | 南京航空航天大学 | 一种智能车双电机线控转向***跟踪及同步控制方法 |
CN114244238A (zh) * | 2021-12-20 | 2022-03-25 | 四川三联新材料有限公司 | 双伺服电机***转速同步容错控制方法 |
US11307539B1 (en) | 2021-08-10 | 2022-04-19 | King Abdulaziz University | Method of extended state observer based fractional order controller design for integer high order systems |
-
2020
- 2020-04-30 CN CN202010367158.8A patent/CN111464073A/zh active Pending
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112114539A (zh) * | 2020-09-25 | 2020-12-22 | 成都易慧家科技有限公司 | 一种双电机驱动推拉门窗的控制***及其方法 |
CN112114539B (zh) * | 2020-09-25 | 2023-11-28 | 成都易慧家科技有限公司 | 一种双电机驱动推拉门窗的控制***及其方法 |
CN112147942A (zh) * | 2020-10-26 | 2020-12-29 | 西安工业大学 | 基于fpga+dsp的双运动平台同步控制***及控制方法 |
CN112821810A (zh) * | 2021-01-27 | 2021-05-18 | 苏州伟创电气科技股份有限公司 | 伺服电机的控制方法以及控制*** |
CN113479258A (zh) * | 2021-07-12 | 2021-10-08 | 南京航空航天大学 | 一种智能车双电机线控转向***跟踪及同步控制方法 |
US11307539B1 (en) | 2021-08-10 | 2022-04-19 | King Abdulaziz University | Method of extended state observer based fractional order controller design for integer high order systems |
CN114244238A (zh) * | 2021-12-20 | 2022-03-25 | 四川三联新材料有限公司 | 双伺服电机***转速同步容错控制方法 |
CN114244238B (zh) * | 2021-12-20 | 2024-05-10 | 四川三联新材料有限公司 | 双伺服电机***转速同步容错控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111464073A (zh) | 一种双电机同步控制装置及方法 | |
CN105914778B (zh) | 基于虚拟同步发电机的微网逆变器多环路控制方法 | |
Lorenz et al. | Motion control with induction motors | |
CN101499753B (zh) | 基于永磁无刷直流电机的无刷伺服控制***和驱动装置 | |
CN110752791A (zh) | 一种一拖三作动装置的位置实时同步控制***及方法 | |
CN1410669A (zh) | 兆瓦级风电机组变速、变距控制*** | |
CN107994620A (zh) | 柔性环网控制器双端虚拟电机控制方法 | |
CN107947646B (zh) | 一种基于有机械联接的双永磁同步电机协调控制优化方法 | |
CN104749997A (zh) | 用于激光跟踪仪精密伺服***的驱动控制电路 | |
CN112910365B (zh) | 一种激光打标用数字控制振镜电机***的驱动控制方法 | |
CN108418487A (zh) | 一种用于电动汽车的速度脉动抑制方法 | |
CN201403064Y (zh) | 基于永磁无刷直流电机的无刷伺服控制***和驱动装置 | |
CN103997245A (zh) | 基于功率前馈和电流微差前馈的直流电压最小波动方法 | |
Drhorhi et al. | Adaptive backstepping controller for DFIG-based wind energy conversion system | |
CN212543685U (zh) | 一种双电机同步控制装置 | |
CN114825396A (zh) | 一种提升高速飞轮储能阵列直流母线电压鲁棒性的方法 | |
CN104935231B (zh) | 基于预测方式的感应电机电流控制方法及其电流控制器 | |
CN101383573B (zh) | 永磁型无轴承电机直接悬浮力控制方法 | |
CN103001574A (zh) | 一种基于dsp的全数字交流伺服驱动*** | |
CN103427754A (zh) | 无轴承异步电机转子径向位移直接控制器 | |
CN113394806B (zh) | 基于神经网络的风电并网线性自抗扰控制*** | |
CN109067273A (zh) | 用于工业六轴机器人的dtc-svpwm的交流伺服驱动器调控方法 | |
CN115208242A (zh) | 一种双开关磁阻电机交叉耦合同步控制***及方法 | |
CN105119507B (zh) | 一种pwm整流器功率前馈控制方法 | |
CN115001335A (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 |