CN1925310B - 利用逆算模型的马达速度控制系统和负载惯量估测方法 - Google Patents
利用逆算模型的马达速度控制系统和负载惯量估测方法 Download PDFInfo
- Publication number
- CN1925310B CN1925310B CN200510096699A CN200510096699A CN1925310B CN 1925310 B CN1925310 B CN 1925310B CN 200510096699 A CN200510096699 A CN 200510096699A CN 200510096699 A CN200510096699 A CN 200510096699A CN 1925310 B CN1925310 B CN 1925310B
- Authority
- CN
- China
- Prior art keywords
- signal
- gain
- synthesizer
- motor
- relational expression
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Control Of Electric Motors In General (AREA)
Abstract
一种利用逆算模型的马达速度控制系统和负载惯量估测方法,应用于一交流伺服模块,主要是利用一逆向系统连结于实际系统上,以逆向推演实质的扭矩输出,于此当实际系统产生的速度信号的值逐渐增加时,会累加净惯量比;而当实际系统产生的速度信号的值增加到一定值时,则会更新净惯量比。
Description
技术领域
本发明涉及一种负载惯量估测技术,特别涉及一种利用逆算模型的马达速度控制系统和负载惯量估测方法。
背景技术
在交流伺服模块中主要包括驱动器和马达二部分。将伺服马达装设于应用的机构上,即可达到定位或控速的需求。因而,在设计交流伺服驱动器时,负载物的转动惯量(rotor inertia)为设计时的一项重要参数,在达到精准估测此参数的情况下,才能确保交流伺服驱动器在进行运算控制时,能对此参数有一正确数值来作出准确的控制运算。然而,机构的惯量值的大小较难借由数学计算而求得,需以在线实时估测方法来获得,才能提供交流伺服驱动器实时了解本身及周遭环境的因素变化。
参照图1,为传统马达速度控制系统,主要由第一合成器110、第一增益控制器120、电流回路130、第二增益控制器140、第二合成器150和马达数学模型160依序串联成一回路。第一合成器110接收一速度命令ω*和马达数学模型160反馈的速度信号ω而输出一误差信号,此误差信号再通过第一增益控制器120以输出第一增益信号,再经由电流回路130转换成一电流信号i以输入至第二增益控制器140,而第二增益控制器140根据此电流信号i产生第二增益信号,接着第二合成器150接收此第二增益信号和一扭矩信号Tl并合成为一合成信号输入至马达数学模型160,以控制其的速度。于此,电流信号i会输出,借以估测得实际负载惯量。
于一般设计下,电流回路频宽都远大于速度回路频宽,因此电流回路的影响都会予以忽略;并且负载惯量(Jl)会远大于机械阻尼(B),故B值亦可忽略不计。
→∫Jldω=∫(i×Kt+Tl)dt
借由公式一简化可得到公式二,并且于取样系统中,当取样率为h秒(sec)且从t0至t1,可由公式二得到一负载惯量的关系式如下:
由公式三可得知由于其分母为变动值因此取样点的多寡对负载惯量Jl的估测值影响甚大,以致使负载惯量Jl的估测值变化甚大。
发明内容
鉴于以上的问题,本发明的主要目的在于提供一种利用逆算模型的马达速度控制系统和负载惯量估测方法,借以解决先前技术所存在的诸多问题与限制。
本发明所公开的利用逆算模型的马达速度控制系统和负载惯量估测方法,借由一逆算模型来逆向推演实质的扭矩输出。
本发明所公开的利用逆算模型的马达速度控制系统和负载惯量估测方法,可实现收敛快速且稳态误差缓动的负载惯量估测。
因此,为达上述目的,本发明所公开的利用逆算模型的负载惯量估测方法,应用于一交流伺服模块,借由接收一速度命令和一扭矩信号来估算一负载惯量,包括下列步骤:首先,设定如下列的一第一关系式于一实际系统中:接着,设定如下列的一第二关系式于一逆算系统中:然后根据第一关系式和第二关系式得到一第三关系式,如下:当交流伺服模块的马达为等速率转动时,根据第三关系式而得到扭矩信号Tl为-以及当交流伺服模块的马达为加减速率转动时,根据第三关系式而得到净扭矩信号为其中η为该单位马达惯量J0除以所述负载惯量Jl的一惯量比。
其中代表净扭矩信号;Kt代表增益常数;i、i0分别代表实际系统和逆算系统产生的电流信号;Tl代表扭矩信号;ω、ω0分别代表实际系统和逆算系统产生的速度信号;Jl、J0分别代表负载惯量和单位马达惯量;电流信号i为实际系统根据速度命令和反馈的速度信号ω而产生;而电流信号i0则逆算系统根据来自实际系统的速度信号ω和反馈的速度信号ω0而产生,并且此速度信号
此外还包括下列步骤:根据第三关系式得到一第四关系式,如下: 当速度信号ω的值由ω0增加至ω1时,根据第四关系式累加净惯量比以及当速度信号ω的值达到ω1时,根据第四关系式更新净惯量比其中,其中η代表单位马达惯量J0除以负载惯量Jl的一惯量比,代表一净惯量比,以及ω1与ω0的差值的绝对值和μ分别为一定值.
本发明还公开一种利用逆算模式的马达速度控制系统,应用于一交流伺服模块,包括:一实际系统和一逆算系统
于实际系统中包括:一第一合成器、一第一增益控制器、一电流回路、一第二增益控制器、一第二合成器和一马达数学模型。此六元件依序串联成一回路。第一合成器用以接收一输入速度信号并根据输入速度信号和反馈的一速度信号产生一误差信号,第一增益控制器则根据误差信号产生一第一增益信号,电流回路再将第一增益信号转换为相应的一电流信号,第二增益控制器根据电流信号产生一第二增益信号,第二合成器将一扭矩信号与第二增益信号合成为一净扭矩信号,最后马达数学模型则根据净扭矩信号产生一速度信号并反馈至第一合成器。
而于逆算系统中则包括:一第三合成器、一第三增益控制器、一电流回路、一第四增益控制器和一马达数学模型。此六元件依序串联成一回路,并且第三合成器会与实际系统的马达数学模型相连接。其中,第三合成器会根据实际系统产生的速度信号和反馈的速度信号而产生一误差信号,第三增益控制器则根据第三合成器产生的误差信号产生第三增益信号,接着电流回路再将第三增益信号转换为相应的电流信号,第四增益控制器根据电流信号产生第四增益信号,最后马达数学模型根据第四增益信号产生一速度信号并反馈至第三合成器。
其中,利用适应性算法可根据实际系统和逆算系统产生的电流信号估测得净扭矩信号,进而估测得交流伺服模块的负载惯量。
再者,实际系统所产生的速度信号大致上相等于逆算系统所产生的速度信号。
此外,实际系统和逆算系统的频宽远小于电流回路所具有的频宽。
于此,第一和第三增益控制器分别为比例积分控制器。
有关本发明的特征与实作,配合图示作最佳实施例详细说明如下。
附图说明
图1为说明传统马达速度控制系统的概要结构图;
图2为图1的简化系统的概要结构图;
图3为说明根据本发明的一实施例的利用逆算模式的马达速度控制系统的概要结构图;以及
图4为图3中的系统产生的各个信号的示意图。
其中,附图标记说明如下:
110第一合成器 120第一增益控制器 130电流回路
140第二增益控制器 150第二合成器 160马达数学模型
210第三合成器 220第三增益控制器 240第四增益控制器
260马达数学模型
ω*速度命令 ω速度信号 ω0速度信号
i电流信号 i0电流信号 Tl扭矩信号
G实际系统 G0逆算系统 净惯量比
具体实施方式
以下举出具体实施例以详细说明本发明的内容,并以附图作为辅助说明。说明中提及的符号参照附图符号。
本发明主要借由一逆算系统来逆向推演实质的扭矩输出,进而以适应性算法估测得实际负载惯量,以达到实时估测且精准控制的目的。
参照图3,为本发明一实施例的利用逆算模式的马达速度控制系统,应用于一交流伺服模块,主要由一实际系统G和一逆算系统G0所组成。
此实际系统G的元件组成和运作大致上与上述的传统马达速度控制系统相同,因于此不再重复说明。此实际系统G由第一合成器110、第一增益控制器120、电流回路(于此电流回路的影响亦可忽略不计,因未显示于图中)、第二增益控制器140、第二合成器150和马达数学模型160依序串联成一回路。其中,第二合成器150将第二增益信号和扭矩信号Tl合成为一净扭矩信号此净扭矩信号输入至马达数学模型160,以控制其的速度,并且马达数学模型160所产生的速度信号ω除了会反馈至第一合成器110,亦会输入之至逆算系统G0中。
此逆算系统G0由第三合成器210、第三增益控制器220、第四增益控制器240、电流回路(于此电流回路的影响亦可忽略不计,因未显示于图中)和马达数学模型260依序串联成一回路。第三合成器210接收来自实际系统G的速度信号ω和马达数学模型260反馈的速度信号ω0而输出一误差信号,此误差信号再通过第三增益控制器220以输出第三增益信号,再经由电流回路230转换成一电流信号i0以输入至第四增益控制器240,而第四增益控制器240根据此电流信号i0产生第二增益信号,并输入至马达数学模型260中以控制其的速度。于此,电流信号i0会输出,进而可借由电流信号i和电流信号i0并利用适应性算法而估测得实际负载惯量。其中,第一和第三增益控制器120、220分别为一比例积分控制器(P/I controller)。
于实际系统G中,第一增益控制器120为一比例积分控制器,其增益值为:第二增益控制器140的增益值为:Kt;马达数学模型160的公式为:而于逆算系统G0中,第三增益控制器220亦为一比例积分控制器,其增益值为:第四增益控制器240的增益值亦为:Kt;马达数学模型260的公式为:
其中,Kp、Kp0、Ki、Ki0、Kt均为常数值;和分别表示Ki的积分和Ki0的积分;Jl为负载惯量,表示负载惯量的微分;J0为单位马达惯量,表示单位马达惯量的微分;而B亦为机械阻尼且因负载惯量(Jl)和单位马达惯量(J0)会远大于机械阻尼(B),故B值均可忽略不计,故马达数学模型160的公式则为:且马达数学模型260的公式为:因而可得到第一和第二关系式如公式四和公式五所示:
................................................公式五
其中,由于因此由公式四~五可得公式六(即第三关系式),如下:
...................公式六
并且,惯量比η定义为单位马达惯量除以负载惯量,因此公式六可简化为公式七(即第三关系式),如下:
其中,当逆算系统G0产生的电流信号i0的绝对值极小时,此时代表马达处于等速率转动,因而净电流几乎为零,进而可得到而当电流信号i0的绝对值够大时,即代表马达处于加减速率转动,也就是净扭矩信号已足够大,且此时输出的电流信号为i,因此可得并且,由公式七可导得公式八(即第四关系式)以进行惯量比η的估测,如下:
..................公式八
其中,|ω1-ω0|和μ分别为一定值。
当速度ω从ω0变化至ω1时,即会进行一次更新,然后重新开始进行累加,并反复于ω增加一定值时,使进行一次更新,如图4所示。其中代表一净惯量比。
于此,于公式八中已不存在分母的运算,因此于实际运用上,比公知技术有较低的稳态误差变动性,同时收敛速度也相当快。此外,于此所得的电流信号i0·可用以判断等速或加减速的时机已决定扭矩信号Tl是否更新估测值,因此可得到较正确的扭矩信号Tl进而能准确地估测负载惯量Jl。
虽然本发明以前述的较佳实施例公开如上,然其并非用以限定本发明,任何本领域的普通技术人员,在不脱离本发明的精神和范围内,当可作些许的更动与润饰,因此本发明的专利保护范围须视本说明书所附的权利要求书的范围为准。
Claims (7)
1.一种利用逆算模型的负载惯显估测方法,应用于一交流伺服模块,借由接收一速度命令和一扭矩信号来估算一负载惯量,包括下列步骤:
设定如下列的一第一关系式于一实际系统中:
其中代表一净扭矩信号,Kt代表一增益常数,i代表该实际系统产生的一电流信号,Tl代表该扭矩信号,ω代表该实际系统产生的一速度信号,Jl代表该负载惯量,以及该电流信号i为该实际系统根据该速度命令和反馈的该速度信号ω而产生;
设定如下列的一第二关系式于一逆算系统中:
其中i0代表该逆算系统产生的一电流信号,Kt代表该增益常数,ω0代表该逆算系统产生的一速度信号,J0代表一单位马达惯量,以及该电流信号i0是该逆算系统根据来自该实际系统的该速度信号ω和反馈的该速度信号ω0而产生,并且该速度信号
根据该第一关系式和该第二关系式得到一第三关系式,如下:
3.如权利要求1所述的利用逆算模型的负载惯量估测方法,其特征在于,该逆算系统为频宽为300Hz的频宽回路。
4.一种利用逆算模式的马达速度控制系统,应用于一交流伺服模块,包括:
一实际系统,包括:
一第一合成器,用以接收一输入速度信号并根据该输入速度信号和反馈的一速度信号产生一误差信号;
一第一增益控制器,连接至该第一合成器,以根据该误差信号产生一第一增益信号;
一电流回路,连接至该第一增益控制器,以将该第一增益信号转换为相应的一电流信号;
一第二增益控制器,连接至该电流回路,以根据相应该第一增益信号的该电流信号产生一第二增益信号;
一第二合成器,连接至该第二增益控制器,以将一扭矩信号与该第二增益信号合成为一净扭矩信号;以及
一马达数学模型,连接至该第一和第二合成器,以根据该净扭矩信号产生一速度信号并反馈至该第一合成器;以及
一逆算系统,包括:
一第三合成器,连接至该实际系统的该马达数学模型,以将该实际系统产生的该速度信号和反馈的一速度信号而产生一误差信号;
一第三增益控制器,连接至该第三合成器,以根据该第三合成器产生的该误差信号产生一第三增益信号;
一电流回路,连接至该第三增益控制器,以将该第三增益信号转换为相应的一电流信号;
一第四增益控制器,连接至该电流回路,以根据相应该第三增益信号的该电流信号产生一第四增益信号;以及
一马达数学模型,连接至该第三合成器和该第四增益控制器,以根据该第四增益信号产生一速度信号并反馈至该第三合成器;
其中,利用适应性算法可根据该实际系统和该逆算系统产生的该些电流信号估测得该净扭矩信号,进而估测得该交流伺服模块的负载惯量。
5.如权利要求4所述的利用逆算模式的马达速度控制系统,其特征在于,该实际系统所产生的该速度信号约等于该逆算系统所产生的该速度信号。
6.如权利要求4所述的利用逆算模式的马达速度控制系统,其特征在于,该实际系统和该逆算系统的频宽远小于该电流回路所具有的频宽。
7.如权利要求4所述的利用逆算模式的马达速度控制系统,其特征在于,该第一和第三增益控制器分别为一比例积分控制器。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN200510096699A CN1925310B (zh) | 2005-08-30 | 2005-08-30 | 利用逆算模型的马达速度控制系统和负载惯量估测方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN200510096699A CN1925310B (zh) | 2005-08-30 | 2005-08-30 | 利用逆算模型的马达速度控制系统和负载惯量估测方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN1925310A CN1925310A (zh) | 2007-03-07 |
CN1925310B true CN1925310B (zh) | 2010-05-12 |
Family
ID=37817822
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN200510096699A Expired - Fee Related CN1925310B (zh) | 2005-08-30 | 2005-08-30 | 利用逆算模型的马达速度控制系统和负载惯量估测方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN1925310B (zh) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4565034B2 (ja) * | 2008-12-16 | 2010-10-20 | ファナック株式会社 | イナーシャ推定を行う制御装置及び制御システム |
CN103684188B (zh) * | 2013-12-31 | 2017-01-11 | 上海英威腾工业技术有限公司 | 一种运动控制系统的转动惯量辨识方法及系统 |
CN105227034B (zh) * | 2014-06-09 | 2018-06-08 | 东元电机股份有限公司 | 马达机械参数估测系统 |
CN104124908B (zh) * | 2014-07-10 | 2017-08-08 | 深圳市汇川技术股份有限公司 | 在线识别惯量比的系统及方法 |
JP6436067B2 (ja) * | 2015-11-19 | 2018-12-12 | オムロン株式会社 | 制御装置、制御方法、情報処理プログラム、および記録媒体 |
TWI726498B (zh) | 2019-11-22 | 2021-05-01 | 財團法人工業技術研究院 | 龍門機構線上慣量匹配同步控制方法 |
US11316452B2 (en) * | 2020-01-15 | 2022-04-26 | Delta Electronics, Inc. | Electronic device and control method thereof |
CN111682825B (zh) * | 2020-06-29 | 2022-04-05 | 潍柴动力股份有限公司 | 一种电机转速控制方法及系统 |
CN113067513B (zh) * | 2021-03-30 | 2023-06-23 | 潍柴动力股份有限公司 | 一种电机的控制方法和装置 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4679103A (en) * | 1986-04-29 | 1987-07-07 | International Business Machines Corporation | Digital servo control system for a data recording disk file |
US5191272A (en) * | 1990-04-03 | 1993-03-02 | Fanuc Ltd. | Method of adjusting gain for motor control |
CN1525148A (zh) * | 2003-02-24 | 2004-09-01 | 台达电子工业股份有限公司 | 负载转子惯量的实时测量方法 |
US6900607B2 (en) * | 2001-08-17 | 2005-05-31 | Delphi Technologies, Inc. | Combined feedforward and feedback parameter estimation for electric machines |
-
2005
- 2005-08-30 CN CN200510096699A patent/CN1925310B/zh not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4679103A (en) * | 1986-04-29 | 1987-07-07 | International Business Machines Corporation | Digital servo control system for a data recording disk file |
US5191272A (en) * | 1990-04-03 | 1993-03-02 | Fanuc Ltd. | Method of adjusting gain for motor control |
US6900607B2 (en) * | 2001-08-17 | 2005-05-31 | Delphi Technologies, Inc. | Combined feedforward and feedback parameter estimation for electric machines |
CN1525148A (zh) * | 2003-02-24 | 2004-09-01 | 台达电子工业股份有限公司 | 负载转子惯量的实时测量方法 |
Non-Patent Citations (1)
Title |
---|
JP特开2001-209403A 2001.08.03 |
Also Published As
Publication number | Publication date |
---|---|
CN1925310A (zh) | 2007-03-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN1925310B (zh) | 利用逆算模型的马达速度控制系统和负载惯量估测方法 | |
CN109240086B (zh) | 一种非线性双边遥操作系统的自适应鲁棒控制方法 | |
Sung et al. | Process identification and PID control | |
CN113341726B (zh) | 一种多质点车辆队列行驶系统的迭代学习控制方法 | |
CN112904728A (zh) | 一种基于改进型趋近律的机械臂滑模控制轨迹跟踪方法 | |
CN111459016B (zh) | 一种裁床切割机轨迹轮廓跟踪控制方法 | |
CN101578584A (zh) | 控制器、观测器及其应用 | |
CN104135212A (zh) | 一种柔性化运动控制ip核及实现方法 | |
CN102809945A (zh) | 数控加工中的运动规划方法、运动规划器及其应用 | |
CN111443599A (zh) | 优化pid参数的核电站汽轮机转速控制方法 | |
Sinyukova et al. | Neural network speed observers | |
CN113093538A (zh) | 一种模块化机器人系统的非零和博弈神经-最优控制方法 | |
CN110340894A (zh) | 一种基于模糊逻辑的遥操作系统自适应多边控制方法 | |
CN104317195A (zh) | 一种基于改进极限学习机的非线性逆模型控制方法 | |
CN103838141B (zh) | 一种面向控制的大型天线建模方法 | |
CN103399488B (zh) | 基于自学习的多模型控制方法 | |
CN114115252B (zh) | 一种基于不等式约束的关节模组鲁棒控制方法 | |
CN111413866A (zh) | 一种考虑时延的航空发动机分布式控制律设计及验证方法 | |
CN108988710B (zh) | 考虑长时延的网络化h∞模型参考直流电机调速方法和系统 | |
CN106777616A (zh) | 一种高速水稻钵苗插秧机移箱机构多学科优化设计方法 | |
Tian | Networked control system time-delay compensation based on PI-based dynamic matrix control | |
CN104950804A (zh) | 一种基于改进的SVD-Krylov算法的数控机床进给系统建模方法 | |
CN113900377A (zh) | 双转子气动系统点对点迭代学习最小能量控制方法 | |
CN114094896A (zh) | 一种永磁同步电机的自构式t-s型模糊神经网络控制方法 | |
CN113110628A (zh) | 基于pso的压水堆除氧器水位控制方法 |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20100512 Termination date: 20150830 |
|
EXPY | Termination of patent right or utility model |