CN101738978A - 多轴伺服电机控制系统 - Google Patents

多轴伺服电机控制系统 Download PDF

Info

Publication number
CN101738978A
CN101738978A CN200810217591A CN200810217591A CN101738978A CN 101738978 A CN101738978 A CN 101738978A CN 200810217591 A CN200810217591 A CN 200810217591A CN 200810217591 A CN200810217591 A CN 200810217591A CN 101738978 A CN101738978 A CN 101738978A
Authority
CN
China
Prior art keywords
module
electric current
speed
point
current 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.)
Granted
Application number
CN200810217591A
Other languages
English (en)
Other versions
CN101738978B (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.)
Shenzhen Academy of Aerospace Technology
Original Assignee
Shenzhen Academy of Aerospace Technology
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 Shenzhen Academy of Aerospace Technology filed Critical Shenzhen Academy of Aerospace Technology
Priority to CN 200810217591 priority Critical patent/CN101738978B/zh
Publication of CN101738978A publication Critical patent/CN101738978A/zh
Application granted granted Critical
Publication of CN101738978B publication Critical patent/CN101738978B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Electric Motors In General (AREA)

Abstract

本发明涉及一种多轴伺服电机控制系统,包括:位置环模块,用于接收各轴的位置环给定值和位置反馈值,并计算速度环给定值;速度环模块,用于接收各轴的速度环给定值和速度反馈值,并计算电流环给定值;电流环模块,用于接收各轴的电流环给定值和电流反馈值,并输出电流环输出值;脉宽调制信号生成模块,用于从所述电流环模块接收所述电流环输出值并生成用于控制各轴伺服电机的脉宽调制信号;多轴时序控制模块,用于控制所述位置环模块、速度环模块、电流环模块和脉宽调制信号生成模块的信号接收和处理。实施本发明的多轴伺服电机控制系统,解决了单轴伺服控制各轴单独驱动无法同步的问题,有效地降低了各轴间的电磁干扰。

Description

多轴伺服电机控制系统
技术领域
本发明涉及控制领域,更具体地说,涉及一种多轴伺服电机控制系统。
背景技术
电机是运动控制主要部件。随着科学技术的发展,通常需要同时控制多轴伺服电机,例如数控车床的主轴驱动与X、Y轴驱动进刀;数控铣床的主轴驱动与X、Y、Z轴驱动进给,而对于机器人和机械手更需要对多个轴进行控制。
已有技术中还未见到多轴伺服电动机控制芯片,因而往往采用单轴伺服电动机控制芯片分别控制各轴,其中LM628和LM629方波无刷电动机位置控制芯片、IR2102正旋波无刷电动机速度控制芯片,它们性能良好,最具代表性。
美国国家半导体公司推出LM628运动控制芯片以及日本Plenty Island公司推出的MCX314系列运动控制芯片实际上可称为位置环伺服控制芯片,可用于伺服单元上位控制,但实质上它们并不包含电机矢量控制和电机速率、力矩闭环控制等低层控制环节。这类芯片的集成度不高,其功能完全可以利用DSP来替代,所以目前意义已经不大。
而采用现有技术中的单轴伺服电机控制系统单独驱动多个轴时,容易出现无法同步的问题。因此,需要一种同时对多个轴进行同步控制的多轴伺服电机控制系统。
发明内容
本发明要解决的技术问题在于,针对采用现有技术中的单轴伺服电机控制系统单独驱动多个轴时,容易出现无法同步的缺陷,提供一种同时对多个轴进行同步控制的多轴伺服电机控制系统。
本发明解决其技术问题所采用的技术方案是:构造一种多轴伺服电机控制系统,包括:位置环模块,用于接收各轴的位置环给定值和位置反馈值,并计算速度环给定值;速度环模块,用于接收各轴的速度环给定值和速度反馈值,并计算电流环给定值;电流环模块,用于接收各轴的电流环给定值和电流反馈值,并输出电流环输出值;脉宽调制信号生成模块,用于从所述电流环模块接收所述电流环输出值并生成用于控制各轴的伺服电机的脉宽调制信号;多轴时序控制模块,用于控制所述位置环模块、速度环模块、电流环模块和脉宽调制信号生成模块的信号接收和处理。
在本发明所述的多轴伺服电机控制系统中,所述多轴伺服电机控制系统包括:数模转换模块,用于在多轴时序控制模块的控制下获取位置反馈值和/或电流反馈值;测速模块,用于在多轴时序控制模块的控制下获取各轴的速度反馈值。
在本发明所述的多轴伺服电机控制系统中,所述数模转换模块进一步用于在多轴时序控制模块的控制下获取位置环给定值、速度环给定值和/或电流环给定值。
在本发明所述的多轴伺服电机控制系统中,当所述多轴时序控制模块控制所述多轴伺服电机控制系统在位置环运行时,位置环模块从所述数模转换模块获取位置环给定值和位置反馈值,速度环模块从所述位置环模块获取速度环给定值、从所述测速模块获取速度反馈值,所述电流环模块从所述速度环模块获取电流环给定值、从所述数模转换模块获取电流反馈值;当所述多轴时序控制模块控制所述多轴伺服电机控制系统在速度环运行时,所述速度环模块从所述测速模块获取速度反馈值、从所述数模转换模块获取速度环给定值,所述电流环模块从所述速度环模块获取电流环给定值、从所述数模转换模块获取电流反馈值;当所述多轴时序控制模块控制所述多轴伺服电机控制系统在电流环运行时,所述电流环模块从所述数模转换模块获取电流反馈值和电流环给定值。
在本发明所述的多轴伺服电机控制系统中,所述数模转换模块包括:模数转换接口单元、模数时序控制单元和第一数据锁存器,其中,所述多轴伺服电机控制系统在位置环运行时,所述模数转换接口单元获取位置环给定值、位置反馈值和电流反馈值;当所述多轴伺服电机控制系统在速度环运行时,所述模数转换接口单元获取速度环给定值,电流反馈值;当所述多轴伺服电机控制系统在电流环运行时,所述模数转换接口单元获取电流环给定值和电流反馈值;所述第一数据锁存器在所述模数时序控制单元的控制下对获取的各值进行锁存。
在本发明所述的多轴伺服电机控制系统中,所述多轴伺服电机控制系统进一步包括电流定标模块,用于定标从所述数模转换模块获取电流反馈值并将定标后的电流反馈值发送到电流环模块。
在本发明所述的多轴伺服电机控制系统中,所述测速模块包括码盘接口单元、M/T法测速单元和第二数据锁存器,其中所述码盘接口单元用于获取各轴角位移;所述M/T法测速单元用于将所述角位移转换成速度反馈值;所述第二数据锁存器在所述多轴时序控制模块的控制下对所述速度反馈值进行锁存。
在本发明所述的多轴伺服电机控制系统中,所述位置环模块进一步包括位置环调节器和位置环数据锁存器;所述位置环调节器用于接收位置环给定值和位置反馈值,并生成速度环给定值,所述位置环数据锁存器在多轴时序控制模块的控制下锁存所述位置环给定值、位置反馈值和/或速度环给定值。
在本发明所述的多轴伺服电机控制系统中,所述速度环模块进一步包括速度环调节器和速度环数据锁存器;所述速度环调节器用于接收速度环给定值和速度反馈值,并生成电流环给定值,所述速度环数据锁存器在多轴时序控制模块的控制下锁存所述速度环给定值、速度反馈值和/或电流环给定值。
在本发明所述的多轴伺服电机控制系统中,所述电流环模块进一步包括电流环调节器和电流环数据锁存器;所述电流环调节器用于接收电流环给定值和电流反馈值,并生成电流环输出值,所述电流环数据锁存器在多轴时序控制模块的控制下锁存所述电流环给定值和电流反馈值和/或电流环输出值。
实施本发明的多轴伺服电机控制系统,具有以下有益效果:
(1)解决了单轴伺服控制各轴单独驱动无法同步的问题;
(2)内部时序保证,在输出不变时采样各种输入,例如,位置、电流、速度等较弱信号,然后在同一时刻输出幅度强大的输出信号,这就从原理上保证各轴具有最佳电磁兼容性能;
(3)快速性能好,其动态性能几乎比微程序控制器、数字信号处理器高一个数量级;
(4)体积最小化、可靠性高、成本低、功耗小。
附图说明
下面将结合附图及实施例对本发明作进一步说明,附图中:
图1是本发明的多轴伺服电机控制系统的模型图;
图2本发明的多轴伺服电机控制系统的前向通道系统的模型图;
图3是电流环前向通道模型的数据流程示意图;
图4是位置环前向通道模型的数据流程示意图;
图5是本发明的多轴伺服电机控制系统的第一实施例的系统框图;
图6是本发明的多轴伺服电机控制系统的第二实施例的系统框图;
图7是本发明的多轴伺服电机控制系统的第三实施例的系统框图;
图8是图7示出的多轴伺服电机控制系统的实施例的电流环数据流向图;
图9是图7示出的多轴伺服电机控制系统的实施例的速度环数据流向图;
图10是图7示出的多轴伺服电机控制系统的实施例的位置环数据流向图;
图11是本发明的模数转换模块的实现框图;
图12是PI调节器的数据流向图;
图13是PI调节器的实现框图;
图14是PID调节器的数据流向图;
图15是PID调节器的实现框图;
图16是码盘接口单元的实现框图;
图17是M/T法测速单元的实现框图;
图18是多轴时序控制模块的多轴时序控制单元的时序图;
图19是多轴时序控制模块的单轴数据计算控制单元的时序图;
图20是系统在位置环运行时的多轴时序控制单元的时序图;
图21是系统在速度环运行时的多轴时序控制单元的时序图;
图22是系统在电流环运行时的多轴时序控制单元的时序图。
具体实施方式
如图1所示,系统模型包括两部分:前向通道和反馈通道。其中前向通道的模型描述如图2所示。图2示出的模型的端口描述为
Model
Input[11:0]PRef;
Input[14:0]IFdb;
Input[14:0]VFdb;
Input[11:0]PFdb;
Output[15:0]CLOut;
图1-2中的KpP、KiP、KdP、PbitsP、IbitsP、DbitsP、PlimitP、PlimitN、KpV、KiV、PbitsV、IbitsV、VlimitP、VlimitN、KpI、KiI、PbitsI、IbitsI、IlimitP、ILimitN为可以设置的参数。CLUpdate、VLUpdate、PLUpdate分别用来控制电流环、速度环和位置环的计算。
可将图2采用语言描述为
If PLUpdate then
Do‘PositionLoop’;
Do‘VelocityLoop’;
Do‘CurrentLoop’;
Else if VLUpdate then
Do‘VelocityLoop’;
Do‘CurrentLoop’;
Else if CLUpdate then
Do‘CurrentLoop’;
Endif
其中,PositionLoop为位置环前向通道的模型;VelocityLoop为速度环前向通道的模型;CurrentLoop为电流环前向通道的模型;CLUpdate为控制电流环数据计算的时序控制信号;VLUpdate为控制速度环数据计算的时序控制信号;PLUpdate为控制位置环数据计算的时序控制信号;CLUpdate,VLUpdate,PLUpdate信号由编程产生,其是固定频率的,频率分别对应于fC,fV,fP,其之间的关系为
fC=n·fV
fC=m·fP
图3是电流环的数据流程示意图;图中的变量的表示方法为变量名(),其中括号里的数字表示变量的位数,如KpI(16),表示变量KpI的位宽为16位;图3中包括加法模块、减法模块、乘法模块(16×16)、乘法模块(17×16)、右移模块P、右移模块I、锁存模块、限幅模块。其中,乘法模块(16×16)表示16位与16位的数据相乘,其输出为32位,乘法模块(17×16)表示17位与16位的数据相乘,其输出为33位。
电流环模块的端口描述如下:
Model current loop
Input[14:0]Ref;
Input[14:0]Fdb;
Input[15:0]KpI;
Input[15:0]KiI;
Input[15:0]LimitP;
Input[15:0]LimitN;
Input[7:0]PBits;
Input[7:0]IBits;
乘法模块的端口描述如下:
Model Multiply(16X16)
Input[15:0]a;
Input[15:0]b;
Output[31:0]Out;
Model Multiply(17X16)
Input[16:0]a;
Input[15:0]b;
Output[32:0]Out;
限幅模块的端口描述如下:
Model Limit
Input[15:0]LimitP;
Input[15:0]LimitN;
Input[15:0]IN;
Output[15:0]Out;
锁存模块的语言描述如下:
 If nRESET=’0’then
 Out=’0’;
 Else
   Out=PrevOut;
Endif
   PrevOut=Out;
限幅模块的语言描述如下:
If IN<=LimitN then
     Out=LimitN
Elseif IN>=LimitP then
     Out=LimitP
Else
       Out=IN
Endif
上图中的其他模块采用c语言中的表达式表示,如减法模块、减法模块、加法模块、乘法模块、右移模块P、右移模块I分别采用c语言中的减法、加法、乘法和移位运算。其中,右移模块P为右移32-PBits,右移模块I为右移33-IBits
速度环模型与电流环模型相同,因此不再赘述。
图4是位置环模型的数据流程示意图。其中右移模块P为右移32-PBits,右移模块I为右移32-IBits,右移模块D为右移33-DBits
位置环模块的接口描述如下所述:
Model Positionloop
Input[14:0]Ref;
Input[14:0]Fdb;
Input[15:0]KpP;
Input[15:0]KiP;
Input[15:0]KdP;
Input[15:0]LimitP;
Input[15:0]LimitN;
Input[7:0]PBits;
Input[7:0]IBits;
Input[7:0]DBits;
右移模块的端口描述:
Model Shift
Input[31:0]IN;
Output[31:0]Out1;
Output[31:0]Out2;
Output[31:0]Out3;
Output[31:0]Out4;
切换模块的端口描述:
Model Switch
Input[31:0]IN1;
Input[31:0]IN2;
Input[31:0]IN3;
Input[31:0]IN4;
Input[7:0]Threhold1;(图4中Switch模块的T1端口)
Input[7:0]Threhold2;(图4中Switch模块的T2端口)
Input[7:0]Threhold3;(图4中Switch模块的T3端口)
Input[7:0]Threhold4;(图4中Switch模块的T4端口)
Output[31:0]Out;
切换模块的语言描述:
If Select<Threhold1 then
    Out=IN1;
Else if Select<Threhold2 then
    Out=IN2;
Else if Select<Threhold3 then
    Out=IN3;
Else if Select<Threhold4 then
    Out=IN4;
Else
    Out=0;
Endif
右移模块的语言描述:
Out1=IN;
Out2=IN>>1;
Out3=IN>>2;
Out4=IN>>3;
锁存和限幅模块已经在上面描述,在此不再赘述。其他的模块,如加法模块、减法模块、乘法模块(16×16)、乘法模块(17×16)、右移模块P、I、D可以采用c语言中的加法,减法,乘法与右移运算。
图5是本发明的多轴伺服电机控制系统的第一实施例的系统框图。如图5所示,本发明的多轴伺服电机控制系统包括:位置环模块400,用于接收各轴的位置环给定值和位置反馈值,并计算速度环给定值;速度环模块500,用于接收各轴的速度环给定值和速度反馈值,并计算电流环给定值;电流环模块200,用于接收各轴的电流环给定值和电流反馈值,并输出电流环输出值;脉宽调制信号生成模块300,用于从所述电流环模块200接收所述电流环输出值并生成用于控制各轴的伺服电机的脉宽调制信号。
图6是本发明的多轴伺服电机控制系统的第二实施例的系统框图。如图6所示,本发明的多轴伺服电机控制系统进一步包括数模转换模块100,用于在多轴时序控制模块700的控制下获取位置反馈值和/或电流反馈值;测速模块600,用于在多轴时序控制模块700的控制下获取各轴的速度反馈值。所述数模转换模块100进一步用于在多轴时序控制模块700的控制下获取位置环给定值、速度环给定值和/或电流环给定值。
图7是本发明的多轴伺服电机控制系统的第三实施例的系统框图。参照图7可知,本系统主要包括位置环调节器401、位置环数据锁存器402、速度环调节器501、速度环数据锁存器502、电流环调节器201和电流环数据锁存器202、脉宽调制信号生成模块300、模数转换接口单元101、模数时序控制单元103、第一数据锁存器102、码盘接口单元601、M/T法测速单元602、第二数据锁存器603、多轴时序控制模块700、电流定标模块800。其中,位置环调节器401、位置环数据锁存器402、速度环调节器501、速度环数据锁存器502、电流环调节器201和电流环数据锁存器202分别对应于图1所示的位置环、速度环和电流环。电流定标模块800与数模转换模块100共同组成了图1所示的电流环反馈通道、码盘接口单元和M/T测速单元构成了对应于图1所示的速度环反馈通道,数模转换模块100构成了图1所示的位置环反馈通道。
其中所述多轴伺服电机控制系统在位置环运行时,所述模数转换接口单元101获取位置环给定值、位置反馈值和电流反馈值;当所述多轴伺服电机控制系统在速度环运行时,所述模数转换接口单元101获取速度环给定值,电流反馈值;当所述多轴伺服电机控制系统在电流环运行时,所述模数转换接口单元101获取电流环给定值和电流反馈值;所述第一数据锁存器102在所述模数时序控制单元103的控制下对获取的各值进行锁存。
与此同时,位置环、速度环和电流环分别以不同的刷新频率(电流环刷新频率fc大于速度环刷新频率fv大于位置环刷新频率fp)对相应的数据进行处理,从而更新相应的数据。
在本发明的一个实施例中,位置环刷新率1~5KHz(0.2~1ms);(国际先进水平为0.5ms)速率环刷新率5~10KHz(100~200μsec);(国际先进水平为250μsec)电流环刷新率20~40KHz(25~50μsec);转速范围0±10000r/min。
当所述多轴时序控制模块700控制所述多轴伺服电机控制系统在位置环运行时,位置环模块400从所述数模转换模块100获取位置环给定值和位置反馈值,速度环模块500从所述位置环模块400获取速度环给定值、从所述测速模块600获取速度反馈值,所述电流环模块200从所述速度环模块500获取电流环给定值、从所述数模转换模块100获取电流反馈值;
当所述多轴时序控制模块700控制所述多轴伺服电机控制系统在速度环运行时,所述速度环模块500从所述测速模块600获取速度反馈值、从所述数模转换模块100获取速度环给定值,所述电流环模块200从所述速度环模块500获取电流环给定值、从所述数模转换模块100获取电流反馈值;当所述多轴时序控制模块700控制所述多轴伺服电机控制系统在电流环运行时,所述电流环模块200从所述数模转换模块100获取电流反馈值和电流环给定值,并输出电流环输出值输给PWM信号生成模块300,从而产生控制功率器件的信号,进而控制电机运动。
对图7进行更详细的分解,可以得到电流环、速度环、位置环的数据流向如图8-10所示,图中的粗线表示数据流方向,细线表示控制数据流的控制信号传递。
图11是本发明的模数转换模块100的实现框图,其包括模数转换接口单元101、模数时序控制单元103、第一数据锁存器102。
图12是PI调节器的数据流向图;图13是PI调节器的实现框图。在本发明中,电流环与速度环调节器均使用PI调节器。
图14是是PID调节器的数据流向图。图15是PID调节器的实现框图。在本发明中,位置环采用PID调节器。
图16是码盘接口单元的实现框图。图17是M/T法测速单元的实现框图,其包括M/T测速部份和数据锁存部份。
在本发明的优选实施例中,所述多轴时序控制模块可包括用于多轴时序控制单元和单轴数据计算时序控制单元。其中,多轴时序控制单元为控制1号轴至n号轴之间的转换;而单轴数据计算时序控制单元为控制每个轴进行数据计算。图18是多轴时序控制模块的多轴时序控制单元的时序图。在本发明的一个优选实施例中,n=4。
图19是多轴时序控制模块的的单轴数据计算控制单元的时序图。每个轴包括三个环路,分别为位置环、速度环和电流环,其对应于三种情况:
(1)只有电流环,如图19中的1所示;
(2)速度环+电流环,如图19中的2所示;
(3)位置环+速度环+电流环,如图19中的3所示。
时序a代表PWM同步信号,其是电机控制系统的同步信号,所有数据转换与计算都由其进行同步。
时序b-f代表反馈通道的相关信号,其中,ADDone表示数据转换部分的完成信号,IFBStart和MTStart分别表示电流反馈通道数据计算和速度反馈通道数据计算的开始,IFBDone和MTDone分别表示电流和速度反馈通道数据计算的结束。
时序h-1表示前向通道的相关信号,其中,SLStart和CLStart分别表示速度环和电流环前向通道数据计算的开始,SLDone和CLDone分别表示速度环和电流环前向通道数据计算的结束。
时序g表示与前向通道和后向通道均有关的信号,其为位置环数据开始计算信号。
对于图19所示的情况3,系统进行位置环,速度环和电流环的运算,时序如图20所示。对于图19所示的情况2,系统进行速度环和电流环的运算,时序如图21所示。对于图19所示的情况2,系统只进行电流环的运算,时序如图22图所示。
采用本发明的多轴伺服电机控制系统,可采用全数字化、多轴、单芯片硬件实现复杂交流伺服电动机矢量控制、力矩、速率、位置闭环控制,以使伺服系统的体积更加紧缩,动态性能提高2-10倍。高性能控制策略和芯片体系结构,使控制系统的力能指标提高2-3倍。使系统外围元器件减少50-80%,整机体积减少2-4倍,产品成本下降2-3倍。
本发明采用控制器时分复用思想,即利用时间资源来代替空间资源。采样频率为40kHz,一个控制器内核,实现4个轴的伺服驱动单元。
虽然本发明是通过具体实施例进行说明的,本领域技术人员应当明白,在不脱离本发明范围的情况下,还可以对本发明进行各种变换及等同替代。因此,本发明不局限于所公开的具体实施例,而应当包括落入本发明权利要求范围内的全部实施方式。

Claims (10)

1.一种多轴伺服电机控制系统,其特征在于,所述多轴伺服电机控制系统包括:
位置环模块(400),用于接收各轴的位置环给定值和位置反馈值,并计算速度环给定值;
速度环模块(500),用于接收各轴的速度环给定值和速度反馈值,并计算电流环给定值;
电流环模块(200),用于接收各轴的电流环给定值和电流反馈值,并输出电流环输出值;
脉宽调制信号生成模块(300),用于从所述电流环模块(200)接收所述电流环输出值并生成用于控制各轴的伺服电机的脉宽调制信号;
和多轴时序控制模块(700),用于控制所述位置环模块(400)、速度环模块(500)、电流环模块(200)和脉宽调制信号生成模块(300)的信号接收和处理。
2.根据权利要求1所述多轴伺服电机控制系统,其特征在于,所述多轴伺服电机控制系统包括:
数模转换模块(100),用于在多轴时序控制模块(700)的控制下获取位置反馈值和/或电流反馈值;
测速模块(600),用于在多轴时序控制模块(700)的控制下获取各轴的速度反馈值。
3.根据权利要求2所述多轴伺服电机控制系统,其特征在于,所述数模转换模块(100)进一步用于在多轴时序控制模块(700)的控制下获取位置环给定值、速度环给定值和/或电流环给定值。
4.根据权利要求3所述多轴伺服电机控制系统,其特征在于,
当所述多轴时序控制模块(700)控制所述多轴伺服电机控制系统在位置环运行时,位置环模块(400)从所述数模转换模块(100)获取位置环给定值和位置反馈值,速度环模块(500)从所述位置环模块(400)获取速度环给定值、从所述测速模块(600)获取速度反馈值,所述电流环模块(200)从所述速度环模块(500)获取电流环给定值、从所述数模转换模块(100)获取电流反馈值;
当所述多轴时序控制模块(700)控制所述多轴伺服电机控制系统在速度环运行时,所述速度环模块(500)从所述测速模块(600)获取速度反馈值、从所述数模转换模块(100)获取速度环给定值,所述电流环模块(200)从所述速度环模块(500)获取电流环给定值、从所述数模转换模块(100)获取电流反馈值;
当所述多轴时序控制模块(700)控制所述多轴伺服电机控制系统在电流环运行时,所述电流环模块(200)从所述数模转换模块(100)获取电流反馈值和电流环给定值。
5.根据权利要求3所述多轴伺服电机控制系统,其特征在于,所述数模转换模块(100)包括:模数转换接口单元(101)、模数时序控制单元(103)和第一数据锁存器(102),
其中,所述多轴伺服电机控制系统在位置环运行时,所述模数转换接口单元(101)获取位置环给定值、位置反馈值和电流反馈值;当所述多轴伺服电机控制系统在速度环运行时,所述模数转换接口单元(101)获取速度环给定值,电流反馈值;当所述多轴伺服电机控制系统在电流环运行时,所述模数转换接口单元(101)获取电流环给定值和电流反馈值;所述第一数据锁存器(102)在所述模数时序控制单元(103)的控制下对获取的各值进行锁存。
6.根据权利要求3所述多轴伺服电机控制系统,其特征在于,所述多轴伺服电机控制系统进一步包括电流定标模块(800),用于定标从所述数模转换模块(100)获取电流反馈值并将定标后的电流反馈值发送到电流环模块(200)。
7.根据权利要求3所述多轴伺服电机控制系统,其特征在于,所述测速模块(600)包括码盘接口单元(601)、M/T法测速单元(602)和第二数据锁存器(603),
其中所述码盘接口单元(601)用于获取各轴角位移;
所述M/T法测速单元(602)用于将所述角位移转换成速度反馈值;
所述第二数据锁存器(603)在所述多轴时序控制模块(700)的控制下对所述速度反馈值进行锁存。
8.根据权利要求1所述多轴伺服电机控制系统,其特征在于,所述位置环模块(400)进一步包括位置环调节器(401)和位置环数据锁存器(402);
所述位置环调节器(401)用于接收位置环给定值和位置反馈值,并生成速度环给定值,
所述位置环数据锁存器(402)在多轴时序控制模块(700)的控制下锁存所述位置环给定值、位置反馈值和/或速度环给定值。
9.根据权利要求1所述多轴伺服电机控制系统,其特征在于,所述速度环模块(500)进一步包括速度环调节器(501)和速度环数据锁存器(502);
所述速度环调节器(501)用于接收速度环给定值和速度反馈值,并生成电流环给定值,
所述速度环数据锁存器(502)在多轴时序控制模块(700)的控制下锁存所述速度环给定值、速度反馈值和/或电流环给定值。
10.根据权利要求1所述多轴伺服电机控制系统,其特征在于,所述电流环模块(200)进一步包括电流环调节器(201)和电流环数据锁存器(202);
所述电流环调节器(201)用于接收电流环给定值和电流反馈值,并生成电流环输出值;
所述电流环数据锁存器(202)在多轴时序控制模块(700)的控制下锁存所述电流环给定值和电流反馈值和/或电流环输出值。
CN 200810217591 2008-11-11 2008-11-11 多轴伺服电机控制系统 Active CN101738978B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN 200810217591 CN101738978B (zh) 2008-11-11 2008-11-11 多轴伺服电机控制系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN 200810217591 CN101738978B (zh) 2008-11-11 2008-11-11 多轴伺服电机控制系统

Publications (2)

Publication Number Publication Date
CN101738978A true CN101738978A (zh) 2010-06-16
CN101738978B CN101738978B (zh) 2011-10-12

Family

ID=42462550

Family Applications (1)

Application Number Title Priority Date Filing Date
CN 200810217591 Active CN101738978B (zh) 2008-11-11 2008-11-11 多轴伺服电机控制系统

Country Status (1)

Country Link
CN (1) CN101738978B (zh)

Cited By (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102156485A (zh) * 2011-04-22 2011-08-17 哈尔滨工业大学 重载机器人带加速度及电流前馈的位置控制器
CN103076752A (zh) * 2012-12-26 2013-05-01 上海云杉信息科技有限公司 舵机控制器、舵机控制方法以及控制系统
TWI460568B (zh) * 2012-01-19 2014-11-11 Lnc Technology Co Ltd Flexible application of multi - axis controller application system
CN108494313A (zh) * 2018-03-29 2018-09-04 广州视源电子科技股份有限公司 时序控制方法和装置及伺服系统
CN108549215A (zh) * 2018-06-29 2018-09-18 南宁学院 一种无刷直流电机模糊化自适应pid控制优化方法
CN109656130A (zh) * 2017-10-10 2019-04-19 北京京东尚科信息技术有限公司 搬运机器人运行控制方法、装置、机器人以及存储介质
CN109933100A (zh) * 2019-02-18 2019-06-25 浙江德马科技股份有限公司 一种积放控制的制动系统及方法
CN111552325A (zh) * 2020-04-28 2020-08-18 深圳易能电气技术股份有限公司 位置指令同步方法、装置和计算机可读存储介质
CN112039370A (zh) * 2020-09-09 2020-12-04 华中科技大学 一种基于fpga芯片的多轴交流伺服电机的控制系统
CN112953321A (zh) * 2021-03-19 2021-06-11 北京自动化控制设备研究所 重载起动控制方法及系统
CN115185231A (zh) * 2022-07-14 2022-10-14 哈硕永业精密机械(苏州)有限公司 一种双主轴双z轴立式加工中心的自动控制系统
CN117075482A (zh) * 2023-10-13 2023-11-17 深圳市正弦电气股份有限公司 一种伺服自适应前馈控制系统

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN2204471Y (zh) * 1994-08-15 1995-08-02 冶金工业部自动化研究院 大功率永磁无刷伺服电机的电子控制装置
DE19882519B4 (de) * 1997-07-02 2005-12-22 Mitsubishi Denki K.K. Synchronisationssteuergerät für einen Servomotor
DE102005040265A1 (de) * 2005-08-24 2007-03-01 Müller Weingarten AG Verfahren und Vorrichtung zur Steuerung und Regelung von Kräften an servo-elektrischen Pressen
JP4083767B2 (ja) * 2005-12-22 2008-04-30 ファナック株式会社 サーボモータを制御する数値制御装置
CN1932706A (zh) * 2006-10-27 2007-03-21 嘉兴华嶺机电设备有限公司 伺服电动机数字控制装置

Cited By (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102156485A (zh) * 2011-04-22 2011-08-17 哈尔滨工业大学 重载机器人带加速度及电流前馈的位置控制器
TWI460568B (zh) * 2012-01-19 2014-11-11 Lnc Technology Co Ltd Flexible application of multi - axis controller application system
CN103076752A (zh) * 2012-12-26 2013-05-01 上海云杉信息科技有限公司 舵机控制器、舵机控制方法以及控制系统
CN103076752B (zh) * 2012-12-26 2015-03-18 上海云杉信息科技有限公司 舵机控制器、舵机控制方法以及控制系统
CN109656130A (zh) * 2017-10-10 2019-04-19 北京京东尚科信息技术有限公司 搬运机器人运行控制方法、装置、机器人以及存储介质
CN109656130B (zh) * 2017-10-10 2022-06-07 北京京东乾石科技有限公司 搬运机器人运行控制方法、装置、机器人以及存储介质
CN108494313A (zh) * 2018-03-29 2018-09-04 广州视源电子科技股份有限公司 时序控制方法和装置及伺服系统
CN108549215B (zh) * 2018-06-29 2021-02-02 南宁学院 一种无刷直流电机模糊化自适应pid控制优化方法
CN108549215A (zh) * 2018-06-29 2018-09-18 南宁学院 一种无刷直流电机模糊化自适应pid控制优化方法
CN109933100B (zh) * 2019-02-18 2022-04-08 浙江德马科技股份有限公司 一种积放控制的制动系统及方法
CN109933100A (zh) * 2019-02-18 2019-06-25 浙江德马科技股份有限公司 一种积放控制的制动系统及方法
CN111552325A (zh) * 2020-04-28 2020-08-18 深圳易能电气技术股份有限公司 位置指令同步方法、装置和计算机可读存储介质
CN112039370A (zh) * 2020-09-09 2020-12-04 华中科技大学 一种基于fpga芯片的多轴交流伺服电机的控制系统
CN112953321A (zh) * 2021-03-19 2021-06-11 北京自动化控制设备研究所 重载起动控制方法及系统
CN112953321B (zh) * 2021-03-19 2023-12-05 北京自动化控制设备研究所 重载起动控制方法及系统
CN115185231A (zh) * 2022-07-14 2022-10-14 哈硕永业精密机械(苏州)有限公司 一种双主轴双z轴立式加工中心的自动控制系统
CN117075482A (zh) * 2023-10-13 2023-11-17 深圳市正弦电气股份有限公司 一种伺服自适应前馈控制系统
CN117075482B (zh) * 2023-10-13 2024-01-05 深圳市正弦电气股份有限公司 一种伺服自适应前馈控制系统

Also Published As

Publication number Publication date
CN101738978B (zh) 2011-10-12

Similar Documents

Publication Publication Date Title
CN101738978B (zh) 多轴伺服电机控制系统
Yuan et al. Fast and accurate motion tracking of a linear motor system under kinematic and dynamic constraints: An integrated planning and control approach
Xiao et al. Optimal synchronization control of high-precision motion systems
Lam et al. Model predictive contouring control for biaxial systems
Yang et al. A novel contour error estimation for position loop-based cross-coupled control
CN107479497B (zh) 一种五轴加工轨迹轮廓误差双闭环补偿方法
Tang et al. Predictive contour control with adaptive feed rate
CN109159151A (zh) 一种机械臂空间轨迹跟踪动态补偿方法和系统
Antonelli et al. A new on-line algorithm for inverse kinematics of robot manipulators ensuring path tracking capability under joint limits
CN113031518B (zh) 基于迭代学习的数控机床快速误差补偿控制系统及方法
CN105867113A (zh) 一种伺服控制器、伺服控制系统及伺服控制方法
Shao et al. Development of an FPGA-based motion control ASIC for robotic manipulators
US20020188381A1 (en) Control system for robots
Martinez-Prado et al. Multi-axis motion controller for robotic applications implemented on an FPGA
Yao et al. Modeling and control of twin parallel-axis linear servo mechanisms for high-speed machine tools
Cheng et al. Adaptive robust control of tracking and synchronization for multi-axis motion system
Kyura The development of a controller for mechatronics equipment
Lee et al. Real-time compensation of two-dimensional contour error in CNC machine tools
Zheng et al. Simple online smooth trajectory generations for industrial systems
Paromtchik et al. A practical approach to motion generation and control for an omnidirectional mobile robot
CN102790584A (zh) 一种伺服驱动系统及其速度环参数整定系统
CN109581862B (zh) 内嵌扰动估计补偿算法的驱动器
Pritschow et al. Open system architecture for drives
JP7453268B2 (ja) 多軸サーボ制御システム
CN112039370A (zh) 一种基于fpga芯片的多轴交流伺服电机的控制系统

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant