CN107645267B - 电动机*** - Google Patents
电动机*** Download PDFInfo
- Publication number
- CN107645267B CN107645267B CN201710589757.2A CN201710589757A CN107645267B CN 107645267 B CN107645267 B CN 107645267B CN 201710589757 A CN201710589757 A CN 201710589757A CN 107645267 B CN107645267 B CN 107645267B
- Authority
- CN
- China
- Prior art keywords
- motor
- gain
- transmission element
- inertia
- loop gain
- 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.)
- Active
Links
- 230000001131 transforming effect Effects 0.000 claims abstract description 11
- 230000005540 biological transmission Effects 0.000 claims description 100
- 238000012546 transfer Methods 0.000 claims description 99
- 238000004364 calculation method Methods 0.000 claims description 28
- 230000004044 response Effects 0.000 claims description 14
- 230000006978 adaptation Effects 0.000 claims description 13
- 230000007246 mechanism Effects 0.000 claims description 13
- 230000003044 adaptive effect Effects 0.000 claims description 10
- 238000001514 detection method Methods 0.000 claims description 10
- 230000014509 gene expression Effects 0.000 claims description 9
- 238000012886 linear function Methods 0.000 claims description 8
- 238000005259 measurement Methods 0.000 claims description 8
- 238000012887 quadratic function Methods 0.000 claims description 3
- 238000006243 chemical reaction Methods 0.000 abstract description 38
- 230000007423 decrease Effects 0.000 abstract description 15
- 238000012545 processing Methods 0.000 description 38
- 238000010586 diagram Methods 0.000 description 14
- 230000010355 oscillation Effects 0.000 description 14
- 238000000034 method Methods 0.000 description 11
- 230000010354 integration Effects 0.000 description 8
- 230000003247 decreasing effect Effects 0.000 description 6
- 230000004069 differentiation Effects 0.000 description 6
- 230000000694 effects Effects 0.000 description 6
- 230000008859 change Effects 0.000 description 5
- 230000008569 process Effects 0.000 description 5
- 230000001629 suppression Effects 0.000 description 5
- 230000004043 responsiveness Effects 0.000 description 4
- 230000004048 modification Effects 0.000 description 3
- 238000012986 modification Methods 0.000 description 3
- 230000009466 transformation Effects 0.000 description 3
- 238000012937 correction Methods 0.000 description 2
- 238000000605 extraction Methods 0.000 description 2
- 238000002474 experimental method Methods 0.000 description 1
- 239000000284 extract Substances 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
Images
Classifications
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
- H02P21/0003—Control strategies in general, e.g. linear type, e.g. P, PI, PID, using robust control
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
- H02P21/14—Estimation or adaptation of machine parameters, e.g. flux, current or voltage
- H02P21/18—Estimation of position or speed
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P2205/00—Indexing scheme relating to controlling arrangements characterised by the control loops
- H02P2205/07—Speed loop, i.e. comparison of the motor speed with a speed reference
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Control Of Electric Motors In General (AREA)
- Control Of Ac Motors In General (AREA)
- Feedback Control In General (AREA)
Abstract
本发明提供在不增大CPU的运算处理负荷的情况下利用自动调谐来抑制振动的电动机***。通过利用第1增益变换单元(15)计算电动机(3)未和动作对象物(2)相连时的增益K0与电动机(3)和动作对象物(2)相连时的增益K的转动惯量比Gr(=K0/K),并求出任意的参数常数Ri与转动惯量比Gr之比(=Ri/Gr),从而简单计算出电动机***(1)的速度环路增益m1。电动机控制装置(4)中,存储有将m1与m0、q0、q1的关系以m0、q0、q1随着m1的下降也下降的方式相对应的第3表格。第2增益变换单元(16)参照第3表格,进行从第1增益变换单元(15)所计算出的速度环路增益m1向m0、q0、q1的变换。
Description
本发明涉及包括使动作对象物动作的电动机和对电动机的旋转进行反馈控制的电动机控制装置的电动机***。
背景技术
以往,作为使自动设备等动作的电动机的控制装置,已知有利用P-PI控制(比例-比例积分控制)来控制电动机的电动机控制装置。在进行P-PI控制的电动机控制装置中,将电动机的旋转位置和转速进行反馈,并对旋转位置的偏差进行比例控制(P控制),对转速的偏差进行比例积分控制(PI控制)。
以往,作为进行这种P-PI控制的电动机***,例如有利用了专利文献1公开的电动机控制装置的电动机***。该电动机控制装置包括提取因机械谐振引起的振动分量并将其作为提取振动信号输出的振动提取滤波器。陷波控制部基于提取振动信号及第2陷波滤波器输出信号,变更第1陷波滤波器及第2陷波滤波器的各陷波中心频率,以减小第2陷波滤波器输出信号的振幅。此外,陷波深度控制部基于提取振动信号,变更第1陷波滤波器的陷波深度。判断控制部对各陷波滤波器的参数进行自动调谐,抑制机械振动。即,在第2陷波滤波器输出信号的振幅大于规定值的情况下,使陷波控制部动作,变更第1陷波滤波器及第2陷波滤波器的各陷波中心频率,以减小因机械谐振的振荡所导致的振动分量。此外,在第2陷波滤波器输出信号的振幅小于规定值的情况下,使陷波深度控制部动作,变更第1陷波滤波器的陷波深度,以减小因机械谐振的振荡所导致的振动分量。
以往,作为进行这种P-PI控制的电动机***,例如有利用了专利文献2公开的电动机控制装置的电动机***。该电动机控制装置在输入负载转动惯量值JL和目标响应频率ωf时,利用根据与电动机转动惯量值JM之比求出的转动惯量值修正增益JCOM=((JL+JM)/JM)0.5,设定速度环路增益kv、速度积分时间常数ti、位置环路增益kp、转矩滤波器常数tf、电流环路增益ki、电流积分时间常数ta及滤波器时间常数tv。即,上述多个控制参数根据作为参数之一的目标响应频率ωf和转动惯量值修正增益JCOM进行自动调谐。
另外,以往,作为进行鲁棒极点配置控制的电动机***,例如有专利文献3中揭示的电动机***。该电动机***中的电动机控制装置具有以电动机的旋转位置指令为输入、以电动机的旋转位置为输出的闭环***。闭环***在向前路径中,包括第1相加点、比例增益要素、第2相加点、积分滤波器要素、电动机增益要素及电动机要素。此外,在第1相加点以负反馈的方式连接有第1反馈路径,在第2相加点经由微分滤波器要素以负反馈的方式连接有第2反馈路径。在该电动机***中,在动作对象物、电动机的转动惯量变大时,即使动作对象物、电动机产生振动,关于干扰响应特性的控制参数q0及q1也会基于转动惯量检测单元中的检测结果自动调谐。通过该调整,可抑制动作对象物、电动机的振动,且将闭环***的特性保持一定。
现有技术文献
专利文献
专利文献1:日本专利第5873975号公报
专利文献2:日本专利第3561911号公报
专利文献3:日本专利特开2016-35676号公报
发明内容
发明所要解决的技术问题
然而,在检测振动并对控制参数进行自动调谐的上述现有的专利文献1及专利文献3所记载的电动机***中,需要进行解析振动的频率及振动的振幅的处理。为此,若不以比振动频率的2倍还要高很多的频率从电动机采样速度检测信号并解析,则振动提取无法达到充分的分辨率。因此,在上述现有的专利文献1及专利文献3所记载的电动机***中,用于电动机控制装置的运算装置需要较快的运算速度,运算负荷变大。
此外,在上述现有的专利文献2所记载的电动机***中,在用于控制参数的运算的转动惯量值修正增益JCOM的计算中使用平方根((JL+JM)/JM)0.5。因此,在上述现有的专利文献2所记载的电动机***中,由于该平方根的计算,用于电动机控制装置的运算装置的运算负荷变大。
解决技术问题的技术方案
为了解决上述问题,本发明的电动机***包括使动作对象物动作的电动机和对电动机的旋转进行反馈控制的电动机控制装置,其特征在于,包括:
闭环***,该闭环***输入电动机的转速指令,并对电动机的旋转位置进行反馈控制,输出转速,构成将速度环路增益包含在因子中的传递函数;
转动惯量检测单元,该转动惯量检测单元对动作对象物及电动机的转动惯量进行检测;
适应确定单元,该适应确定单元基于电动机位置传递要素的输入和电动机位置传递要素的输出,对增益K进行确定,该增益K为将包含向电动机供电的放大器的固定增益和电动机的转矩常数在内的固定值除以动作对象物及电动机的转动惯量后的值;及
计算单元,该计算单元计算增益K0相对于增益K的转动惯量比Gr,利用计算出的转动惯量比Gr,求出任意的参数常数Ri相对于以转动惯量比Gr为因子的规定的函数值的比,并根据该比来计算速度环路增益,K0为将包含向电动机供电的放大器的固定增益和电动机的转矩常数在内的固定值除以电动机的转动惯量后的值,根据由计算单元计算出的速度环路增益,对传递函数进行修正。
适应确定单元基于电动机位置传递要素的输入和电动机位置传递要素的输出,对动作对象物及电动机的转动惯量进行确定,从而可构成转动惯量检测单元。
根据本结构,通过计算单元计算电动机未和负载相连时的增益K0与电动机和负载相连时的增益K的转动惯量比Gr(=K0/K),并利用计算出的转动惯量比Gr,求出任意的参数常数Ri与以转动惯量比Gr为因子的规定的函数值f(Gr)之比(=Ri/f(Gr)),从而简单计算出作为传递函数的因子的速度环路增益。速度环路增益以一定的比例常数Ri与函数值f(Gr)成反比,在转动惯量比Gr变大时有变小的趋势。若转动惯量比Gr变大,则控制对象的增益频率特性在机械谐振频率下的增益峰值及在比机械谐振频率要高的频率下的增益变大,容易产生振荡。然而,在本结构中,沿将其抵消的方向降低速度环路增益,因此,可确保表示闭环***的稳定度的增益余量。因此,可在不增大构成计算单元的运算处理装置(CPU)的运算处理负荷的情况下利用自动调谐来抑制振动。其结果,CPU的运算处理负荷变少,也可使用处理速度较慢的CPU,因此,可削减电动机控制装置的成本。
此外,对于2惯性***或多惯性***的驱动***,若利用与1惯性***的驱动***相同地推定出的负载转动惯量来更新控制增益,则会发生伺服振荡。然而,根据本结构,对于2惯性***或多惯性***的驱动***中的谐振,可利用简单的运算处理来抑制振荡。
此外,本发明的特征在于,
闭环***构成将速度环路增益及位置环路增益包含在因子中的传递函数,输入电动机的旋转位置指令以代替转速指令,并对电动机的旋转位置进行反馈控制,输出旋转位置,
计算单元计算与速度环路增益具有一定关系的值来作为位置环路增益的值,
根据由计算单元计算出的速度环路增益及位置环路增益,对传递函数进行修正。
根据本结构,利用计算单元简单计算出与速度环路增益具有一定关系的值来作为位置环路增益的值,并自动调谐为相对于速度环路增益而言控制***的平衡较佳的值。因此,可通过简单的运算处理,在不对CPU施加负荷的情况下进行不会使控制变得不稳定且考虑了电动机的转速和电动机的旋转位置后的稳定的反馈控制。
此外,本发明的特征在于,
闭环***具有向前路径及第1反馈路径,该向前路径具有第1比例增益传递要素、输入电动机的转速指令的第1相加点、积分滤波器传递要素、电动机增益传递要素及电动机位置传递要素,该第1反馈路径将电动机的旋转位置经由微分滤波器传递要素负反馈到第1相加点,
在设速度环路增益为m1、拉普拉斯运算符为s时,具有控制动作对象物及电动机的速度的期望特性的闭环***的期望传递函数由算式m1/(s+m1)所规定,
在设利用适应确定单元基于电动机位置传递要素的输入和电动机位置传递要素的输出确定的增益设为p,关于干扰响应特性的控制参数为q0及q1,使闭环***的特性与期望传递函数一致的参数为a1=q1+m1-p、b1=q0·m1、b2=(q1-p)·(m1-p)+q0时,其中,所述增益p是将关于动作对象物及电动机的粘性的项除以动作对象物及电动机的转动惯量后的值,
第1比例增益传递要素由m1表示,
积分滤波器传递要素由(s2+q1·s+q0)/(s2+a1·s)表示,
电动机增益传递要素由1/K表示,
电动机位置传递要素由K/(s2+p·s)表示,
微分滤波器传递要素由(b2·s2+b1·s)/(s2+q1·s+q0)表示,
在电动机控制装置中存储将m1与q0、q1的关系相对应的表格,
计算单元参照表格,进行从计算出的速度环路增益m1向q0、q1的变换。
根据本结构,将m1与q0、q1的关系相对应的表格存储在电动机控制装置中,因此,从m1向q0、q1变换的运算处理可通过简单检索表格来进行。因此,缩短了运算处理时间,并进一步降低了CPU的运算处理负荷。
此外,本发明的特征在于,
闭环***具有向前路径及第1反馈路径,该向前路径具有第1比例增益传递要素、输入电动机的转速指令的第1相加点、积分滤波器传递要素、电动机增益传递要素及电动机位置传递要素,该第1反馈路径将电动机的旋转位置经由微分滤波器传递要素负反馈到第1相加点,
在设速度环路增益为m1、拉普拉斯运算符为s时,控制动作对象物及电动机的速度的期望传递函数由算式m1/(s+m1)所规定,
在设利用适应确定单元基于电动机位置传递要素的输入和电动机位置传递要素的输出确定的增益设为p,关于干扰响应特性的控制参数为ωq,使闭环***的特性与期望传递函数一致的参数为b1=ωq·m1、b2=m1-p+ωq时,其中,所述增益p是将关于动作对象物及电动机的粘性的项除以动作对象物及电动机的转动惯量后的值,
第1比例增益传递要素由m1表示,
积分滤波器传递要素由(s+ωq)/s表示,
电动机增益传递要素由1/K表示,
电动机位置传递要素由K/(s2+p·s)表示,
微分滤波器传递要素由(b2·s2+b1·s)/(s+ωq)表示,
在电动机控制装置中存储将m1与ωq的关系相对应的表格,
计算单元参照表格,进行从计算出的速度环路增益m1向ωq的变换。
根据本结构,将m1与ωq的关系相对应的表格存储在电动机控制装置中,因此,从m1向ωq变换的运算处理可通过简单检索表格来进行。因此,缩短了运算处理时间,并进一步降低了CPU的运算处理负荷。
此外,本发明的特征在于,
闭环***具有向前路径、第1反馈路径及第2反馈路径,该向前路径具有输入电动机的旋转位置指令来代替转速指令的第2相加点、第2比例增益传递要素、第1相加点、积分滤波器传递要素、电动机增益传递要素及电动机位置传递要素,该第1反馈路径将电动机的旋转位置经由微分滤波器传递要素负反馈到第1相加点,该第2反馈路径将电动机的旋转位置直接负反馈到第2相加点,
在设速度环路增益为m1、位置环路增益为m0/m1、拉普拉斯运算符为s时,控制动作对象物及电动机的位置的期望传递函数由算式m0/(s2+m1·s+m0)所规定,
在设利用适应确定单元基于电动机位置传递要素的输入和电动机位置传递要素的输出确定的增益设为p,关于干扰响应特性的控制参数为q0及q1,使闭环***的特性与期望传递函数一致的参数为a1=q1+m1-p、b1=q0·m1、b2=(q1-p)·(m1-p)+q0时,其中,所述增益p是将关于动作对象物及电动机的粘性的项除以动作对象物及电动机的转动惯量后的值,
第2比例增益传递要素由m0表示,
积分滤波器传递要素由(s2+q1·s+q0)/(s2+a1·s)表示,
电动机增益传递要素由1/K表示,
电动机位置传递要素由K/(s2+p·s)表示,
微分滤波器传递要素由(b2·s2+b1·s)/(s2+q1·s+q0)表示,
在电动机控制装置中存储将m1与m0、q0、q1的关系相对应的表格,计算单元参照表格,进行从计算出的速度环路增益m1向m0、q0、q1的变换。
根据本结构,将m1与m0、q0、q1的关系相对应的表格存储在电动机控制装置中,因此,从m1向m0、q0、q1变换的运算处理可通过简单检索表格来进行。因此,缩短了运算处理时间,并进一步降低了CPU的运算处理负荷。
此外,本发明的特征在于,以转动惯量比Gr为因子的所述规定的计算速度环路增益的函数为仅以转动惯量比Gr为因子的一次函数。
根据本结构,速度环路增益m1、Kvp的值相对于转动惯量比Gr的增加以单纯的反比例的关系减少。因此,计算速度环路增益m1、Kvp的值的CPU的运算处理变简单,可进一步抑制CPU的运算处理负荷。
此外,本发明的特征在于,以转动惯量比Gr为因子的所述规定的计算速度环路增益的函数为以转动惯量比Gr和常数为因子的一次函数。
根据本结构,可调整速度环路增益m1、Kvp和转动惯量比Gr的反比例关系,调整量为常数值。因此,可扩大速度环路增益m1、Kvp的设定范围,且抑制CPU的运算处理负荷。
此外,本发明的特征在于,以转动惯量比Gr为因子的所述规定的计算速度环路增益的函数为以转动惯量比Gr和常数为因子的二次函数。
根据本结构,速度环路增益m1、Kvp的值可设定为与单纯的反比例关系不同的、相对于转动惯量比Gr的增加而单调减少的所期望的关系。因此,可力图兼顾闭环***的指令响应特性和振动抑制特性。
此外,本发明的特征在于,将参数常数Ri作为电动机与动作对象物之间的动力传递机构的种类所对应的多个值存储在电动机控制装置中。
根据本结构,用户从预先存储在电动机控制装置的多个参数常数Ri中简单选择对应于动力传递机构的种类的参数常数Ri的值,从而可进行参数设定。因此,可提供提高了用户便利性的电动机***。
此外,本发明的特征在于,对转动惯量比Gr的上限值设有限制。
在随着转动惯量比Gr的增加,速度环路增益m1、Kvp的值过小,无法设定与转动惯量比Gr的值对应的速度环路增益m1、Kvp的值的情况下,例如与转动惯量比Gr的值对应的速度环路增益m1、Kvp的值比表格中设定的最小水平的速度环路增益m1、Kvp的值要小的情况下,无法降低速度环路增益m1、Kvp的值。在这种情况下,将根据能设定的速度环路增益m1、Kvp的最小值m1min、Kvpmin并基于关系式(m1=Ri/f(Gr)、Kvp=Ri/f(Gr))求出的转动惯量比Gr(=Ri/m1min、=Ri/Kvpmin)设定作为转动惯量比Gr的上限值,通过像本结构那样对转动惯量比Gr的上限值施加限制,从而对与转动惯量比Gr的值对应的速度环路增益m1、Kvp的值的下限施加限制。因此,关系式(m1=Ri/f(Gr)、Kvp=Ri/f(Gr))始终成立,不会再出现无法设定速度环路增益m1、Kvp的值的情况。
发明效果
根据本发明的电动机***,可如上述那样,在不增大CPU的运算处理负荷的情况下利用自动调谐来抑制振动。
附图说明
图1是表示本发明的各实施方式所涉及的电动机***的简要结构的框图。
图2是表示本发明的实施方式1所涉及的电动机***的闭环***的框线图。
图3(a)是将实施方式1的电动机***中的速度环路增益m1与转动惯量比Gr的关系以单纯的反比例关系示出的曲线图,图3(b)是表示实施方式3的变形例的电动机***中对转动惯量比Gr设定有上限值grcamax时的转动惯量比Gr的时间变化的曲线图。
图4是表示本发明的实施方式2所涉及的电动机***的闭环***的框线图。
图5是表示本发明的实施方式3所涉及的电动机***的闭环***的框线图。
图6是表示本发明的实施方式4所涉及的电动机***的闭环***的框线图。
图7是表示本发明的实施方式5所涉及的电动机***的闭环***的框线图。
图8是表示本发明的实施方式3的变形例所涉及的电动机***的闭环***的框线图。
具体实施方式
以下,说明用于实施本发明的电动机***的方式。
图1是表示本发明的各实施方式所涉及的电动机***1的简要结构的框图。
电动机***1包括使动作对象物2动作的电动机3和控制电动机3的电动机控制装置4。电动机3为AC伺服电动机或DC伺服电动机,例如使作为动作对象物2的工业用自动设备的手臂等动作。动作对象物2经由传送带等动力传递机构6连接到电动机3。电动机3包括用于检测电动机3的旋转位置的检测机构(编码器)5。检测机构5的输出信号输入到对电动机3的旋转进行反馈控制的电动机控制装置4。电动机控制装置4的电动机控制电路由模拟电路(连续时间类型的电路)构成,但也可由数字电路(离散时间类型的电路)构成,也可利用软件来构成。
图2是表示本发明的实施方式1所涉及的电动机***1的闭环***8A的框线图。
闭环***8A具有向前路径及第1反馈路径,该向前路径具有第1比例增益传递要素9、输入电动机3的转速指令的第1相加点10、积分滤波器传递要素11、电动机增益传递要素12及电动机位置传递要素13,该第1反馈路径将电动机3的旋转位置从电动机位置传递要素13经由微分滤波器传递要素14负反馈到第1相加点10,该闭环***8A输入电动机3的转速指令,并对电动机3的旋转位置进行反馈控制,输出转速。该闭环***8A构成将速度环路增益m1包含在因子中的传递函数,在设拉普拉斯运算符为s时,利用算式m1/(s+m1)来规定速度的期望传递函数。期望传递函数具有根据动作对象物2恰当地控制电动机3的期望特性。动作对象物2由利用闭环***8A进行旋转控制的电动机3设定动作对象速度。
适应确定单元21基于电动机位置传递要素13的输入和电动机位置传递要素13的输出,对增益K(=(放大器的固定增益)×(电动机3的固定值)/(动作对象物2及电动机3的转动惯量))进行确定,该增益K为将包含向电动机3供电的放大器的固定增益和电动机3的转矩常数在内的固定值除以动作对象物2及电动机3的转动惯量后的值。该确定利用最小二乘法等确定法以规定时间间隔逐次进行。另外,此处所述的放大器是闭环***8A中的除电动机位置传递要素13外的结构部分。此外,本实施方式中,适应确定单元21构成转动惯量检测单元,基于电动机位置传递要素13的输入和电动机位置传递要素13的输出,利用最小二乘法等确定法对动作对象物2及电动机3的转动惯量进行确定,并以规定时间间隔逐次进行检测。此外,适应确定单元21基于电动机位置传递要素13的输入和电动机位置传递要素13的输出,对增益p进行确定,该增益p是将关于动作对象物2及电动机3的粘性的项除以动作对象物2及电动机3的转动惯量后的值。该确定也利用最小二乘法等确定法以规定时间间隔逐次进行。
在设关于干扰响应特性的控制参数为q0及q1,使闭环***8A的特性与期望传递函数一致的参数a1、b1及b2分别由下式(1)、(2)、(3)来表示时,
a1=q1+m1-p…(1)
b1=q0m1…(2)
b2=(q1-p)(m1-p)+q0…(3)
第1比例增益传递要素9由m1表示,积分滤波器传递要素11由(s2+q1·s+q0)/(s2+a1·s)表示,电动机增益传递要素12由1/K表示,电动机位置传递要素13由K/(s2+p·s)表示,微分滤波器传递要素14由(b2·s2+b1·s)/(s2+q1·s+q0)表示。
第1增益变换单元15中输入有由用户设定的任意的参数常数Ri。第1增益变换单元15基于由适应确定单元12确定的增益K和输入的参数常数Ri,计算增益K0相对于增益K的转动惯量比Gr(=K0/K)。此处,增益K0为将包含向电动机3供电的放大器的固定增益和电动机3的转矩常数在内的固定值除以电动机3的转动惯量后的值(=(放大器的固定增益)×(电动机3的固定值)/(电动机3的转动惯量))。
然后,第1增益变换单元15利用计算出的转动惯量比Gr,求出参数常数Ri相对于以转动惯量比Gr为因子的规定的函数值(f(Gr))的比(=Ri/f(Gr)),并根据该比来计算速度环路增益m1。本实施方式中,规定的函数f(Gr)设定为Gr(f(Gr)=Gr),速度环路增益m1由下式(4)来表示。
m1=Ri/Gr…(4)
电动机控制装置4中,存储有将m1与q0、q1的关系以q0、q1随着m1的下降也下降的方式相对应的第1表格。第2增益变换单元16参照第1表格,进行从第1增益变换单元15所计算出的速度环路增益m1向q0、q1的变换。此时,进行从与第1增益变换单元15所计算出的速度环路增益m1的值最接近的表格值的m1向q0、q1的变换。第3增益变换单元17根据由第1增益变换单元15计算出的m1和由适应确定单元21确定的增益p,基于式(1)、(2)、(3),分别计算a1、b1及b2。
第1增益变换单元15及第2增益变换单元16构成计算单元,其计算转动惯量比Gr,并利用计算出的转动惯量比Gr,通过式(4)计算速度环路增益m1。第1增益变换单元15、第2增益变换单元16及第3增益变换单元17在本实施方式中由电动机控制装置4所具备的微机的CPU构成。电动机控制装置4将由第1增益变换单元15计算出的速度环路增益m1提供给第1比例增益传递要素9,以规定时间间隔逐次对第1比例增益传递要素9进行更新。此外,将由第2增益变换单元16求出的q0、q1、及由第3增益变换单元17计算出的a1、b1、b2提供给积分滤波器传递要素11及微分滤波器传递要素14,分别以规定时间间隔逐次对积分滤波器传递要素11及微分滤波器传递要素14进行更新。适应确定单元21将确定的增益K提供给电动机增益传递要素12,以规定时间间隔逐次对电动机增益传递要素12进行更新。
利用这些更新,以规定时间间隔逐次对闭环***8A的传递函数进行修正,即使动作对象物2、电动机3的转动惯量变大,振动有变强的趋势,也能使闭环***8A的传递函数与期望传递函数自动一致。因此,即使动作对象物2、电动机3的转动惯量变大,也能使闭环***8A的特性变稳定以抑制振动。
根据这样的实施方式1的电动机***1,通过利用第1增益变换单元15计算电动机3未和动作对象物2相连时的增益K0与电动机3和动作对象物2相连时的增益K的转动惯量比Gr(=K0/K),并求出任意的参数常数Ri与计算出的转动惯量比Gr之比(=Ri/Gr),从而简单计算出速度环路增益m1。
图3(a)的曲线图为将速度环路增益m1与转动惯量比Gr的关系以式(4)所示的单纯的反比例关系来示出的曲线图。该曲线图的横轴为转动惯量比Gr,纵轴为速度环路增益m1。各特性线a、b、c分别表示比例常数Ri的值为Ri1、Ri2、Ri3(Ri1<Ri2<Ri3)时的特性。如该曲线图所示,速度环路增益m1以一定的比例常数Ri与转动惯量比Gr成反比,在转动惯量比Gr变大时有变小的趋势。此外,比例常数Ri的值越小,随着转动惯量比Gr的增加而降低速度环路增益m1的值的作用越强。
比例常数Ri为由用户设定的控制参数,根据动力传递机构6的刚性来设定。例如,在动力传递机构6为传动带驱动那样的刚性较小的机构的情况下,刚性越小,比例常数Ri设定为越小的值。此外,动作对象物2的粘性阻力越小,比例常数Ri设定为越小的值。在比例常数Ri较小的情况下,速度环路增益m1的值随着转动惯量比Gr的增加而降低的降低率变大,指令响应性变平稳,但振动抑制性能提高。若将表格值设定成q0、q1的值也随着m1的值下降而下降,则振动抑制效果进一步变强。
此外,在动力传递机构6为滚珠丝杠驱动那样的刚性较大的机构的情况下,刚性越大,比例常数Ri设定为越大的值,使得速度环路增益m1不会过度下降。在比例常数Ri较大的情况下,速度环路增益m1的值随着转动惯量比Gr的增加而降低的降低率变小,指令响应性提高,但振动抑制性能下降。
若转动惯量比Gr变大,则控制对象的增益频率特性在机械谐振频率下的增益峰值及在比机械谐振频率要高的频率下的增益变大,容易产生振荡。然而,在本实施方式的电动机***1中,若转动惯量比Gr变大,则如上述那样,沿将其抵消的方向降低速度环路增益m1,因此,可确保表示闭环***的稳定度的增益余量。速度环路增益m1可如上述那样简单计算出。因此,可在不增大CPU的运算处理负荷的情况下利用自动调谐来抑制振动。其结果,CPU的运算处理负荷变少,也可使用处理速度较慢的CPU,因此,可削减构成电动机控制装置4的微机的成本。用户利用该自动调谐,可在电动机***的初始使用时不会无调整地进行振荡的情况下使电动机3动作。
此外,对于2惯性***或多惯性***的驱动***,若利用与1惯性***的驱动***相同地推定出的负载转动惯量来更新控制增益,则会发生伺服振荡。然而,根据本实施方式,对于2惯性***或多惯性***的驱动***中的谐振,可利用简单的运算处理来抑制振荡。
根据实施方式1的电动机***1,将m1与q0、q1的关系相对应的第1表格存储在电动机控制装置4中。因此,从m1向q0、q1变换的运算处理可通过由第2增益变换单元16简单检索第1表格来进行。其结果,缩短了运算处理时间,并进一步降低了CPU的运算处理负荷。
此外,在实施方式1的电动机***1中,以转动惯量比Gr为因子的规定函数如式(4)的分母所示那样,规定为仅以转动惯量比Gr为因子的一次函数。因此,速度环路增益m1的值相对于转动惯量比Gr的增加以单纯的反比例的关系减少。因此,计算速度环路增益m1的值的CPU的运算处理变简单,可进一步抑制CPU的运算处理负荷。
接着,说明本发明实施方式2的电动机***1中的闭环***8B。图4是表示该闭环***8B的框线图。另外,对于该图中与图2相同或相当的部分标注相同标号,并省略其说明。
闭环***8B的速度的期望传递函数也由与实施方式1相同的算式m1/(s+m1)来规定。然而,在设关于干扰响应特性的控制参数为ωq,使闭环***8B的特性与期望传递函数一致的参数b1及b2分别由下式(5)、(6)来表示时,
b1=ωq·m1…(5)
b2=m1-p+ωq…(6)
积分滤波器传递要素11由(s+ωq)/s表示,微机滤波器传递要素14由(b2·s2+b1·s)/(s+ωq)表示。
电动机控制装置4中,存储有将m1与ωq的关系以ωq随着m1的下降也下降的方式相对应的第2表格。第2增益变换单元16参照第2表格,进行从第1增益变换单元15如上述那样计算出的速度环路增益m1向ωq的变换。第3增益变换单元17根据由第1增益变换单元15计算出的m1和由适应确定单元21确定的增益p,基于式(5)、(6),分别计算b1及b2。
电动机控制装置4将由第2增益变换单元16求出的ωq、及由第3增益变换单元17计算出的b1、b2提供给积分滤波器传递要素11及微分滤波器传递要素14,分别以规定时间间隔逐次对积分滤波器传递要素11及微分滤波器传递要素14进行更新。利用这些更新,以规定时间间隔逐次对闭环***8B的传递函数进行修正,即使动作对象物2、电动机3的转动惯量变大而导致振动有变强的趋势,也能使闭环***8B的传递函数与期望传递函数自动一致。因此,即使动作对象物2、电动机3的转动惯量变大,也能使闭环***8B的特性变稳定以抑制振动。
根据这样的实施方式2的电动机***1,也通过利用第1增益变换单元15计算转动惯量比Gr(=K0/K),并求出任意的参数常数Ri与计算出的转动惯量比Gr之比(=Ri/Gr),从而简单计算出速度环路增益m1。因此,根据实施方式2的电动机***1,也可在不增大CPU的运算处理负荷的情况下利用自动调谐来抑制振动,起到与实施方式1同样的作用效果。
根据实施方式2的电动机***1,将m1与ωq的关系相对应的第2表格存储在电动机控制装置4中。因此,从m1向ωq变换的运算处理可通过由第2增益变换单元16简单检索第2表格来进行。因此,缩短了运算处理时间,并进一步降低了CPU的运算处理负荷。
接着,说明本发明实施方式3的电动机***1中的闭环***8C。图5是表示该闭环***8C的框线图。另外,对于该图中与图2相同或相当的部分标注相同标号,并省略其说明。
闭环***8C构成将速度环路增益m1及位置环路增益m0/m1包含在因子中的传递函数,输入电动机3的旋转位置指令以代替转速指令,并对电动机3的旋转位置进行反馈控制,输出旋转位置。闭环***8C的位置的期望传递函数由算式m0/(s2+m1·s+m0)规定。闭环***8C与图2所示的闭环***8A相比,在向前路径的第1相加点10的前级具有第2相加点18和第2比例增益传递要素19来代替第1比例增益传递要素9。在第2相加点18输入有电动机3的旋转位置指令以代替转速指令,并且,电动机3的旋转位置从电动机位置传递要素13经由第2反馈路径直接进行负反馈。在第2比例增益传递要素19输入有从第2相加点18输出的旋转位置指令与旋转位置的偏差。动作对象物2由利用闭环***8C进行旋转控制的电动机3设定动作对象位置。
该闭环***8C中,第2比例增益传递要素19由m0表示,积分滤波器传递要素11、电动机增益传递要素12及微分滤波器传递要素14与图2所示的闭环***8A同样地表示。
电动机控制装置4中,存储有将m1与m0、q0、q1的关系以m0、q0、q1随着m1的下降也下降的方式相对应的第3表格。第2增益变换单元16参照第3表格,进行从第1增益变换单元15所计算出的速度环路增益m1向m0、q0、q1的变换。此时,第3表格的表格值设定成计算与速度环路增益m1具有一定关系的值作为位置环路增益m0/m1的值。这是由于,若仅m1单独降低值,则与m0的平衡变差,控制有时会变得不稳定。因此,降低m1的值后降低m0的值,根据m1的值来调整m0的值。相对于m1的值m0的值降低多少取决于1惯性***下变得稳定的m1与m0的比率。
此时,第3表格的表格值设定成计算与速度环路增益m1具有一定关系的值作为q0、q1的值。这也是由于,若仅m1单独降低值,则控制有时会变得不稳定。因此,降低m1的值后降低q0、q1的值,根据m1的值来调整q0、q1的值。
第3增益变换单元17根据由第1增益变换单元15如上述那样计算出的m1和由适应确定单元21确定的增益p,基于式(1)、(2)、(3),分别计算使闭环***8C的特性与期望传递函数一致的参数a1、b1及b2。电动机控制装置4将由第2增益变换单元16求出的m0、q0、q1、及由第3增益变换单元17计算出的a1、b1、b2提供给积分滤波器传递要素11、微分滤波器传递要素14及第2比例增益传递要素19,分别以规定时间间隔逐次对积分滤波器传递要素11、微分滤波器传递要素14及第2比例增益传递要素19进行更新。利用这些更新,以规定时间间隔逐次对闭环***8C的传递函数进行修正,即使动作对象物2、电动机3的转动惯量变大导致振动有变强的趋势,也能使闭环***8C的传递函数与期望传递函数自动一致。因此,即使动作对象物2、电动机3的转动惯量变大,也能使闭环***8C的特性变稳定以抑制振动。
根据这样的实施方式3的电动机***1,也通过利用第1增益变换单元15计算转动惯量比Gr(=K0/K),并求出任意的参数常数Ri与计算出的转动惯量比Gr之比(=Ri/Gr),从而简单计算出速度环路增益m1。因此,根据实施方式3的电动机***1,也可在不增大CPU的运算处理负荷的情况下利用自动调谐来抑制振动,起到与实施方式1同样的作用效果。
在实施方式3的电动机***1中,将m1与m0、q0、q1的关系相对应的第3表格存储在电动机控制装置4中,因此,从m1向m0、q0、q1变换的运算处理可通过由第2增益变换单元16简单检索第3表格来进行。因此,缩短了运算处理时间,并进一步降低了CPU的运算处理负荷。
根据实施方式3的电动机***1,利用第2增益变换单元16简单计算与速度环路增益m1具有一定关系的值来作为位置环路增益m0/m1的值,并自动调谐为相对于速度环路增益m1而言控制***的平衡较佳的值。因此,可通过简单的运算处理,在不对CPU施加负荷的情况下进行不会使控制变得不稳定且考虑了电动机3的转速和电动机3的旋转位置后的稳定的反馈控制。
上述闭环***8C中的由算式m0/(s2+m1·s+m0)规定的期望传递函数可如以下那样变形。
m0/(s2+m1·s+m0)=ω1·ω2/(s+ω1)·(s+ω2)
此处,ω1、ω2为期望传递函数的截止频率,以下的关系成立。
m0=ω1·ω2、m1=ω1+ω2
因此,在实施方式3中,也可控制ω1、ω2以代替控制m0、m1。
积分滤波器传递要素11及微分滤波器传递要素14中的特性多项式(s2+q1·s+q0)可如以下那样变形。
s2+q1·s+q0=(s+ωq1)·(s+ωq2)
此处,对于ωq1、ωq2,以下的关系成立。
q0=ωq1·ωq2、q1=ωq1+ωq2
为了简化调整,也可如下式那样使ωq1和ωq2相等。
ωq=ωq1=ωq2
此处,对于ωq,以下的关系成立。
q0=ωq 2、q1=2·ωq
因此,在实施方式1及实施方式3中,也可控制ωq1、ωq2以代替控制q0、q1。
另外,上述的各实施方式1、2及3的电动机***1中,说明了进行鲁棒极点配置控制的情况。然而,对于进行P-PI控制的电动机***,也可同样适用本发明。
图6是表示进行PI速度控制的本发明的实施方式4所涉及的电动机***1的闭环***8D的框线图。另外,对于该图中与图2相同或相当的部分标注相同标号,并省略其说明。
闭环***8D构成将速度环路增益Kvp包含在因子内的传递函数,输入电动机3的转速指令,并对电动机3的旋转位置进行反馈控制,输出转速。在闭环***8D中的第1相加点10直接输入有电动机3的转速指令,在积分滤波器传递要素11中,包含有速度环路增益Kvp以作为比例增益传递要素。闭环***8D中的积分滤波器传递要素11在设速度积分增益为Kvi时由Kvp(1+Kvi/s)表示,微分滤波器传递要素14在设截止频率为ωc时由ωcs/(s+ωc)表示。动作对象物2由利用闭环***8D进行旋转控制的电动机3设定动作对象速度。
在该闭环***8D中,也基于由适应确定单元21确定的增益K和输入的参数常数Ri,计算增益K0相对于增益K的转动惯量比Gr(=K0/K)。然后,利用计算出的转动惯量比Gr,求出参数常数Ri相对于以转动惯量比Gr为因子的规定的函数值的比,并根据该比计算速度环路增益Kvp。本实施方式中,根据相当于式(4)的算式(Kvp=Ri/Gr),计算速度环路增益Kvp。进一步基于计算出的速度环路增益Kvp,参照表格对闭环***8D中的各控制参数逐次进行更新。因此,根据实施方式4的电动机***1,也简单计算出速度环路增益Kvp,可在不增大CPU的运算处理负荷的情况下利用自动调谐来抑制振动,起到与实施方式1同样的作用效果。
图7是表示进行PI位置控制的本发明的实施方式5所涉及的电动机***1的闭环***8E的框线图。另外,对于该图中与图6相同或相当的部分标注相同标号,并省略其说明。
闭环***8E构成将速度环路增益Kvp及位置环路增益Kpp包含在因子中的传递函数,输入电动机3的旋转位置指令以代替转速指令,并对电动机3的旋转位置进行反馈控制,输出旋转位置。闭环***8E与图6所示的闭环***8D相比,在向前路径的第1相加点10的前级具有第2相加点18和第2比例增益传递要素19。在第2相加点18输入有电动机3的旋转位置指令以代替转速指令,并且,电动机3的旋转位置从电动机位置传递要素13经由第2反馈路径直接进行负反馈。在第2比例增益传递要素19输入有从第2相加点18输出的旋转位置指令与旋转位置的偏差。动作对象物2由利用闭环***8E进行旋转控制的电动机3设定动作对象位置。
在该闭环***8E中,也基于由适应确定单元21确定的增益K和输入的参数常数Ri,计算增益K0相对于增益K的转动惯量比Gr(=K0/K)。然后,利用计算出的转动惯量比Gr,求出参数常数Ri相对于以转动惯量比Gr为因子的规定的函数值的比,并根据该比计算速度环路增益Kvp。本实施方式中,也根据相当于式(4)的算式(Kvp=Ri/Gr),计算速度环路增益Kvp。进一步基于计算出的速度环路增益Kvp,参照表格对闭环***8E中的各控制参数逐次进行更新。
此时,作为位置环路增益Kpp及速度积分增益Kvi的值,计算出与速度环路增益Kvp具有一定关系的值。这是由于,若仅Kvp单独降低值,则与Kpp及Kvi的平衡变差,控制有时会变得不稳定。因此,降低Kvp的值后降低Kpp及Kvi的值,根据Kvp的值来调整Kpp及Kvi的值。相对于Kvp的值将Kpp及Kvi的值降低多少取决于1惯性***下变得稳定的Kvp与Kpp及Kvi的比率的方式来决定。
根据这样的实施方式5的电动机***1,也简单计算出速度环路增益Kvp及位置环路增益Kpp,可在不增大CPU的运算处理负荷的情况下利用自动调谐来抑制振动,起到与实施方式1同样的作用效果。
在上述的实施方式1~5的电动机***1中,说明了如下情况:即,以转动惯量比Gr为因子的规定函数f(Gr)设定为仅以转动惯量比Gr为因子的一次函数(f(Gr)=Gr),速度环路增益m1、Kvp与转动惯量比Gr具有式(4)所示的单纯的反比例关系。然而,也可利用以转动惯量比Gr和常数Rid0为因子的一次函数(f(Gr)=Gr+Rid0)来表示规定函数f(Gr),利用下式(7.1)、(7.2)来规定速度环路增益m1、Kvp。
m1=Ri/(Gr+Rid0)…(7.1)
Kvp=Ri/(Gr+Rid0)…(7.2)
根据式(7.1)、(7.2),可调整速度环路增益m1、Kvp和转动惯量比Gr的反比例关系,调整的量为常数值Rid0。因此,可扩大速度环路增益m1、Kvp的设定范围,且抑制CPU的运算处理负荷。
此外,也可利用以转动惯量比Gr和常数Rid0为因子的二次函数(f(Gr)=Gr2+Rid1·Gr+Rid0)来表示规定函数f(Gr),利用下式(8.1)、(8.2)来规定速度环路增益m1、Kvp。
m1=Ri/(Gr2+Rid1·Gr+Rid0)…(8.1)
Kvp=Ri/(Gr2+Rid1·Gr+Rid0)…(8.2)
根据将分母设为二次的分数函数的式(8.1)、(8.2),速度环路增益m1、Kvp的值可设定为与单纯的反比例关系不同的相对于转动惯量比Gr的增加而单调减少的所期望的关系。与分母为一次函数的反比例关系相比,将分母设为二次的分数函数可进一步兼顾指令响应特性和振动抑制特性。
由对速度环路增益m1、Kvp进行规定的各式(4)、(7.1)、(7.2)、(8.1)、(8.2)所示的具体特性在本实施方式中决定为通过利用实验对速度环路增益m1、Kvp与转动惯量比Gr的关系进行测定得到的点的特性。分母的函数的次数越高,越能提高将函数值向测定点拟和的精度,但CPU的运算处理负荷变大。
此外,在上述各实施方式1~5的电动机***1中,说明了用户完全自由地将任意的参数常数Ri输入到电动机控制装置4的情况。然而,也可采用将参数常数Ri作为电动机3与动作对象物2之间的动力传递机构6的种类所对应的多个值并预先存储在电动机控制装置4中的结构。根据该结构,用户从预先存储在电动机控制装置4的多个参数常数Ri中简单选择对应于动力传递机构6的种类的参数常数Ri的值,从而可进行参数设定。因此,可提供提高了用户的便利性的电动机***1。
此外,在上述各实施方式1~5的电动机***1中,说明了利用表格进行从速度环路增益m1、Kvp向各控制参数的变换的情况。然而,也可不利用表格,而通过利用算式的运算,进行从速度环路增益m1、Kvp向各控制参数的变换。
此外,在上述各实施方式1~5的电动机***1中,也可构成为对转动惯量比Gr的上限值设定限制。
在随着转动惯量比Gr的增加,速度环路增益m1、Kvp的值过小,无法设定与转动惯量比Gr的值对应的速度环路增益m1、Kvp的值的情况下,例如与转动惯量比Gr的值对应的速度环路增益m1、Kvp的值比表格中设定的最小水平的速度环路增益m1、Kvp的值要小的情况下,无法降低速度环路增益m1、Kvp的值。
在这种情况下,将根据表格中能设定的速度环路增益m1的最小值m1min、Kvp的最小值Kvpmin并基于关系式(m1=Ri/f(Gr)、Kvp=Ri/f(Gr))求出的转动惯量比Gr作为转动惯量比Gr的上限值预先设定于电动机控制装置4。通过这样对转动惯量比Gr的上限值施加限制,从而对与转动惯量比Gr的值对应的速度环路增益m1、Kvp的值的下限施加限制。因此,关系式(m1=Ri/f(Gr)、Kvp=Ri/f(Gr))始终成立,不会再出现无法设定速度环路增益m1、Kvp的值的情况。
例如,利用式(4)计算出速度环路增益m1的值,如图3(a)的曲线图所示,速度环路增益m1与转动惯量比Gr的关系由单纯的反比例关系(m1=Ri/Gr)表示的情况下,若设表格中能设定的速度环路增益m1的最小值为m1min,则转动惯量比Gr的上限值grcamax基于式(4)可由下式(9)表示。
grcamax=Ri/m1min…(9)
图3(b)为表示对转动惯量比Gr设定有上限值grcamax时的转动惯量比Gr的时间变化的曲线图。该曲线图的横轴为时间,纵轴为转动惯量比Gr。如该曲线图所示,若在时间t对转动惯量比Gr设定上限值grcamax,则在时间t之后,如点划线所示那样渐增的转动惯量比Gr的推定值限制在grcamax[%]。因此,通过将转动惯量比Gr的设定限制在由式(9)决定的上限值grcamax,从而对与转动惯量比Gr的值对应的速度环路增益m1的值的下限施加限制,关系式(m1=Ri/f(Gr))始终成立,不会再出现无法设定速度环路增益m1的值的情况。
此外,在图3(a)所示的速度环路增益m1与转动惯量比Gr的关系中,如该曲线图所示,若对速度环路增益m1的值设定上限值m1max,使速度环路增益m1的值在用户期望的上限值m1max饱和,则可尽可能提高指令响应性。根据这样的电动机***1,可在不增大CPU的运算处理负荷的情况下利用自动调谐抑制振动,使指令响应性接近用户期望的特性。
图8是实施方式3的电动机***1中追加对转动惯量比Gr的上限值设定限制的结构后的变形例的闭环***8C’的框线图。另外,对于该图中与图5相同或相当的部分标注相同标号,并省略其说明。
闭环***8C’在闭环***8C的基础上追加了由CPU构成的Gr上限值计算单元22及限制器23。该闭环***8C’中,图5中由1/K(=Gr/K0)表示的电动机增益传递要素12分割为由1/K0表示的传递要素12a、由Gr表示的传递要素12b这两个传递要素而呈现。对Gr上限值计算单元22提供第3表格中能设定的速度环路增益m1的最小值m1min、及参数常数Ri。Gr上限值计算单元22根据最小值m1min及参数常数Ri,利用式(9)计算出转动惯量比Gr的上限值grcamax并进行存储。若利用式(4)计算出的速度环路增益m1的值在第3表格中达到下限饱和,则限制器23将传递要素12b中的Gr的值限制为由Gr上限值计算单元22计算出的上限值grcamax。由此进行限制使得1/K设定值不会过度上升,换言之,使得K设定值不会过度下降。因此,关系式(m1=Ri/Gr)始终成立,不会再出现无法设定速度环路增益m1的值的情况。
此外,在上述各实施方式1~5及上述变形例的电动机***1中,说明了闭环***8A、8B、8C、8C’、8D、8E的传递函数对多惯性***的特性进行规定的情况。然而,在闭环***的传递函数对1惯性***的特性进行规定的情况下,也可同样适用本发明。根据这种结构,虽然闭环***的指令响应特性下降,但可在用户未意识到是控制对象装置的刚性较高的1惯性***、还是控制刚性较低的多惯性***的情况下防止控制导致的振荡。
此外,在上述各实施方式1~5及上述变形例的电动机***1中,说明了适应确定单元21构成检测动作对象物2及电动机3的转动惯量的转动惯量检测单元的情况。然而,电动机控制装置4也可构成为在适应确定单元21的基础上,另外具备检测动作对象物2及电动机3的转动惯量的转动惯量检测单元。
标号说明
1 电动机***
2 动作对象物
3 电动机
4 电动机控制装置
6 动力传递机构
8A,8B,8C,8C’,8D,8E 闭环***
9 第1比例增益传递要素
10 第1相加点
11 积分滤波器传递要素
12 电动机增益传递要素
13 电动机位置传递要素
14 微分滤波器传递要素
15 第1增益变换单元
16 第2增益变换单元
17 第3增益变换单元
18 第2相加点
19 第2比例增益传递要素
21 适应确定单元
Claims (11)
1.一种电动机***,该电动机***包括使动作对象物动作的电动机和对所述电动机的旋转进行反馈控制的电动机控制装置,其特征在于,包括:
闭环***,该闭环***输入所述电动机的转速指令,并对所述电动机的旋转位置进行反馈控制,输出转速,且构成将速度环路增益包含在因子中的传递函数;
转动惯量检测单元,该转动惯量检测单元对所述动作对象物及所述电动机的转动惯量进行检测;
适应确定单元,该适应确定单元基于电动机位置传递要素的输入和电动机位置传递要素的输出,对增益K进行确定,该增益K为将包含向所述电动机供电的放大器的固定增益和所述电动机的转矩常数在内的固定值除以所述动作对象物及所述电动机的转动惯量后的值;及
计算单元,该计算单元计算增益K0相对于所述增益K的转动惯量比Gr,利用计算出的所述转动惯量比Gr,求出任意的参数常数Ri相对于以所述转动惯量比Gr为因子的规定的函数值的比,并根据该比来计算所述速度环路增益,所述K0为将包含向所述电动机供电的放大器的固定增益和所述电动机的转矩常数在内的固定值除以所述电动机的转动惯量后的值,
根据由所述计算单元计算出的所述速度环路增益,对所述传递函数进行修正。
2.如权利要求1所述的电动机***,其特征在于,
所述闭环***构成将所述速度环路增益及位置环路增益包含在因子中的传递函数,输入所述电动机的旋转位置指令以代替所述转速指令,并对所述电动机的旋转位置进行反馈控制,输出旋转位置,
所述计算单元计算与所述速度环路增益具有一定关系的值作为所述位置环路增益的值,
根据由所述计算单元计算出的所述速度环路增益及所述位置环路增益,对所述传递函数进行修正。
3.如权利要求1所述的电动机***,其特征在于,
所述闭环***具有向前路径及第1反馈路径,该向前路径具有第1比例增益传递要素、输入所述电动机的转速指令的第1相加点、积分滤波器传递要素、电动机增益传递要素及电动机位置传递要素,该第1反馈路径将所述电动机的旋转位置经由微分滤波器传递要素负反馈到所述第1相加点,
在设所述速度环路增益为m1、拉普拉斯运算符为s时,具有控制所述动作对象物及所述电动机的速度的期望特性的期望传递函数由算式m1/(s+m1)所规定,
在设利用所述适应确定单元基于所述电动机位置传递要素的输入和所述电动机位置传递要素的输出所确定的增益设为p,关于干扰响应特性的控制参数为q0及q1,使所述闭环***的特性与所述期望传递函数一致的参数为a1=q1+m1-p、b1=q0·m1、b2=(q1-p)·(m1-p)+q0时,其中,所述增益p是将关于所述动作对象物及所述电动机的粘性的项除以所述动作对象物及所述电动机的转动惯量后的值,
所述第1比例增益传递要素由m1表示,
所述积分滤波器传递要素由(s2+q1·s+q0)/(s2+a1·s)表示,
所述电动机增益传递要素由1/K表示,
所述电动机位置传递要素由K/(s2+p·s)表示,
所述微分滤波器传递要素由(b2·s2+b1·s)/(s2+q1·s+q0)表示,
在所述电动机控制装置中存储将m1与q0、q1的关系相对应的表格,
所述计算单元参照所述表格,进行从计算出的所述速度环路增益m1向q0、q1的变换。
4.如权利要求1所述的电动机***,其特征在于,
所述闭环***具有向前路径及第1反馈路径,该向前路径具有第1比例增益传递要素、输入所述电动机的转速指令的第1相加点、积分滤波器传递要素、电动机增益传递要素及电动机位置传递要素,该第1反馈路径将所述电动机的旋转位置经由微分滤波器传递要素负反馈到所述第1相加点,
在设所述速度环路增益为m1、拉普拉斯运算符为s时,具有控制所述动作对象物及所述电动机的速度的期望特性的期望传递函数由算式m1/(s+m1)所规定,
在设利用所述适应确定单元基于所述电动机位置传递要素的输入和所述电动机位置传递要素的输出所确定的增益设为p,关于干扰响应特性的控制参数为ωq,使所述闭环***的特性与所述期望传递函数一致的参数为b1=ωq·m1、b2=m1-p+ωq时,其中,所述增益p是将关于所述动作对象物及所述电动机的粘性的项除以所述动作对象物及所述电动机的转动惯量后的值,
所述第1比例增益传递要素由m1表示,
所述积分滤波器传递要素由(s+ωq)/s表示,
所述电动机增益传递要素由1/K表示,
所述电动机位置传递要素由K/(s2+p·s)表示,
所述微分滤波器传递要素由(b2·s2+b1·s)/(s+ωq)表示,
在所述电动机控制装置中存储将m1与ωq的关系相对应的表格,
所述计算单元参照所述表格,进行从计算出的所述速度环路增益m1向ωq的变换。
5.如权利要求2所述的电动机***,其特征在于,
所述闭环***具有向前路径、第1反馈路径及第2反馈路径,该向前路径具有输入所述电动机的旋转位置指令来代替所述转速指令的第2相加点、第2比例增益传递要素、第1相加点、积分滤波器传递要素、电动机增益传递要素及电动机位置传递要素,该第1反馈路径将所述电动机的旋转位置经由微分滤波器传递要素负反馈到所述第1相加点,该第2反馈路径将所述电动机的旋转位置直接负反馈到所述第2相加点,
在设所述速度环路增益为m1、所述位置环路增益为m0/m1、拉普拉斯运算符为s时,具有控制所述动作对象物及所述电动机的位置的期望特性的期望传递函数由算式m0/(s2+m1·s+m0)所规定,
在设利用所述适应确定单元基于所述电动机位置传递要素的输入和所述电动机位置传递要素的输出所确定的增益设为p,关于干扰响应特性的控制参数为q0及q1,使所述闭环***的特性与所述期望传递函数一致的参数为a1=q1+m1-p、b1=q0·m1、b2=(q1-p)·(m1-p)+q0时,其中,所述增益p是将关于所述动作对象物及所述电动机的粘性的项除以所述动作对象物及所述电动机的转动惯量后的值,
所述第2比例增益传递要素由m0表示,
所述积分滤波器传递要素由(s2+q1·s+q0)/(s2+a1·s)表示,
所述电动机增益传递要素由1/K表示,
所述电动机位置传递要素由K/(s2+p·s)表示,
所述微分滤波器传递要素由(b2·s2+b1·s)/(s2+q1·s+q0)表示,
在所述电动机控制装置中存储将m1与m0、q0、q1的关系相对应的表格,
所述计算单元参照所述表格,进行从计算出的所述速度环路增益m1向m0、q0、q1的变换。
6.如权利要求1至5中任一项所述的电动机***,其特征在于,
以所述转动惯量比Gr为因子的所述规定的计算所述速度环路增益的函数为仅以所述转动惯量比Gr为因子的一次函数。
7.如权利要求1至5中任一项所述的电动机***,其特征在于,
以所述转动惯量比Gr为因子的所述规定的计算所述速度环路增益的函数为以所述转动惯量比Gr和常数为因子的一次函数。
8.如权利要求1至5中任一项所述的电动机***,其特征在于,
以所述转动惯量比Gr为因子的所述规定的计算所述速度环路增益的函数为以所述转动惯量比Gr和常数为因子的二次函数。
9.如权利要求1至5中任一项所述的电动机***,其特征在于,
所述参数常数Ri作为所述电动机与所述动作对象物之间的动力传递机构的种类所对应的多个值存储于所述电动机控制装置。
10.如权利要求1至5中任一项所述的电动机***,其特征在于,
对所述转动惯量比Gr的上限值设有限制。
11.如权利要求1至5中任一项所述的电动机***,其特征在于,
所述适应确定单元构成所述转动惯量检测单元,基于所述电动机位置传递要素的输入和所述电动机位置传递要素的输出,对所述动作对象物及所述电动机的转动惯量进行确定。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016-142170 | 2016-07-20 | ||
JP2016142170A JP6751615B2 (ja) | 2016-07-20 | 2016-07-20 | モータシステム |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107645267A CN107645267A (zh) | 2018-01-30 |
CN107645267B true CN107645267B (zh) | 2020-05-26 |
Family
ID=61020499
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710589757.2A Active CN107645267B (zh) | 2016-07-20 | 2017-07-19 | 电动机*** |
Country Status (4)
Country | Link |
---|---|
JP (1) | JP6751615B2 (zh) |
KR (1) | KR102453684B1 (zh) |
CN (1) | CN107645267B (zh) |
TW (1) | TWI740954B (zh) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109067284B (zh) * | 2018-08-15 | 2021-01-15 | 江门市蒙德电气股份有限公司 | 一种基于滤波误差的电机控制方法及装置 |
TWI681274B (zh) * | 2018-11-14 | 2020-01-01 | 財團法人工業技術研究院 | 工具機頻率響應參數的調整方法及應用其之調整系統 |
CN110968118B (zh) * | 2019-12-18 | 2021-01-05 | 中国科学院长春光学精密机械与物理研究所 | 一种六自由度调整转台的控制方法 |
CN110989357B (zh) * | 2019-12-18 | 2021-05-04 | 中国科学院长春光学精密机械与物理研究所 | 一种复杂机电***的辨识控制方法和*** |
CN111745646B (zh) * | 2020-06-10 | 2021-12-24 | 杭州凯尔达机器人科技股份有限公司 | 机器人伺服电机增益参数控制方法及*** |
CN111969899B (zh) * | 2020-08-14 | 2022-03-18 | 南京航空航天大学 | 一种永磁直驱伺服电机的低速运行控制方法 |
TWI741754B (zh) * | 2020-08-25 | 2021-10-01 | 東元電機股份有限公司 | 伺服馬達增益調整系統及其方法 |
KR20230154976A (ko) * | 2021-04-21 | 2023-11-09 | 미쓰비시덴키 가부시키가이샤 | 모터 제어 장치, 모터 제어 시스템 및 모터 제어 방법 |
CN115425892B (zh) * | 2022-11-08 | 2023-03-24 | 季华实验室 | 一种电机的转动惯量辨识方法及采用该方法的装置 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0515193A (ja) * | 1991-07-03 | 1993-01-22 | Toshiba Corp | インバータ装置のゲイン調整方法 |
JP2001169581A (ja) * | 1999-12-02 | 2001-06-22 | Yaskawa Electric Corp | モータ制御装置 |
CN1938934A (zh) * | 2004-03-26 | 2007-03-28 | 株式会社安川电机 | 电机控制装置 |
KR20080062830A (ko) * | 2006-12-29 | 2008-07-03 | 엘에스산전 주식회사 | 센서리스 인버터의 관성 모멘트 추정방법 |
CN101895252A (zh) * | 2010-07-09 | 2010-11-24 | 上海新时达电气股份有限公司 | 电机伺服驱动器控制器参数自动调整装置及其方法 |
CN101989827A (zh) * | 2010-11-18 | 2011-03-23 | 东南大学 | 基于惯量辨识的交流伺服***速度环控制参数自整定方法 |
CN104993764A (zh) * | 2015-07-07 | 2015-10-21 | 江西洪都航空工业集团有限责任公司 | 基于一种参数自整定的电机控制器及其控制方法 |
Family Cites Families (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS542398A (en) * | 1977-06-08 | 1979-01-09 | Ajinomoto Co Inc | Preparation of d-alpha-amino acid |
JP3541857B2 (ja) * | 1995-01-17 | 2004-07-14 | 株式会社安川電機 | オーバーシュートレスオートチューニング方法 |
JP3981773B2 (ja) * | 1997-05-28 | 2007-09-26 | 株式会社安川電機 | ロボット制御装置 |
CN1149457C (zh) * | 1999-06-04 | 2004-05-12 | 株式会社安川电机 | 电动机位置控制器 |
JP3757101B2 (ja) * | 2000-06-09 | 2006-03-22 | 株式会社日立産機システム | オンラインオートチューニングサーボ制御装置 |
JP3561911B2 (ja) | 2000-07-11 | 2004-09-08 | 株式会社安川電機 | モータ制御装置 |
JP4192780B2 (ja) * | 2003-12-26 | 2008-12-10 | 株式会社安川電機 | ロボットの制御装置 |
CN102354104B (zh) * | 2005-09-19 | 2015-05-27 | 克利夫兰州立大学 | 控制器、观测器及其应用 |
WO2008087893A1 (ja) * | 2007-01-17 | 2008-07-24 | Panasonic Corporation | サーボモータの制御装置および制御方法 |
US8232758B2 (en) * | 2009-08-28 | 2012-07-31 | Fanuc Ltd | Controller of electric motor having function of estimating inertia and friction simultaneously |
WO2011148623A1 (ja) * | 2010-05-28 | 2011-12-01 | パナソニック株式会社 | 電動機制御装置 |
JP5528421B2 (ja) * | 2011-12-08 | 2014-06-25 | 山洋電気株式会社 | モータ制御装置 |
JP6353731B2 (ja) * | 2014-08-04 | 2018-07-04 | 日本電産サンキョー株式会社 | モータシステム |
CN204967593U (zh) * | 2015-09-24 | 2016-01-13 | 歌尔声学股份有限公司 | 自适应控制微型马达 |
-
2016
- 2016-07-20 JP JP2016142170A patent/JP6751615B2/ja active Active
-
2017
- 2017-06-02 TW TW106118216A patent/TWI740954B/zh active
- 2017-07-17 KR KR1020170090126A patent/KR102453684B1/ko active IP Right Grant
- 2017-07-19 CN CN201710589757.2A patent/CN107645267B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0515193A (ja) * | 1991-07-03 | 1993-01-22 | Toshiba Corp | インバータ装置のゲイン調整方法 |
JP2001169581A (ja) * | 1999-12-02 | 2001-06-22 | Yaskawa Electric Corp | モータ制御装置 |
CN1938934A (zh) * | 2004-03-26 | 2007-03-28 | 株式会社安川电机 | 电机控制装置 |
KR20080062830A (ko) * | 2006-12-29 | 2008-07-03 | 엘에스산전 주식회사 | 센서리스 인버터의 관성 모멘트 추정방법 |
CN101895252A (zh) * | 2010-07-09 | 2010-11-24 | 上海新时达电气股份有限公司 | 电机伺服驱动器控制器参数自动调整装置及其方法 |
CN101989827A (zh) * | 2010-11-18 | 2011-03-23 | 东南大学 | 基于惯量辨识的交流伺服***速度环控制参数自整定方法 |
CN104993764A (zh) * | 2015-07-07 | 2015-10-21 | 江西洪都航空工业集团有限责任公司 | 基于一种参数自整定的电机控制器及其控制方法 |
Also Published As
Publication number | Publication date |
---|---|
JP6751615B2 (ja) | 2020-09-09 |
TWI740954B (zh) | 2021-10-01 |
JP2018014806A (ja) | 2018-01-25 |
CN107645267A (zh) | 2018-01-30 |
KR102453684B1 (ko) | 2022-10-12 |
KR20180010145A (ko) | 2018-01-30 |
TW201804270A (zh) | 2018-02-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107645267B (zh) | 电动机*** | |
KR101460463B1 (ko) | 모터 제어 장치 | |
JP6353731B2 (ja) | モータシステム | |
WO2008075558A1 (ja) | 位置制御装置 | |
JP5652678B2 (ja) | 電動機制御装置 | |
JP2009303432A (ja) | モータによる位置制御装置 | |
JP6281751B2 (ja) | 位置制御システム | |
JP5644409B2 (ja) | 電動機の位置制御装置 | |
CN107196581B (zh) | 用于微调伺服马达的控制装置、方法及计算机可读介质 | |
US11579570B2 (en) | Servo control device, servo control method and servo control system | |
JP6953337B2 (ja) | 制御系設計支援装置、制御系設計支援方法、及び制御系設計支援プログラム | |
CN109412495B (zh) | 参数自调整方法、设备及计算机可读存储介质 | |
JP5362339B2 (ja) | モータ制御装置 | |
JP2014007900A (ja) | モータ制御装置 | |
WO2009084258A1 (ja) | モータ制御装置 | |
JP2010142020A (ja) | サーボ制御装置とサーボ制御方法 | |
JP2007306779A (ja) | モータ制御装置 | |
JP2011147201A (ja) | 電動機制御装置 | |
JP2010086395A (ja) | 2自由度デジタル制御装置 | |
JP7008885B1 (ja) | モータ制御装置、モータ制御システムおよびモータ制御方法 | |
JP3975537B2 (ja) | 制御装置と制御方法 | |
JP2012118785A (ja) | 2自由度制御系のチューニング | |
JP2021006952A (ja) | パラメータ調整方法 | |
RU2761780C1 (ru) | Способ адаптивного управления электромеханической системой с гармоническим моментом нагрузки в широком диапазоне скоростей и устройство для его осуществления | |
JP4420158B2 (ja) | 電動機速度制御装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |