CN105978428A - 伺服马达系统及其控制方法 - Google Patents

伺服马达系统及其控制方法 Download PDF

Info

Publication number
CN105978428A
CN105978428A CN201510500888.XA CN201510500888A CN105978428A CN 105978428 A CN105978428 A CN 105978428A CN 201510500888 A CN201510500888 A CN 201510500888A CN 105978428 A CN105978428 A CN 105978428A
Authority
CN
China
Prior art keywords
speed
current
control system
servomotor
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
Application number
CN201510500888.XA
Other languages
English (en)
Other versions
CN105978428B (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.)
Lite On Technology Corp
Original Assignee
Lite On Technology Corp
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 Lite On Technology Corp filed Critical Lite On Technology Corp
Priority to US15/234,165 priority Critical patent/US9768720B2/en
Publication of CN105978428A publication Critical patent/CN105978428A/zh
Application granted granted Critical
Publication of CN105978428B publication Critical patent/CN105978428B/zh
Expired - Fee Related 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
    • H02P23/00Arrangements or methods for the control of AC motors characterised by a control method other than vector control
    • H02P23/14Estimation or adaptation of motor parameters, e.g. rotor time constant, flux, speed, current or voltage
    • 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/18Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
    • G05B19/416Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control of velocity, acceleration or deceleration
    • 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
    • H02P21/00Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
    • H02P21/14Estimation or adaptation of machine parameters, e.g. flux, current or voltage
    • 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
    • H02P21/00Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
    • H02P21/14Estimation or adaptation of machine parameters, e.g. flux, current or voltage
    • H02P21/143Inertia or moment of inertia estimation
    • 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
    • H02P21/00Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
    • H02P21/14Estimation or adaptation of machine parameters, e.g. flux, current or voltage
    • H02P21/20Estimation of torque
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/34Director, elements to supervisory
    • G05B2219/34015Axis controller
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/50Machine tool, machine tool null till machine tool work handling
    • G05B2219/50185Monitoring, detect failures, control of efficiency of machine, tool life

Landscapes

  • Engineering & Computer Science (AREA)
  • Power Engineering (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Control Of Electric Motors In General (AREA)

Abstract

一种伺服马达系统及其控制方法,可快速调整速度控制器。当伺服马达系统以预定速度运转时估测转矩常数及摩擦系数。当伺服马达系统减速时则估测惯量。在估测完成前述参数之后可立即设定伺服马达系统的控制增益。全部自动调整的过程无需人力且仅需1秒左右。伺服马达系统的电流设定模块可让伺服马达系统能稳定运作,避免因为系统不稳定产生控制误差。另外,初始值设定模块、转矩常数估算器、初始惯量估算器、摩擦系数估算单元及惯量估算单元可让伺服马达系统得出精确的转矩常数、惯量及摩擦系数等参数,对于伺服马达系统能更精确且快速地调整。

Description

伺服马达系统及其控制方法
技术领域
本发明涉及一种伺服马达系统及其控制方法,特别是涉及一种用于快速估测对应伺服马达系统的转矩常数、惯量及摩擦系数等参数且能够稳定运作的伺服马达系统及其控制方法。
背景技术
伺服马达系统已广泛应用于现今工业界,如半导体制程设备、机械加工平台、机器人、自动化机器等。伺服马达系统的控制需有迅速自动调整的能力,如此才能使伺服马达系统能够稳定运作,并降低人工调整的成本,提升产品的竞争力。
由于各伺服马达系统的机构特性差异,其对应的转矩常数、惯量及摩擦系数也随之相异,目前尚待解决的课题,是快速估测转矩常数、惯量及摩擦系数等参数且控制伺服马达系统能够稳定运作。
发明内容
因此,本发明的目的在于提供一种改善先前技术的伺服马达系统及其控制方法。
本发明的伺服马达系统的控制方法中,该伺服马达系统具有一电流控制回路、一速度控制回路及一控制装置,该电流控制回路依据电流命令控制该伺服马达系统的输出电流、该速度控制回路依据速度命令控制该伺服马达系统的输出速度,该控制装置用以设定该电流控制回路及该速度控制回路。该方法包括下述步骤:该电流控制回路依据电流命令i* q以及输出电流iq的电流误差进行积分限制,使该伺服马达系统定速于一稳定速度ω0。该控制装置配合d轴及q轴的解耦电压vdo,vqo以前馈控制方式令该伺服马达系统自该稳定速度ω0升速至另一预定速度ω1,且于该预定速度ω1估算对应该伺服马达系统的转矩常数,及/或配合于该预定速度ω1降速时估算对应该伺服马达系统的惯量或摩擦系数。
本发明的伺服马达系统的控制方法,该方法还包括下述步骤:该控制装置对于该电流控制回路输入电流命令i* q=i1并对该电流控制回路的电流命令i* q以及输出电流iq的电流误差进行积分限制,使该伺服马达系统定速于该稳定速度ω0且输出电流iq=i2
当该伺服马达系统定速于该稳定速度ω0时,该控制装置依据一第一公式换算d轴及q轴的解耦电压vdo,vqo,其中,
该第一公式:vd0=-ω0*Lq*iq及vq0=ωγ*Ld*idγ*λ,
Lq及Ld的定义分别为q轴及d轴电感、iq及id的定义分别为q轴及d轴电流、ωv的定义为速度回路带宽,及λ为磁通链;及
该控制装置输入该d轴及q轴的解耦电压vdo,vqo至该电流控制回路,使该电流控制回路的q轴的输出电流iq跟随该电流命令i* q
本发明的伺服马达系统的控制方法,该方法还包括下述步骤:当该电流控制回路的输出电流iq跟随该电流命令i* q时,该控制装置令该电流控制回路放宽电流误差之积分限制,使该伺服马达系统加速到该预定速度ω1,在该预定速度ω1的状态下换算一摩擦系数
本发明的伺服马达系统的控制方法,该方法还包括下述步骤:当该伺服马达系统速度到达该预定速度ω1时,该控制装置使该伺服马达系统在降速之前依据一第二公式于输入电流指令i* q=0时计算一初始转矩常数Kt0及输入电流指令i* q=i1计算一初始惯量J0,并将该初始转矩常数Kt0及该初始惯量J0依据一第三公式换算一速度控制增益Kp_v0:及Ki_v0,其中,
该第二公式:vq的定义为q轴电压,ω的定义为马达机械转速,a的定义为加速度,iq的定义为q轴电流,
该第三公式:Kp_v0=2·ωv·J0
该控制装置对于该速度控制回路输入该速度控制增益Kp_v0及Ki_v0
本发明的伺服马达系统的控制方法,该方法还包括下述步骤:该控制装置控制该伺服马达系统停止运作以使该伺服马达系统开始减速,该控制装置并依据减速期间测得的速度曲线取样数个速度配合该摩擦系数以曲线拟合方式估算一惯量
本发明的伺服马达系统的控制方法,该方法还包括下述步骤:该伺服马达系统从输入电流指令i* q=i1改为输入电流指令i* q=0,再转换成以该速度控制回路进行速度控制于其速度等于该预定速度ω1时,该控制装置量测该预定速度ω1对应的输出电流iq=i3,并依据该预定速度ω1及该输出电流iq=i3依据一第四公式换算一转矩常数并依据该转矩常数换算该摩擦系数其中,
该第四公式: K ^ e = v q - i 3 * r s ω 1 , K ^ t = 1.5 x K ^ e B ^ = K ^ txi 3 ω 1 ,
vq的定义为q轴电压、rs的定义为电阻;及
该控制装置控制该伺服马达系统停止运作以使该伺服马达系统开始减速,并依据减速期间测得的速度曲线取样数个速度配合该第四公式计算的摩擦系数依据一第五公式以曲线拟合方式估算该惯量
该第五公式:ω(t)=M*eN*t其中,M的定义为马达转速以指数函数形式作曲线拟合得到的速度初始值、N的定义为马达转速以指数函数形式作曲线拟合得到的时间常数。
本发明的伺服马达系统的控制方法,该方法还包括下述步骤:该控制装置依据该摩擦系数及该惯量以一第六公式换算该速度控制增益Kp_v及Ki_v,并以该速度控制增益Kp_v及Ki_v设定该速度控制回路,其中,
该第六公式: K p _ v = ω γ * J ^ K i _ v = ω γ * B ^ .
本发明一种伺服马达系统,包括一电流控制回路、一速度控制回路及一控制装置,该电流控制回路依据电流命令控制该伺服马达系统的输出电流,该速度控制回路依据速度命令控制该伺服马达系统的输出速度,该控制装置用以设定该电流控制回路及该速度控制回路,且该电流控制回路的电流命令i* q以及输出电流iq的电流误差进行积分限制,使该伺服马达系统定速于一稳定速度ω0,且该控制装置配合d轴及q轴的解耦电压vdo,vqo以前馈控制方式令该伺服马达系统自该稳定速度ω0升速至另一预定速度ω1,且于该预定速度ω1估算对应该伺服马达系统的转矩常数及/或配合于该预定速度ω1降速时估算对应该伺服马达系统的惯量或摩擦系数
本发明的伺服马达系统,该控制装置具有:一初始值设定模块,令该电流控制回路的输入电流指令i* q=0,当该伺服马达系统降速之前,计算一初始转矩常数Kt0及一初始惯量J0,并将该初始转矩常数kt0及该初始惯量J0换算一初速控制增益Kp_v0及Ki_v0,且以该初速控制增益Kp_v0及Ki_v0设定该速度控制回路;
一摩擦系数估算单元,当该电流控制回路的输出电流iq跟随该电流命令i* q时,令该电流控制回路放宽电流误差之积分限制,使该伺服马达系统加速至该预定速度ω1,在该预定速度ω1的状态下换算一摩擦系数
一惯量估算单元,控制该伺服马达系统停止运作以使该伺服马达系统开始减速,并依据减速期间测得的速度曲线取样数个速度配合该摩擦系数以曲线拟合方式估算一惯量
本发明的伺服马达系统,该控制装置于该预定速度ω1时量测该预定速度ω1对应的输出电流iq,并依据该预定速度ω1及该输出电流iq换算一转矩常数及依据转矩常数换算一摩擦系数且依据该摩擦系数及该惯量换算该速度控制增益Kp_v及Ki_v,并以该速度控制增益Kp_v及Ki_v设定该速度控制回路以使该伺服马达系统稳定运作。
本发明的功效在于:伺服马达系统的电流设定模块可让伺服马达系统能稳定运作,避免因为系统不稳定产生控制误差。另外,初始值设定模块、转矩常数估算器、初始惯量估算器、摩擦系数估算单元及惯量估算单元可让伺服马达系统得出精确的转矩常数、惯量及摩擦系数等参数,对于伺服马达系统能更精确且快速地调整。
附图说明
本发明的其他的特征及功效,将于参照图式的实施例详细说明中清楚地呈现,其中:
图1是一系统方块图,说明本发明伺服马达系统的实施例;
图2是一控制方块图,说明该实施例具有的位置控制回路组件;
图3是一控制方块图,说明该实施例具有的速度控制回路组件;
图4是一控制方块图,说明该实施例具有的电流控制回路组件;
图5是一曲线图,说明本发明伺服马达系统的控制方法的实施例的电流指令、输出电流及输出速度;
图6是一局部放大曲线图,说明图5的该实施例在降速状态的取样速度;及
图7是一曲线图,说明依据该实施例的输出速度曲线实施而得出的转矩常数、摩擦系数及惯量。
具体实施方式
参阅图1,本发明的实施例中,伺服马达系统100是一永磁同步马达系统,其包括一控制装置1及一主机3,主机3包括一位置控制回路30、一速度控制回路31、一电流控制回路32及一电动机33。伺服马达系统100用以配合一负载机构2运作并估算能稳定驱动负载机构2所需的转矩常数摩擦系数及惯量
需事先说明的是,本实施例内容有加「*」的符号为命令值,例如,ω*为速度命令,iq *为q轴电流命令。有加「^」符号为估测值,例如,为估测的惯量。没有加「*」或「^」的符号为实际值,例如,ω为实际马达转速,iq为实际之q轴输出电流,J为实际之惯量,以此类推。
参阅图2及图3,位置控制回路30用以产生速度控制回路31所需的速度命令ω*,其应用位置控制方程式的一种实施态样如公式1,其结合公式1的位置控制方块图如图2所示,其中,Kp_p为依据截止频率(cutoff frequency)设置的带宽增益,然而,其他类似的位置转换方程式亦适用,不以公式1为限制。
θ ( s ) θ * ( s ) = K p _ p s + K p _ p 公式1
速度控制回路31可应用速度控制方程式的一种实施态样如公式2,其结合公式2的速度控制方块图如图3所示,其中,ωv为依据截止频率设置的速度回路带宽,然而,其他类似的速度转换方程式亦适用,不以公式2为限制。
ω ( s ) ω * ( s ) = K i _ v / B s + K i _ v / B = ω v s + ω v 公式2
电流控制回路32可应用电流控制方程式的一种实施态样如公式3,其结合公式3的电流控制方块图如图4所示,但不以此为限。
i q ( s ) i q * ( s ) = K p _ i q / L q s + K p _ i q / L q = ω i q s + ω i q 公式3
其中,Lq的定义为马达的q轴电感(q-axis inductance)。
参阅图1至图4,控制装置1包括一电流设定模块11、一初始值设定模块12、一转矩常数估算器13、一初始惯量估算器14、一摩擦系数估算单元15、一惯量估算单元16、一第一计算器171及一第二计算器172。
本实施例中,控制装置1是一电子计算器,借由前述软件程序组件或韧体组件的功能模块交互协同运作以执行本发明伺服马达系统100的控制方法,并配合如图5的时点t0~t6的控制过程中计算出各种待求解的参数后,依据求解出来的估测参数进行设定并借此驱动电动机33配合负载机构2运作。
参阅图3,速度控制回路31采用比例调节和积分调节控制器(proportional integral controller),并依据如图2的位置控制回路30提供的速度命令ω*与马达实际的输出速度ω相减得到速度误差,以待求解的比例增益Kp_v和积分增益Ki_v处理后得到一转矩命令T* e,接着,转矩命令T* e与转矩常数相除后产生一电流命令i*,电流命令i*包括q轴的电流命令i* q及d轴的电流命令i* d,本实施例采用q轴电流命令i* q,d轴电流命令i* d设为零。
参阅图4,并配合图3,由于电流控制回路32的输出变化比速度控制回路31的输出变化快很多,本实施例将电流控制回路32的转移函数视为1,代表电流命令i* q等于实际输出电流iq。已知实际输出电流iq乘上转矩常数Kt后为实际输出转矩Te,且实际输出转矩Te减掉实际负载转矩TL后,经由惯量J与摩擦系数B产生伺服马达系统100的实际输出速度ω。电流控制回路32采用比例调节和积分调节控制器,在q轴的电流控制方面,电流命令i* q与回授电流iq相减得到电流误差,依据待求解的比例增益和积分增益处理后,再加上解耦合电压vqo之后即为q轴的实际输出电压vq。同理,在d轴的电流控制方面,电流命令i* d与回授电流id相减得到电流误差,再将电流误差依据待求解的比例增益和积分增益处理后,再加上解耦合电压vdo即为d轴的实际输出电压vd。本实施例中,d,q两轴的比例调节和积分调节控制器在电流误差积分之后还具有一限制器321,且以该限制器321将电流误差积分值限制在合理的范围。
参阅图1及图5,各组件在不同时间区间的作用说明如下。
于时点t0~t1—电流设定模块11对电流控制回路32输入电流命令i* q,电流控制回路32对电流命令i* q以及输出电流iq的电流误差进行积分限制,使伺服马达系统100的实际马达转速达到一稳定速度ω0且输出电流iq=i2
详细而言,伺服马达系统100开始动作时,电流设定模块11对于电流控制回路32输入一电流命令i* q=i1,电流控制回路32对电流命令i* q=i1以及输出电流iq的电流误差进行积分限制,使伺服马达系统100在时点t1达到稳定速度ω0且输出电流iq=i2
于时点t1~t2—伺服马达系统100的实际马达转速定速于稳定速度ω0时,初始值设定模块12计算d轴及q轴的解耦电压vdo,vqo
详细而言,当伺服马达系统100定速于稳定速度ω0时,依据公式4换算d轴及q轴的解耦电压vdo,vqo
vd0=-ω0*Lq*iq及vq0=ωv*Ld*idv*λ 公式4
公式4中,Lq及Ld的定义分别为q轴及d轴电感、iq及id的定义分别为q轴及d轴电流、ωv的定义为速度回路带宽,及λ为磁通链(flux linkage)。「磁通链」的计算方式请参照2010年出版的"PermanentMagnet Synchronous and Brushless DC Motor Drives"的第三章的第227~233页。
然后,初始值设定模块12输入该d轴及q轴的解耦电压vdo,vqo至该电流控制回路32,使该电流控制回路32的输出电流iq跟随该电流命令i* q,且随着输出电流iq增加而以前馈控制方式提高输出速度,也就是升速。
于时点t2~t3—伺服马达系统100维持对于电流控制回路32输入电流命令i* q,且令电流控制回路32放宽电流误差之积分限制,使伺服马达系统100于时点t3达到预定速度ω1
于时点t3~t4—伺服马达系统100的实际马达转速达到预定速度ω1时,电流设定模块11令电流控制回路32的输入电流命令i* q=0,借此使伺服马达系统100稍微降速,且在降速之前配合转矩常数估算器13计算一初始转矩常数Kt0及初始惯量估算器14计算一初始惯量J0,第一计算器171并将初始转矩常数Kt0及初始惯量J0换算一初速控制增益Kp_v0及Ki_v0
详细而言,当伺服马达系统100定速于预定速度ω1时,伺服马达系统100依据公式5于输入电流指令i* q=0时计算一初始转矩常数Kt0及输入电流指令i* q=i1计算一初始惯量J0,使伺服马达系统100依据公式5计算一初始转矩常数Kt0及一初始惯量J0
K t 0 = 3 2 * v q ω J 0 = K t 0 * i 1 a 公式5
公式5中,vq的定义为q轴电压,ω的定义为实际速度,a的定义为由稳定速度ω0升速到预定速度ω1的加速度,iq的定义为q轴电流。
将初始转矩常数Kt0及初始惯量J0依据公式6换算一速度控制增益Kp_v0及Ki_v0
Kp_v0=2·ωv·J0 公式6
公式6中,ωv的定义为如公式2的速度回路带宽。
完成前述计算后,改由速度控制回路31以初速控制增益Ki_v0设定速度控制回路31。其中,如图5于时点t3开始具有部分凹陷曲线是因为控制系统由电流控制转换成速度控制时有一小段时间强制电流命令i* q为零所致。详细而言,速度控制回路31依据速度控制增益Kp_v0及Ki_v0,使伺服马达系统100改为预定速度ω1而重新定速。
接着,于时点t4当摩擦系数估算单元15在预定速度ω1的状态下换算一摩擦系数
详细而言,当输出速度ω等于该预定速度ω1时,量测该预定速度ω1对应的输出电流iq=i3,转矩常数估算器13并依据该预定速度ω1及该输出电流i3依据公式7换算转矩常数及摩擦系数估算单元15依据转矩常数换算摩擦系数
K ^ e = v q - i 3 * r s ω 1 , K ^ t = 1.5 x K ^ e B ^ = K ^ txi 3 ω 1 , 公式7
公式7中,vq的定义为q轴电压、rs的定义为电阻。
于时点t4~t7—控制伺服马达系统100停止运作,使伺服马达系统100开始减速,惯量估算单元16依据减速期间的时点t5~t6测得的速度曲线取样数个速度配合摩擦系数以曲线拟合方式估算一惯量
参阅图6,详细而言,控制伺服马达系统100停止运作以使伺服马达系统100减速,并在降至输出速度ω2(在输出速度ω0~ω1之间),依据减速期间的时点t5~t6之间测得的速度曲线取样数个速度ωd1~ωdn。然后,惯量估算单元16配合该摩擦系数依据公式8以曲线拟合方式估算惯量
ω(t)=M*eN*t 公式8
公式8中,ω(t)代入多个已知的取样速度ωd1~ωdn及t代入对应取样速度ωd1~ωdn的时间d1~dn可求出M及N,M的定义为马达转速以指数函数形式作曲线拟合得到的速度初始值、N的定义为马达转速以指数函数形式作曲线拟合得到的时间常数,然后,将摩擦系数除以N就可求出惯量
经过如前述的控制流程后,第二计算器172取得摩擦系数估算单元15的摩擦系数及惯量估算单元16的惯量并依据摩擦系数及惯量以公式9换算速度控制增益Kp_v及Ki_v,并以增益Ki_v设定速度控制回路31,使伺服马达系统100达成稳定运作的需求,其中,ωv的定义为如公式2的速度回路带宽。
K p _ v = ω γ * J ^ K i _ v = ω γ * B ^ 公式9
因此,依据时点t0~t6的控制过程中计算出摩擦系数及惯量后,从时点t6开始依据摩擦系数及惯量计算速度控制增益Kp_v及Ki_v,并以速度控制增益Kp_v及Ki_v设定伺服马达系统100,如此就能使得伺服马达系统100稳定运作而达到良好的效能。
参阅图7,说明实际实验结果的其中一范例,在升速阶段可测得转矩常数为0.48(Nm/A),升速为1500rpm后降速测得初始惯量J0为1.4*10-3(kg*m2),且在降速过程中测得摩擦系数为2.54*10-3(Nm/rad/s),而在停止运作之前测得实际惯量为3.44*10-4(kg*m2),其自动调整时间只需耗时大约1.4秒。
参阅表1,在对照实验方面,本发明方法估测的惯量对照手动设定方法的惯量之间的误差值约5%左右,本发明方法估测的摩擦系数对照手动设定方法的摩擦系数之间的误差值皆为约5.1%左右,本发明方法估测的转矩常数对照手动设定方法的转矩常数之间的误差值则为约1.5%。
表1
手动设定 本发明方法 误差百分比
惯量 3.28x10-4 3.44x10-4 5%
摩擦系数 2.33x10-3 2.45x10-3 5.1%
转矩常数 0.486 0.478 1.5%
依据前述,伺服马达系统100依据本发明伺服马达系统的控制方法可对马达进行估测且将估测参数自动转换为速度控制增益Kp_v及Ki_v,实验结果证实可在大约1.4秒自动完成精确估测,达成设计的动态效能(dynamic performance)。此外,测得的频率响应也具有稳定的动态效能。
综上所述,伺服马达系统100的电流设定模块11对电流控制回路32的电流命令i* q以及输出电流iq的电流误差进行积分限制可让伺服马达系统100能稳定运作,避免因为系统不稳定产生控制误差。另外,初始值设定模块12、转矩常数估算器13、初始惯量估算器14、摩擦系数估算单元15及惯量估算单元16可借由完成如图5的控制流程,借此估测出的转矩常数惯量及摩擦系数等参数,对于伺服马达系统100能更精确且快速地调整,故确实能达成本发明的目的。
以上所述者,仅为本发明的实施例而已,当不能以此限定本发明实施的范围,即凡依本发明权利要求书及说明书内容所作的简单的等效变化与修饰,皆仍属本发明的范围。

Claims (10)

1.一种伺服马达系统的控制方法,该伺服马达系统具有一电流控制回路、一速度控制回路及一控制装置,该电流控制回路依据电流命令控制该伺服马达系统的输出电流、该速度控制回路依据速度命令控制该伺服马达系统的输出速度,其特征在于:该控制装置用以设定该电流控制回路及该速度控制回路,且该方法包括下述步骤:
该电流控制回路依据电流命令以及输出电流的电流误差进行积分限制,使该伺服马达系统定速于一稳定速度ω0
该控制装置产生d轴及q轴的解耦电压vdo,vqo以前馈控制方式令该伺服马达系统自该稳定速度ω0升速至另一预定速度ω1,且于该预定速度ω1估算对应该伺服马达系统的转矩常数,及/或配合于该预定速度ω1估算对应该伺服马达系统的惯量或摩擦系数。
2.根据权利要求1所述的伺服马达系统的控制方法,其特征在于:还包括下述步骤:
该控制装置对于该电流控制回路输入电流命令i* q=i1并对该电流控制回路的电流命令i* q以及输出电流iq的电流误差进行积分限制,使该伺服马达系统定速于该稳定速度ω0且输出电流iq=i2
当该伺服马达系统定速于该稳定速度ω0时,该控制装置依据一第一公式换算d轴及q轴的解耦电压vdo,vqo,其中,
该第一公式:vd0=-ω0*Lq*iq及vq0=ωY*Ld*idy*λ,
Lq及Ld的定义分别为q轴及d轴电感、iq及id的定义分别为q轴及d轴电流、ωv的定义为速度回路带宽,及λ为磁通链;及
该控制装置输入该d轴及q轴的解耦电压vdo,vqo至该电流控制回路,使该电流控制回路的q轴的输出电流iq跟随该电流命令i* q
3.根据权利要求2所述的伺服马达系统的控制方法,其特征在于:还包括下述步骤:
当该电流控制回路的输出电流iq跟随该电流命令i* q时,该控制装置令该电流控制回路放宽电流误差之积分限制,使该伺服马达系统加速到该预定速度ω1,在该预定速度ω1的状态下换算一摩擦系数
4.根据权利要求3所述的伺服马达系统的控制方法,其特征在于:还包括下述步骤:
当该伺服马达系统速度到达该预定速度ω1时,该控制装置使该伺服马达系统在降速之前依据一第二公式于输入电流指令i* q=0时计算一初始转矩常数Kt0及输入电流指令i* q=i1计算一初始惯量J0,并将该初始转矩常数Kt0及该初始惯量J0依据一第三公式换算一速度控制增益Kp_v0:及Ki_v0,其中,
该第二公式:vq的定义为q轴电压,ω的定义为马达机械转速,a的定义为加速度,iq的定义为q轴电流,
该第三公式:Kp_v0=2·ωv·J0
该控制装置对于该速度控制回路输入该速度控制增益Kp_v0及Ki_v0
5.根据权利要求4所述的伺服马达系统的控制方法,其特征在于:还包括下述步骤:
该控制装置控制该伺服马达系统停止运作以使该伺服马达系统开始减速,该控制装置并依据减速期间测得的速度曲线取样数个速度配合该摩擦系数以曲线拟合方式估算一惯量
6.根据权利要求5所述的伺服马达系统的控制方法,其特征在于:还包括下述步骤:
该伺服马达系统从输入电流指令i* q=i1改为输入电流指令i* q=0,再转换成以该速度控制回路进行速度控制于其速度等于该预定速度ω1时,该控制装置量测该预定速度ω1对应的输出电流iq=i3,并依据该预定速度ω1及该输出电流iq=i3依据一第四公式换算一转矩常数并依据该转矩常数换算该摩擦系数其中,
该第四公式: K ^ e = v q - i 3 * r s ω 1 , K ^ t = 1.5 x K ^ e B ^ = K ^ tx i 3 ω 1 ,
vq的定义为q轴电压、rs的定义为电阻;及
该控制装置控制该伺服马达系统停止运作以使该伺服马达系统开始减速,并依据减速期间测得的速度曲线取样数个速度配合该第四公式计算的摩擦系数依据一第五公式以曲线拟合方式估算该惯量
该第五公式:ω(t)=M*eN*t其中,M的定义为马达转速以指数函数形式作曲线拟合得到的速度初始值、N的定义为马达转速以指数函数形式作曲线拟合得到的时间常数。
7.根据权利要求6所述的伺服马达系统的控制方法,其特征在于:还包括下述步骤:
该控制装置依据该摩擦系数及该惯量以一第六公式换算该速度控制增益Kp_v及Ki_v,并以该速度控制增益Kp_v及Ki_v设定该速度控制回路,其中,
该第六公式: K p _ v = ω γ * J ^ K i _ v = ω γ * B ^ .
8.一种伺服马达系统,包括一电流控制回路、一速度控制回路及一控制装置,该电流控制回路依据电流命令控制该伺服马达系统的输出电流,该速度控制回路依据速度命令控制该伺服马达系统的输出速度,其特征在于:
该控制装置用以设定该电流控制回路及该速度控制回路,且该电流控制回路的电流命令i* q以及输出电流iq的电流误差进行积分限制,使该伺服马达系统定速于一稳定速度ω0,且该控制装置配合d轴及q轴的解耦电压vdo,vqo以前馈控制方式令该伺服马达系统自该稳定速度ω0升速至另一预定速度ω1,且于该预定速度ω1估算对应该伺服马达系统的转矩常数及/或配合于该预定速度ω1降速时估算对应该伺服马达系统的惯量或摩擦系数
9.根据权利要求8所述的伺服马达系统,其特征在于:该控制装置具有:
一初始值设定模块,令该电流控制回路的输入电流指令i* q=0,当该伺服马达系统降速之前,计算一初始转矩常数KtO及一初始惯量J0,并将该初始转矩常数kt0及该初始惯量J0换算一初速控制增益Kp_v0及Ki_v0,且以该初速控制增益Kp_v0及Ki_v0设定该速度控制回路;
一摩擦系数估算单元,当该电流控制回路的输出电流iq跟随该电流命令i* q时,令该电流控制回路放宽电流误差之积分限制,使该伺服马达系统加速至该预定速度ω1,在该预定速度ω1的状态下换算一摩擦系数
一惯量估算单元,控制该伺服马达系统停止运作以使该伺服马达系统开始减速,并依据减速期间测得的速度曲线取样数个速度配合该摩擦系数以曲线拟合方式估算一惯量
10.根据权利要求9所述的伺服马达系统,其特征在于:该控制装置于该预定速度ω1时量测该预定速度ω1对应的输出电流iq,并依据该预定速度ω1及该输出电流iq换算一转矩常数及依据转矩常数换算一摩擦系数且依据该摩擦系数及该惯量换算该速度控制增益Kp_v及Ki_v,并以该速度控制增益Kp_v及Ki_v设定该速度控制回路以使该伺服马达系统稳定运作。
CN201510500888.XA 2015-03-13 2015-08-14 伺服马达系统及其控制方法 Expired - Fee Related CN105978428B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
US15/234,165 US9768720B2 (en) 2015-03-13 2016-08-11 Method and system for estimating operation parameters of a servomotor

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
TW104108079 2015-03-13
TW104108079 2015-03-13

Publications (2)

Publication Number Publication Date
CN105978428A true CN105978428A (zh) 2016-09-28
CN105978428B CN105978428B (zh) 2019-07-26

Family

ID=56988351

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510500888.XA Expired - Fee Related CN105978428B (zh) 2015-03-13 2015-08-14 伺服马达系统及其控制方法

Country Status (3)

Country Link
US (1) US9768720B2 (zh)
CN (1) CN105978428B (zh)
TW (1) TWI551007B (zh)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109756169A (zh) * 2017-11-06 2019-05-14 操纵技术Ip控股公司 永磁dc驱动转向系统的电流传感器故障缓解
CN110161971A (zh) * 2018-02-16 2019-08-23 发那科株式会社 参数决定辅助装置和记录有程序的计算机可读介质
CN110278232A (zh) * 2018-03-16 2019-09-24 腾讯科技(深圳)有限公司 一种控制数据下载的方法及装置、系统
CN110376970A (zh) * 2018-04-12 2019-10-25 发那科株式会社 参数决定辅助装置和记录有程序的计算机可读介质
TWI739620B (zh) * 2020-10-05 2021-09-11 東元電機股份有限公司 轉速前饋調整系統及其方法

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10855211B2 (en) * 2018-03-09 2020-12-01 Trane International Inc. Self-calibration of ECM motor and variable frequency drive inferred torque
JP2020108255A (ja) * 2018-12-27 2020-07-09 富士電機株式会社 サーボアンプ及びサーボシステム
TWI676871B (zh) * 2019-01-08 2019-11-11 東元電機股份有限公司 馬達命令收斂調整裝置及其方法
CN116545327A (zh) * 2022-01-25 2023-08-04 台达电子工业股份有限公司 伺服驱动器及其增益快速自调整方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1338617A (zh) * 2000-08-11 2002-03-06 刘向群 永磁直流电动机虚拟测试系统
CN1983794A (zh) * 2005-08-25 2007-06-20 国际整流器公司 用于永磁无传感器控制的自调节方法和装置
CN102355193A (zh) * 2011-09-30 2012-02-15 哈尔滨工业大学 交流永磁伺服系统的在线转动惯量辨识装置及辨识方法
CN104242770A (zh) * 2014-10-09 2014-12-24 南京科远自动化集团股份有限公司 一种交流伺服系统速度环控制器参数自整定方法

Family Cites Families (20)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20030205984A1 (en) * 2001-06-20 2003-11-06 Jun Yoshida Method of controlling numerically controlled machine tool and numerically controlled machine tool
TW483218B (en) * 2000-04-18 2002-04-11 Tian-Hua Liou Three-phase AC motor shaft position (angle) estimating method
US6940251B1 (en) * 2004-04-30 2005-09-06 Honeywell International Inc. Decoupling of cross coupling for floating reference frame controllers for sensorless control of synchronous machines
JP4349309B2 (ja) * 2004-09-27 2009-10-21 日産自動車株式会社 車両用操舵制御装置
US7211984B2 (en) * 2004-11-09 2007-05-01 General Motors Corporation Start-up and restart of interior permanent magnet machines
US7088077B2 (en) * 2004-11-09 2006-08-08 General Motors Corporation Position-sensorless control of interior permanent magnet machines
WO2006057317A1 (ja) * 2004-11-24 2006-06-01 Nsk Ltd. 無結線式モータ、その駆動制御装置及び無結線式モータの駆動制御装置を使用した電動パワーステアリング装置
US7211979B2 (en) * 2005-04-13 2007-05-01 The Broad Of Trustees Of The Leland Stanford Junior University Torque-position transformer for task control of position controlled robots
US7339344B2 (en) * 2005-08-25 2008-03-04 International Rectifier Corporation Self tuning method and apparatus for permanent magnet sensorless control
TWI275238B (en) * 2006-01-02 2007-03-01 Tian-Hua Liu Rotor position/speed estimating method for micro permanent magnet synchronous motors
US8207701B2 (en) * 2006-10-31 2012-06-26 Byd Company, Ltd. Control method of electromotor
US7986118B2 (en) * 2007-04-23 2011-07-26 Honda Motor Co., Ltd. Open-loop torque control on joint position-controlled robots
US8232758B2 (en) * 2009-08-28 2012-07-31 Fanuc Ltd Controller of electric motor having function of estimating inertia and friction simultaneously
JP5534935B2 (ja) * 2010-05-20 2014-07-02 株式会社東芝 回転センサレス制御装置
CN102959856B (zh) * 2010-07-14 2015-09-02 三菱电机株式会社 马达控制装置
JP5209810B1 (ja) * 2011-07-27 2013-06-12 ファナック株式会社 イナーシャと摩擦係数とばね定数を同時に推定する機能を備える電動機の制御装置
TWM438070U (en) * 2011-12-23 2012-09-21 Shun-Yuan Wang Fuzzy estimation control driving device for Induction motor stator resistance and speed
TWM435775U (en) * 2011-12-23 2012-08-11 Shun-Yuan Wang With adaptive speed and stator resistor estimator of induction motor driving device
JP2013183532A (ja) * 2012-03-01 2013-09-12 Toshiba Corp モータ制御装置及びその制御方法
US8981702B2 (en) * 2013-03-15 2015-03-17 Texas Instruments Incorporated Automated motor control

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1338617A (zh) * 2000-08-11 2002-03-06 刘向群 永磁直流电动机虚拟测试系统
CN1983794A (zh) * 2005-08-25 2007-06-20 国际整流器公司 用于永磁无传感器控制的自调节方法和装置
CN102355193A (zh) * 2011-09-30 2012-02-15 哈尔滨工业大学 交流永磁伺服系统的在线转动惯量辨识装置及辨识方法
CN104242770A (zh) * 2014-10-09 2014-12-24 南京科远自动化集团股份有限公司 一种交流伺服系统速度环控制器参数自整定方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
刘宁: "基于矢量控制的混合动力汽车永磁同步电机驱动系统研究", 《中国优秀硕士学位论文全文数据库-工程科技Ⅱ辑》 *
柳晶: "变频空调永磁同步电机的参数辨识", 《中国优秀硕士学位论文全文数据库-工程科技Ⅱ辑》 *

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109756169A (zh) * 2017-11-06 2019-05-14 操纵技术Ip控股公司 永磁dc驱动转向系统的电流传感器故障缓解
CN109756169B (zh) * 2017-11-06 2022-06-17 操纵技术Ip控股公司 永磁dc驱动转向系统的电流传感器故障缓解
CN110161971A (zh) * 2018-02-16 2019-08-23 发那科株式会社 参数决定辅助装置和记录有程序的计算机可读介质
CN110161971B (zh) * 2018-02-16 2021-05-04 发那科株式会社 参数决定辅助装置和记录有程序的计算机可读介质
CN110278232A (zh) * 2018-03-16 2019-09-24 腾讯科技(深圳)有限公司 一种控制数据下载的方法及装置、系统
CN110278232B (zh) * 2018-03-16 2021-08-17 腾讯科技(深圳)有限公司 一种控制数据下载的方法及装置、系统
CN110376970A (zh) * 2018-04-12 2019-10-25 发那科株式会社 参数决定辅助装置和记录有程序的计算机可读介质
CN110376970B (zh) * 2018-04-12 2021-07-06 发那科株式会社 参数决定辅助装置和记录有程序的计算机可读介质
TWI739620B (zh) * 2020-10-05 2021-09-11 東元電機股份有限公司 轉速前饋調整系統及其方法

Also Published As

Publication number Publication date
TWI551007B (zh) 2016-09-21
US9768720B2 (en) 2017-09-19
CN105978428B (zh) 2019-07-26
TW201633669A (zh) 2016-09-16
US20170045870A1 (en) 2017-02-16

Similar Documents

Publication Publication Date Title
CN105978428A (zh) 伺服马达系统及其控制方法
CN101087120B (zh) 用于控制电机高速运行的装置及其方法
JPH0951700A (ja) 回転電機の制御装置
CN103997272A (zh) 永磁同步电机的负载扰动补偿装置及方法
CN103684182A (zh) 一种永磁同步电机参数辨识方法
CN102647144B (zh) 用于估计同步磁阻电动机的转子角度的方法和设备
CN104660142A (zh) 一种电机控制系统和方法
CN102857171B (zh) 多电机同步控制系统
CN102150358B (zh) 用于变换器的控制或调节方法
US6777906B1 (en) Method of controlling induction motor
US10340776B2 (en) Acceleration method for V/F controlled induction motor in flux-weakening region
JP2018102101A (ja) インバータの制御方法およびインバータの制御装置
CN103825520A (zh) 一种异步电机最优转差频率控制方法
JP2010279095A (ja) 交流電動機のセンサレス制御装置
JP5499594B2 (ja) 永久磁石形同期電動機の制御装置
CN109995286B (zh) 一种异步电机速度环pi参数优化设计方法
KR101530543B1 (ko) 유도 전동기 및 유도 전동기의 동작을 제어하는 제어 장치
EP3111282B1 (en) Machine loss modeling for improved field oriented control accuracy
JP6966978B2 (ja) 工作機械用モータ駆動装置
JP2009290962A (ja) 永久磁石形同期電動機の制御装置
CN104767459A (zh) 电动机控制装置
JPH04304183A (ja) 誘導電動機のベクトル制御装置
CN104506102B (zh) 永磁同步电机控制方法及装置
JP2021197752A (ja) トルク推定装置およびトルク推定方法
JP4984057B2 (ja) 永久磁石形同期電動機の制御装置

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20190726

Termination date: 20200814