CN115336169A - 电动机的控制装置 - Google Patents

电动机的控制装置 Download PDF

Info

Publication number
CN115336169A
CN115336169A CN202180022833.6A CN202180022833A CN115336169A CN 115336169 A CN115336169 A CN 115336169A CN 202180022833 A CN202180022833 A CN 202180022833A CN 115336169 A CN115336169 A CN 115336169A
Authority
CN
China
Prior art keywords
inertia
driven body
information
estimating unit
control device
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.)
Pending
Application number
CN202180022833.6A
Other languages
English (en)
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 CN115336169A publication Critical patent/CN115336169A/zh
Pending legal-status Critical Current

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
    • G05B19/00—Programme-control systems
    • G05B19/02—Programme-control systems electric
    • G05B19/18—Numerical 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/406—Numerical 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 monitoring or safety
    • G05B19/4062—Monitoring servoloop, e.g. overload of servomotor, loss of feedback or reference
    • 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
    • G05B19/00—Programme-control systems
    • G05B19/02—Programme-control systems electric
    • G05B19/18—Numerical 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/404—Numerical 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
    • 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/40—Regulating or controlling the amount of current drawn or delivered by the motor for controlling the mechanical 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/37—Measurements
    • G05B2219/37388—Acceleration or deceleration, inertial measurement
    • 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/37—Measurements
    • G05B2219/37621—Inertia, mass of rotating, moving tool, workpiece, element
    • 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/14—Estimation or adaptation of motor parameters, e.g. rotor time constant, flux, speed, current or voltage

Landscapes

  • Engineering & Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Power Engineering (AREA)
  • Numerical Control (AREA)
  • Control Of Electric Motors In General (AREA)

Abstract

提供一种能够自动地判断是否需要启动惯性估计功能的控制装置。一种电动机的控制装置(10)，具备：第一惯性估计部(11)，其基于与具备电动机的装置的动作程序或动作设定有关的第一信息、从用于检测通过电动机而被驱动的被驱动体的形状的检测装置获得的第二信息以及表示电动机的动作状态的第三信息中的至少任一者，来估计被驱动体的惯性是否存在变动；以及第二惯性估计部(12)，其在由第一惯性估计部(11)估计为被驱动体的惯性存在变动的情况下，进行被驱动体的惯性的估计。

Description

电动机的控制装置
技术领域
本发明涉及一种电动机的控制装置。
背景技术
在机床等使用电动机来驱动各驱动轴的系统中，包括工件、搭载工件的工作台等的被驱动体的惯性根据成为加工对象的工件而变化。因而，为了在这样的机床中准确地控制各轴，需要准确地获知被驱动体的惯性。提出有具备估计被驱动体的惯性的功能的机床(例如，专利文献1、专利文献2以及专利文献3)。
现有技术文献
专利文献
专利文献1：日本特开2010-148178号公报
专利文献2：日本特开2014-007816号公报
专利文献3：日本特开2016-181193号公报
发明内容
发明要解决的问题
为了进行惯性估计，需要使机床稳定地执行特定的动作，因此惯性估计功能的执行一般耗费时间。一般而言，这样的惯性估计功能的启动往往是根据操作者的判断来进行的。期望一种能够自动地判断是否需要启动惯性估计功能的控制装置。
用于解决问题的方案
本公开的一个方式是一种电动机的控制装置，具备：第一惯性估计部，其基于与具备所述电动机的装置的动作程序或动作设定有关的第一信息、从用于检测通过所述电动机而被驱动的被驱动体的形状的检测装置获得的第二信息以及表示所述电动机的动作状态的第三信息中的至少任一者，来估计所述被驱动体的惯性是否存在变动；以及第二惯性估计部，其在由所述第一惯性估计部估计为所述被驱动体的惯性存在变动的情况下，进行所述被驱动体的惯性的估计。
发明的效果
根据上述结构，能够自动地估计惯性是否发生了变动并启动惯性估计功能。
根据附图所示的本发明的典型的实施方式的详细说明，本发明的这些目的、特征及优点、以及其它的目的、特征及优点将变得更明确。
附图说明
图1是表示包括一个实施方式所涉及的电动机的控制装置的系统的结构的框图。
图2是用于说明机床中治具改变了的状况的图。
图3是用于说明机床中程序改变了的状况的图。
图4是用于说明机床中的一个程序的结束到下一个程序的开始的状况的图。
图5是表示机床中由视觉传感器对工件进行摄影的状况的图。
图6是表示机床中由视觉传感器对治具进行摄影的状况的图。
图7是用于对因工件的差异引起的加工的种类数的差异进行说明的图。
图8是用于对在非切削时等估计被驱动体的惯性的变动的动作进行说明的图。
图9是用于对在进给轴以恒定加速度动作时估计被驱动体的惯性的变动的动作进行说明的图。
图10是示出进给轴的加速度和转矩的时间推移的例子的图。
图11A是用于说明将惯性不同的工件使用于机床的状况的图。
图11B是用于说明将惯性不同的工件使用于机床的状况的图。
图12A是表示图11A的状况中的转矩指令的时间波形的图。
图12B是表示图11B的状况中的转矩指令的时间波形的图。
图13A是表示图12A的转矩指令的时间波形的频率特性的图。
图13B是表示图12B的转矩指令的时间波形的频率特性的图。
具体实施方式
接着，参照附图来对本公开的实施方式进行说明。在参照的附图中，对相同的结构部分或功能部分标注了相同的参照标记。为了易于理解，适当地变更了这些附图的比例尺。另外，附图所示的方式是用于实施本发明的一个例子，本发明并不限定于图示的方式。
图1是表示包括一个实施方式所涉及的同步电动机的控制装置10的系统的结构的框图。本实施方式所涉及的同步电动机的控制装置(下面简称为“控制装置”)10基于来自计算机数值控制装置(CNC：Computer Numerical Control)等上位控制装置20的位置指令，来控制放大器30，由此使驱动被驱动体51的同步电动机41(下面记述为电动机41)以规定的指令速度进行动作。电动机41例如可以是用于对机床中的主轴或进给轴进行驱动控制的电动机，或者也可以是使机器人的关节轴进行旋转动作的电动机。由电动机41驱动的被驱动体51可以包括台、机械臂以及相对于它们可进行装卸的工件等，另外，也可以包括电动机41本身的动作部分。
下面，图1所记载的系统设为电动机41构成机床1来进行说明。电动机41的位置、速度、转矩通过执行伺服控制的控制装置10而被控制。也可以是，对于各个轴而将控制装置10连接于上位控制装置20。
在图1的结构中，在上位控制装置20中通过指令计算生成的位置指令被发送到控制装置10，由位置控制部2进行接收。位置控制部2基于所接收到的位置指令，向速度控制部3发送速度指令。速度控制部3基于所接收到的速度指令，向电流控制部4发送电流指令。电流控制部4向电流放大电路31发送电压指令，该电流放大电路31构成用于驱动电动机41的放大器30。电动机41利用从电流放大电路31输入的电力而以规定的指令速度进行动作，从而驱动被驱动体51。
在电动机41设置有用于检测电动机41的速度和位置的传感器42。与传感器42检测到的速度及位置有关的数据被分别反馈到控制装置10内的位置控制部2、速度控制部3、以及后述的第一惯性估计部11及第二惯性估计部12。
第一惯性估计部11基于与机床1的动作程序(加工程序)或动作设定有关的第一信息、能够从用于检测通过电动机41而被驱动的被驱动体的形状的检测装置(外部传感器52)获得的第二信息、以及表示电动机41的动作状态的第三信息中的至少一者，来估计被驱动体的惯性是否存在变动。第二惯性估计部12在由第一惯性估计部11估计为被驱动体的惯性存在变动的情况下执行被驱动体的惯性的估计。
对第二惯性估计部12进行的惯性估计进行说明。第二惯性估计部12当从第一惯性估计部11接收到表示被驱动体的惯性存在变动的信号(启动指示)时，针对电动机41施加执行特定的动作的加减速指令，基于从电动机41反馈的速度值和从放大器30反馈的电流值来估计被驱动体51的惯性。被驱动体51的惯性J[kgm2]能够利用电流值I[A]、加速度值a[rad/s2]、速度值ω[rad/s]、同步电动机的转矩常数Kt来通过下式计算出。
J＝Kt×I/a＝Kt×I/(dω/dt)…(1)
对式(1)中的加速度a＝dω/dt的计算方法进行说明。设为从传感器42以采样周期T反馈某时刻t的速度值ω(t)。此时的加速度a能够利用在某时刻t反馈的速度值ω(t)与在该时刻t的一个采样周期之前的时刻(t-T)反馈的速度值ω(t-T)之差，计算为a＝(ω(t)-ω(t-T))/T。
为了如上述那样利用反馈信号来准确地估计惯性，需要在对于加减速指令而产生的转矩稳定后执行估计，因此惯性的估计需要一定程度的时间。由第二惯性估计部12估计出的惯性被使用于加减速指令的时间常数的决定、决定速度控制的响应性的速度控制增益的计算中。
下面，对第一惯性估计部11估计被驱动体的惯性是否发生了变动的具体的动作例进行说明。具体的动作例包括下面的内容。
(1)治具改变了时(基于第二信息的估计)
(2)程序改变了时(基于第一信息的估计)
(3)程序的时间间隔(基于第一信息的估计)
(4)由视觉传感器获得的二维图像(基于第二信息的估计)
(5)由视觉传感器获得的三维坐标(基于第二信息的估计)
(6)加工种类数(基于第一信息的估计)
(7)非切削时等的测定(基于第三信息的估计)
(8)恒定加速度时的测定(基于第三信息的估计)
(9)根据转矩波形进行估计(基于第三信息的估计)
此外，在上述动作例中，动作例(1)至(6)主要是在程序或工序开始前执行的处理，动作例(7)至(9)是在加工程序运行的过程中能够执行的处理。此外，在利用视觉传感器的动作例(4)、(5)的情况下，也能够在加工程序运行的过程中执行。
(1)治具改变了时
在用于固定工件的治具被变更了的情况下，能够视为工件的形状也变为不同的形状。据此，第一惯性估计部11检测用于固定工件的治具是否被变更了。而且，在治具被变更了的情况下，第一惯性估计部11根据工件的形状改变了这一情形而估计为被驱动体的惯性存在变动。图2图示了机床1上的治具、固定于治具的工件、以及主轴支承部101。在本动作例的情况下，在治具事先安装有用于保持治具所固有的识别信息的识别信息保持体(条形码、IC标签、ID芯片等)。在图2的左侧示出了机床1中使用治具71来作为用于固定工件W1的治具并通过安装于主轴支承部101的工具进行加工的状况。在图2的右侧示出了为了在机床1上固定与工件W1不同形状的工件W2而使用了与治具71不同的治具72的状况。
在治具71安装有用于保持治具71的识别信息的识别信息保持体91。在治具72安装有用于保持治具72的识别信息的识别信息保持体92。在该情况下，外部传感器52是用于读取识别信息保持体91、92所保持的识别信息的读取装置。作为一例，在识别信息保持体91、92为条形码的情况下，外部传感器52为条形码读取器。条形码读取器例如被安装于机床1的主轴支承部101的能够读取识别信息保持体91、92的位置。
第一惯性估计部11例如在开始执行加工程序之前的规定的定时，使外部传感器52读取识别信息保持体91(或92)所保持的识别信息。然后，在本次读取到的治具72的识别信息与前次读取到的治具71的识别信息不同的情况下，第一惯性估计部11根据工件的形状发生了变动这一情形而估计为惯性发生了变动，使第二惯性估计部12执行惯性的估计。
本动作例是通过检测治具的形状来间接地检测工件的形状改变了这一情形的方法。因此，在从外部传感器52的位置不能够直接观察工件那样的状况下能够取得优势。
(2)程序改变了时
在加工程序变为不同的程序时，能够考虑是成为加工对象的工件的形状发生变动的情况。据此，在加工程序变更了时，第一惯性估计部11根据工件的形状改变这一情形而估计为被驱动体的惯性存在变动。在图3的左侧示出了机床1中基于程序A进行加工的对象为工件W11的状况。在图3的右侧示出了机床1中基于程序B进行加工的对象为与工件W11不同形状的工件W12。此外，在图3中，例示了在基于程序A的加工和基于程序B的加工中使用相同的治具且工具也相同的情况。
在该情况下，第一惯性估计部11从上位控制装置20获取用于识别加工程序的信息(程序名等)。而且，第一惯性估计部11在所获取到的程序的识别信息与前次实施的程序的识别信息不同的情况下，根据工件的形状改变这一情形而估计为惯性发生变动。然后，第一惯性估计部11使第二惯性估计部12执行惯性的估计。
程序是否改变了除根据程序名进行判断的例子以外，还能够利用如下的方法进行判断。
(a1)设为在程序开始时测定在程序中已确定的工件的原点位置。在本次程序开始时测定出的原点位置与前次的程序中测定出的原点位置的差异超过阈值的情况下，判断为程序改变了。
(a2)在作为选择工件坐标系的G代码的坐标系(G54-G59)而使用了前次的程序中未使用的坐标系的情况下，判断为程序不同。例如，设为在前次的程序中所使用的工件坐标系仅为G代码的G54(即，只进行一个面的加工的定义内容)。设为本次的程序中定义的工件坐标系是G代码的G54、G55、G56(即，加工三个面的定义内容)。在该情况下，第一惯性估计部11能够根据使用的工件坐标系的差异而判断为程序不同。此外，这些(a1)、(a2)也能够称为与机床1的动作设定有关的信息。
(3)程序的时间间隔
一般而言，相同的加工程序的运行往往是不隔开时间间隔地连续进行的。因此，在从某加工程序的执行结束起直到下一加工程序开始为止空出了一定程度的时间间隔的情况下，能够考虑是进行不同的加工的状况(例如，加工程序不同的状况)，并且是工件的形状发生变动的情况。假定图4那样的状况。在图4中，在机床1中，基于程序A对工件W41进行的加工在时刻T1结束，基于下一程序B对工件W42进行的加工在时刻T2开始。在从前次的程序A的加工结束时刻T1起直到本次的加工程序B的开始时刻T2为止的间隔超过了预先设定的设定值的情况下，第一惯性估计部11判断为工件的形状发生变动。该设定值例如能够由用户经由上位控制装置20的用户接口设定输入到控制装置10中。该设定值依赖于机床的种类、加工的种类、对象工件的种类等，因此用户在考虑这些的基础上进行设定输入。
第一惯性估计部11从控制装置10内的内部时钟获取时刻信息，存储前次的程序A的结束时刻，获取本次的程序B的开始时刻。第一惯性估计部11将从前次的程序A的结束时刻T1起直到本次的程序B的开始时刻T2为止的时间间隔与预先设定的设定值进行比较。然后，在该时间间隔比设定值大的情况下，第一惯性估计部11根据工件的形状改变这一情形而估计为被驱动体51的惯性存在变动，使第二惯性估计部12执行惯性的估计。
(4)由视觉传感器获得的二维图像
接着，对使用视觉传感器110(摄像机)作为外部传感器52的情况下的由第一惯性估计部11进行的估计动作的例子进行说明。如图5-图6所示，视觉传感器110以能够拍摄包括被驱动体的至少一部分(例如工件或治具)的加工区域的方式被安装于主轴支承部101的上部。
在图5左侧示出了机床1正在对工件W51进行加工的状况。在图5右侧示出了机床1正在对与工件W51不同形状的工件W52进行加工的状况。在图5的情况下，视觉传感器110被安装于能够对工件W51(W52)进行摄影的位置。第一惯性估计部11获取视觉传感器110例如在加工开始时拍摄包括工件的区域所得到的图像。然后，第一惯性估计部11通过对比前次加工时获取到的工件W51的图像与本次加工时获取到的工件W52的图像，来判断工件的形状是否发生了变动。在此，也可以是，通过从所获取到的图像中提取例如工件所特有的色调的区域，来确定图像内的工件的形状并进行对比。也可以是，使用用于从图像中提取特征并确定图像内的工件的其它图像识别技术。
在通过像这样的利用工件的二维图像进行的对比而判断为工件的形状存在变动的情况下，第一惯性估计部11使第二惯性估计部12执行惯性的估计。
图6是说明由视觉传感器110检测治具的形状的情况的例子的图。在图6的左侧示出由机床1对固定于治具171的工件W61执行加工的状况。在图6的右侧示出由机床1对固定于治具172的工件W62执行加工的状况。在图6的情况下，视觉传感器110被配置于能够对治具171(治具172)的至少一部分进行摄影的位置。第一惯性估计部11获取由视觉传感器110获取到的包括治具的图像。然后，第一惯性估计部11通过对比前次加工时获取到的治具171的图像与本次加工时获取到的治具172的图像，来判定治具的形状是否改变了。在此，也可以是，通过从所获取到的图像中提取例如治具所特有的色调的区域，来确定图像内的治具的形状并进行对比。也可以是，使用用于从图像中提取特征并确定图像内的治具的其它图像识别技术。
在通过像这样的利用治具的二维图像进行的对比而判断为治具的形状改变了的情况下，第一惯性估计部11视为工件的形状改变了，估计为被驱动体的惯性存在变动。然后，第一惯性估计部11使第二惯性估计部12执行惯性的估计。本动作例是通过检测治具的形状来间接地检测工件的形状改变了这一情形的方法。因此，在从视觉传感器110的位置不能够直接观察工件那样的状况下能够取得优势。
(5)由视觉传感器获得的三维坐标
接着，对使用能够获取对象物的三维坐标信息的三维传感器(立体摄像机等)作为视觉传感器110的情况下的动作例进行说明。设为使用三维传感器作为视觉传感器110并在图5的状况下获取到包括工件W51、工件W52的区域的三维坐标信息(三维图像)。在该情况下，第一惯性估计部11例如将工件确定为三维图像内存在于工作台上的一块物体。第一惯性估计部11利用像这样确定出的工件W51、工件W52各自的三维形状信息来进行对比。由此，第一惯性估计部11能够更高精度地检测工件的形状(例如体积)是否改变了。此外，也可以使用基于三维图像内的特征量来确定工件的其它图像处理技术。
考虑使用三维传感器作为视觉传感器110并如图6那样获取到包括治具171、治具172的区域的三维坐标信息的情况。在该情况下，第一惯性估计部11也可以通过利用三维坐标信息，来将例如位于距视觉传感器110规定的距离处的物体确定为治具。第一惯性估计部11利用像这样确定出的治具171、治具172各自的三维形状信息进行对比。由此，第一惯性估计部11能够更高精度地检测治具的形状是否改变了。此外，也可以使用基于三维图像内的特征量来确定治具的其它图像处理技术。本动作例是通过检测治具的形状来间接地检测工件的形状改变了这一情形的方法。因此，在从视觉传感器110的位置不能够直接观察工件那样的状况下能够取得优势。
(6)加工种类数
一般而言，数值控制装置(CNC)的加工程序具有在对加工的流程整体进行控制的主流程之下按加工的种类设置描述具体加工的子例程的结构。据此，能够通过提取加工程序中的子例程的数量来掌握加工的种类数。第一惯性估计部11从上位控制装置20所持有的加工程序获取加工的种类数。第一惯性估计部11将从前次执行的程序中提取出的加工的种类数与从本次执行的程序中提取出的加工的种类数进行比较。在图7的左侧示出由机床1基于某程序对工件W71执行加工的状况。在图7的右侧示出了机床1基于与W71用的程序不同的程序对与工件W71不同形状的工件W72执行加工的状况。在该情况下，由于工件的形状不同，因此具体的加工内容会出现差异，从而加工的种类数也会不同。
在前次的程序中的加工的种类数与本次的程序中的加工的种类数不同的情况下，第一惯性估计部11根据工件的形状改变这一情形而估计为被驱动体51的惯性发生变动。在该情况下，第一惯性估计部11使第二惯性估计部12执行惯性的估计。
(7)非切削时等的测定
第一惯性估计部11也可以构成为，能够以在加工程序执行的过程中不会招致加工程序的中断等的形式来估计惯性是否发生了变动。这样的动作的第一例为，在加工程序执行的过程中处于非切削状态的情况下，在成为惯性估计的对象的轴停止了或正在以恒定速度动作时(所谓的非切削动作时)，对该轴进行励振并进行惯性的计算。在图8中示出机床1的结构。如图8所示，机床1在主轴支承部101的前端部具备用于驱动主轴的主轴马达M11。另外，机床1具备用于使载置工件W81的工作台分别沿与主轴(Z轴)垂直的X轴及Y轴方向移动的进给轴马达M12、M13。
例如，设为作为惯性估计的对象的轴为X轴方向的轴。在该情况下，第一惯性估计部11通过利用例如来自传感器42的反馈信息，来检测非切削中且进给轴马达M12停止了时或正在以恒定速度动作的状态。在检测到这样的状态的情况下，第一惯性估计部11对该进给轴施加振动，并根据此时的加速度a[rad/s2]和转矩T[Nm]来通过下面的运动方程式(2)求出惯性J[kgm2]。此外，转矩T[Nm]能够将从电流控制部4反馈的电流值乘以系数而求出。
Ja＝T…(2)
此外，由于这里的目的在于求出惯性是否发生了变动，因此能够以比在第二惯性估计部12估计惯性的情况下花费的时间短的时间执行惯性值的计算。也可以是，第一惯性估计部11在通过上述的励振动作检测到的惯性与前次通过这样的励振动作检测到的惯性不同的情况下(例如，在惯性的差异超过规定的阈值的情况下)，通过向上位控制装置20进行通知来使加工程序中断，使第二惯性估计部12进行准确的惯性的估计。
(8)恒定加速度时的测定
对能够以在加工程序执行的过程中不招致加工程序的中断等的形式来估计惯性是否发生了变动的动作的第二例进行说明。在本动作例中，在加工程序执行过程中为非切削状态的情况下，在成为惯性估计的对象的轴正在以恒定加速度动作时，第一惯性估计部11计算与该轴有关的惯性。在图9中示出机床1的结构。如图9所示，在机床1中，载置有工件W91的工作台75通过进给机构而移动，该进给机构通过进给轴马达M12而被驱动。图10示出作为进给轴马达M12的驱动控制的一例的加速度的时间推移(曲线131)和转矩的时间推移(曲线132)。第一惯性估计部11例如利用来自传感器42的信息，来检测加速度a恒定的状态(例如，在图10中，时刻t3与t4之间)。然后，在加速度a恒定的状态时，第一惯性估计部11通过上述运动方程式(2)来计算作为对象的轴的惯性。
也可以是，第一惯性估计部11在通过上述动作计算出的惯性与前次通过同样的动作计算出的惯性不同的情况下(例如，在惯性的差异超过规定的阈值的情况下)，通过向上位控制装置20进行通知来使加工程序中断，使第二惯性估计部12进行准确的惯性的估计。
(9)根据转矩波形进行估计
对能够以在加工程序执行的过程中不招致加工程序的中断等的形式来估计惯性是否发生了变动的动作的第三例进行说明。第一惯性估计部11也可以构成为，基于对针对成为惯性估计的对象的轴的转矩指令的时间波形进行频率解析所获得的频率峰值的位置，来估计该轴的惯性是否发生了变动(工件的形状是否发生了变动)。对转矩指令的时间波形进行频率解析所获得的频率峰值的位置取决于机械系统的共振频率而变动。如图11A和图11B所示，假定由机床1对惯性不同的工件W93(惯性Ja)、工件W94(惯性Jb)进行加工的状况。在除去工件后的状态下的进给轴(进给轴马达M12)的被驱动体的惯性为Jm，是共通的。
图12A表示图11A的状况中的进给轴的转矩指令的时间波形141，图12B表示图11B的状况中的进给轴的转矩指令的时间波形142。图13A示出通过基于FFT(高速傅里叶变换)对图12A的时间波形141进行频率解析所获得的频率特性151，图13B示出通过基于FFT(高速傅里叶变换)对图12B的时间波形142进行频率解析所获得的频率特性152。如图13A和图13B所示，在工件不同的情况下，转矩指令的时间波形的频率峰值的频率F1与频率F2不同。在前次检测时的频率峰值的位置的频率F1与本次检测时的频率峰值的位置的频率F2不同的情况下，第一惯性估计部11估计为惯性发生了变动(即，是工件的形状发生了变动的状况)，使第二惯性估计部12执行惯性的估计。
如上面所说明的那样，根据本实施方式，能够自动地估计惯性是否发生了变动并启动惯性估计功能。
上面使用典型的实施方式对本发明进行了说明，但只要是本领域技术人员就能够理解，能够在不脱离本发明的范围的情况下对上述的各实施方式进行变更以及各种其它的变更、省略、追加。
上述的实施方式所涉及的控制装置的结构能够应用于机器人及其它具有通过电动机而被驱动的驱动轴的各种工业机械的控制装置。
图1所示的控制装置10的结构可以通过控制装置10所具备的CPU执行保存于存储装置中的各种软件来实现，或者也可以通过以ASIC(Application Specific IntegratedCircuit：专用集成电路)等硬件为主体的结构来实现。执行与由第一惯性估计部11和第二惯性估计部12执行的上述的处理内容相当的控制方法的程序能够记录于计算机能够读取的各种记录介质(例如，ROM、EEPROM、快闪存储器等半导体存储器、CD-ROM、DVD-ROM等光盘、磁记录介质)。
附图标记说明
1：机床；2：位置控制部；3：速度控制部；4：电流控制部；10：控制装置；11：第一惯性估计部；12：第二惯性估计部；20：上位控制装置；30：放大器；31：电流放大电路；41：电动机；42：传感器；51：被驱动体；52：外部传感器；101：主轴支承部；110：视觉传感器。

Claims (9)

1.一种电动机的控制装置，具备：
第一惯性估计部，其基于与具备所述电动机的装置的动作程序或动作设定有关的第一信息、从用于检测通过所述电动机而被驱动的被驱动体的形状的检测装置获得的第二信息以及表示所述电动机的动作状态的第三信息中的至少任一者，来估计所述被驱动体的惯性是否存在变动；以及
第二惯性估计部，其在由所述第一惯性估计部估计为所述被驱动体的惯性存在变动的情况下，进行所述被驱动体的惯性的估计。
2.根据权利要求1所述的电动机的控制装置，其中，
所述第二信息是由作为所述检测装置的视觉传感器获得的所述被驱动体的至少一部分的二维图像或三维坐标信息，
所述第一惯性估计部基于所述二维图像或所述三维坐标信息，来判断所述被驱动体的形状是否发生了变动，在判断为所述被驱动体的形状发生了变动的情况下，估计为所述被驱动体的惯性存在变动。
3.根据权利要求1所述的电动机的控制装置，其中，
所述第二信息是由作为所述检测装置的读取装置从安装于所述被驱动体的识别信息保持体读取到的、所述被驱动体所固有的识别信息，
所述第一惯性估计部基于由所述读取装置读取到的所述被驱动体的所述识别信息，来估计所述被驱动体的惯性是否存在变动。
4.根据权利要求1所述的电动机的控制装置，其中，
所述第一惯性估计部在基于所述第一信息判断为前次执行的动作程序与本次执行的动作程序不同的情况下，估计为所述被驱动体的惯性存在变动。
5.根据权利要求1所述的电动机的控制装置，其中，
所述第一信息是与所述动作程序的开始时刻或结束时刻有关的信息，
在前次执行的动作程序的结束时刻与本次执行的动作程序的开始时刻的时间间隔超过预先设定的设定时间的情况下，所述第一惯性估计部估计为所述被驱动体的惯性存在变动。
6.根据权利要求1所述的电动机的控制装置，其中，
所述第一信息是表示所述动作程序内所定义的加工的种类数的信息，
在前次执行的动作程序内所定义的加工的种类数与本次执行的动作程序内所定义的加工的种类数不同时，所述第一惯性估计部估计为所述被驱动体的惯性存在变动。
7.根据权利要求1所述的电动机的控制装置，其中，
所述装置是包括主轴和进给轴作为驱动轴的机床，
所述第三信息是表示设置于所述驱动轴的各个驱动轴的所述电动机的动作状态的信息，
所述第一惯性估计部通过在所述机床为非切削状态且所述驱动轴中的成为对象的轴停止了或正在以恒定速度动作时，对所述成为对象的轴进行励振并对所述成为对象的轴进行惯性的测定，来估计所述成为对象的轴的所述被驱动体的惯性是否存在变动。
8.根据权利要求1所述的电动机的控制装置，其中，
所述第三信息是表示所述电动机的加速度的信息，
所述第一惯性估计部通过在所述电动机的加速度恒定时进行所述电动机的所述被驱动体的惯性的测定，来估计所述被驱动体的惯性是否存在变动。
9.根据权利要求1所述的电动机的控制装置，其中，
所述第三信息是与针对所述电动机的转矩指令的随时间推移的波形有关的信息，
所述第一惯性估计部在通过对所述波形进行频率解析所获得的频率峰值的位置存在变动的情况下，估计为所述被驱动体的惯性存在变动。
CN202180022833.6A 2020-03-23 2021-03-17 电动机的控制装置 Pending CN115336169A (zh)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP2020051597 2020-03-23
JP2020-051597 2020-03-23
PCT/JP2021/010855 WO2021193290A1 (ja) 2020-03-23 2021-03-17 電動機の制御装置

Publications (1)

Publication Number Publication Date
CN115336169A true CN115336169A (zh) 2022-11-11

Family

ID=77890252

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202180022833.6A Pending CN115336169A (zh) 2020-03-23 2021-03-17 电动机的控制装置

Country Status (5)

Country Link
US (1) US11892813B2 (zh)
JP (1) JP7359944B2 (zh)
CN (1) CN115336169A (zh)
DE (1) DE112021001809T5 (zh)
WO (1) WO2021193290A1 (zh)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7118316B1 (ja) * 2022-01-31 2022-08-15 三菱電機株式会社 モータ制御装置、加工システム、モータ制御方法、および加工方法
CN117175981A (zh) * 2023-09-13 2023-12-05 东南大学 一种基于图像识别的永磁同步电机无位置控制系统及方法

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4565034B2 (ja) 2008-12-16 2010-10-20 ファナック株式会社 イナーシャ推定を行う制御装置及び制御システム
JP5369225B1 (ja) 2012-06-22 2013-12-18 ファナック株式会社 アンプ保護機能を備えた同期電動機の制御装置及び制御方法
JP6407076B2 (ja) 2015-03-25 2018-10-17 Dmg森精機株式会社 位置決め装置のパラメータ設定方法、及び位置決め装置
JP6464226B2 (ja) 2017-06-14 2019-02-06 ファナック株式会社 電動機の制御装置
DE102018209094B4 (de) 2017-06-14 2021-10-28 Fanuc Corporation Motorsteuereinheit
CN110914770B (zh) 2018-07-05 2021-03-12 三菱电机株式会社 数控装置

Also Published As

Publication number Publication date
DE112021001809T5 (de) 2023-02-02
US20230050838A1 (en) 2023-02-16
WO2021193290A1 (ja) 2021-09-30
US11892813B2 (en) 2024-02-06
JP7359944B2 (ja) 2023-10-11
JPWO2021193290A1 (zh) 2021-09-30

Similar Documents

Publication Publication Date Title
JP7359944B2 (ja) 電動機の制御装置
CN106346315B (zh) 能够取得工件原点的机床控制系统以及工件原点设定方法
JP4098761B2 (ja) 仕上げ加工方法
US10478935B2 (en) Deburring apparatus
JP6445070B2 (ja) 工作機械の制御システム
JP6140130B2 (ja) 工具及び被加工物を保護する数値制御装置
JP4276252B2 (ja) 工具とワークの接触検知機構を有する工作機械
US6993410B2 (en) Active electromagnetic device for measuring the dynamic response of a tool in a CNC machine
JP4261470B2 (ja) 制御装置
JP6013139B2 (ja) 工具長測定方法および工作機械
US10618173B2 (en) Processing system and method for controlling processing machine
JP2014087883A (ja) 工具長測定方法および工作機械
JP3547564B2 (ja) 数値制御装置および数値制御装置における工具長補正方法
JP4451708B2 (ja) 誤加工防止装置および誤加工防止方法
JPS582907A (ja) 数値制御工作機械および工作機械の制御方法
WO2018083746A1 (ja) 設備診断装置および設備診断方法
EP0903198A2 (en) Contact detecting method and an apparatus for the same
JPH08118103A (ja) 工具の芯出装置
JP2002039743A (ja) 測定機
JP7419026B2 (ja) 数値制御装置および工作機械
JP3057218B2 (ja) 工具刃先検出装置
JP2020071703A (ja) 加工装置及び加工方法
JP7448648B2 (ja) 追随ロボットおよび制御装置
JP6829982B2 (ja) 機械位置測定装置および機械位置測定システム
JPS63108409A (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