CN103092135B - 具备不灵敏带处理部的电动机的控制装置 - Google Patents

具备不灵敏带处理部的电动机的控制装置 Download PDF

Info

Publication number
CN103092135B
CN103092135B CN201210418376.5A CN201210418376A CN103092135B CN 103092135 B CN103092135 B CN 103092135B CN 201210418376 A CN201210418376 A CN 201210418376A CN 103092135 B CN103092135 B CN 103092135B
Authority
CN
China
Prior art keywords
mentioned
position deviation
insensitive
motor
driven member
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
Application number
CN201210418376.5A
Other languages
English (en)
Other versions
CN103092135A (zh
Inventor
园田直人
丰泽雪雄
岩下平辅
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Fanuc Corp
Original Assignee
Fanuc Corp
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Fanuc Corp filed Critical Fanuc Corp
Publication of CN103092135A publication Critical patent/CN103092135A/zh
Application granted granted Critical
Publication of CN103092135B publication Critical patent/CN103092135B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
    • G05B19/404Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control arrangements for compensation, e.g. for backlash, overshoot, tool offset, tool wear, temperature, machine construction errors, load, inertia
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/41Servomotor, servo controller till figures
    • G05B2219/41202Structure, compensation circuit after comparator in loop

Abstract

本发明提供一种具备不灵敏带处理部的电动机的控制装置。电动机(M)的控制装置(1)具备:检测被驱动体(2)的位置的位置检测部(11);在每个采样周期获取给予电动机(M)的位置指令和由位置检测部(11)检测的被驱动体(2)的位置的位置偏差的位置偏差获取部(12);在由位置偏差获取部(12)获取的位置偏差包含于规定的不灵敏带范围内的场合,将该位置偏差置换为零并输出的不灵敏带处理部(13);以及计算从不灵敏带处理部(13)输出的位置偏差为零的修正量的反复控制部(14),根据由位置偏差获取部(12)获取的位置偏差和由反复控制部(14)计算的修正量控制电动机(M)。

Description

具备不灵敏带处理部的电动机的控制装置
技术领域
本发明涉及利用数值控制装置等控制装置驱动控制的机床或工业机械等的电动机的控制装置,尤其涉及通过反复进行规定的相同模式的位置指令而利用相同动作模式对被驱动体进行驱动控制的电动机的控制装置。
背景技术
在反复执行相同模式的指令来进行加工等的场合,作为将控制偏差收敛到零(0)附近而提高加工精度的方法,已知有反复控制(学习控制)。该反复控制(学习控制)例如日本专利第2840139号公报及日本专利第4043996号公报所记载的那样的、将工件1旋转等模式动作的时间作为反复(学习)周期,使工件多次旋转而在每个规定控制周期中求出位置偏差,根据该位置偏差将修正量存储在存储器中,通过在该模式周期的各控制周期的位置偏差中加上存储在存储器中的与一个前一模式周期对应的控制周期的修正量,使位置偏差收敛为零。在反复控制中,具有日本专利第2840139号公报所记载的发明那样的以被驱动体的位置或角度为基准进行控制的方法、日本专利第4043996号公报所记载的发明那样的以时间为基准进行控制的方法。
在以高精度进行利用电动机对具有库伦摩擦那样的非线形摩擦特性的被驱动体进行相同动作反复控制的场合,若持续在从相对于对被驱动体进行驱动控制的电动机的位置指令为零以外的状态转移到零附近后进一步停在零附近的状态,则由于被驱动体的非线形摩擦的影响,有时反复控制部输出的修正量振动。其结果,即使在被驱动体停止的状态下,若继续进行反复控制,则在被驱动体上产生振动。
图10是表示具有连续效果的非线形摩擦特性的图。在图示的例子中,粘性摩擦为零。在具有这种摩擦特性的被驱动体中,在驱动时发现破裂现象。图11及图12是表示在利用电动机驱动控制具有图10所示的非线形摩擦特性的被驱动体的场合产生的被驱动体的振动的仿真结果的图,图11表示相对于对被驱动体进行驱动控制的电动机的位置指令,图12是表示执行图11所示的位置指令时的被驱动体的位置偏差的图。在图11所示的位置指令中,作为一个例子,在执行100Hz的正弦波状的同一模式指令的场合,在某时点使其振幅逐渐减小,最终设定振幅为零。若对电动机给予图11所示的位置指令并对具有图10所示的非线形摩擦特性的被驱动体反复进行驱动控制,则如图12所示,在位置指令的振幅为零后,通过继续维持零的状态,产生低频率(15Hz)的振动。如上所述,在反复控制中具有以被驱动体的位置或角度为基准进行控制的方法、和以时间为基准进行控制的方法,但即使利用任意的控制方法使电动机进行动作而驱动控制具有非线形摩擦特性的被驱动体,则产生上述那样的振动。
若说明上述那样的振动的产生原理则如下。在相对于对被驱动体进行驱动控制的电动机的位置指令从零以外的状态转移到零的状态的场合,通过存在被驱动体的非线形摩擦,即使对电动机的位置指令为零,作为反复控制部的输出的修正量也不为零。其理由在于,原本在反复控制部输出的修正量为零的时点,作为位置指令和被驱动体的实际的位置的差的位置偏差为零,但如果库伦摩擦比电动机根据修正后的位置指令产生的转矩大,则在反复控制部输出的修正量为零之前,位置偏差为零。其结果,反复控制部保持位置偏差为零的时点的修正量(即不是零的值)。即使位置偏差为零,由于从反复控制部输出不是零的修正量,因此使用该修正量制成的相对于电动机的速度指令未收敛于零。因此,由电动机驱动控制的被驱动体的速度的积分项逐渐变大,若产生大于摩擦的转矩,则产生位置偏差。于是,反复控制部输出抑制该位置偏差的修正量。但是,位置偏差的产生周期与反复控制部的处理的反复周期(学习周期)不同步,因此持续反复控制的反复控制部增大该位置偏差,其结果,在被驱动体上产生振动。
发明内容
本发明鉴于上述问题,其目的在于提供在由电动机对被驱动体进行相同动作模式的反复控制的场合,能够抑制为了使被驱动体停止而使电动机的位置指令为零时产生的被驱动体的振动。
为了实现上述目的,在本发明中,通过反复执行规定的相同模式的位置指令,以相同动作模式驱动控制被驱动体的电动机的控制装置具备检测被驱动体的位置的位置检测部、在每个采样周期获取给予电动机的位置指令和由位置检测部检测的被驱动体的位置的位置偏差的位置偏差获取部、在由位置偏差获取部获取的位置偏差包含于规定的不灵敏带范围内的场合,将该位置偏差置换为零并输出的不灵敏带处理部、计算从不灵敏带处理部输出的位置偏差为零的修正量的反复控制部,根据由位置偏差获取部获取的位置偏差和由反复控制部计算的修正量控制电动机。
在此,不灵敏带处理部在相对于电动机的规定的值以下的速度指令持续规定的时间的场合或对被驱动体检测的速度为规定的值以下的状态持续规定的时间的场合,可以将包含于不灵敏带范围内的位置偏差置换为零并输出。
另外,不灵敏带处理部在由位置偏差获取部获取的位置偏差处于从不灵敏带范围外到使该不灵敏带范围包含于内部的缓冲范围内的期间的场合,将比此时的位置偏差小的值设定为新的位置偏差并输出,就在由位置偏差获取部获取的位置偏差位于缓冲范围外的场合,将此时的位置偏差原样输出。在该场合,在包含于从不灵敏带范围外到缓冲范围内的期间的场合所设定的上述新的位置偏差而言,在由位置偏差获取部获取的位置偏差位于不灵敏带范围的边界时为零,并且,在由位置偏差获取部获取的位置偏差处于缓冲范围的边界时根据与该位置偏差一致的增函数设定。
反复控制部具有屏蔽高频区域的低通滤波器部、设置在低通滤波器部的后级并在采样周期的至少一个周期期间保持修正量的存储器部、将在由存储器部保持后的输出上乘上小于1的增益的值和从不灵敏带处理部输出的位置偏差相加的加法器,在上述低通滤波器部中输入由加法器得到的相加结果。
附图说明
本发明通过参照以下的附图能理解得更透彻。
图1是表示本发明的实施例的电动机的控制装置的方框图。
图2是表示本发明的实施例的电动机的控制装置的不灵敏带处理部及反复控制部的方框图。
图3是表示本发明的实施例的电动机的控制装置的动作流程的流程图。
图4是表示在利用本发明的实施例的电动机的控制装置驱动控制具有图10所示的非线形摩擦特性的被驱动体的场合产生的被驱动体的振动的仿真结果的图。
图5a及图5b是表示仿真结果的图,该仿真结果表示本发明的实施例的反复控制部的反馈增益Kc和反复控制部的输出的关系,图5a是表示反复控制部的反馈增益Kc为1的场合的图,图5b是表示反复控制部的反馈增益Kc小于1的场合的图。
图6是表示以往使用的不灵敏带特性的图(之一)。
图7是表示以往使用的不灵敏带特性的图(之二)。
图8是说明在本发明的实施例的电动机的控制装置的不灵敏带处理部使用的不灵敏带特性的图(之一)。
图9是说明在本发明的实施例的电动机的控制装置的不灵敏带处理部使用的不灵敏带特性的图(之二)。
图10是表示具有连续(ストライベック)效果的非线形摩擦特性的图。
图11是表示在利用电动机驱动控制具有图10所示的非线形摩擦特性的被驱动体的场合产生的被驱动体的振动的仿真结果的图,是表示相对于驱动控制被驱动体的电动机的位置指令的图。
图12是表示在利用电动机驱动控制具有图10所示的非线形摩擦特性的被驱动体的场合产生的被驱动体的振动的仿真结果的图,是表示进行图11所示的位置指令时的被驱动体的位置偏差的图。
具体实施方式
下面,参照附图对具备不灵敏带处理部的电动机的控制装置进行说明。但是,本发明未限定于附图或以下所说明的实施方式。
图1是表示本发明的实施例的电动机的控制装置的方框图。以后,标注相同的参照符号的结构要素表示具有相同功能的结构要素。在本实施例中,对被驱动体2连结在电动机M上,通过相对于电动机M反复进行规定的相同模式的位置指令,以相同动作模式驱动控制被驱动体2的场合进行说明。作为以相同动作模式进行动作的被驱动体2的例子,具有对产品进行反复加工的工具等。
如图1所示,通过反复进行规定的相同模式的位置指令,以相同动作模式驱动控制被驱动体2的电动机M的控制装置1具备检测被驱动体2的位置的位置检测部11、在每个采样周期获取给予电动机M的位置指令和由位置检测部11检测的被驱动体2的位置的位置偏差的位置偏差获取部12、在由位置偏差获取部12获取的位置偏差包含于规定的不灵敏带范围内的场合将该位置偏差转换为零并输出的不灵敏带处理部13、计算使从不灵敏带处理部13输出的位置偏差为零的修正量的反复控制部14,根据由位置偏差获取部12获取的位置偏差和由反复控制部14计算的修正量控制电动机M。
输入到位置偏差获取部12的位置指令例如从上游的数值控制装置(未图示)输入。利用加法器15将由位置偏差获取部12获取的位置偏差和由反复控制部14计算的修正量相加。在该相加结果乘以规定的增益后,输入到速度控制部16,速度控制部16根据该输入的信息和由位置检测器11检测的被驱动体2的位置信息形成相对于电动机M的转矩指令。位置偏差获取部12、不灵敏带处理部13、反复控制部14、加法器15、增益及速度控制部16例如由DSP或FPGA等运算处理信息处理器构成,其动作能够由软件程序规定。另外,不灵敏带处理部13的处理所使用的不灵敏带范围的宽度可以根据应用本发明的实施例的电动机的控制装置11的状况或环境等适当设定。
图2是表示本发明的实施例的电动机的控制装置的不灵敏带处理部及反复控制部的方框图。从图1的位置偏差获取部12输出的位置偏差经由不灵敏带处理部13输入反复控制部14。
反复控制部14具备加法器23、屏蔽高频区域的低通滤波器部21、设置在低通滤波器21的后级的存储器部22、相位推进过滤器部24。存储器部22是将从低通滤波器部21输出的值保持在采样周期的至少一个周期的期间的滞后存储器。利用存储部22保持在采样周期的至少一个周期的期间后所输出的修正量输入相位推进过滤器部24。修正量在利用相位推进过滤器部24进行运送(屏蔽低频区域)后,从反复控制部14输出。从反复控制部14输出的修正量输入图1的加法器15。另外,利用存储器部22进行保持后的输出正反馈至加法器22。将反复控制部14的正反馈的反馈增益设为Kc。加法器23将从利用存储器部22进行保持后输出正反馈的修正量和从不灵敏带处理部13输出的位置偏差相加。在低通滤波器部21中输入利用加法器23得到的相加结果。
接着,对参照图1及图2说明的电动机的控制装置1的动作流程进行说明。图3是表示本发明的实施例的电动机的控制装置的动作流程的流程图。
在步骤S101中,位置偏差获取部12在每个采样周期获取给予检测被驱动体2的位置的位置检测部11、电动机M的位置指令和由位置检测部11检测的被驱动体2的位置的位置偏差。获取的位置偏差输入不灵敏带处理部13及加法器15。
接着,在步骤S102中,不灵敏带处理部13判断由位置偏差获取部12获取的位置偏差是否包含于规定的不灵敏带范围内。在位置偏差处于规定的不灵敏带范围内的场合,进入步骤S103,将该位置偏差置换为零并输出,进入步骤S104。在位置偏差不处于规定的不灵敏带范围内的场合,在根据后述的不灵敏带特性重新设定位置偏差后,进入步骤S104。从不灵敏带处理部13输出的位置偏差输入反复控制部14。
由于存储器部22将从低通滤波器21输出的值保持在采样周期的至少一个周期期间,因此在步骤S104中,加法器23将从不灵敏带处理部13输出的位置偏差和比该位置偏差至少靠前采样周期的一个周期的值相加。利用加法器23得到的相加结果输入到低通滤波器部21。
接着,在步骤S105中,低通滤波器部21执行屏蔽由加法器23得到的相加结果的高频区域的低通滤波器处理。
在步骤S106中,低通滤波器部21的输出作为修正量保存在存储器部22中。存储器部22将从低通滤波器部21输出的值保持在采样周期的至少一个周期期间。
利用存储器部22保持在采样周期的至少一个周期期间后所输出的修正量输出相位推进过滤器部24。在步骤S107中,相位推进过滤器部24对输入的修正量屏蔽低频率区域并执行相位推进过滤处理,并输出。从反复控制部14输出的修正量输入图1的加法器15。
另外,利用存储器部22保持在采样周期的至少一个周期后的输出正反馈至加法器23,加法器23在步骤S108中将从利用存储器部22保持后的输出正反馈的修正量和从不灵敏带处理部13输出的位置偏差相加。以后,反复执行上述各处理。
图4是表示在利用本发明的实施例的电动机的控制装置驱动控制具有图10所示的非线形摩擦特性的被驱动体的场合产生的被驱动体的振动的仿真结果的图。在本仿真中,与图12所示的现有技术的场合相同,对电动机M赋予图11所示的位置指令。在图11所示的位置指令中,反复进行100Hz的正弦波状的相同模式,在某时点逐渐减小其振幅,最终振幅为零。若对本发明的实施例的电动机M的控制装置1赋予图11所示的位置指令并反复驱动控制具有图10所示的非线形摩擦特性的被驱动体2,则如图4所示,即使持续位置指令的振幅为零的状态,也不会在被驱动体2上产生振动。这样,根据本发明的实施例的电动机M的控制装置1,在利用电动机对被驱动体2进行相同模式的反复控制的场合,能够抑制为了使被驱动体2停止而使电动机M的位置指令为零时产生的被驱动体2的振动。
另外,若设定上述的不灵敏带,则反复控制部14无法相对于该不灵敏带宽度的位置偏差发挥作用,位置偏差不收敛于零而具有相当于不灵敏带宽度的位置偏差,因此也能够得到产生被驱动体2振动的状态。例如由于在图11所示的位置指令中速度指令必定通过速度零附近,因此若设定不灵敏带,则存在位置偏差增加的场合。因此,为了避免这种状态,在相对于电动机M为规定的值以下的速度指令持续规定的时间的场合或对被驱动体2检测的速度为规定的值以下的状态持续规定的时间的场合,将包含于不灵敏带范围内的位置偏差置换为零并输出。由此,能够将位置偏差收敛于零,抑制被驱动体2产生振动。
另外,若设定不灵敏带,则如上所述,位置偏差不收敛于零而具有相当于不灵敏带宽度的位置偏差,另外,也有被驱动体2的非线形摩擦的影响,从反复控制部14输出的修正量不会收敛于零。在该场合,若被驱动体2的摩擦状态变化,则有时再次产生被驱动体2的振动。因此,为了避免这种状态,可以将反复控制部14的正反馈的反馈增益Kc设定为小于1。由此,能够以某时间数使从反复控制部14输出的修正量逐渐减小,其结果,能够避免这种被驱动体2的振动。到将反复控制部14输出的修正量收敛于零的时间数根据反馈增益Kc的大小规定。图5a及图5b是表示仿真结果的图,该仿真结果表示本发明的实施例的反复控制部的反馈增益Kc与反复控制部的输出的关系,图5a是表示反复控制部的反馈增益Kc为1的场合的图,图5b是表示反复控制部的反馈增益Kc小于1的场合的图。在仿真中,对电动机M赋予图11所示的位置指令。在图11所示的指令位置,反复进行100Hz的正弦波状的相同模式,在某时点逐渐减小其振幅,最终振幅为零。若对本发明的实施例的电动机M的控制装置1给予图11所示的位置指令而反复驱动控制具有图10所示的非线形摩擦特性的被驱动体2,则在反复控制部14的反馈增益Kc为1的场合,如图5a所示,即使位置指令为零,从反复控制部14输出的修正量也不会收敛于零,维持某个一定值。相对于此,在反复控制部14的反馈增益Kc小于1的场合,如图5b所示,若位置指令为零,则与此相应地从反复控制部14输出的修正量收敛于零。这样,如果将反复控制部14的反馈增益Kc设定为小于1,则在利用电动机对被驱动体2进行相同动作模式的反复控制的场合,在为了使被驱动体2停止而使电动机M的位置指令为零时,由于从反复控制部14输出的修正量收敛于零,因此即使被驱动体2的摩擦的状态变化,也能够抑制被驱动体2的振动。
接着,更具体地对不灵敏带处理部13的处理进行说明。图6及图7是表示以往使用的不灵敏带处理特性的图。另外,图8及图9是说明在本发明的实施例的电动机的控制装置的不灵敏带处理部使用的不灵敏带特性的图。根据以往普遍使用的不灵敏带处理,如图6所示,在输入信号位于不灵敏带范围内时,输出信号设定为零,在输入信号处于不灵敏带范围外时,设定为以式1表示的输出信号。
输出信号=(︱输入信号︱-不灵敏带宽度)*(输入信号的符号)…(式1)
若使用图6所示的不灵敏带特性,则由于在不灵敏带范围的边界左右的输出信号的不连续性小,因此在控制的稳定性方面也优异。但是,若将图6所示的不灵敏带特性原样应用于本发明的实施例的电动机的控制装置的不灵敏带处理部,则在输入信号位于不灵敏带范围外时,如式1所示,从输入信号减去不灵敏带宽度,因此反复控制部14的增益实际上下降,反复控制部14相对于位置偏差的变动的追随性变差。
另一方面,若将在图7所示的输入信号位于不灵敏带范围内时将输出信号设定为零,在输入信号处于不灵敏带范围外时与输入信号相等的不灵敏带特性应用于本发明的实施例的电动机的控制装置的不灵敏带处理部时,能够避免在图6所示的不灵敏带特性中成为问题的反复控制部14的增益的下降。但是,在该场合,由于输出信号不连续,因此在反复控制部14的控制的稳定性方面存在问题。
因此,在本发明的实施例的电动机的控制装置1的不灵敏带处理部13中,使用图8或9所示的不灵敏带特性。
在图8所示的例子中,不灵敏带处理部13在由位置偏差获取部12获取的位置偏差包含于规定的不灵敏带范围内的场合,将该位置偏差置换为零并输出,在包含于从不灵敏带范围到将该不灵敏带范围包含于内部的缓冲范围内期间的场合,将比此时的位置偏差小的值设定为新的位置偏差并输出,在位于缓冲范围外的场合,将此时的位置偏差原样输出。在此,在处于从不灵敏带范围外到缓冲范围内之间的场合所设定的上述新的位置偏差在由位置偏差获取部12获取的位置偏差处于不灵敏带范围的边界时为零,并且在由位置偏差获取部12获取的位置偏差处于缓冲范围的边界时根据与该位置偏差一致的增函数,作为具有连续性的值而设定。通过使用这种不灵敏带特性,能够提高反复控制部14相对于位置偏差的变动的追随性,另外反复控制部14的控制的稳定性也增加。因此,能够更迅速且稳定地抑制被驱动体2的振动。
另外,图9所示的例子在图8所示的不灵敏带特性中,不灵敏带范围的边界的左右及缓冲范围的边界的左右的输出信号的连续性更顺畅。由此,反复控制部14的控制的稳定性进一步增加。
本发明能够应用于由数值控制装置等控制装置驱动控制的机床或工业机械等的电动机的控制装置。尤其通过反复进行规定的相同模式的位置指令,能够利用相同动作模式驱动控制被驱动体的电动机的控制装置。作为利用相同动作模式进行动作的被驱动体的例子,具有相对于产品进行反复加工的工具等。
根据本发明,在反复控制部的前级设置不灵敏带处理部,该不灵敏带处理部在给予电动机的位置指令和由位置检测部检测的被驱动体的位置的位置偏差包含于规定的不灵敏带范围内的场合,将该位置偏差置换为零并输出,由于将从不灵敏带处理部输出的位置偏差输入反复控制部,因此反复控制部不会受到被驱动体的非线形摩擦的影响。反复控制部计算从该不灵敏带处理部输出的位置偏差为零的修正量,由于将其加在位置偏差上并利用电动机驱动控制被驱动体,因此在利用电动机对被驱动体进行相同动作模式的反复控制的场合,能够抑制为了使被驱动体停止而使电动机的位置指令为零时产生的被驱动体的振动。
另外,若设定不灵敏带,则反复控制部无法相对于该不灵敏带宽度的位置偏差发挥功能,由于位置偏差不会收敛于零而具有相当于不灵敏带宽度的位置偏差,因此也得到被驱动体产生振动的状态,但在本发明中,通过使不灵敏带处理部构成为在相对于电动机的规定的值以下的速度指令持续规定的时间的场合或对被驱动体进行检测的速度为规定的值以下的状态持续规定的时间的场合,将包含于不灵敏带范围内的位置偏差置换为零并输出,能够使位置偏差收敛于零,抑制被驱动体的振动的产生。
另外,根据本发明,通过使不灵敏带处理部构成为,在由位置偏差获取部获取的位置偏差位于从不灵敏带范围外将该不灵敏带范围包含于内部的缓冲范围内期间的场合,将比此时的位置偏差小的值设定为新的位置偏差并输出,在由位置偏差获取部获取的位置偏差处于缓冲范围外的场合,将此时的位置偏差原样输出,能够更迅速且稳定地抑制被驱动体的振动。
另外,根据本发明,通过使反复控制部构成为,具有屏蔽高频区域的低通滤波器部、设置在在低通滤波器部的后级并保持相当于采样周期的至少一个周期的修正量的存储器部、将在利用存储器部保持后的输出上乘以小于1的增益的值和从不灵敏带处理部输出的位置偏差相加的加法器,在上述低通滤波器部输入利用加法器得到的相加结果,即使被驱动体的摩擦的状态变化,也能够抑制被驱动体的振动的产生。

Claims (4)

1.一种电动机的控制装置,其通过反复执行规定的相同模式的位置指令,以相同动作模式驱动控制被驱动体,该电动机的控制装置的特征在于,
具备:检测上述被驱动体的位置的位置检测部;
在每个采样周期获取给予上述电动机的位置指令和由上述位置检测部检测的上述被驱动体的位置的位置偏差的位置偏差获取部;
不灵敏带处理部,其在由上述位置偏差获取部获取的上述位置偏差包含于规定的不灵敏带范围内的场合,将该位置偏差置换为零并输出,在相对于上述电动机的规定的值以下的速度指令持续规定的时间的场合或对上述被驱动体检测的速度为规定的值以下的状态持续规定的时间的场合,将包含于上述不灵敏带范围内的位置偏差置换为零并输出;以及
计算从上述不灵敏带处理部输出的位置偏差为零的修正量的反复控制部,
根据由上述位置偏差获取部获取的上述位置偏差和由上述反复控制部计算的修正量控制上述电动机。
2.根据权利要求1所述的电动机的控制装置,其特征在于,
上述反复控制部具有:
屏蔽高频区域的低通滤波器部;
设置在上述低通滤波器部的后级并在上述采样周期的至少一个周期期间保持上述修正量的存储器部;以及
将在由上述存储器部保持后的输出上乘上小于1的增益的值和从上述不灵敏带处理部输出的位置偏差相加的加法器,
在上述低通滤波器部中输入由上述加法器得到的相加结果。
3.根据权利要求1或2所述的电动机的控制装置,其特征在于,
上述不灵敏带处理部在由上述位置偏差获取部获取的上述位置偏差处于从上述不灵敏带范围外到使该不灵敏带范围包含于内部的缓冲范围内的期间的场合,将比该位置偏差小的值设定为新的位置偏差并输出,
在由上述位置偏差获取部获取的上述位置偏差位于上述缓冲范围外的场合,将该位置偏差原样输出。
4.根据权利要求3所述的电动机的控制装置,其特征在于,
就在包含于从上述不灵敏带范围外到上述缓冲范围内的期间的场合所设定的上述新的位置偏差而言,在由上述位置偏差获取部获取的上述位置偏差位于上述不灵敏带范围的边界时为零,并且,在由上述位置偏差获取部获取的上述位置偏差处于上述缓冲范围的边界时根据与该位置偏差一致的增函数设定。
CN201210418376.5A 2011-10-27 2012-10-26 具备不灵敏带处理部的电动机的控制装置 Active CN103092135B (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2011236157A JP5221735B2 (ja) 2011-10-27 2011-10-27 不感帯処理部を備えた電動機の制御装置
JP2011-236157 2011-10-27

Publications (2)

Publication Number Publication Date
CN103092135A CN103092135A (zh) 2013-05-08
CN103092135B true CN103092135B (zh) 2014-03-19

Family

ID=48084492

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201210418376.5A Active CN103092135B (zh) 2011-10-27 2012-10-26 具备不灵敏带处理部的电动机的控制装置

Country Status (4)

Country Link
US (1) US8903518B2 (zh)
JP (1) JP5221735B2 (zh)
CN (1) CN103092135B (zh)
DE (1) DE102012110227B4 (zh)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5713044B2 (ja) * 2013-04-15 2015-05-07 ダイキン工業株式会社 制御装置
JP6673632B2 (ja) 2014-09-08 2020-03-25 ファナック株式会社 レーザ光を高速で走査可能なガルバノスキャナを含む光造形加工機
US10381031B2 (en) * 2015-03-31 2019-08-13 Seagate Technology Llc Adaptive disturbance rejection using dead zone filter
JP6544219B2 (ja) * 2015-11-30 2019-07-17 オムロン株式会社 制御装置
US10081102B1 (en) * 2016-06-02 2018-09-25 X Development Llc Antagonistic output actuation
JP6457569B2 (ja) 2017-02-24 2019-01-23 ファナック株式会社 サーボモータ制御装置、サーボモータ制御方法、及びサーボモータ制御用プログラム
JP7021147B2 (ja) * 2019-04-03 2022-02-16 ファナック株式会社 モータ制御装置及びモータ制御用コンピュータプログラム
CN112977080B (zh) * 2019-12-16 2022-08-26 华为技术有限公司 驱动防滑控制方法、装置以及驱动防滑控制系统

Family Cites Families (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0799482B2 (ja) * 1984-08-09 1995-10-25 東芝機械株式会社 プラスチックシート等の厚さ制御方法
JPH0421101A (ja) * 1990-05-16 1992-01-24 Fanuc Ltd 学習コントローラの飽和処理方式
JPH0443996A (ja) 1990-06-11 1992-02-13 Toshiba Corp 高速炉プラントの蒸気流量制御装置
JP2840139B2 (ja) 1991-04-24 1998-12-24 ファナック株式会社 予見繰り返し制御装置
JPH05216903A (ja) * 1992-02-06 1993-08-27 Hitachi Ltd 帳票書式作成方法および装置
US6272401B1 (en) * 1997-07-23 2001-08-07 Dresser Industries, Inc. Valve positioner system
JP2001126421A (ja) * 1999-10-29 2001-05-11 Sony Corp ディスクドライブ装置およびディスクドライブ装置のヘッド位置決め制御方法
JP2002199767A (ja) * 2000-12-27 2002-07-12 Aisin Seiki Co Ltd 外乱補償制御装置
JP4043996B2 (ja) 2003-01-20 2008-02-06 ファナック株式会社 サーボモータ駆動制御装置
JP2004227163A (ja) * 2003-01-21 2004-08-12 Fanuc Ltd サーボ制御装置
US7649815B2 (en) 2004-01-16 2010-01-19 Panasonic Corporation Repetitive control device and optical disc device
CN100462875C (zh) 2006-04-14 2009-02-18 中国科学院长春光学精密机械与物理研究所 具有间隙特性传动机构的控制系统
WO2007125083A1 (de) * 2006-04-27 2007-11-08 Continental Teves Ag & Co. Ohg Verfahren und vorrichtung zum ermitteln eines optimalen lenkwinkels in untersteuersituationen eines fahrzeugs
JP2009181242A (ja) * 2008-01-29 2009-08-13 Panasonic Corp デジタルpid制御装置

Also Published As

Publication number Publication date
US8903518B2 (en) 2014-12-02
JP5221735B2 (ja) 2013-06-26
CN103092135A (zh) 2013-05-08
US20130106336A1 (en) 2013-05-02
JP2013092986A (ja) 2013-05-16
DE102012110227A1 (de) 2013-05-02
DE102012110227B4 (de) 2019-11-21

Similar Documents

Publication Publication Date Title
CN103092135B (zh) 具备不灵敏带处理部的电动机的控制装置
JP5885883B2 (ja) サーボ制御装置
CN111788040B (zh) 机器人的动力学参数辨识方法、机器人和存储装置
CN102893513B (zh) 马达控制装置
JP2017102617A (ja) 補正装置、補正装置の制御方法、情報処理プログラム、および記録媒体
CN102006011A (zh) 具有同时推定惯量和摩擦的功能的电动机的控制装置
JP5646073B2 (ja) サーボ制御装置
CN107769627B (zh) 电动机控制装置、电动机控制方法及计算机可读记录介质
WO2014167808A1 (ja) モータ駆動装置
CN105242678B (zh) 一种舵机抖动抑制电路及舵机系统
CN105320059A (zh) 伺服电动机的控制装置
CN105978400A (zh) 超声电机控制方法
CN107678276A (zh) 一种基于转台控制的自适应复合控制方法
JP2021047556A (ja) 物体移動装置、工作機械、情報処理装置、情報処理方法および情報処理プログラム
JP2014204622A (ja) モータ駆動装置
CN109067284B (zh) 一种基于滤波误差的电机控制方法及装置
CN108964553B (zh) 一种用于伺服电机控制的路径规划方法及装置
US20160292349A1 (en) Method and apparatus for supporting design improvement work of mechanical apparatus
JP5246328B2 (ja) モータ制御装置
KR102240722B1 (ko) 레퍼런스 재생성부를 포함하는 제어기 및 이의 제어 방법
JP2014002474A (ja) サーボ制御装置
KR102240723B1 (ko) 위치 예측부를 포함하는 제어기 및 이의 제어 방법
TW201344383A (zh) 使用於工具機之加工路徑最佳化方法
US9052005B2 (en) Method of backlash compensation
WO2022044329A1 (ja) 制御システム、制御方法、コンピュータ、および制御プログラム

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant