CN1925310B - 利用逆算模型的马达速度控制***和负载惯量估测方法 - Google Patents

Abstract

一种利用逆算模型的马达速度控制***和负载惯量估测方法，应用于一交流伺服模块，主要是利用一逆向***连结于实际***上，以逆向推演实质的扭矩输出，于此当实际***产生的速度信号的值逐渐增加时，会累加净惯量比；而当实际***产生的速度信号的值增加到一定值时，则会更新净惯量比。

Description

利用逆算模型的马达速度控制***和负载惯量估测方法

技术领域

本发明涉及一种负载惯量估测技术，特别涉及一种利用逆算模型的马达速度控制***和负载惯量估测方法。

背景技术

在交流伺服模块中主要包括驱动器和马达二部分。将伺服马达装设于应用的机构上，即可达到定位或控速的需求。因而，在设计交流伺服驱动器时，负载物的转动惯量(rotor inertia)为设计时的一项重要参数，在达到精准估测此参数的情况下，才能确保交流伺服驱动器在进行运算控制时，能对此参数有一正确数值来作出准确的控制运算。然而，机构的惯量值的大小较难借由数学计算而求得，需以在线实时估测方法来获得，才能提供交流伺服驱动器实时了解本身及周遭环境的因素变化。

参照图1，为传统马达速度控制***，主要由第一合成器110、第一增益控制器120、电流回路130、第二增益控制器140、第二合成器150和马达数学模型160依序串联成一回路。第一合成器110接收一速度命令ω^＊和马达数学模型160反馈的速度信号ω而输出一误差信号，此误差信号再通过第一增益控制器120以输出第一增益信号，再经由电流回路130转换成一电流信号i以输入至第二增益控制器140，而第二增益控制器140根据此电流信号i产生第二增益信号，接着第二合成器150接收此第二增益信号和一扭矩信号T_l并合成为一合成信号输入至马达数学模型160，以控制其的速度。于此，电流信号i会输出，借以估测得实际负载惯量。

s即代表负载惯量的微分，而B为机械阻尼。

于一般设计下，电流回路频宽都远大于速度回路频宽，因此电流回路的影响都会予以忽略；并且负载惯量(J_l)会远大于机械阻尼(B)，故B值亦可忽略不计。

因而可得一简化的传统马达速度控制***，如图2所示，其中马达数学模型160的型式为：

于此，可得到输出速度信号ω、电流信号i、扭矩信号T_l的关系式如下：

...........................................公式一

→∫J_ldω＝∫(i×Kt+T_l)dt

$\→J_l=\frac{\∫(i\×\mathrm{Kt}+T_l)\mathrm{dt}}{\∫\mathrm{d\ω}}$ ..................................公式二

借由公式一简化可得到公式二，并且于取样***中，当取样率为h秒(sec)且从t₀至t₁，可由公式二得到一负载惯量的关系式如下：

$J_l=\frac{\mathrm{h\Σ}(i\×\mathrm{Kt}+T_l)\mathrm{dt}}{{\mathrm{\ω}}_1-{\mathrm{\ω}}_0}$ ................................公式三

由公式三可得知由于其分母为变动值因此取样点的多寡对负载惯量J_l的估测值影响甚大，以致使负载惯量J_l的估测值变化甚大。

发明内容

鉴于以上的问题，本发明的主要目的在于提供一种利用逆算模型的马达速度控制***和负载惯量估测方法，借以解决先前技术所存在的诸多问题与限制。

本发明所公开的利用逆算模型的马达速度控制***和负载惯量估测方法，借由一逆算模型来逆向推演实质的扭矩输出。

本发明所公开的利用逆算模型的马达速度控制***和负载惯量估测方法，可实现收敛快速且稳态误差缓动的负载惯量估测。

因此，为达上述目的，本发明所公开的利用逆算模型的负载惯量估测方法，应用于一交流伺服模块，借由接收一速度命令和一扭矩信号来估算一负载惯量，包括下列步骤：首先，设定如下列的一第一关系式于一实际***中：接着，设定如下列的一第二关系式于一逆算***中：

然后根据第一关系式和第二关系式得到一第三关系式，如下：当交流伺服模块的马达为等速率转动时，根据第三关系式而得到扭矩信号T_l为-以及当交流伺服模块的马达为加减速率转动时，根据第三关系式而得到净扭矩信号

为其中η为该单位马达惯量J₀除以所述负载惯量J_l的一惯量比。

其中代表净扭矩信号；Kt代表增益常数；i、i₀分别代表实际***和逆算***产生的电流信号；T_l代表扭矩信号；ω、ω₀分别代表实际***和逆算***产生的速度信号；J_l、J₀分别代表负载惯量和单位马达惯量；电流信号i为实际***根据速度命令和反馈的速度信号ω而产生；而电流信号i₀则逆算***根据来自实际***的速度信号ω和反馈的速度信号ω₀而产生，并且此速度信号

此外还包括下列步骤：根据第三关系式得到一第四关系式，如下：

当速度信号ω的值由ω0增加至ω1时，根据第四关系式累加净惯量比以及当速度信号ω的值达到ω1时，根据第四关系式更新净惯量比

其中，其中η代表单位马达惯量J₀除以负载惯量Jl的一惯量比，代表一净惯量比，以及ω1与ω0的差值的绝对值和μ分别为一定值.

本发明还公开一种利用逆算模式的马达速度控制***，应用于一交流伺服模块，包括：一实际***和一逆算***

于实际***中包括：一第一合成器、一第一增益控制器、一电流回路、一第二增益控制器、一第二合成器和一马达数学模型。此六元件依序串联成一回路。第一合成器用以接收一输入速度信号并根据输入速度信号和反馈的一速度信号产生一误差信号，第一增益控制器则根据误差信号产生一第一增益信号，电流回路再将第一增益信号转换为相应的一电流信号，第二增益控制器根据电流信号产生一第二增益信号，第二合成器将一扭矩信号与第二增益信号合成为一净扭矩信号，最后马达数学模型则根据净扭矩信号产生一速度信号并反馈至第一合成器。

而于逆算***中则包括：一第三合成器、一第三增益控制器、一电流回路、一第四增益控制器和一马达数学模型。此六元件依序串联成一回路，并且第三合成器会与实际***的马达数学模型相连接。其中，第三合成器会根据实际***产生的速度信号和反馈的速度信号而产生一误差信号，第三增益控制器则根据第三合成器产生的误差信号产生第三增益信号，接着电流回路再将第三增益信号转换为相应的电流信号，第四增益控制器根据电流信号产生第四增益信号，最后马达数学模型根据第四增益信号产生一速度信号并反馈至第三合成器。

其中，利用适应性算法可根据实际***和逆算***产生的电流信号估测得净扭矩信号，进而估测得交流伺服模块的负载惯量。

再者，实际***所产生的速度信号大致上相等于逆算***所产生的速度信号。

此外，实际***和逆算***的频宽远小于电流回路所具有的频宽。

于此，第一和第三增益控制器分别为比例积分控制器。

有关本发明的特征与实作，配合图示作最佳实施例详细说明如下。

附图说明

图1为说明传统马达速度控制***的概要结构图；

图2为图1的简化***的概要结构图；

图3为说明根据本发明的一实施例的利用逆算模式的马达速度控制***的概要结构图；以及

图4为图3中的***产生的各个信号的示意图。

其中，附图标记说明如下：

110第一合成器       120第一增益控制器    130电流回路

140第二增益控制器   150第二合成器        160马达数学模型

210第三合成器       220第三增益控制器    240第四增益控制器

260马达数学模型

ω^＊速度命令        ω速度信号           ω₀速度信号

i电流信号           i₀电流信号           T_l扭矩信号

G实际***           G₀逆算***            净惯量比

具体实施方式

以下举出具体实施例以详细说明本发明的内容，并以附图作为辅助说明。说明中提及的符号参照附图符号。

本发明主要借由一逆算***来逆向推演实质的扭矩输出，进而以适应性算法估测得实际负载惯量，以达到实时估测且精准控制的目的。

参照图3，为本发明一实施例的利用逆算模式的马达速度控制***，应用于一交流伺服模块，主要由一实际***G和一逆算***G₀所组成。

此实际***G的元件组成和运作大致上与上述的传统马达速度控制***相同，因于此不再重复说明。此实际***G由第一合成器110、第一增益控制器120、电流回路(于此电流回路的影响亦可忽略不计，因未显示于图中)、第二增益控制器140、第二合成器150和马达数学模型160依序串联成一回路。其中，第二合成器150将第二增益信号和扭矩信号T_l合成为一净扭矩信号此净扭矩信号

输入至马达数学模型160，以控制其的速度，并且马达数学模型160所产生的速度信号ω除了会反馈至第一合成器110，亦会输入之至逆算***G₀中。

此逆算***G₀由第三合成器210、第三增益控制器220、第四增益控制器240、电流回路(于此电流回路的影响亦可忽略不计，因未显示于图中)和马达数学模型260依序串联成一回路。第三合成器210接收来自实际***G的速度信号ω和马达数学模型260反馈的速度信号ω₀而输出一误差信号，此误差信号再通过第三增益控制器220以输出第三增益信号，再经由电流回路230转换成一电流信号i₀以输入至第四增益控制器240，而第四增益控制器240根据此电流信号i₀产生第二增益信号，并输入至马达数学模型260中以控制其的速度。于此，电流信号i₀会输出，进而可借由电流信号i和电流信号i₀并利用适应性算法而估测得实际负载惯量。其中，第一和第三增益控制器120、220分别为一比例积分控制器(P/I controller)。

于此，此逆算***G₀设计为高频宽(例如：300Hz)回路，且其输出的速度信号ω₀相当近似于实际***G输出的速度信号ω，即

于实际***G中，第一增益控制器120为一比例积分控制器，其增益值为：第二增益控制器140的增益值为：Kt；马达数学模型160的公式为：而于逆算***G₀中，第三增益控制器220亦为一比例积分控制器，其增益值为：

第四增益控制器240的增益值亦为：Kt；马达数学模型260的公式为：

其中，Kp、Kp₀、Ki、Ki₀、Kt均为常数值；和分别表示Ki的积分和Ki₀的积分；J_l为负载惯量，表示负载惯量的微分；J₀为单位马达惯量，表示单位马达惯量的微分；而B亦为机械阻尼且因负载惯量(J_l)和单位马达惯量(J₀)会远大于机械阻尼(B)，故B值均可忽略不计，故马达数学模型160的公式则为：

且马达数学模型260的公式为：

因而可得到第一和第二关系式如公式四和公式五所示：

....................................公式四

................................................公式五

其中，由于因此由公式四～五可得公式六(即第三关系式)，如下：

...................公式六

并且，惯量比η定义为单位马达惯量除以负载惯量，因此公式六可简化为公式七(即第三关系式)，如下：

........公式七

其中，当逆算***G₀产生的电流信号i₀的绝对值极小时，此时代表马达处于等速率转动，因而净电流

几乎为零，进而可得到

而当电流信号i₀的绝对值够大时，即代表马达处于加减速率转动，也就是净扭矩信号已足够大，且此时输出的电流信号为i，因此可得并且，由公式七可导得公式八(即第四关系式)以进行惯量比η的估测，如下：

..................公式八

其中，|ω1-ω0|和μ分别为一定值。

当速度ω从ω0变化至ω1时，即会进行一次更新，然后重新开始进行累加，并反复于ω增加一定值时，使进行一次更新，如图4所示。其中代表一净惯量比。

于此，于公式八中已不存在分母的运算，因此于实际运用上，比公知技术有较低的稳态误差变动性，同时收敛速度也相当快。此外，于此所得的电流信号i₀·可用以判断等速或加减速的时机已决定扭矩信号T_l是否更新估测值，因此可得到较正确的扭矩信号T_l进而能准确地估测负载惯量J_l。

虽然本发明以前述的较佳实施例公开如上，然其并非用以限定本发明，任何本领域的普通技术人员，在不脱离本发明的精神和范围内，当可作些许的更动与润饰，因此本发明的专利保护范围须视本说明书所附的权利要求书的范围为准。

Claims (7)

1.一种利用逆算模型的负载惯显估测方法，应用于一交流伺服模块，借由接收一速度命令和一扭矩信号来估算一负载惯量，包括下列步骤：

设定如下列的一第一关系式于一实际***中：

其中代表一净扭矩信号，Kt代表一增益常数，i代表该实际***产生的一电流信号，T_l代表该扭矩信号，ω代表该实际***产生的一速度信号，J_l代表该负载惯量，以及该电流信号i为该实际***根据该速度命令和反馈的该速度信号ω而产生；

设定如下列的一第二关系式于一逆算***中：

其中i₀代表该逆算***产生的一电流信号，Kt代表该增益常数，ω₀代表该逆算***产生的一速度信号，J₀代表一单位马达惯量，以及该电流信号i₀是该逆算***根据来自该实际***的该速度信号ω和反馈的该速度信号ω₀而产生，并且该速度信号

根据该第一关系式和该第二关系式得到一第三关系式，如下：

当该交流伺服模块的马达为等速率转动时，根据该第三关系式而得到该扭矩信号T_l为

以及当该交流伺服模块的马达为加减速率转动时，根据该第三关系式而得到该净扭矩信号为

其中η为该单位马达惯量J₀除以所述负载惯量J_l的一惯量比。

2.如权利要求1所述的利用逆算模型的负载惯量估测方法，其特征在于，还包括下列步骤：

根据该第三关系式得到一第四关系式，如下：

其中η代表该单位马达惯量J₀除以该负载惯显J_l的一惯量比，代表一净惯量比，以及ω1与ω0的差值的绝对值和μ分别为一定值；

当该速度信号ω的值由ω0增加至ω1时，根据该第四关系式累加该净惯量比

以及

当该速度信号ω的值达到ω1时，根据该第四关系式更新该净惯量比

3.如权利要求1所述的利用逆算模型的负载惯量估测方法，其特征在于，该逆算***为频宽为300Hz的频宽回路。

4.一种利用逆算模式的马达速度控制***，应用于一交流伺服模块，包括：

一实际***，包括：

一第一合成器，用以接收一输入速度信号并根据该输入速度信号和反馈的一速度信号产生一误差信号；

一第一增益控制器，连接至该第一合成器，以根据该误差信号产生一第一增益信号；

一电流回路，连接至该第一增益控制器，以将该第一增益信号转换为相应的一电流信号；

一第二增益控制器，连接至该电流回路，以根据相应该第一增益信号的该电流信号产生一第二增益信号；

一第二合成器，连接至该第二增益控制器，以将一扭矩信号与该第二增益信号合成为一净扭矩信号；以及

一马达数学模型，连接至该第一和第二合成器，以根据该净扭矩信号产生一速度信号并反馈至该第一合成器；以及

一逆算***，包括：

一第三合成器，连接至该实际***的该马达数学模型，以将该实际***产生的该速度信号和反馈的一速度信号而产生一误差信号；

一第三增益控制器，连接至该第三合成器，以根据该第三合成器产生的该误差信号产生一第三增益信号；

一电流回路，连接至该第三增益控制器，以将该第三增益信号转换为相应的一电流信号；

一第四增益控制器，连接至该电流回路，以根据相应该第三增益信号的该电流信号产生一第四增益信号；以及

一马达数学模型，连接至该第三合成器和该第四增益控制器，以根据该第四增益信号产生一速度信号并反馈至该第三合成器；

其中，利用适应性算法可根据该实际***和该逆算***产生的该些电流信号估测得该净扭矩信号，进而估测得该交流伺服模块的负载惯量。

5.如权利要求4所述的利用逆算模式的马达速度控制***，其特征在于，该实际***所产生的该速度信号约等于该逆算***所产生的该速度信号。

6.如权利要求4所述的利用逆算模式的马达速度控制***，其特征在于，该实际***和该逆算***的频宽远小于该电流回路所具有的频宽。

7.如权利要求4所述的利用逆算模式的马达速度控制***，其特征在于，该第一和第三增益控制器分别为一比例积分控制器。

Images