CN103270692A - 马达控制装置 - Google Patents
马达控制装置 Download PDFInfo
- Publication number
- CN103270692A CN103270692A CN2011800608929A CN201180060892A CN103270692A CN 103270692 A CN103270692 A CN 103270692A CN 2011800608929 A CN2011800608929 A CN 2011800608929A CN 201180060892 A CN201180060892 A CN 201180060892A CN 103270692 A CN103270692 A CN 103270692A
- Authority
- CN
- China
- Prior art keywords
- control object
- parameter
- motor
- model
- operational part
- 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
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B5/00—Anti-hunting arrangements
- G05B5/01—Anti-hunting arrangements electric
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1641—Programme controls characterised by the control loop compensation for backlash, friction, compliance, elasticity in the joints
-
- 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
- H02P23/00—Arrangements or methods for the control of AC motors characterised by a control method other than vector control
- H02P23/0004—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
- H02P29/00—Arrangements for regulating or controlling electric motors, appropriate for both AC and DC motors
- H02P29/50—Reduction of harmonics
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39186—Flexible joint
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39195—Control, avoid oscillation, vibration due to low rigidity
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/41—Servomotor, servo controller till figures
- G05B2219/41128—Compensate vibration beam, gantry, feedback of speed of non driven end
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/41—Servomotor, servo controller till figures
- G05B2219/41166—Adaptive filter frequency as function of oscillation, rigidity, inertia load
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/41—Servomotor, servo controller till figures
- G05B2219/41233—Feedforward simulation filter, with model
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/42—Servomotor, servo controller kind till VSS
- G05B2219/42077—Position, speed or current, combined with vibration feedback
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Electric Motors In General (AREA)
Abstract
马达控制装置控制具有马达以及能够振动要素的控制对象的动作,具备:生成部,根据表示与所述控制对象的振动特性关联的所述控制对象的状态的状态信息,生成表示所述控制对象的振动特性的第1参数;第1运算部,运算与由所述生成部生成的第1参数的时间变化量相应的第2参数;第2运算部,使用动作目标值、所述第1参数以及所述第2参数,以使所述控制对象不激发振动的方式运算模型转矩;以及发生部,以使所述控制对象的动作追踪所述动作目标值的方式,根据由所述第2运算部运算的模型转矩发生转矩指令。
Description
技术领域
本发明涉及马达控制装置。
背景技术
在刚性低的产业用机械装置中,如果通过马达进行了产业用机械装置的定位驱动,则有时起因于机械共振等而在停止时发生残留振动。为了抑制这样的残留振动,经由马达使产业用机械装置动作的马达控制装置根据动作目标值以使产业用机械装置的振动频率(共振频率)的信号分量变小的方式运算控制信号,来进行产业用机械装置的阻尼控制。马达控制装置为了进行该阻尼控制,需要与包含产业用机械装置的控制系统的振动频率相应的阻尼控制的阻尼参数。对于在动作中振动频率不发生变化的产业用机械装置,如果在马达控制装置中设定固定的阻尼参数,则能够充分抑制残留振动。
另一方面,在产业用机械装置中,存在如直行机器手、起重机等那样在动作中振动频率发生变化的装置。对于这样的产业用机械装置,存在即使在马达控制装置中设定固定的阻尼参数,仍无法抑制残留振动的倾向。
相对于此,在专利文献1中,记载了如下技术:在能够通过x轴用的马达使臂在x轴方向移动并且通过z轴用的马达使臂顶端的重物在z轴方向移动的机械控制装置中,根据包括臂以及重物的控制对象的发生变化的振动频率,变更参数(增益常数)。具体而言,控制用数据表格得到关于从滑动部至臂顶端的重物为止的距离的位置信息并输出与振动频率的校正量有关的输出数据,校正块将从控制用数据表格的输出数据得到的参数(增益常数)乘以位置指令值的2阶微分值来求出校正量并输出到加法器,加法器将该校正量加到原来的位置指令。由此,根据专利文献1,由于考虑与控制对象中的移动的一部分的结构部件的当前位置相应的振动频率等的变化来进行校正,所以能够使移动至规定位置的控制对象不振动地停止。
另外,在专利文献2中,记载了如下技术:在具有与货物卡合而将货物悬挂的绳缆和将绳缆卷上卷下的起重卷筒的起重机的驱动装置的控制系统中,根据绳缆长度的信号以不产生货物摆动的方式进行前馈控制。具体而言,在控制系统中,检测绳缆长度,根据绳缆长度的检测结果,逐次运算绳缆的共振频率,从被限制成不超过驱动装置的性能的搬送指令中进一步去除共振频率的分量而输入到起重机的驱动装置。由此,根据专利文献2,能够在搬送了货物的时间点以不使货物大幅摆动的方式驱动并且控制起重机的驱动装置。
专利文献1:日本专利第4367041号公报
专利文献2:国际公开第05/012155号
发明内容
在专利文献1记载的机械控制装置中,公开了如下指令生成法:根据关于从滑动部至臂顶端的重物为止的距离的位置信息,输出根据振动频率而变化的参数(增益常数),作为位置指令的2阶微分与参数(增益常数)之积,求出校正量,将所求出的校正量加到位置指令,从而即使针对在动作中机械固有振动频率发生变化的控制对象也不会激发振动。但是,存在如下这样的问题:有时即使边使得与发生变化的机械固有振动频率正确地对应边使参数(增益常数)变化仍无法充分地得到振动抑制效果。
在专利文献2记载的控制系统中,由于为了不产生货物摆动,仅进行从搬送指令去除共振频率的分量的操作,所以有可能无法充分地得到振动抑制效果。而且,在起重机的驱动装置中,也存在仅去掉根据绳缆长度而变化的共振频率附近的信号,振动抑制效果并不充分这样的问题。另外,在专利文献2记载的控制系统中,考虑为通过仿真反复运算来决定滤波器系数,所以具有系数的决定难且花费时间的倾向。
本发明是鉴于上述而完成的,其目的在于得到一种马达控制装置,能够进一步提高使在动作中振动特性发生变化的控制对象动作时的振动抑制效果。
为了解决上述课题并达成目的,本发明的1个方面的马达控制装置控制具有马达以及能够振动要素的控制对象的动作,其特征在于,具备:生成部,根据表示与所述控制对象的振动特性关联的所述控制对象的状态的状态信息,生成表示所述控制对象的振动特性的第1参数;第1运算部,运算与由所述生成部生成的所述第1参数的时间变化量相应的第2参数;第2运算部,根据动作目标值、所述第1参数以及所述第2参数,以使所述控制对象不激发振动的方式运算模型转矩;以及发生部,以使所述控制对象的动作追踪所述动作目标值的方式,根据由所述第2运算部运算出的模型转矩,发生转矩指令。
根据本发明,不仅使用第1参数,而且还使用与第1参数的时间变化量相应的第2参数来运算模型转矩,所以能够不仅考虑振动特性而且还考虑振动特性的变化率来发生转矩指令。由此,能够进一步提高使在动作中振动特性发生变化的控制对象动作时的振动抑制效果。
附图说明
图1是示出实施方式1的马达控制装置的结构的图。
图2是示出实施方式1中的控制对象的图。
图3是示出实施方式1中的控制对象的图。
图4是示出实施方式1中的控制对象的图。
图5是示出实施方式1中的前馈控制部的结构的图。
图6是示出实施方式1中的共振·反共振表格的结构的图。
图7是示出实施方式2中的前馈控制部的结构的图。
图8是示出实施方式3中的前馈控制部的结构的图。
图9是示出实施方式4中的前馈控制部的结构的图。
图10是示出实施方式5的马达控制装置的结构的图。
图11是示出实施方式5中的前馈控制部的结构的图。
(符号说明)
1:控制对象;1a:马达;1a1:x轴马达;1a2:马达;1a11:z轴马达;1b:弹簧;1b1:z轴臂;1b2:绳缆;1c:机械负载;1c1、1c2:负载;1d1:x轴臂;1d2:滑块;2:检测器;3:检测器;4:电流控制器;100、200、300、400、500:马达控制装置;111、211、311、411、511:前馈控制部;112、512:反馈控制部;113:转矩加法器;121、221、321、421、521:阻尼滤波器;121a:位置运算部;121b、521b:速度运算部;121c、221c、321c、421c、521c:转矩运算部;122、222、322、422:阻尼参数决定部;122a、222a、322a、422a:生成部;122b:存储部;122b1:共振·反共振表格;123:阻尼参数滤波器;123a:微分器;123b:微分器;131:位置控制器;132:速度控制器;133:速度运算器;141、241、341、441:模型位置运算部;142、542:模型速度运算部;143、543:模型加速度运算部;144、244、344、444、544:惯性力矩乘法部;221a、321a、421a:补偿信号生成部;221b、321b、421b:变化量运算部;245、345、445:模型位置微分器;246、446:模型速度微分器;321d:速度运算部;347:共振补偿信号减法部;348:共振补偿信号微分器;349:共振补偿信号2阶微分器;4410:目标值微分器;4411:目标值2阶微分器;4412:模型转矩减法器;4413:模型转矩补偿部;4414:模型转矩加法器。
具体实施方式
以下,根据附图,详细说明本发明的马达控制装置的实施方式。另外,本发明不限于该实施方式。
实施方式1.
使用图1来说明实施方式1的马达控制装置100的结构。图1是示出实施方式1的马达控制装置100的结构的框图。
马达控制装置100从外部(例如,未图示的上位控制器)接收表示所驱动的控制对象1的位置目标值的动作目标值(位置指令)pref,并且从检测器2接收由检测器2(例如,编码器)检测到的表示马达1a的位置(例如,马达1a内的转子的旋转位置或者可动元件的驱动位置)的马达动作检测值pM。另外,马达控制装置100从检测器3接收表示与控制对象1的振动特性关联的控制对象1的状态的参数变更信号(状态信息)ML。马达控制装置100进行与参数变更信号ML相应的动作,并且以使马达动作检测值pM追踪动作目标值pref的方式发生转矩指令τM并输出到电流控制器4。由此,电流控制器4将与转矩指令τM相应的电流I(依赖于此的电力)供给到处于控制对象1内部的马达1a,所以马达1a发生与转矩指令τM相应的马达转矩而使处于控制对象1内部的弹簧(能够振动要素)1b以及机械负载1c动作。
具体而言,马达控制装置100具备前馈控制部111、反馈控制部112、以及转矩加法器(发生部)113。
前馈控制部111从外部接收动作目标值pref,并且从检测器3接收参数变更信号ML。检测器3是例如臂长度检测器,检测z轴臂1b1(参照图3)的长度作为参数变更信号ML。或者,检测器3是例如绳缆长度检测器,检测绳缆1b2(参照图4)的长度作为参数变更信号ML。前馈控制部111将与控制对象1的理想的动作波形对应的模型位置pa、模型速度va输出到反馈控制部112,将模型转矩τa输出到转矩加法器113。
反馈控制部112接收从前馈控制部111输出的模型位置pa、模型速度va,并且接收从检测器2反馈的控制对象1(马达1a)的马达动作检测值pM,向转矩加法器113输出反馈转矩τB。
转矩加法器113发生反馈转矩τB与模型转矩τa之和作为转矩指令τM并输出到电流控制器4。电流控制器4接收从转矩加法器113输出的转矩指令τM,将实现与转矩指令τM一致的马达转矩的实际电流I(依赖于此的电力)施加(供给)到马达1a。然后,使从电流控制器4输出的实际电流I流入马达1a,从而控制对象1内的弹簧(能够振动要素)1b以及机械负载1c被驱动。另外,通过检测器2,检测控制对象1内的马达1a的马达动作检测值pM。
接下来,说明前馈控制部111的内部结构的概略。前馈控制部111具有阻尼参数决定部122、阻尼参数滤波器(第1运算部)123、以及阻尼滤波器(第2运算部)121。
阻尼参数决定部122接收参数变更信号ML,来生成阻尼参数信号θ。即,阻尼参数决定部122根据参数变更信号ML,生成表示控制对象1的当前的振动特性的阻尼参数信号(第1参数)θ并输出到阻尼滤波器121和阻尼参数滤波器123。
阻尼参数滤波器123接收阻尼参数信号θ,运算阻尼参数变量信号θ’。即,阻尼参数滤波器123从阻尼参数决定部122接收阻尼参数信号θ,运算表示控制对象1的振动特性变化的、即与阻尼参数信号θ的时间变化量相应的阻尼参数变量信号(第2参数)θ’,并将运算出的结果输出到阻尼滤波器121。
阻尼滤波器121以不激发振动、且使控制对象1稳定地追踪动作目标值pref的方式,运算并输出模型位置pa、模型速度va、以及模型转矩τa。
具体而言,阻尼滤波器121从外部接收动作目标值pref,从阻尼参数决定部122接收阻尼参数信号θ,从阻尼参数滤波器123接收阻尼参数变量信号θ’。阻尼滤波器121通过阻尼参数信号θ和阻尼参数变量信号θ’逐次变更其特性。然后,阻尼滤波器121针对动作目标值pref的变动,以不激发振动的方式、且以使模型位置pa稳定地与动作目标值pref一致、使模型速度va稳定地与动作目标值的1阶微分值p(1) ref一致、使模型转矩τa稳定地与对动作目标值的2阶微分值p(2) ref乘以控制对象1的惯性力矩而得到的值一致的方式,运算模型位置pa、模型速度va、模型转矩τa。
另外,p(1) ref表示与pref的时间有关的1阶微分,p(2) ref表示与pref的时间有关的2阶微分,以后处于各记号的右上的()内的数值表示与时间有关的微分的次数。
然后,阻尼滤波器121将模型位置pa和模型速度va输出到反馈控制部112,将模型转矩τa输出到转矩加法器113。关于运算模型位置pa、模型速度va、模型转矩τa的方法,在以后叙述。
接下来,说明反馈控制部112的内部结构。反馈控制部112具有位置控制器131、速度运算器133、以及速度控制器132。
位置控制器131接收从前馈控制部111输出的模型位置pa,并且接收从检测器2反馈的马达动作检测值pM。位置控制器131以使马达动作检测值pM追踪模型位置pa的方式,计算速度指令vu。位置控制器131将所计算出的速度指令vu输出到速度控制器132。例如,在位置控制器131是比例控制的情况下,将位置比例增益设为Kp,进行式(1)的运算,将其结果作为速度指令vu输出。
vu=Kp×(pa-pM)…(1)
速度运算器133接收由检测器2检测到的马达动作检测值pM。速度运算器133对所接收到的马达动作检测值pM进行差分、滤波处理等,计算马达速度运算值vM。速度运算器133将所计算出的马达速度运算值vM输出到速度控制器132。
速度控制器132接收从前馈控制部111输出的模型速度va,接收从位置控制器131输出的速度指令vu,接收从速度运算器133输出的马达速度运算值vM。速度控制器132以使马达速度运算值vM追踪模型速度va的方式、即以使马达速度运算值vM与模型速度va和速度指令vu之和一致的方式,通过速度PI控制等运算,计算反馈转矩τB。速度控制器132将所计算出的反馈转矩τB输出到转矩加法器113。作为速度控制器132中的计算处理的例子,有如式(2)那样PI控制和滤波器的组合。此处,s是拉普拉斯运算子、Kv是速度比例增益、Ki是速度积分增益。滤波器H(s)是在比由速度控制器132的速度比例增益、速度积分增益决定的控制频带高的频率下去除规定的频率分量的滤波器,使用被称为低通滤波器、陷波滤波器的滤波器。
τB=H(s)×Kv×((s+Ki)/s)×(vu+va-vM)…(2)
据此,转矩加法器113对由反馈控制器112计算出的反馈转矩τB和由前馈控制部111计算出的模型转矩τa进行加法运算,计算转矩指令τM。然后,转矩加法器113对电流控制器4输出转矩指令τM。由此,驱动处于控制对象1中的马达1a,使马达动作检测值pM追踪动作目标值pref,使控制对象1进行期望的动作。
接下来,详细说明阻尼滤波器121的动作(模型位置pa、模型速度va、模型转矩τa的运算方法)。在本实施方式中,如图2所示,将控制对象1的特性(机械位置特性、机械速度特性)设为用马达1a经由弹簧(能够振动要素)1b驱动机械负载1c的二惯性系统模型来表示的特性而进行说明。另外,在本实施方式中,设为弹簧1b的弹簧常数在动作中发生变化。图2的二惯性系统模型的运动方程式能够用式(3)、(4)来表示。
JM×p(2) M=-km×(pM-pL)+τM…(3)
JL×p(2) L=km×(pM-pL)…(4)
在式(3)、(4)中,pM表示马达位置(例如,马达1a内的转子的旋转位置或者可动元件的驱动位置)、vM表示马达速度(例如,马达1a内的转子的旋转速度或者可动元件的驱动速度)、pL表示机械位置(机械负载1c的位置)、JM表示马达1a的惯性力矩、JL表示机械负载1c的惯性力矩、τM表示马达转矩(例如,对马达1a内的转子或者可动元件作用的转矩)、km表示弹簧常数。另外,在以后的说明中,还使用定义为vM:=P(1) M的马达速度、定义为vL:=P(1) L的机械速度。另外,在式(3)、(4)和图1中,马达位置相当于马达动作检测值、马达速度相当于马达速度运算值、马达转矩相当于转矩指令。因此,在本实施方式中,关于马达位置和马达动作检测值、马达速度和马达速度运算值、马达转矩和转矩指令,使用相同的记号来表示,分别设为pM、vM、τM。另外,在本实施方式中,弹簧常数km并非固定值而是在动作中发生变化,与其对应地用式(5)、(6)表示的二惯性系统模型的共振频率ωp、反共振频率ωz也在动作中发生变化。
作为能够用在动作中变化的二惯性系统对这样的弹簧常数km进行模型化的机械装置,例如,可以举出图3(a)所示那样的z轴臂1b1的臂长度变化的正交2轴(x-y)机器手、图4所示那样的绳缆1b2的绳缆长度发生变化的起重机等。
在图3(a)所示的正交2轴(x-y)机器手中,通过x轴马达1a1以及z轴马达1a11,分别驱动2个臂即x轴臂1d1以及z轴臂1b1。如果在x轴方向上驱动x轴臂1d1,则z轴臂1b1整体向x轴方向移动。另外,成为如果驱动z轴臂1b1,则负载1c1在z轴方向移动的结构。在这样的正交2轴机器手中,如果在x轴方向对负载1c1进行高速驱动,则发生振动。表示该振动特性的图是图3(b)、(c)的波特图。如果观察图3(b)、(c)的波特图,则可知在z轴臂1b1短的情况和长的情况这两方的情况下,有增益特性成为峰值的共振特性、和增益特性成为谷值的反共振特性。已熟知的是使用用式(3)、(4)表示的二惯性系统模型来表示这样的共振特性、反共振特性。另外,在图3(b)、(c)的波特图中,用虚线来表示z轴臂1b1的长度短的情况下的x轴方向的增益特性,用实线来表示z轴臂1b1的长度长的情况下的x轴方向的增益特性。
另外,在正交2轴机器手的情况下,如图3(b)、(c)的波特图所示,在x轴方向驱动了负载1c1时的振动频率依赖于z轴方向的臂长度。在图3(b)、(c)所示那样的特性的情况下,在z轴臂1b1的臂长度长的情况下,在x轴方向进行了驱动时的负载1c1所致的振动频率低,而在z轴臂1b1的臂长度短的情况下,在x轴方向进行了驱动时的负载1c1所致的振动频率高。即,在使x轴臂1d1以及z轴臂1b1这两方同时驱动的情况下,负载1c1所致的振动特性(共振、反共振特性)随着时间发生变化。在这样共振、反共振特性随着时间变化的情况下,能够使用用式(3)、(4)表示的弹簧常数km随着时间变化的二惯性系统模型来表示正交2轴机器手的特性。
在图4中表示的绳缆长发生变化的起重机的情况下,通过马达1a2驱动滑块1d2,从而经由绳缆1b2,负载1c2在水平方向移动,通过绳缆1b2的卷上、卷下,负载1c2在垂直方向移动。在该情况下,利用滑块1d2的水平方向的驱动对应于上述正交2轴机器手中的x轴臂1d1的驱动,绳缆1b2的卷上以及卷下对应于z轴臂1b1的驱动。即,驱动了滑块1d2时的负载1c2的振动频率根据绳缆1b2的长度而不同。这样,振动频率根据绳缆1b2的长度而不同,但即使在该情况下,也能够使用用式(3)、(4)表示的弹簧常数km随着时间变化的二惯性系统模型来表示。
另外,此处说明的情况是控制对象1的一个例子,只要能够用图2所示的二惯性系统模型来表示,则可以是任意的控制对象。另外,控制对象1的运动方程式、或者动态特性不限于用式(3)、(4)表示的例子。
接下来,使用图5,说明前馈控制部111的内部结构的详细内容。图5是示出前馈控制部111的内部结构的框图。
阻尼参数决定部122具有生成部122a。生成部122a接收表示与控制对象1的振动特性关联的控制对象1的当前状态的参数变更信号(状态信息)ML。参数变更信号ML例如包括与图3所示的臂长度发生变化的正交2轴(x-y)机器手中的z轴马达1a11的旋转位置对应(决定负载的位置)的z轴臂1b1的长度(臂长度)。或者,参数变更信号ML例如包括图4所示的起重机中的绳缆1b2的长度(绳缆长)。生成部122a根据参数变更信号ML,生成表示控制对象1的(当前的)振动特性的阻尼参数(第1参数)θ并输出到阻尼参数滤波器123以及阻尼滤波器121。阻尼参数信号θ例如包括共振频率ωp、反共振频率ωz。阻尼参数信号θ也可以还包括负载惯性力矩、弹簧常数km、绳缆长度等。
阻尼参数决定部122也可以还具有存储部122b。存储部122b存储将参数变更信号ML的多个值和阻尼参数信号θ的多个值对应起来的共振·反共振表格122b1。例如,也可以预先实验性地求出参数变更信号ML的多个值和阻尼参数信号θ的多个值的对应,并作为共振·反共振表格122b1预先存储到存储部122b。共振·反共振表格122b1是例如如图6所示,将多个参数变更信号(臂长度)ML和多个共振频率ωp以及多个反共振频率ωz对应起来的表格。在该情况下,生成部122a通过逐次参照存储部122b所存储的共振·反共振表格122b1,决定并生成与从检测部3(参照图1)接收到的参数变更信号(臂长度)ML对应的阻尼参数信号θ即共振频率ωp、反共振频率ωz。
另外,存储部122b也可以代替共振·反共振表格122b1,而存储表示参数变更信号ML的值与阻尼参数信号θ的值之间的关系的函数。在该情况下,生成部122a通过逐次参照存储部122b所存储的函数,决定并生成与从检测部3(参照图1)接收的参数变更信号(臂长度)ML对应的阻尼参数信号θ即共振频率ωp、反共振频率ωz。
阻尼参数滤波器(第1运算部)123从阻尼参数决定部122接收阻尼参数信号θ即共振频率ωp、反共振频率ωz。阻尼参数滤波器123运算与阻尼参数信号θ的时间变化量相应的阻尼参数变量信号(第2参数)θ’。阻尼参数变量信号θ’是以与阻尼参数信号θ的时间变化量相当的方式被运算出的量,表示控制对象1的振动特性变化。例如,关于阻尼参数变量信号θ’,针对阻尼参数信号θ使用微分、差分、微分+平均滤波器、高通滤波器等来运算。另外,在通过共振·反共振表格122b1存储了阻尼参数信号θ的情况下,也可以预先计算阻尼参数信号θ的变量量,根据所计算出的变量量与参数变更信号ML的时间微分之积来求出阻尼参数变量信号θ’。
例如,阻尼参数滤波器123具有微分器123a以及微分器123b。微分器123a从生成部122a接收共振频率ωp、反共振频率ωz。微分器123a针对共振频率ωp、反共振频率ωz在时间上进行1阶微分,将其结果作为微分值ω(1) p、ω(1) z输出到微分器123b以及阻尼滤波器121。微分器123b从微分器123a接收微分值ω(1) p、ω(1) z,对微分值ω(1) p进一步在时间上进行1阶微分,将其结果作为2阶微分值ω(2) p输出到阻尼滤波器121。
阻尼滤波器121(第2运算部)具有位置运算部121a、速度运算部121b、以及转矩运算部121c。
位置运算部121a具有模型位置运算部141。模型位置运算部141从外部接收动作目标值pref,从阻尼参数决定部122接收反共振频率ωz。模型位置运算部141使用动作目标值pref和反共振频率ωz,如后述公式(8)所示,运算模型位置pa并输出到反馈控制部112(参照图1)。
速度运算部121b具有模型速度运算部142。模型速度运算部142从外部接收动作目标值pref,从阻尼参数决定部122的生成部122a接收反共振频率ωz,从阻尼参数滤波器123的微分器123a接收反共振频率的1阶微分值ω(1) z。模型速度运算部142使用动作目标值pref、反共振频率ωz、以及反共振频率的1阶微分值ω(1) z,如后述公式(10)所示,运算模型速度va并输出到反馈控制部112(参照图1)。
转矩运算部121c具有模型加速度运算部143以及惯性力矩乘法部144。
模型加速度运算部143从外部接收动作目标值pref,从阻尼参数决定部122的生成部122a接收共振频率ωp。另外,模型加速度运算部143从阻尼参数滤波器123的微分器123a接收共振频率的1阶微分值ω(1) p,从阻尼参数滤波器123的微分器123b接收共振频率的2阶微分值ω(2) p。模型加速度运算部143使用动作目标值pref、共振频率ωp、共振频率的1阶微分值ω(1) p、以及共振频率的2阶微分值ω(2) p,如后述公式(13)所示,运算模型加速度aa并输出到惯性力矩乘法部144。
惯性力矩乘法部144从模型加速度运算部143接收模型加速度aa。惯性力矩乘法部144使用模型加速度aa,如后述公式(14)所示,运算模型转矩τa并输出到转矩加法器113(参照图1)。
另外,共振频率ωp、反共振频率ωz相当于图1的阻尼参数θ,共振频率的1阶微分值ω(1) p、2阶微分值ω(2) p、反共振频率的1阶微分值ω(1) z相当于图1的阻尼参数变量信号θ’。
接下来,说明阻尼滤波器121内部的具体的动作。
阻尼滤波器121的模型位置运算部141使用反共振频率ωz(阻尼参数信号θ)和动作目标值pref,运算以使机械位置pL与动作目标值pref一致的方式使马达1a动作了时的马达位置pM,将其运算结果作为模型位置pa输出到反馈控制部112(参照图1)。通过使马达动作检测值pM与这样运算的模型位置pa一致,即使针对在动作中共振·反共振频率发生变化的控制对象1也能够使控制对象1的机械位置与动作目标值pref一致,其结果能够抑制振动。另外,以稳定地与动作目标值pref一致的方式计算模型位置pa,所以马达动作检测值pM也易于追踪动作目标值pref。在详细说明用二惯性系统模型表示了从马达转矩τM至机械位置pL的特性的情况时,关于使机械位置pL与动作目标值pref一致了时的马达位置pM,能够根据式(4)、(6)运算为
1/ωz 2×p(2) ref+pref=pM…(7)
因此,模型位置运算部141使用下述式(8)来运算模型位置pa。即,模型位置pa为对动作目标值的2阶微分值p(2) ref乘以反共振频率ωz的平方分之一而得到的值与动作目标值pref之和。
pa=1/ωz 2×p(2) ref+pref…(8)
总之,模型位置运算部141使用动作目标值pref和与阻尼参数θ相当的反共振频率ωz,通过式(8)运算模型位置pa,将运算出的模型位置pa输出到反馈控制部112。
阻尼滤波器121的模型速度运算部142使用反共振频率ωz(阻尼参数信号θ)和其1阶微分值ω(1) z(阻尼参数变量信号θ’),通过式(4),运算机械速度vL与动作目标值的1阶微分值p(1) ref一致了时的马达速度vM,将其运算结果作为模型速度va输出到反馈控制部112。通过使马达速度运算值vM追踪这样运算的模型速度va,即使针对在动作中共振·反共振频率发生变化的控制对象1,也能够使控制对象1中的机械速度(机械负载1c的移动速度)无偏差地追踪动作目标值的1阶微分值p(1) ref。在实际上使用公式来说明时,关于机械速度vL与动作目标值的1阶微分值p(1) ref一致了时的马达速度vM,考虑反共振频率ωz也随着时间变化,针对式(7)的两边关于时间进行微分,从而求出为
1/ωz 2×p(3) ref+p(1) ref-2×ω(1) z/ωz 3×p(2) ref
=p(1) M
=vM…(9)
因此,模型速度运算部142使用下述式(10)来运算模型速度va。然后,将运算出的模型速度va输出到反馈控制部112。即,模型速度运算部142将对动作目标值的3阶微分值p(3) ref乘以反共振频率ωz的平方分之一而得到的值、与对动作目标值的2阶微分值p(2) ref和反共振频率的1阶微分值ω(1) z之积的2倍的值乘以反共振频率ωz的三次方之一而得到的值之差,加上动作目标值的1阶微分p(1) ref,将由此得到值作为模型速度va输出到反馈控制部112。
va=1/ωz 2×p(3) ref+p(1) ref
-2×ω(1) z/ωz 3×p(2) ref…(10)
在公式(10)中,ωz是从阻尼参数决定部122得到的值。ω(1) z是阻尼参数滤波器123从阻尼参数决定部122取得ωz并进行微分或者差分等运算而输出到阻尼滤波器121的值。根据式(10)可知,在共振频率变动的控制对象1中,为了以使机械速度vL与动作目标值的1阶微分值p(1) ref一致的方式运算与马达速度vM相当的模型速度va,不仅是反共振频率ωz,而且反共振频率的1阶微分值ω(1) z也是必要的信息。
模型加速度运算部143和惯性力矩乘法部144使用共振频率ωp(阻尼参数信号θ)、和其1阶微分值ω(1) p、2阶微分值ω(2) p(阻尼参数变量信号θ’),以使从动作目标值pref至模型转矩τa为止的特性成为从马达转矩τM至机械位置pL为止的特性的逆特性的方式,运算模型转矩τa。惯性力矩乘法部144将运算出的模型转矩τa输出到转矩加法器113。
通过这样运算模型转矩τa,只要无摩擦、模型误差等干扰,就能够使控制对象1的机械位置无偏差地追踪动作目标值pref。其结果,还能够抑制振动。接下来,使用公式来说明模型加速度运算部143和惯性力矩乘法部144的动作。
首先,针对式(4)的两边,还考虑共振频率ωp也随着时间变化,关于时间,进行1阶、2阶微分的计算。然后,当将所计算出的式子和式(4)自身代入式(3),来求出从马达转矩τM至机械位置pL为止的动态特性时,成为式(11)。
1/ωp 2×p(4) L-4×ω(1) p/ωp 3×p(3) L
+(-2×ω(2) p/ωp 2+6×(ω(1) p)2/ωp 4)×p(2) L
+p(2) L
=1/(JM+JL)×τM…(11)
根据式(11)可知,在共振频率ωp发生变动的控制对象1中,其动态特性不仅受共振频率ωp的影响,而且还受共振频率的1阶微分值ω(1) p、2阶微分值ω(2) p的影响,所以为了完全补偿控制对象1的动态特性,不仅是共振频率ωp,而且共振频率的1阶微分值ω(1) p、2阶微分值ω(2) p也是必要的信息。而且,如果使从动作目标值pref至模型转矩τa为止的特性成为从马达转矩τM至机械位置pL为止的特性的逆特性,则能够使控制对象的机械位置无偏差地追踪动作目标值pref,并且从马达转矩τM至机械位置pL,动态特性成为式(11),所以以成为式(12)的方式,运算模型转矩τa。
τa=(JM+JL)
×{1/ωp 2×p(4) ref-4×ωp (1)/ωp 3×p(3) ref
+(-2×ω(2) p/ωp 2+6×(ω(1) p)2/ωp 4)×p(2) ref
+p(2) ref}…(12)
因此,模型加速度运算部143使用动作目标值pref、共振频率ωp、以及其1阶微分值ω(1) p、2阶微分值ω(2) p,通过下述式(13)运算模型加速度aa。模型加速度运算部143将运算出的模型加速度aa输出到惯性力矩乘法部144。惯性力矩乘法部144使用模型加速度aa,通过下述式(14)运算模型转矩τa。惯性力矩乘法部144将运算出的模型转矩τa输出到转矩加法器113。
aa=1/ωp 2×p(4) ref-4×ωp (1)/ωp 3×p(3) ref+(-2×ω(2) p/ωp 2+6×(ω(1) p)2/ωp 4)×p(2) ref+p(2) ref…(13)
τa=(JM+JL)×aa…(14)
在式(13)中,ωp是从阻尼参数决定部122得到的阻尼参数信号θ。ω(1) p、ω(2) p是阻尼参数滤波器123从阻尼参数决定部122得到ωp并运算而输出到阻尼滤波器121的阻尼参数变量信号θ’。
这样,通过模型加速度运算部143使用式(13),惯性力矩乘法部144使用式(14),运算模型转矩τa,在无摩擦、模型误差等干扰的情况下,能够使机械位置pL无偏差地追踪动作目标值pref。
如以上那样,在实施方式1中,在马达控制装置100中,根据控制对象1的振动特性变化,阻尼参数决定部122和阻尼参数滤波器123使前馈控制部111的特性变化。即,阻尼参数决定部122的生成部122a根据表示与控制对象1的振动特性关联的控制对象1的(当前的)状态的参数变更信号ML,生成表示控制对象1的振动特性的阻尼参数信号θ。阻尼参数滤波器123运算与由生成部122a生成的阻尼参数信号θ的时间变化量相应的阻尼参数变量信号θ’。阻尼滤波器121使用动作目标值pref、阻尼参数信号θ、以及阻尼参数变量信号θ’,以使控制对象1不激发振动的方式,运算模型转矩τa。即,阻尼参数信号θ包含控制对象1的振动频率,阻尼参数变量信号θ’包含控制对象1的振动频率的时间变化量。这样,不仅使用阻尼参数信号(振动频率),而且还使用阻尼参数变量信号(振动频率的时间变化量)来运算模型转矩τa,所以能够不仅考虑振动特性而且还考虑振动特性的变化率来进行前馈控制。由此,即使针对在动作中振动特性发生变化的控制对象也能够实现振动抑制控制中的高响应化·低振动化。即,能够进一步提高使在动作中振动特性发生变化的控制对象1动作时的振动抑制效果。
另外,在实施方式1中,阻尼滤波器121使用动作目标值pref、阻尼参数信号θ、以及阻尼参数变量信号θ’,以使控制对象1不振动的方式,运算模型速度va。速度控制器132以使控制对象1的速度追踪由阻尼滤波器121运算出的模型速度va的方式,发生反馈转矩τB。由此,即使在针对动作中的振动特性发生变化的控制对象1施加干扰的状况下,也能够得到高的振动抑制效果。
进而,在实施方式1中,阻尼滤波器121使用动作目标值pref、阻尼参数信号θ、以及阻尼参数变量信号θ’,以使控制对象1不激发振动的方式,运算模型位置pa。位置控制器131以使控制对象1的位置追踪由阻尼滤波器121运算出的模型位置pa的方式,发生反馈转矩τB。由此,即使在针对动作中的振动特性发生变化的控制对象1施加干扰的状况下,也能够得到高的振动抑制效果。
进而,在实施方式1中,由于在阻尼滤波器121的运算中使用的阻尼参数θ(振动频率)是能够根据(由检测器3检测出的)控制对象1的特性简单地运算或者决定的参数,所以无需在决定阻尼滤波器121的系数(即,阻尼参数θ)时反复进行仿真,能够简单地在短时间内进行阻尼参数θ的决定。
例如,阻尼参数决定部122的存储部122b存储将参数变更信号ML的多个值和阻尼参数信号θ的多个值对应起来的共振·反共振表格122b1。生成部122a通过参照存储部122b中存储的共振·反共振表格122b1,生成与所接收的参数变更信号ML对应的阻尼参数信号θ。由此,易于简单地在短时间内进行阻尼参数θ的决定。
或者,例如,阻尼参数决定部122的存储部122b存储表示参数变更信号ML的值与阻尼参数信号θ的值之间的关系的函数。生成部122a通过参照存储部122b中存储的函数,生成与所接收的参数变更信号ML对应的阻尼参数信号θ。由此,易于简单地在短时间内进行阻尼参数θ的决定。
另外,在实施方式1中,通过阻尼参数滤波器123进行阻尼参数信号θ的1阶微分以及2阶微分,运算阻尼参数变量信号θ’。由此,能够简易地在短时间内运算阻尼参数变量信号θ’。
另外,在实施方式1中,在控制对象1是图3所示的正交2轴(x-y)机器手的情况下,控制对象1包括多个马达即x轴马达1a1以及z轴马达1a11。阻尼参数决定部122的生成部122a接收的参数变更信号ML包括与多个马达(x轴马达1a1以及z轴马达1a11)中的未由马达控制装置100控制的z轴马达1a11的位置(旋转位置)相应的z轴臂(能够振动要素)1b1的状态(臂长度)。由此,即使在控制具有多个马达的控制对象中的1个马达的过程中,控制对象的振动频率根据其他马达的位置而发生变化的情况下,也能够提高使控制对象1动作时的振动抑制中的精度。
另外,在实施方式1中,阻尼滤波器121以使从动作目标值pref至模型转矩τa为止的特性成为从转矩指令(马达转矩)τM至控制对象1的位置为止的特性的逆特性的方式,运算模型转矩τa。由此,能够使控制对象1的机械位置无偏差地追踪动作目标值pref。
另外,在实施方式1中,阻尼滤波器121运算控制对象1的速度追踪与动作目标值pref相应的速度时的马达速度vM而作为模型速度va。由此,能够使控制对象1的速度无偏差地追踪模型速度va。
另外,在实施方式1中,阻尼滤波器121推测控制对象1的位置追踪与动作目标值pref相应的位置时的马达位置pM并运算为模型位置pa。由此,能够使控制对象1的机械位置无偏差地追踪动作目标值pref。
另外,在本实施方式中,作为控制对象1,使用了弹簧常数可变的二惯性系统模型,但本实施方式还能够应用于其以外的控制对象。例如,也可以是惯性力矩在动作中变化的控制对象、存在阻尼等的衰减的控制对象。
另外,在本实施方式中,逐次变更了共振频率、反共振频率和它们的微分,但也可以从表格等中参照弹簧常数,并根据其值计算共振频率、反共振频率并输出到阻尼滤波器121。
另外,在本实施方式中,从马达控制装置100的外部(即检测器3)接收参数变更信号ML,并与其对应地变更了阻尼参数信号θ、阻尼参数变量信号θ’,但马达控制装置100也可以从外部接收阻尼参数信号θ。在该情况下,马达控制装置100也可以根据所接收的阻尼参数信号θ,计算阻尼参数变量信号θ’。或者,马达控制装置100也可以从外部接收阻尼参数信号θ和阻尼参数变量信号θ’这两方。
另外,在本实施方式中,设为位置控制器131进行P控制、速度控制器132进行PI控制和滤波的结构,但它们也可以是PID控制、H∞控制、μ控制、自适应控制、滑动模式控制那样的控制器。
实施方式2.
接下来,说明实施方式2的马达控制装置200。以下,以与实施方式1不同的点为中心而进行说明。
本实施方式的马达控制装置200与实施方式1的马达控制装置100的差异在于,阻尼滤波器中的处理内容(模型位置、模型速度、模型转矩的运算方法)。即,在共振频率ωp和反共振频率ωz大致相等的(ωp≈ωz)情况下,生成从动作目标值pref去掉了与阻尼参数信号θ对应的频率分量的动作补偿信号(模型位置pa),进行所生成的动作补偿信号的1阶微分、2阶微分来运算模型速度va、模型转矩τa。
具体而言,马达控制装置200具备图7所示那样的前馈控制部211。图7是示出实施方式2中的前馈控制部211的内部结构的框图。
前馈控制部211不具有阻尼参数滤波器123,而具有阻尼参数决定部222以及阻尼滤波器221。
阻尼参数决定部222具有生成部222a。生成部222a根据参数变更信号ML,将反共振频率ωz作为参数变更信号θ输出到阻尼滤波器221,但不输出共振频率ωp。在该情况下,也可以在阻尼参数决定部222的存储部122b中,存储共振·反共振表格122b1中的共振频率栏被省略了的结构的表格(反共振表格)。
阻尼滤波器221具有补偿信号生成部(第2生成部)221a、变化量运算部(第1运算部)221b、以及转矩运算部(第2运算部)221c。
补偿信号生成部221a生成从动作目标值pref去掉了与参数变更信号θ(反共振频率ωz)对应的频率分量的动作补偿信号(模型位置pa)。
具体而言,补偿信号生成部221a具有模型位置运算部241。模型位置运算部241从外部接收动作目标值pref,从阻尼参数决定部222的生成部222a接收与阻尼参数信号θ相当的反共振频率ωz。模型位置运算部241通过式(8),从动作目标值pref去掉与反共振频率ωz对应的分量,将去掉后的信号作为模型位置pa输出到反馈控制部112以及变化量运算部221b。
变化量运算部221b运算对由补偿信号生成部221a生成的动作补偿信号(模型位置pa)在时间上进行1、2阶微分而得的值,作为与阻尼参数信号θ的时间变化量相应的参数(第2参数)。
具体而言,变化量运算部221b具有模型位置微分器245以及模型速度微分器246。模型位置微分器245从模型位置运算部241接收动作补偿信号(模型位置pa),运算其1阶微分值p(1) a。此时,模型位置微分器245如式(7)~式(10)所示,对由补偿信号生成部221a生成的动作补偿信号(模型位置pa)在时间上进行1阶微分,从而以使控制对象1不激发振动的方式,运算模型速度va。模型位置微分器245将运算出的结果作为模型速度va输出到反馈控制部112以及模型速度微分器246。
模型速度微分器246从模型位置微分器245接收模型速度va,运算其1阶微分值v(1) a。模型速度微分器246将其运算结果作为对动作补偿信号(模型位置pa)在时间上进行2阶微分而得到的值,输出到转矩运算部221c。
转矩运算部221c根据动作目标值pref、阻尼参数(第1参数)θ、以及动作补偿信号的2阶微分值(第2参数)v(1) a,以使控制对象1不激发振动的方式,运算模型转矩τa。
具体而言,转矩运算部221c具有惯性力矩乘法部244。惯性力矩乘法部244从模型速度微分器246接收动作补偿信号的2阶微分值(模型速度的1阶微分值v(1) a)。动作补偿信号的2阶微分值如后述式(15)所示,包括动作目标值pref和阻尼参数θ(反共振频率ωz)。即,惯性力矩乘法部244对包括动作目标值pref和阻尼参数(第1参数)θ的动作补偿信号的2阶微分值v(1) a,应用共振频率ωp和反共振频率ωz相同(ωp=ωz)这样的关系,进而乘以惯性力矩(JM+JL),从而求出模型转矩τa。惯性力矩乘法部244将所求出的模型转矩τa输出到转矩加法器113。
接下来,使用图7来说明阻尼滤波器221的具体的动作。
模型位置运算部241根据从外部输入的动作目标值pref和从阻尼参数决定部122输入的反共振频率ωz,通过式(8),运算从动作目标值pref去掉了与反共振频率ωz对应的分量的模型位置pa。然后,模型位置运算部241将运算出的模型位置pa输出到模型位置微分器245以及反馈控制器112。
模型位置微分器245接收模型位置pa,运算其1阶微分值,将运算出的结果作为模型速度va输出到模型速度微分器246以及反馈控制器112。即,模型位置微分器245通过对模型位置pa的1阶微分进行直接运算,求出与用式(10)表示的模型速度va等同的信号并输出到模型速度微分器246以及反馈控制器112。
模型速度微分器246从模型位置微分器245接收模型速度va,运算模型速度的1阶微分值v(1) a,将其运算结果输出到惯性力矩乘法部244。即,模型速度微分器246通过对模型速度va的1阶微分进行直接运算,求出与下述式(15)等同的信号并输出到惯性力矩乘法部244。
v(1) a=1/ωz 2×p(4) ref-4×ωz (1)/ωz 3×p(3) ref
+(-2×ω(2) z/ωz 3+6×(ω(1) z)2/ωz 4)×p(2) ref
+p(2) ref…(15)
惯性力矩乘法部244对模型速度微分器246的输出v(1) a乘以惯性力矩(JM+JL),将其积作为模型转矩τa输出到转矩加法器113。
即,在共振频率ωp与反共振频率ωz大致相等的(ωp≈ωz)情况下,惯性力矩乘法部244的输出与在使用实施方式1的式(12)来运算的模型转矩τa中使共振频率ωp和反共振频率ωz成为相同(ωp=ωz)的情况的模型转矩τa一致。这样,在共振频率ωp和反共振频率ωz大致相等的(ωp≈ωz)情况下,关于实施方式1的阻尼滤波器121输出的模型位置pa、模型速度va、模型转矩τa、和本实施方式的阻尼滤波器221输出的模型位置pa、模型速度va、模型转矩τa,仅其运算方法不同,作为值相同。因此,阻尼滤波器221针对如图3所示的正交2轴机器手那样共振频率ωp和反共振频率ωz接近的(ωp≈ωz)控制对象,能够通过简单的运算得到与实施方式1等同的效果。
在阻尼滤波器221中,不利用反共振频率ωz的1阶微分ω(1) z、2阶微分ω(2) z而能得到与实施方式1等同的效果的主要原因在于,对从动作目标值pref利用反共振频率ωz来去掉与反共振频率ωz对应的分量之后的信号即模型位置pa进行微分的构造(运算顺序)。通过模型位置微分器245对从动作目标值pref去掉与反共振频率ωz对应的分量之后的信号即模型位置pa进行1阶微分,运算与实施方式1中的阻尼参数变量信号θ’相当的反共振频率的1阶微分值ω(1) z并进行补偿。同样地,通过模型速度微分器246对模型速度va进行1阶微分来求出模型位置pa的2阶微分值,由此运算与实施方式1中的阻尼参数变量信号θ’相当的反共振频率的2阶微分值ω(2) z并进行补偿。这样,在阻尼滤波器221中,由于是在阻尼滤波器121的内部运算与阻尼参数变量信号θ’相当的反共振频率的微分ω(1) z、2阶微分ω(2) z的结构,所以即使不利用阻尼参数变量信号θ’自身仍能得到与实施方式1的阻尼滤波器121等同的效果。
如以上那样,根据实施方式2,在控制对象1的共振频率ωp和反共振频率ωz大致相等的(ωp≈ωz)情况下,能够不利用(生成)阻尼参数变量信号θ自身,而利用(生成)与阻尼参数变量信号θ相当的参数(动作补偿信号的1阶微分值、2阶微分值),来运算与实施方式1等同的模型速度va、模型转矩τa。
实施方式3.
接下来,说明实施方式3的马达控制装置300。以下,以与实施方式1不同的点为中心而进行说明。
本实施方式的马达控制装置300与实施方式1的马达控制装置100的差异在于,阻尼滤波器中的处理内容(模型位置、模型速度、模型转矩的运算方法)。即,即使在控制对象1的共振频率ωp、反共振频率ωz不同的情况下,仍生成从动作目标值pref去掉了与阻尼参数信号θ对应的频率分量的动作补偿信号(模型位置pa、共振频率补偿信号pcp),进行所生成的动作补偿信号(模型位置pa)的1阶微分来运算模型速度va,并且进行动作补偿信号(共振频率补偿信号pcp)的2阶微分来运算模型转矩τa。
具体而言,马达控制装置300具备图8所示那样的前馈控制部311。图8是示出实施方式3中的前馈控制部311的内部结构的框图。
前馈控制部311不具有阻尼参数滤波器123,而具有阻尼参数决定部322以及阻尼滤波器321。
阻尼参数决定部322具有生成部322a。生成部322a根据参数变更信号ML,将共振频率ωp以及反共振频率ωz作为参数变更信号θ输出到阻尼滤波器321。
阻尼滤波器321具有补偿信号生成部(第2生成部)321a、速度运算部321d、变化量运算部(第1运算部)321b、以及转矩运算部(第2运算部)321c。
补偿信号生成部321a生成从动作目标值pref去掉了与参数变更信号θ(共振频率ωp)对应的频率分量的动作补偿信号(共振频率补偿信号pcp)。
具体而言,补偿信号生成部321a具有模型位置运算部341以及共振补偿信号运算部347。模型位置运算部341从外部接收动作目标值pref,从阻尼参数决定部322的生成部322a接收与阻尼参数信号θ相当的反共振频率ωz。模型位置运算部341通过式(8),从动作目标值pref去掉与反共振频率ωz对应的分量,将去掉后的信号作为模型位置pa输出到反馈控制部112以及速度运算部321d。
共振补偿信号运算部347从外部接收动作目标值pref,从阻尼参数决定部322的生成部322a接收与阻尼参数信号θ相当的共振频率ωp。共振补偿信号运算部347通过后述式(16),从动作目标值pref去掉与共振频率ωp对应的分量,将去掉后的信号作为共振补偿信号pcp输出到变化量运算部321b。
速度运算部321d具有模型位置微分器345。模型位置微分器345从模型位置运算部341接收从动作目标值pref去掉了反共振频率分量的信号即模型位置pa。模型位置微分器345运算模型位置的1阶微分值p(1) a,将运算出的结果作为模型速度va输出到反馈控制部112。
变化量运算部321b运算对由补偿信号生成部321a生成的动作补偿信号(共振频率补偿信号pcp)在时间上进行了2阶微分而得的值,作为与阻尼参数信号θ的时间变化量相应的参数(第2参数)。
具体而言,变化量运算部321b具有共振补偿信号微分器348以及共振补偿信号2阶微分器349。共振补偿信号微分器348从共振补偿信号运算部347接收共振补偿信号pcp,运算其1阶微分值p(1) cp,将运算结果输出到共振补偿信号2阶微分器349。
共振补偿信号2阶微分器349从共振补偿信号微分器348接收共振补偿信号的1阶微分值p(1) cp,运算其1阶微分值p(2) cp。共振补偿信号2阶微分器349将其运算结果作为对动作补偿信号(共振补偿信号pcp)在时间上进行2阶微分而得到的值输出到转矩运算部321c。
转矩运算部321c根据动作目标值pref、阻尼参数(第1参数)θ、以及动作补偿信号的2阶微分值(第2参数)p(2) cp,以使控制对象1不激发振动的方式,运算模型转矩τa。
具体而言,转矩运算部321c具有惯性力矩乘法部344。惯性力矩乘法部344从共振补偿信号2阶微分器349接收动作补偿信号的2阶微分值(共振补偿信号的2阶微分值p(2) cp)。动作补偿信号的2阶微分值如后述式(18)所示,包括动作目标值pref和阻尼参数θ(共振频率ωp)。即,惯性力矩乘法部344通过对包括动作目标值pref和阻尼参数(第1参数)θ的动作补偿信号的2阶微分值p(2) cp乘以惯性力矩(JM+JL),求出模型转矩τa。惯性力矩乘法部344将所求出的模型转矩τa输出到转矩加法器113。
接下来,使用图8来说明阻尼滤波器321的具体的动作。
模型位置运算部341根据从外部输入的动作目标值pref和从阻尼参数决定部322输入的反共振频率ωz,通过式(8)计算从动作目标值pref去掉了与反共振频率ωz对应的分量的模型位置pa。然后,模型位置运算部341将运算出的模型位置pa输出到模型位置微分器345以及反馈控制器112。
模型位置微分器345接收模型位置pa,运算其1阶微分值p(1) a,将运算出的结果作为模型速度va输出到反馈控制部112。因此,由阻尼滤波器321运算的模型位置pa以及模型速度va分别通过式(8)以及式(10)来表示。
另一方面,共振补偿信号运算部347从外部接收动作目标值pref,从阻尼参数决定部322接收与阻尼参数信号θ相当的共振频率ωp,通过下述式(16)的运算从动作目标值pref去掉共振频率分量,将运算出的结果作为共振补偿信号pcp输出到共振补偿信号微分器348。
pcp=1/ωp 2×p(2) ref+pref…(16)
共振补偿信号微分器348从共振补偿信号运算部347接收共振补偿信号pcp,运算其1阶微分值p(1) cp,将运算出的结果输出到共振补偿信号2阶微分器349。即,共振补偿信号微分器348的输出与用式(17)表示的信号等价。
p(1) cp=1/ωp 2×p(3) ref-2×ω(1) p/ωp 3×p(2) ref
+p(1) ref…(17)
共振补偿信号2阶微分器349通过从共振补偿信号微分器348接收共振补偿信号的1阶微分值p(1) cp,对共振补偿信号的微分进行微分,来运算共振补偿信号的2阶微分p(2) cp,并将运算出的结果输出到惯性力矩乘法部344。即,共振补偿信号2阶微分器349的输出与用式(18)表示的信号等价。
p(2) cp=1/ωp 2×p(4) ref-4×ωp (1)/ωp 3×p(3) ref
+(-2×ω(2) p/ωp 3+6×(ω(1) p)2/ωp 4)×p(2) ref
+p(2) ref…(18)
惯性力矩乘法器344对共振补偿信号2阶微分器349的输出即共振补偿信号的2阶微分值p(2) cp乘以惯性力矩(JM+JL),将其积作为模型转矩τa输出到转矩加法器113。即,惯性力矩乘法器344将与式(12)等同的信号输出到转矩加法器113。这样,关于实施方式1的阻尼滤波器321输出的模型位置pa、模型速度va、模型转矩τa、和本实施方式的阻尼滤波器321输出的模型位置pa、模型速度va、模型转矩τa,仅其运算方法不同,作为值相同。因此,阻尼滤波器321不论对于共振频率ωp和反共振频率ωz接近的(ωp≈ωz)控制对象,还是对共振频率ωp和反共振频率ωz不同的(ωp≠ωz)控制对象,都能够通过简单的运算得到与实施方式1等同的效果。
在阻尼滤波器321中,不利用共振频率ωp的1阶微分ω(1) p、2阶微分ω(2) p而能得出与实施方式1等同的效果的主要原因在于,成为通过对去掉了与共振频率ωp对应的分量之后的信号即共振补偿信号ω(1) p进行微分,由阻尼滤波器321自身运算与实施方式1中的阻尼参数变量信号θ’相当的共振频率的1阶微分值ω(1) p、2阶微分值ω(2) p的结构。
如以上那样,根据实施方式3,不论在控制对象1的共振频率ωp和反共振频率ωz大致相等的(ωp≈ωz)情况下,还是在控制对象1的共振频率ωp和反共振频率ωz不同的(ωp≠ωz)情况下,都能够不利用(生成)阻尼参数变量信号θ’自身,而利用(生成)与阻尼参数变量信号θ’相当的参数(动作补偿信号的1阶微分值、2阶微分值),来运算与实施方式1等同的模型速度va、模型转矩τa。
实施方式4.
接下来,说明实施方式4的马达控制装置400。以下,以与实施方式1不同的点为中心而进行说明。
本实施方式的马达控制装置400与实施方式1的马达控制装置100的差异在于,阻尼滤波器中的处理内容(模型位置、模型速度、模型转矩的运算方法)。即,即使在控制对象1的共振频率ωp、反共振频率ωz不同的情况下,仍生成从动作目标值pref去掉了与阻尼参数信号θ对应的频率分量的动作补偿信号(模型位置pa),进行所生成的动作补偿信号(模型位置pa)的1阶微分以及2阶微分,分别运算模型速度va以及模型转矩τa。
具体而言,马达控制装置400具备图9所示那样的前馈控制部411。图9是示出实施方式4中的前馈控制部411的内部结构的框图。
前馈控制部411不具有阻尼参数滤波器123,而具有阻尼参数决定部422以及阻尼滤波器421。
阻尼参数决定部422具有生成部422a。生成部422a根据参数变更信号ML,将共振频率ωp以及反共振频率ωz作为参数变更信号θ输出到阻尼滤波器421。
阻尼滤波器421具有补偿信号生成部(第2生成部)421a、变化量运算部(第1运算部)421b、以及转矩运算部(第2运算部)421c。
补偿信号生成部421a生成从动作目标值pref去掉了与参数变更信号θ(反共振频率ωz)对应的频率分量的动作补偿信号(模型位置pa)。
具体而言,补偿信号生成部421a具有模型位置运算部441。模型位置运算部441从外部接收动作目标值pref,从阻尼参数决定部422的生成部422a接收与阻尼参数信号θ相当的反共振频率ωz。模型位置运算部441通过式(8),从动作目标值pref去掉与反共振频率ωz对应的分量,将去掉后的信号作为模型位置pa输出到反馈控制部112以及变化量运算部421b。
变化量运算部421b运算对由补偿信号生成部421a生成的动作补偿信号(模型位置pa)在时间上进行2阶微分而得出的值,作为与阻尼参数信号θ的时间变化量相应的参数(第2参数)。
具体而言,变化量运算部421b具有模型位置微分器445以及模型速度微分器446。模型位置微分器445从模型位置运算部441接收动作补偿信号(模型位置pa),运算其1阶微分值p(1) a。此时,模型位置微分器445通过如式(7)~式(10)所示那样,对由补偿信号生成部421a生成的动作补偿信号(模型位置pa)在时间上进行1阶微分,以使控制对象1不激发振动的方式,运算模型速度va。模型位置微分器445将运算出的结果作为模型速度va输出到反馈控制部112以及模型速度微分器446。
模型速度微分器446从模型位置微分器445接收模型速度va,运算其1阶微分值v(1) a。模型速度微分器446将其运算结果作为对动作补偿信号(模型位置pa)在时间上进行2阶微分而得到的值输出到转矩运算部421c。
转矩运算部421c根据动作目标值pref、阻尼参数(第1参数)θ、以及动作补偿信号的2阶微分值(第2参数)v(1) a,以使控制对象1不激发振动的方式,运算模型转矩τa。
具体而言,转矩运算部421c具有目标值微分器4410、目标值2阶微分器4411、模型转矩减法部4412、模型转矩补偿部4413、模型转矩加法器4414、以及惯性力矩乘法部444。目标值微分器4410从外部接收动作目标值pref,运算动作目标值的1阶微分值p(1) ref,将运算出的结果输出到目标值2阶微分器4411。
目标值2阶微分器4411从目标值微分器4410接收动作目标值的1阶微分值p(1) ref,运算其1阶微分值,将运算出的结果作为动作目标值的2阶微分值p(2) ref输出到模型转矩减法器4412以及模型转矩加法器4414。
模型转矩减法器4412从目标值2阶微分器4411接收动作目标值的2阶微分值p(2) ref,从模型速度微分器446接收模型速度va的1阶微分值v(1) a。模型转矩减法器4412从模型速度va的1阶微分值v(1) a减去动作目标值的2阶微分值p(2) ref,将其减法结果输出到模型转矩补偿部4413。
模型转矩补偿部4413从模型转矩减法器4412接收减法结果,从阻尼参数决定部422接收(控制对象1的当前的)共振频率ωp、反共振频率ωz。模型转矩补偿部4413运算对由模型转矩减法器4412得到的减法结果乘以反共振频率ωz的平方,并除以共振频率ωp的平方而得到的值,将其运算结果输出到模型转矩加法器4414。
模型转矩加法器4414从模型转矩补偿部4413接收运算结果,从目标值2阶微分器4411接收动作目标值的2阶微分值p(2) ref,对这些值进行加法,将其加法结果输出到惯性力矩乘法部444。
惯性力矩乘法部444对由模型转矩加法器4414得到的加法结果乘以惯性力矩,将其积作为模型转矩τa输出到转矩加法器113。
接下来,使用图9来详细说明阻尼滤波器421的具体的动作。
模型速度微分器446从模型位置微分器445接收模型速度va,运算模型速度的1阶微分值v(1) a,将其运算结果输出到模型转矩减法器4412。即,模型速度微分器446通过直接运算模型速度va的1阶微分,求出与下述式(15)等同的信号来输出到模型转矩减法器4412。
v(1) a=1/ωz 2×{p(4) ref-4×ωp (1)/ωp×p(3) ref
+(-2×ω(2) p/ωp+6×(ω(1) p)2/ωp 2)×p(2) ref}
+p(2) ref…(19)
在式(19)中,使用了如下假设:
ω(1) p/ωp=ω (1) z/ωz,ω(2) p/ωp=ω(2) z/ωz…(20)
模型转矩减法器4412从模型速度微分器446接收模型速度的1阶微分值v(1) a,从目标值2阶微分器4411接收动作目标值的2阶微分值p(2) ref。模型转矩减法器4412从模型速度的1阶微分值v(1) a减去动作目标值的2阶微分值p(2) ref,将其减法结果输出到模型转矩补偿部4413。即,模型转矩减法器4412将下述式(21)的值输出到模型转矩补偿部4413。
p(4) ref-4×ωp (1)/ωp×p(3) ref
+(-2×ω(2) p/ωp+6×(ω(1) p)2/ωp 2)×p(2) ref…(21)
模型转矩补偿部4413对由模型转矩减法器4412得到的减法结果乘以反共振频率ωz的平方,并除以共振频率ωp的平方,将其运算结果输出到模型转矩加法器4414。因此,将用式(22)计算的值输出到模型转矩加法器4414。
1/ωp 2×p(4) ref-4×ω(1) p/ωp 3×p(3) ref
+(-2×ω(2) p/ωp 2+6×(ω(1) p)2/ωp 4)×p(2) ref…(22)
模型转矩加法器4414对由模型转矩补偿器4413得到的运算结果加上动作目标值的2阶微分值p(2) ref。模型转矩加法器4414将其和输出到惯性力矩乘法部444。因此,将具有与用式(23)计算的值等同的值的信号输出到惯性力矩乘法部444。
1/ωp 2×p(4) ref-4×ω(1) p/ωp 3×p(3) ref
+(-2×ω(2) p/ωp 2+6×(ω(1) p)2/ωp 4)×p(2) ref
+p(2) ref…(23)
惯性力矩乘法部444对由模型转矩加法器4414得到的加法结果乘以惯性力矩(JM+JL),将其积作为模型转矩τa输出到转矩加法器113。
即,惯性力矩乘法部444的输出成为与实施方式1的惯性力矩乘法部144同样地用式(12)计算的值。因此,从阻尼滤波器421输出的模型位置pa、模型速度va、模型转矩τa的值分别成为式(8)、(10)、(12)。因此,关于实施方式1中的前馈控制部111输出的模型位置pa、模型速度va、模型转矩τa、和本实施方式中的前馈控制部411输出的模型位置pa、模型速度va、模型转矩τa,仅运算方法不同,作为值是相同的。因此,在实施方式4的方式中也能够得到与实施方式1等同的效果。
如以上那样,根据实施方式4,不论是在控制对象1的共振频率ωp和反共振频率ωz大致相等的(ωp≈ωz)情况下,还是在控制对象1的共振频率ωp和反共振频率ωz不同的(ωp≠ωz)情况下,都能够不利用(生成)阻尼参数变量信号θ自身,而利用(生成)与阻尼参数变量信号θ相当的参数(动作补偿信号的1阶微分值、2阶微分值),来运算与实施方式1等同的模型速度va、模型转矩τa。
实施方式5.
接下来,使用图10来说明实施方式5的马达控制装置500。图10是示出实施方式5的马达控制装置500的结构的框图。以下,以与实施方式1不同的点为中心而进行说明。
本实施方式与实施方式1的差异在于,在实施方式1中是使马达动作检测值pM追踪期望的动作目标值(位置指令)pref的位置控制,而相对于此在本实施方式中是使马达速度运算值vM追踪动作目标值(速度指令)vref的速度控制。即,马达控制装置500从外部(例如,未图示的上位控制器)接收表示所驱动的控制对象1的速度目标值的动作目标值(速度指令)vref,以使与马达动作检测值pM相应的马达速度运算值vM追踪动作目标值vref的方式,发生转矩指令τM而输出到电流控制器4。
具体而言,马达控制装置500具备前馈控制部511以及反馈控制部512。反馈控制部512不具有位置控制器131(参照图1),而具有速度运算器133、以及速度控制器132。
另外,前馈控制部511具有阻尼滤波器(第2运算部)521。阻尼滤波器521如图11所示,其内部结构与实施方式1不同。图11是示出前馈控制部511的内部结构的框图。
阻尼滤波器521不具有位置运算部121a(参照图5),而具有速度运算部521b以及转矩运算部521c。
在速度运算部521b中,模型速度运算部542从外部接收动作目标值vref,从阻尼参数决定部122的生成部122a接收反共振频率ωz,从阻尼参数滤波器123的微分器123a接收反共振频率的1阶微分值ω(1) z。模型速度运算部542使用动作目标值vref、反共振频率ωz、以及反共振频率的1阶微分值ω(1) z,如后述公式(24)所示,运算模型速度va并输出到反馈控制部512(参照图10)。
转矩运算部521c具有模型加速度运算部543以及惯性力矩乘法部544。
模型加速度运算部543从外部接收动作目标值vref,从阻尼参数决定部122的生成部122a接收共振频率ωp。另外,模型加速度运算部543从阻尼参数滤波器123的微分器123a接收共振频率的1阶微分值ω(1) p,从阻尼参数滤波器123的微分器123b接收共振频率的2阶微分值ω(2) p。模型加速度运算部543使用动作目标值vref、共振频率ωp、共振频率的1阶微分值ω(1) p、以及共振频率的2阶微分值ω(2) p,如后述公式(27)所示,运算模型加速度aa并输出到惯性力矩乘法部544。
惯性力矩乘法部544从模型加速度运算部543接收模型加速度aa。惯性力矩乘法部544使用模型加速度aa,如后述公式(28)所示,运算模型转矩τa并输出到转矩加法器113(参照图10)。
接下来,详细说明阻尼滤波器521的动作(模型位置pa、模型速度va、模型转矩τa的运算方法)。
模型速度运算部542使用反共振频率ωz(阻尼参数信号θ)和动作目标值vref,通过式(6)和对式(4)在时间上进行微分而得到的式子,运算机械速度vL与外部速度指令vref一致了时的马达速度vM,将其运算结果作为模型速度va输出到反馈控制部512。在实际上使用公式来说明时,关于机械速度vL与外部速度指令vref一致时的马达速度vM,考虑到反共振频率ωz也随着时间变化,针对式(4)的两边关于时间进行微分,从而求出为
va=1/ωz 2×v(2) ref-2×ω(1) z/ωz 3×v(1) ref
+vref…(24)
此处,还使用了式(6)。模型速度运算部542使用该式(24)来运算模型速度va。模型速度运算部542将运算出的模型速度va输出到反馈控制部512。即,模型速度运算部542将如下值作为模型速度va输出到反馈控制部512,该值是针对对动作目标值的2阶微分值v(2) ref乘以反共振频率ωz的平方分之一而得到的值、与对动作目标值的1阶微分值v(1) ref以及反共振频率的1阶微分值ω(1) z之积的2倍值乘以反共振频率ωz的三次方分之一而得到的值之差加上动作目标值vref而得到的值。
模型加速度控制器543和惯性力矩乘法部544使用共振频率ωp(阻尼参数信号θ)和其1阶微分值ω(1) p、2阶微分值ω(2) p(阻尼参数变量信号θ’),以使从动作目标值vref至模型转矩τa为止的特性成为从马达转矩τM至机械速度vL为止的动态特性的逆特性的方式,运算模型转矩τa。惯性力矩乘法部544将运算结果输出到转矩加法器113。
这样,通过运算模型转矩τa,只要无摩擦、模型误差等干扰,就能够使控制对象1的机械速度vL无偏差地追踪动作目标值vref。其结果,还能够抑制振动。接下来,使用公式来说明模型加速度运算部543和惯性力矩乘法部544的动作。
首先,关于式(4)的两边,还考虑到共振频率ωp、反共振频率ωz也随着时间变化,而在时间上进行1阶微分以及2阶微分的运算。然后,如果将运算出的式子和式(4)自身代入式(3)来求出从马达转矩τM至机械速度vL为止的动态特性,则成为式(25)。
1/ωp 2×v(4) L-4×ω(1) p/ωp 3×v(3) L
+(-2×ω(2) p/ωp 2+6×(ω(1) p)2/ωp 4)×v(2) L+v(2) L
=1/(JM+JL)×τM…(25)
如果使从动作目标值vref至模型转矩τa为止的特性成为从马达转矩τM至机械速度vL为止的特性的逆特性,则能够使控制对象的机械速度无偏差地追踪动作目标值vref,并且从马达转矩τM至机械速度vL为止的动态特性成为式(25),所以模型转矩τa如为下述式(26)那样进行运算。
τa=(JM+JL)
×{1/ωp 2×v(4)ref-4×ωp (1)/ωp 3×p(3) ref
+(-2×ω(2) p/ωp 2+6×(ω(1) p)2/ωp 4)×v(2) ref
+v(2) ref}…(26)
因此,模型加速度运算部543使用动作目标值vref、共振频率ωp、其1阶微分ω(1) p、2阶微分ω(2) p,通过下述式(27)运算模型加速度aa。模型加速度运算部543将运算出的模型加速度aa输出到惯性力矩乘法部544。惯性力矩乘法部544与实施方式1同样地使用模型加速度aa,通过式(28)运算模型转矩τa,将模型转矩τa输出到转矩加法器113。
aa=1/ωp 2×v(4) ref-4×ωp (1)/ωp 3×v(3) ref
+(-2×ω(2) p/ωp 2+6×(ω(1) p)2/ωp 4)×v(2) ref
+v(2) ref…(27)
τa=(JM+JL)×aa…(28)
这样,通过模型加速度运算部543使用式(27),而惯性力矩乘法部544使用式(28)来运算模型转矩τa,从而在无摩擦、模型误差等干扰的情况下,能够使控制对象的机械速度vL无偏差地追踪动作目标值vref。
如以上那样,根据实施方式5,即使在速度控制中也能够得到与实施方式1等同的效果,能够扩大本发明的马达控制装置的用途。
另外,在本实施方式中,通过编码器等检测器2检测马达动作目标值pM,针对其通过速度运算器133计算了马达速度运算值vM,但也可以使用分解器、速度计、霍尔元件等来直接测量马达速度运算值vM。
另外,也可以将动作目标值vref的积分值视为关于位置的动作目标值pref,通过与本实施方式2~实施方式4同样的计算方法,计算模型速度va和模型转矩τa。
产业上的可利用性
如以上那样,本发明的马达控制装置对刚性低的产业用机械装置的定位驱动是有用的。
Claims (13)
1.一种马达控制装置,控制具有马达以及能够振动要素的控制对象的动作,其特征在于,具备:
生成部,根据表示与所述控制对象的振动特性关联的所述控制对象的状态的状态信息,生成表示所述控制对象的振动特性的第1参数;
第1运算部,运算与由所述生成部生成的所述第1参数的时间变化量相应的第2参数;
第2运算部,根据动作目标值、所述第1参数以及所述第2参数,以使所述控制对象不激发振动的方式运算模型转矩;以及
发生部,根据由所述第2运算部运算出的所述模型转矩,发生使所述控制对象的动作追踪所述动作目标值的针对所述马达的转矩指令。
2.根据权利要求1所述的马达控制装置,其特征在于,
所述第2运算部使用所述动作目标值、所述第1参数以及所述第2参数,运算所述控制对象能够不振动地追踪的速度即模型速度,
所述发生部以使所述控制对象的速度追踪由所述第2运算部运算出的所述模型速度的方式,发生所述转矩指令。
3.根据权利要求2所述的马达控制装置,其特征在于,
所述第2运算部使用所述动作目标值和所述第1参数,运算所述控制对象能够不振动地追踪的位置即模型位置,
所述发生部发生使所述控制对象的位置追踪由所述第2运算部运算出的所述模型位置的所述转矩指令。
4.根据权利要求1所述的马达控制装置,其特征在于,
所述第1参数包括所述控制对象的振动频率,
所述第2参数包括所述控制对象的振动频率的时间变化量。
5.根据权利要求1所述的马达控制装置,其特征在于,还具备:
存储部,存储将所述状态信息的多个值和所述第1参数的多个值对应起来的表格,
所述生成部通过参照所述存储部所存储的所述表格,生成与所接收的所述状态信息对应的所述第1参数。
6.根据权利要求1所述的马达控制装置,其特征在于,还具备:
第2存储部,存储表示所述状态信息的值与所述第1参数的值的关系的函数,
所述生成部通过参照所述第2存储部所存储的所述函数,生成与输入到所述生成部的所述状态信息对应的所述第1参数。
7.根据权利要求1所述的马达控制装置,其特征在于,
所述第1运算部在使n为大于1的整数时,通过进行所述第1参数的n阶微分或者n阶差分来运算所述第2参数。
8.根据权利要求1所述的马达控制装置,其特征在于,
所述控制对象具有多个所述马达,
所述生成部接收的所述状态信息包括与所述多个马达中的未由所述马达控制装置控制的马达的位置相应的所述能够振动要素的状态。
9.根据权利要求1所述的马达控制装置,其特征在于,
所述第2运算部根据从所述转矩指令至所述控制对象的位置为止的动态特性的逆特性,运算为了使所述控制对象的位置追踪所述动作目标值而所需的所述转矩指令,通过运算结果运算所述模型转矩。
10.根据权利要求2所述的马达控制装置,其特征在于,
所述第2运算部推测所述控制对象的速度追踪与所述动作目标值相应的速度时的马达速度,而运算为所述模型速度。
11.根据权利要求3所述的马达控制装置,其特征在于,
所述第2运算部推测所述控制对象的位置追踪与所述动作目标值相应的速度时的马达位置,而运算为所述模型位置。
12.一种马达控制装置,控制具有马达以及能够振动要素的控制对象的动作,其特征在于,具备:
生成部,根据表示与所述控制对象的振动特性关联的所述控制对象的状态的状态信息,生成表示所述控制对象的振动特性的第1参数;
第2生成部,生成从动作目标值去掉了与所述第1参数对应的频率分量的动作补偿信号;
第3运算部,通过对由所述第2生成部生成的动作补偿信号在时间上进行2阶微分,生成模型转矩;以及
发生部,以使所述控制对象的动作追踪所述动作目标值的方式,根据由所述第3运算部运算出的所述模型转矩,发生针对所述马达的转矩指令。
13.根据权利要求12所述的马达控制装置,其特征在于,
所述第3运算部通过对由所述第2生成部生成的动作补偿信号在时间上进行1阶微分,运算使所述控制对象不振动地动作的模型速度,
所述发生部发生使所述控制对象的速度追踪由所述第3运算部运算的所述模型速度的、所述转矩指令。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010-283550 | 2010-12-20 | ||
JP2010283550 | 2010-12-20 | ||
PCT/JP2011/079216 WO2012086550A1 (ja) | 2010-12-20 | 2011-12-16 | モータ制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103270692A true CN103270692A (zh) | 2013-08-28 |
CN103270692B CN103270692B (zh) | 2016-01-20 |
Family
ID=46313822
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201180060892.9A Active CN103270692B (zh) | 2010-12-20 | 2011-12-16 | 马达控制装置 |
Country Status (6)
Country | Link |
---|---|
US (1) | US9075400B2 (zh) |
JP (1) | JP5496365B2 (zh) |
CN (1) | CN103270692B (zh) |
DE (1) | DE112011104448B4 (zh) |
TW (1) | TWI459162B (zh) |
WO (1) | WO2012086550A1 (zh) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104698970A (zh) * | 2013-12-06 | 2015-06-10 | 金丽科技股份有限公司 | 运用于时变信号的信号处理装置 |
CN104802161A (zh) * | 2013-10-28 | 2015-07-29 | 精工爱普生株式会社 | 机器人、机器人控制装置以及机器人系统 |
TWI506943B (zh) * | 2013-12-05 | 2015-11-01 | Rdc Semiconductor Co Ltd | 運用於時變信號的信號處理裝置 |
CN106464193A (zh) * | 2014-05-13 | 2017-02-22 | 三菱电机株式会社 | 电动机控制常数计算装置 |
CN108687761A (zh) * | 2017-03-31 | 2018-10-23 | 精工爱普生株式会社 | 控制装置、机器人以及机器人系统 |
CN109664297A (zh) * | 2018-12-14 | 2019-04-23 | 深圳市汇川技术股份有限公司 | 机器人的振动抑制方法、系统、装置及计算机可读存储器 |
WO2019237868A1 (zh) * | 2018-06-13 | 2019-12-19 | 南京埃斯顿自动化股份有限公司 | 一种伺服电机与负载多级传动系统的振动抑制方法 |
CN111152213A (zh) * | 2019-12-05 | 2020-05-15 | 北京蒂斯科技有限公司 | 一种基于混合控制的机械臂振动补偿方法及装置 |
CN113330373A (zh) * | 2019-02-05 | 2021-08-31 | 欧姆龙株式会社 | 控制装置、模型创建方法以及控制程序 |
CN113557479A (zh) * | 2019-06-14 | 2021-10-26 | 株式会社日立产机系统 | 电动机控制装置、陷波滤波器调整装置、陷波滤波器调整方法 |
Families Citing this family (31)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5795064B2 (ja) * | 2010-07-13 | 2015-10-14 | ボルボ コンストラクション イクイップメント アーベー | 建設機械の旋回制御装置及びその方法 |
JP5652042B2 (ja) | 2010-08-06 | 2015-01-14 | セイコーエプソン株式会社 | ロボット装置、ロボット装置の制御方法およびプログラム |
JP6083145B2 (ja) * | 2012-07-31 | 2017-02-22 | セイコーエプソン株式会社 | ロボットの制御装置、およびロボット |
JP5596756B2 (ja) * | 2012-08-29 | 2014-09-24 | トヨタ自動車株式会社 | 電動車両 |
US8829701B2 (en) * | 2012-10-11 | 2014-09-09 | Pratt & Whitney Canada Corp. | Resonant mode damping system and method |
JP5916583B2 (ja) * | 2012-10-19 | 2016-05-11 | 株式会社神戸製鋼所 | 多関節ロボットのウィービング制御装置 |
JP5694428B2 (ja) * | 2013-05-13 | 2015-04-01 | ファナック株式会社 | 固有振動を抑制するモータ制御装置 |
JP6041762B2 (ja) * | 2013-07-09 | 2016-12-14 | 山洋電気株式会社 | モータ制御装置 |
US9067600B2 (en) * | 2013-07-26 | 2015-06-30 | Ford Global Technologies, Llc | Engine speed control apparatus and method for a hybrid vehicle |
JP6314426B2 (ja) * | 2013-10-31 | 2018-04-25 | セイコーエプソン株式会社 | ロボット制御装置およびロボット制御方法 |
CL2015001080A1 (es) | 2014-04-25 | 2016-05-20 | Harnischfeger Tech Inc | Control de fuga de recolección de una máquina industrial |
JP5897645B2 (ja) * | 2014-06-05 | 2016-03-30 | ファナック株式会社 | 機械先端点のたわみを低減するサーボ制御装置 |
EP2996003B1 (en) | 2014-09-11 | 2021-06-30 | Robert Bosch GmbH | Device and method for moving an object |
JP6020537B2 (ja) * | 2014-11-21 | 2016-11-02 | 株式会社安川電機 | モータ制御装置及びモータ制御方法 |
JP6017595B2 (ja) * | 2015-01-16 | 2016-11-02 | ファナック株式会社 | 振動を抑制するモータ制御装置 |
EP3073337B1 (de) * | 2015-03-24 | 2023-11-15 | Fabian Sacharowitz | Stellvorrichtung für armaturen mit mess- und verarbeitungseinrichtung für körperschall der armatur |
TWI578124B (zh) * | 2015-11-24 | 2017-04-11 | 財團法人金屬工業研究發展中心 | 多旋翼飛行器及其控制方法 |
DE102015122638A1 (de) * | 2015-12-22 | 2017-06-22 | Schneider Electric Industries Sas | Elektromotorischer Antrieb und Verfahren zum Betreiben eines Motors |
RU2629946C1 (ru) * | 2016-03-11 | 2017-09-05 | Федеральное государственное автономное образовательное учреждение высшего образования "Национальный исследовательский Томский политехнический университет" | Вентильный электропривод колебательного движения |
JP2017175890A (ja) * | 2016-03-25 | 2017-09-28 | ファナック株式会社 | 振動を抑制する機能を有するモータ制御装置 |
AU2017254937B2 (en) | 2016-11-09 | 2023-08-10 | Joy Global Surface Mining Inc | Systems and methods of preventing a run-away state in an industrial machine |
JP6846213B2 (ja) * | 2017-01-20 | 2021-03-24 | 山洋電気株式会社 | モータ制御装置 |
DE102017104335A1 (de) * | 2017-03-02 | 2018-09-06 | Physik Instrumente (Pi) Gmbh & Co. Kg | Vorrichtung zur Bewegungsanalyse und Antriebsvorrichtung |
JP6939024B2 (ja) * | 2017-03-31 | 2021-09-22 | セイコーエプソン株式会社 | ロボット制御装置、ロボットおよびロボットシステム |
CN111095132B (zh) * | 2017-09-08 | 2023-04-18 | 三菱电机株式会社 | 伺服控制装置 |
US11569709B2 (en) * | 2018-06-15 | 2023-01-31 | Panasonic Intellectual Property Management Co., Ltd. | Motor drive device and servo adjustment method |
JP6875329B2 (ja) * | 2018-06-26 | 2021-05-19 | ファナック株式会社 | 学習制御を行うロボットシステム |
JP7277260B2 (ja) * | 2019-06-03 | 2023-05-18 | ファナック株式会社 | 振動を抑制するモータ制御装置及び産業機械 |
CN110502111B (zh) * | 2019-08-09 | 2021-02-26 | 瑞声科技(新加坡)有限公司 | 马达信号补偿方法、电子设备及存储介质 |
DE112020006573B4 (de) * | 2020-03-17 | 2024-06-06 | Mitsubishi Electric Corporation | Steuerungssystem, Motorsteuerungsvorrichtung und Vorrichtung für Maschinelles Lernen |
CN113849007B (zh) * | 2021-09-10 | 2022-07-26 | 北京空间飞行器总体设计部 | 一种用于航天器柔性结构的加速度反馈振动控制方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001249720A (ja) * | 2000-03-08 | 2001-09-14 | Mitsubishi Electric Corp | 位置制御装置 |
CN1448816A (zh) * | 2002-03-29 | 2003-10-15 | 松下电器产业株式会社 | 电动机控制方法及控制装置 |
JP2005039954A (ja) * | 2003-07-17 | 2005-02-10 | Mitsubishi Electric Corp | 電動機制御装置 |
JP4367041B2 (ja) * | 2003-07-18 | 2009-11-18 | 富士電機システムズ株式会社 | 機械制御装置 |
Family Cites Families (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3220182B2 (ja) | 1991-06-14 | 2001-10-22 | 富士通株式会社 | ファイル複写装置 |
JP3274070B2 (ja) * | 1996-08-08 | 2002-04-15 | 三菱電機株式会社 | 電動機制御方法及び電動機制御装置 |
DE10059499A1 (de) | 2000-01-26 | 2001-08-09 | Hewlett Packard Co | Vorrichtung zum manuellen Fokussieren einer digitalen Kamera |
JP4020726B2 (ja) | 2002-08-08 | 2007-12-12 | 三菱電機株式会社 | 機械の位置制御装置および機械の位置制御システム |
JP4095480B2 (ja) * | 2003-03-28 | 2008-06-04 | 住友重機械工業株式会社 | 振動制御装置 |
EP1652810B1 (en) | 2003-08-05 | 2012-12-19 | Sintokogio, Ltd. | Crane and controller for the same |
JP4577107B2 (ja) * | 2005-06-17 | 2010-11-10 | 三菱電機株式会社 | 機械位置制御装置 |
JP4468415B2 (ja) * | 2007-06-29 | 2010-05-26 | 三菱電機株式会社 | 電動パワーステアリング制御装置 |
JP2009118684A (ja) * | 2007-11-08 | 2009-05-28 | Mitsubishi Electric Corp | 振動抑制制御装置 |
JP4540727B2 (ja) * | 2008-07-31 | 2010-09-08 | 山洋電気株式会社 | モータ制御装置 |
JP5372249B2 (ja) | 2010-05-17 | 2013-12-18 | 三菱電機株式会社 | モータ制御装置 |
JP5695555B2 (ja) * | 2011-01-28 | 2015-04-08 | オークマ株式会社 | 位置制御装置 |
-
2011
- 2011-12-16 CN CN201180060892.9A patent/CN103270692B/zh active Active
- 2011-12-16 US US13/884,295 patent/US9075400B2/en not_active Expired - Fee Related
- 2011-12-16 JP JP2012549778A patent/JP5496365B2/ja active Active
- 2011-12-16 DE DE112011104448.8T patent/DE112011104448B4/de active Active
- 2011-12-16 WO PCT/JP2011/079216 patent/WO2012086550A1/ja active Application Filing
- 2011-12-20 TW TW100147330A patent/TWI459162B/zh active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001249720A (ja) * | 2000-03-08 | 2001-09-14 | Mitsubishi Electric Corp | 位置制御装置 |
CN1448816A (zh) * | 2002-03-29 | 2003-10-15 | 松下电器产业株式会社 | 电动机控制方法及控制装置 |
JP2005039954A (ja) * | 2003-07-17 | 2005-02-10 | Mitsubishi Electric Corp | 電動機制御装置 |
JP4367041B2 (ja) * | 2003-07-18 | 2009-11-18 | 富士電機システムズ株式会社 | 機械制御装置 |
Cited By (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104802161A (zh) * | 2013-10-28 | 2015-07-29 | 精工爱普生株式会社 | 机器人、机器人控制装置以及机器人系统 |
CN104802161B (zh) * | 2013-10-28 | 2019-03-22 | 精工爱普生株式会社 | 机器人、机器人控制装置以及机器人系统 |
TWI506943B (zh) * | 2013-12-05 | 2015-11-01 | Rdc Semiconductor Co Ltd | 運用於時變信號的信號處理裝置 |
CN104698970B (zh) * | 2013-12-06 | 2017-06-16 | 金丽科技股份有限公司 | 运用于时变信号的信号处理装置 |
CN104698970A (zh) * | 2013-12-06 | 2015-06-10 | 金丽科技股份有限公司 | 运用于时变信号的信号处理装置 |
CN106464193A (zh) * | 2014-05-13 | 2017-02-22 | 三菱电机株式会社 | 电动机控制常数计算装置 |
CN106464193B (zh) * | 2014-05-13 | 2018-11-23 | 三菱电机株式会社 | 电动机控制常数计算装置 |
CN108687761B (zh) * | 2017-03-31 | 2023-01-20 | 精工爱普生株式会社 | 控制装置、机器人以及机器人系统 |
CN108687761A (zh) * | 2017-03-31 | 2018-10-23 | 精工爱普生株式会社 | 控制装置、机器人以及机器人系统 |
WO2019237868A1 (zh) * | 2018-06-13 | 2019-12-19 | 南京埃斯顿自动化股份有限公司 | 一种伺服电机与负载多级传动系统的振动抑制方法 |
US11913512B2 (en) | 2018-06-13 | 2024-02-27 | Nanjing Estun Automation Company | Vibration suppression method for servo motor and load multistage drive system |
CN109664297A (zh) * | 2018-12-14 | 2019-04-23 | 深圳市汇川技术股份有限公司 | 机器人的振动抑制方法、系统、装置及计算机可读存储器 |
CN113330373A (zh) * | 2019-02-05 | 2021-08-31 | 欧姆龙株式会社 | 控制装置、模型创建方法以及控制程序 |
CN113557479A (zh) * | 2019-06-14 | 2021-10-26 | 株式会社日立产机系统 | 电动机控制装置、陷波滤波器调整装置、陷波滤波器调整方法 |
CN113557479B (zh) * | 2019-06-14 | 2024-02-02 | 株式会社日立产机系统 | 电动机控制装置、陷波滤波器调整装置、陷波滤波器调整方法 |
CN111152213B (zh) * | 2019-12-05 | 2021-03-16 | 北京蒂斯科技有限公司 | 一种基于混合控制的机械臂振动补偿方法及装置 |
CN111152213A (zh) * | 2019-12-05 | 2020-05-15 | 北京蒂斯科技有限公司 | 一种基于混合控制的机械臂振动补偿方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
US9075400B2 (en) | 2015-07-07 |
WO2012086550A1 (ja) | 2012-06-28 |
DE112011104448T5 (de) | 2013-09-19 |
TW201232207A (en) | 2012-08-01 |
TWI459162B (zh) | 2014-11-01 |
CN103270692B (zh) | 2016-01-20 |
JP5496365B2 (ja) | 2014-05-21 |
DE112011104448B4 (de) | 2021-05-06 |
US20130234642A1 (en) | 2013-09-12 |
JPWO2012086550A1 (ja) | 2014-05-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103270692B (zh) | 马达控制装置 | |
De Luca et al. | Robots with flexible elements | |
CN1146765C (zh) | 位置控制装置 | |
KR101110892B1 (ko) | 면진 제어 시스템 | |
JP5113862B2 (ja) | モータ制御装置 | |
CN106687792A (zh) | 振动模式测定装置 | |
De Jager | Acceleration assisted tracking control | |
JP5441944B2 (ja) | モータ制御装置 | |
Inoue et al. | Spatial disturbance suppression of a flexible system based on wave model | |
CN107037726B (zh) | 一种非同元分数阶系统滑膜干扰观测器设计方法 | |
CN112859618B (zh) | 一种多自由度磁悬浮平面电机自适应学习滑模控制方法 | |
CN117086884B (zh) | 一种绳牵引并联机器人的控制方法、装置、设备和介质 | |
Katsura et al. | Absolute stabilization of multimass resonant system by phase-lead compensator based on disturbance observer | |
CN110389530B (zh) | 基于数据筛选的mems陀螺仪参数辨识驱动控制方法 | |
Oboe et al. | Use of MEMS inertial sensors for performance improvement of low-cost motion control systems | |
JP5245085B2 (ja) | 時変形システムに対する振動抑制制御入力決定方法、搬送システム、および時変形システムに対する振動抑制制御入力演算プログラム | |
JP6333495B1 (ja) | サーボ制御装置 | |
Shimada | Disturbance Observer for Advanced Motion Control with MATLAB/Simulink | |
CN113767565B (zh) | 马达控制系统、马达控制方法以及程序 | |
CN113489404A (zh) | 一种具有不等式约束的永磁直线电机鲁棒有界控制方法 | |
JP2906255B2 (ja) | サーボ制御装置 | |
CN109039152B (zh) | 一种超声波电机伺服控制系统轮廓控制方法 | |
CN111273552A (zh) | 一种基于数学模型的贴片机运动控制方法及系统 | |
JP2869281B2 (ja) | モータ駆動系の制御装置 | |
CN117639615A (zh) | 电机控制方法、设备和可读存储介质 |
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 |