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

专利名称：利用逆算模型的马达速度控制系统和负载惯量估测方法
技术领域：
本发明涉及一种负载惯量估测技术，特别涉及一种利用逆算模型的马达速度控制系统和负载惯量估测方法。
背景技术：
在交流伺服模块中主要包括驱动器和马达二部分。将伺服马达装设于应用的机构上，即可达到定位或控速的需求。因而，在设计交流伺服驱动器时，负载物的转动惯量(rotor inertia)为设计时的一项重要参数，在达到精准估测此参数的情况下，才能确保交流伺服驱动器在进行运算控制时，能对此参数有一正确数值来作出准确的控制运算。然而，机构的惯量值的大小较难借由数学计算而求得，需以在线实时估测方法来获得，才能提供交流伺服驱动器实时了解本身及周遭环境的因素变化。
参照图1，为传统马达速度控制系统，主要由第一合成器110、第一增益控制器120、电流回路130、第二增益控制器140、第二合成器150和马达数学模型160依序串联成一回路。第一合成器110接收一速度命令ω*和马达数学模型160反馈的速度信号ω而输出一误差信号，此误差信号再通过第一增益控制器120以输出第一增益信号，再经由电流回路130转换成一电流信号i以输入至第二增益控制器140，而第二增益控制器140根据此电流信号i产生第二增益信号，接着第二合成器150接收此第二增益信号和一扭矩信号Tl并合成为一合成信号输入至马达数学模型160，以控制其的速度。于此，电流信号i会输出，借以估测得实际负载惯量。
其中，第一增益控制器120为一比例/积分控制器，其增益值为 第二增益控制器140的增益值为Kt。马达数学模型160的型式为 其中，Kp、Ki、Kt为三常数值， 代表Ki的积分，Jl为负载惯量，Jls即代表负载惯量的微分，而B为机械阻尼。
于一般设计下，电流回路频宽都远大于速度回路频宽，因此电流回路的影响都会予以忽略；并且负载惯量(Jl)会远大于机械阻尼(B)，故B值亦可忽略不计。
因而可得一简化的传统马达速度控制系统，如图2所示，其中马达数学模型160的型式为 于此，可得到输出速度信号ω、电流信号i、扭矩信号Tl的关系式如下 公式一→∫Jldωdt=i×kt+Tl]]>→∫Jldω=∫(i×Kt+Tl)dt]]>→Jl=∫(i×Kt+Tl)dt∫dω········]]>公式二借由公式一简化可得到公式二，并且于取样系统中，当取样率为h秒(sec)且从t0至t1，可由公式二得到一负载惯量的关系式如下Jl=hΣ(i×Kt+Tl)dtω1-ω0········]]>公式三由公式三可得知由于其分母为变动值因此取样点的多寡对负载惯量Jl的估测值影响甚大，以致使负载惯量Jl的估测值变化甚大。

发明内容
鉴于以上的问题，本发明的主要目的在于提供一种利用逆算模型的马达速度控制系统和负载惯量估测方法，借以解决先前技术所存在的诸多问题与限制。
本发明所公开的利用逆算模型的马达速度控制系统和负载惯量估测方法，借由一逆算模型来逆向推演实质的扭矩输出。
本发明所公开的利用逆算模型的马达速度控制系统和负载惯量估测方法，可实现收敛快速且稳态误差缓动的负载惯量估测。
因此，为达上述目的，本发明所公开的利用逆算模型的负载惯量估测方法，应用于一交流伺服模块，借由接收一速度命令和一扭矩信号来估算一负载惯量，包括下列步骤首先，设定如下列的一第一关系式于一实际系统中 接着，设定如下列的一第二关系式于一逆算系统中 然后根据第一关系式和第二关系式得到一第三关系式，如下 当交流伺服模块的马达为等速率转动时，根据第三关系式而得到扭矩信号Tl为-Kti；以及当交流伺服模块的马达为加减速率转动时，根据第三关系式而得到净扭矩信号 为Tl+Kti。
其中 代表净扭矩信号；Kt代表增益常数；i、i0分别代表实际系统和逆算系统产生的电流信号；Tl代表扭矩信号；ω、ω0分别代表实际系统和逆算系统产生的速度信号；Jl、J0分别代表负载惯量和单位马达惯量；电流信号i为实际系统根据速度命令和反馈的速度信号ω而产生；而电流信号i0则逆算系统根据来自实际系统的速度信号ω和反馈的速度信号ω0而产生，并且此速度信号ω大致上相等于速度信号ω0。
此外还包括下列步骤根据第三关系式得到一第四关系式，如下 当速度信号ω的值由ω0增加至ω1时，根据第四关系式累加净惯量比 以及当速度信号ω的值达到ω1时，根据第四关系式更新净惯量比 其中，其中η代表负载惯量Jl除以单位马达惯量J0的一惯量比， 代表一净惯量比，以及ω1与ω0的差值的绝对值和μ分别为一定值。
于此，逆算系统可设计为一高频宽回路。其中，此高频宽回路可具有约300Hz的频宽。
本发明还公开一种利用逆算模式的马达速度控制系统，应用于一交流伺服模块，包括一实际系统和一逆算系统于实际系统中包括一第一合成器、一第一增益控制器、一电流回路、一第二增益控制器、一第二合成器和一马达数学模型。此六元件依序串联成一回路。第一合成器用以接收一输入速度信号并根据输入速度信号和反馈的一速度信号产生一误差信号，第一增益控制器则根据误差信号产生一第一增益信号，电流回路再将第一增益信号转换为相应的一电流信号，第二增益控制器根据电流信号产生一第二增益信号，第二合成器将一扭矩信号与第二增益信号合成为一净扭矩信号，最后马达数学模型则根据净扭矩信号产生一速度信号并反馈至第一合成器。
而于逆算系统中则包括一第三合成器、一第三增益控制器、一电流回路、一第四增益控制器和一马达数学模型。此六元件依序串联成一回路，并且第三合成器会与实际系统的马达数学模型相连接。其中，第三合成器会根据实际系统产生的速度信号和反馈的速度信号而产生一误差信号，第三增益控制器则根据第三合成器产生的误差信号产生第三增益信号，接着电流回路再将第三增益信号转换为相应的电流信号，第四增益控制器根据电流信号产生第四增益信号，最后马达数学模型根据第四增益信号产生一速度信号并反馈至第三合成器。
其中，利用适应性算法可根据实际系统和逆算系统产生的电流信号估测得净扭矩信号，进而估测得交流伺服模块的负载惯量。
再者，实际系统所产生的速度信号大致上相等于逆算系统所产生的速度信号。
此外，实际系统和逆算系统的频宽远小于所具有的电流回路。
于此，第一和第三增益控制器可为比例/积分控制器。
有关本发明的特征与实作，配合附图作最佳实施例详细说明如下。


图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)。
于此，此逆算系统G0设计为高频宽(例如300Hz)回路，且其输出的速度信号ω0相当近似于实际系统G输出的速度信号ω，即ω0ω。
于实际系统G中，第一增益控制器120为一比例/积分控制器，其增益值为 第二增益控制器140的增益值为Kt；马达数学模型160的公式为 而于逆算系统G0中，第三增益控制器220亦为一比例/积分控制器，其增益值为 第四增益控制器240的增益值亦为Kt；马达数学模型260的公式为 其中，Kp、Kp0、Ki、Ki0、Kt均为常数值； 和 分别表示Ki的积分和Ki0的积分；Jl为负载惯量，Jls表示负载惯量的微分；J0为单位马达惯量，J0s表示单位马达惯量的微分；而B亦为机械阻尼且因负载惯量(Jl)和单位马达惯量(J0)会远大于机械阻尼(B)，故B值均可忽略不计，故马达数学模型160的公式则为 且马达数学模型260的公式为 因而可得到第一和第二关系式如公式四和公式五所示 公式四 公式五其中，由于ω0ω，因此由公式四和公式五可得公式六(即第三关系式)，如下 公式六并且，惯量比η定义为负载惯量除以单位马达惯量 因此公式六可简化为公式七(即第三关系式)，如下 公式七其中，当逆算系统G0产生的电流信号i0的绝对值极小时，此时代表马达处于等速率转动，因而净电流 几乎为零，进而可得到Tl＝-Kti；而当电流信号i0的绝对值够大时，即代表马达处于加减速率转动，也就是净扭矩信号 已足够大，且此时输出的电流信号为i，因此可得 并且，由公式七可导得公式八(即第四关系式)以进行惯量比η的估测，如下 公式八其中，|ω1-ω0|和μ分别为一定值。
当速度ω从ω0变化至ω1时， 即会进行一次更新，然后重新开始进行累加，并反复于ω增加一定值时，使 进行一次更新，如图4所示。其中 代表一净惯量比。
于此，于公式八中已不存在分母的运算，因此于实际运用上，比公知技术有较低的稳态误差变动性，同时收敛速度也相当快。此外，于此所得的电流信号i0可用以判断等速或加减速的时机已决定扭矩信号Tl是否更新估测值，因此可得到较正确的扭矩信号Tl进而能准确地估测负载惯量Jl。
虽然本发明以前述的较佳实施例公开如上，然其并非用以限定本发明，任何本领域的普通技术人员，在不脱离本发明的精神和范围内，当可作些许的更动与润饰，因此本发明的专利保护范围须视本说明书所附的权利要求书的范围为准。
权利要求
1.一种利用逆算模型的负载惯量估测方法，应用于一交流伺服模块，借由接收一速度命令和一扭矩信号来估算一负载惯量，包括下列步骤设定如下列的一第一关系式于一实际系统中 其中 代表一净扭矩信号，Kt代表一增益常数，i代表该实际系统产生的一电流信号，Tl代表该扭矩信号，ω代表该实际系统产生的一速度信号，Jl代表该负载惯量，以及该电流信号i为该实际系统根据该速度命令和反馈的该速度信号ω而产生；设定如下列的一第二关系式于一逆算系统中 其中i0代表该逆算系统产生的一电流信号，Kt代表该增益常数，ω0代表该逆算系统产生的一速度信号，J0代表一单位马达惯量，以及该电流信号i0是该逆算系统根据来自该实际系统的该速度信号ω和反馈的该速度信号ω0而产生，并且该速度信号ω大致上相等于该速度信号ω0；根据该第一关系式和该第二关系式得到一第三关系式，如下 当该交流伺服模块的马达为等速率转动时，根据该第三关系式而得到该扭矩信号Tl为-Kt:i；以及当该交流伺服模块的马达为加减速率转动时，根据该第三关系式而得到该净扭矩信号 为Tl+Kt:i。
2.如权利要求1所述的利用逆算模型的负载惯量估测方法，其特征在于，还包括下列步骤根据该第三关系式得到一第四关系式，如下 其中η代表该负载惯量Jl除以该单位马达惯量J0的一惯量比， 代表一净惯量比，以及ω1与ω0的差值的绝对值和μ分别为一定值；当该速度信号ω的值由ω0增加至ω1时，根据该第四关系式累加该净惯量比 以及当该速度信号ω的值达到ω1时，根据该第四关系式更新该净惯量比
3.如权利要求1所述的利用逆算模型的负载惯量估测方法，其特征在于，设计该逆算系统为一高频宽回路。
4.如权利要求3所述的利用逆算模型的负载惯量估测方法，其特征在于设计该高频宽回路具有约300Hz的频宽。
5.一种利用逆算模式的马达速度控制系统，应用于一交流伺服模块，包括一实际系统，包括一第一合成器，用以接收一输入速度信号并根据该输入速度信号和反馈的一速度信号产生一误差信号；一第一增益控制器，连接至该第一合成器，以根据该误差信号产生一第一增益信号；一电流回路，连接至该第一增益控制器，以将该第一增益信号转换为相应的一电流信号；一第二增益控制器，连接至该电流回路，以根据相应该第一增益信号的该电流信号产生一第二增益信号；一第二合成器，连接至该第二增益控制器，以将一扭矩信号与该第二增益信号合成为一净扭矩信号；以及一马达数学模型，连接至该第一和第二合成器，以根据该净扭矩信号产生一速度信号并反馈至该第一合成器；以及一逆算系统，包括一第三合成器，连接至该实际系统的该马达数学模型，以将该实际系统产生的该速度信号和反馈的一速度信号而产生一误差信号；一第三增益控制器，连接至该第三合成器，以根据该第三合成器产生的该误差信号产生一第三增益信号；一电流回路，连接至该第三增益控制器，以将该第三增益信号转换为相应的一电流信号；一第四增益控制器，连接至该电流回路，以根据相应该第三增益信号的该电流信号产生一第四增益信号；以及一马达数学模型，连接至该第三合成器和该第四增益控制器，以根据该第四增益信号产生一速度信号并反馈至该第三合成器；其中，利用适应性算法可根据该实际系统和该逆算系统产生的该些电流信号估测得该净扭矩信号，进而估测得该交流伺服模块的负载惯量。
6.如权利要求5所述的利用逆算模式的马达速度控制系统，其特征在于，该实际系统所产生的该速度信号大致上相等于该逆算系统所产生的该速度信号。
7.如权利要求5所述的利用逆算模式的马达速度控制系统，其特征在于，该实际系统和该逆算系统的频宽远小于所具有的该电流回路。
8.如权利要求5所述的利用逆算模式的马达速度控制系统，其特征在于，该第一和第三增益控制器分别为一比例/积分控制器。
全文摘要
一种利用逆算模型的马达速度控制系统和负载惯量估测方法，应用于一交流伺服模块，主要是利用一逆向系统连结于实际系统上，以逆向推演实质的扭矩输出，于此当实际系统产生的速度信号的值逐渐增加时，会累加净惯量比；而当实际系统产生的速度信号的值增加到一定值时，则会更新净惯量比。
文档编号H02P23/14GK1925310SQ200510096699
公开日2007年3月7日 申请日期2005年8月30日 优先权日2005年8月30日
发明者蔡清雄, 吴家明 申请人:台达电子工业股份有限公司