CN109286352A - 伺服电动机控制装置 - Google Patents

伺服电动机控制装置 Download PDF

Info

Publication number
CN109286352A
CN109286352A CN201810777750.8A CN201810777750A CN109286352A CN 109286352 A CN109286352 A CN 109286352A CN 201810777750 A CN201810777750 A CN 201810777750A CN 109286352 A CN109286352 A CN 109286352A
Authority
CN
China
Prior art keywords
mentioned
driven member
speed
motor control
servo motor
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
Application number
CN201810777750.8A
Other languages
English (en)
Other versions
CN109286352B (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 CN109286352A publication Critical patent/CN109286352A/zh
Application granted granted Critical
Publication of CN109286352B publication Critical patent/CN109286352B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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/19—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 positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
    • G05B19/21—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 positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device
    • G05B19/23—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 positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device for point-to-point control
    • G05B19/231—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 positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device for point-to-point control the positional error is used to control continuously the servomotor according to its magnitude
    • G05B19/237—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 positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device for point-to-point control the positional error is used to control continuously the servomotor according to its magnitude with a combination of feedback covered by G05B19/232 - G05B19/235
    • 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/19—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 positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
    • G05B19/21—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 positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device
    • G05B19/23—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 positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device for point-to-point control
    • G05B19/231—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 positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device for point-to-point control the positional error is used to control continuously the servomotor according to its magnitude
    • G05B19/232—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 positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device for point-to-point control the positional error is used to control continuously the servomotor according to its magnitude with speed feedback only
    • 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
    • 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/19—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 positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
    • G05B19/33—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 positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an analogue measuring device
    • G05B19/37—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 positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an analogue measuring device for continuous-path control
    • G05B19/371—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 positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an analogue measuring device for continuous-path control the positional error is used to control continuously the servomotor according to its magnitude
    • G05B19/373—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 positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an analogue measuring device for continuous-path control the positional error is used to control continuously the servomotor according to its magnitude with speed feedback only
    • 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
    • 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/41021—Variable gain

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)
  • Control Of Electric Motors In General (AREA)
  • Control Of Position Or Direction (AREA)
  • Numerical Control (AREA)
  • Feedback Control In General (AREA)

Abstract

本发明提供一种抑制由于作用于被驱动体的驱动轴上的负荷的变动引起的响应性的下降的伺服电动机控制装置。伺服电动机控制装置具备：伺服电动机；被驱动体，其由伺服电动机进行驱动，作用于驱动轴的负荷根据被驱动体的位置而发生变动；位置检测部，其检测被驱动体的位置(FB)；速度检测部，其检测被驱动体的速度(FB)；以及电动机控制部，其控制伺服电动，电动机控制部具有：位置控制部，其根据被驱动体的位置指令与位置(FB)之间的位置偏差来生成速度指令；速度控制部，其将速度增益乘以速度指令与速度(FB)之间的速度偏差，和/或加上转矩补偿并生成转矩指令；以及变更部，其根据被驱动体的位置来变更速度增益与转矩补偿中的至少一个。

Description

伺服电动机控制装置
技术领域
本发明涉及一种控制用于驱动被驱动体的伺服电动机的伺服电动机控制装置。
背景技术
例如在机床中，会使用进给机构使包括用于驱动工具的主轴用电动机的主轴单元进行移动。已知一种伺服电动机控制装置(例如参照专利文献1～3)，控制用于驱动这种进给机构(被驱动体)的伺服电动机。
专利文献1：日本特开2002-178237号公报
专利文献2：日本特开平06-155217号公报
专利文献3：国际公开第2016/135958号
发明内容
在上述机床中，通过重力、旋转而作用于进给机构的驱动轴上的负荷(负载)会根据进给机构(被驱动体)的位置(即主轴单元的位置)而发生变化。例如，如果作用于驱动轴的负荷增加，则进给机构到达目标位置的时间变迟。即，伺服电动机控制装置的响应性下降。
本发明的目的为提供一种抑制由于作用于被驱动体的驱动轴上的负荷的变动引起的响应性的下降的伺服电动机控制装置。
(1)本发明的伺服电动机控制装置(例如后述的伺服电动机控制装置1)具备：伺服电动机(例如后述的伺服电动机400)；被驱动体(例如后述的倾斜机构500)，其由上述伺服电动机进行驱动，作用于驱动轴(例如后述的倾斜轴X)的负荷根据上述被驱动体的位置而发生变动；位置检测部(例如后述的编码器300)，其检测上述被驱动体的位置；速度检测部(例如后述的编码器300)，其检测上述被驱动体的速度；以及电动机控制部(例如后述的电动机控制部100)，其控制上述伺服电动机，上述电动机控制部具有：位置控制部(例如后述的位置控制部20)，其根据上述被驱动体的位置指令与通过上述位置检测部检测出的位置反馈之间的位置偏差来生成速度指令；速度控制部(例如后述的速度控制部30)，其将速度增益乘以通过上述位置控制部生成的速度指令与通过上述速度检测部检测出的速度反馈之间的速度偏差，和/或加上转矩补偿来生成转矩指令；以及变更部(例如后述的变更部60)，其根据上述被驱动体的位置来变更上述速度增益与上述转矩补偿中的至少一个。
(2)在(1)记载的伺服电动机控制装置中，上述变更部可以使用通过上述位置检测部检测出的位置反馈作为上述被驱动体的位置。
(3)在(1)记载的伺服电动机控制装置中，上述变更部可以使用上述被驱动体的位置指令作为上述被驱动体的位置。
(4)在(1)～(3)中任意一项记载的伺服电动机控制装置中，上述被驱动体由上述伺服电动机进行旋转驱动，上述变更部可以使用上述被驱动体的旋转角度作为上述被驱动体的位置。
(5)在(1)～(4)中任意一项记载的伺服电动机控制装置中，上述被驱动体可以包括主轴单元(例如后述的主轴单元510)，该主轴单元包括用于驱动机床的工具的主轴用电动机。
根据本发明，能够提供一种抑制由于作用于被驱动体的驱动轴上的负荷的变动引起的响应性的下降的伺服电动机控制装置。
附图说明
图1表示本实施方式的伺服电动机控制装置的结构。
图2表示图1所示的电动机控制部的结构。
图3表示存储在存储部中的函数(数据表)的一例。
附图标记的说明
1：伺服电动机控制装置、10：位置指令部、20：位置控制部、21：减法器、22：位置控制部、30：速度控制部、31：减法器、32：速度控制器、33：加法器、40：电流控制部、41：减法器、42：电流控制器、50：存储部、60：变更部、100：电动机控制部、200：电流检测器(电流检测部)、300：编码器(位置检测部、速度检测部)、400：伺服电动机、500：倾斜机构(被驱动体)、510：主轴单元、501：基材、502：臂。
具体实施方式
以下，根据附图说明本发明的实施方式的一例。另外，在各个附图中对相同或相当的部分标注相同的符号。
(第一实施方式)
图1表示本实施方式的伺服电动机控制装置的结构。图1所示的伺服电动机控制装置1具备电动机控制部100、电流检测器200、编码器(位置检测部、速度检测部)300、伺服电动机400以及倾斜机构500。
电动机控制部100控制用于驱动倾斜机构(被驱动体)500的伺服电动机400，该倾斜机构500包括机床的主轴单元510。后面详细描述电动机控制部100。
电流检测器200例如是电流互感器。电流检测器200检测伺服电动机400的驱动电流。检测出的电流用作电流反馈(电流FB)。
编码器300设置在伺服电动机400上，检测伺服电动机400的旋转位置。伺服电动机400的旋转位置与倾斜机构500的位置对应，所以编码器300检测倾斜机构500的位置(机器坐标，换言之是倾斜角度(旋转角度))。检测出的位置用作位置反馈(位置FB)。
另外，编码器300检测伺服电动机400的转速。伺服电动机400的转速与倾斜结构500的速度对应，所以编码器300检测倾斜机构500的速度。检测出的速度用作速度反馈(速度FB)。
倾斜结构500由伺服电动机400进行旋转驱动，使包括用于驱动机床的工具的主轴用电动机的主轴单元510倾斜。倾斜结构500例如由安装了机床的主轴单元510的基材501、在一端侧支撑基材501且在另一端侧具有倾斜轴(旋转轴)X的臂502构成。这样，倾斜结构500具有相对于倾斜轴X非对称的结构。
接着，参照图2说明电动机控制部100。图2表示图1所示的电动机控制部100的结构。电动机控制部100具备位置指令部10、位置控制部20、速度控制部30、电流控制部40、存储部50以及变更部60。
位置指令部10根据从未图示的上位控制装置、外部输入装置等输入的程序、命令来生成伺服电动机400的位置指令，即倾斜机构500的位置指令。
位置控制部20根据通过位置指令部10生成的位置指令和通过编码器300检测出的位置FB来生成速度指令。位置控制部20具备减法器21和位置控制器22。
减法器21求出通过位置指令部10生成的位置指令和通过编码器300检测出的位置FB之间的位置偏差。位置控制器22将位置增益与通过减法器21求出的位置偏差相乘来生成速度指令。
速度控制部30根据通过位置控制部20生成的速度指令、通过编码器300检测出的速度FB、来自变更部60的速度增益以及转矩补偿来生成转矩指令。速度控制部30具备减法器31、速度控制器32、加法器33。
减法器31求出通过位置控制部20生成的速度指令与通过编码器300检测出的速度FB之间的速度偏差。速度控制器32将变更部60的速度增益与通过减法器31求出的速度偏差相乘。加法器33将来自变更部60的转矩补偿与通过速度控制器32进行乘法运算而得的值相加，生成转矩指令。
另外，速度控制部30可以不具备加法器33，而根据速度指令、速度FB以及速度增益来生成转矩指令。
电流控制部40根据通过速度控制部30生成的转矩指令和通过电流检测器200检测出的电流FB来生成伺服电动机400的驱动电流。电流控制部40具备减法器41和电流控制器42。
减法器41生成通过速度控制部30生成的转矩指令和通过电流检测器200检测出的电流FB之间的转矩偏差。电流控制器42将转矩增益与通过减法器41求出的转矩偏差相乘，生成驱动电流。所生成的驱动电流被提供给伺服电动机400。
存储部50存储预定的速度增益(固定值)以及预定的转矩补偿(固定值)。另外，存储部50存储用于变更预定的速度增益的倍率(Override)。
具体地说，如图3所示，存储部50存储将位置FB(倾斜机构500的位置)作为输入，并将与输入的位置FB对应的速度增益的倍率作为输出的函数。具体地说，存储部50将位置FB与速度增益的倍率进行关联后的数据表作为函数进行存储。图3中，位置FB所表示的倾斜机构500的位置离垂直方向的位置(0)越远，速度增益的倍率被大致正比地设定得越大。
存储部50例如是EEPROM等能够改写的存储器。
变更部60根据通过编码器300检测出的位置FB(倾斜机构500的位置)变更速度增益，并将变更后的速度增益和预定的转矩补偿提供给速度控制部30。
具体地说，变更部60根据存储在存储部50中的函数来导出与位置FB对应的速度增益的倍率。具体地说，变更部60参照数据表并根据位置FB来决定速度增益的倍率。然后，变更部60将导出的倍率与存储在存储部50中的预定速度增益(固定值)相乘，从而变更速度增益。
另外，变更部60将存储在存储部50中的预定转矩补偿(固定值)设定为转矩补偿。
电动机控制部100例如由DSP(Digital Signal Processor数字信号处理器)、FPGA(Field-Programmable Gate Array现场可编程门阵列)等运算处理器构成。电动机控制部100的各种功能(位置指令部10、位置控制部20、速度控制部30、电力路控制部40以及变更部60)例如通过执行存储在存储部50中的预定软件(程序)来实现。电动机控制部100的各种功能可以通过硬件与软件之间的协作来实现，也可以只通过硬件(电子电路)来实现。
这里，通过主轴电源510的重力、旋转而作用于倾斜机构500的倾斜轴X上的负荷(负载(力矩))会根据倾斜机构500的位置(即主轴单元的位置)而发生变化。例如，如果作用于倾斜轴X的负荷增加，则驱动力不足，倾斜机构500到达目标位置的时间变迟。即，伺服电动机控制装置1的响应性下降。
关于这点，考虑将速度增益设定为大的值，提高响应性。但是，如果速度增益始终很大，则在负荷轻时会产生振荡(振动)。即，伺服电动机控制装置1的稳定性下降。
因此，在本实施方式的伺服电动机控制装置1中，变更部60根据倾斜机构(被驱动体)500的位置来变更增益。这样，当作用于倾斜轴X的负荷增加时，能够使速度增益增加，使驱动电流增加并使驱动力增加。因此能够抑制倾斜机构500到达目标位置的时间延迟。即，能够抑制由于作用于倾斜机构500的倾斜轴X的负荷变动引起的响应性的下降。
进一步，在作用于倾斜轴X的负荷减少时，能够使速度增益减少，抑制振荡(振动)。这样，能够同时实现抑制由于作用于倾斜机构500的倾斜轴X的负荷变动引起的响应性的下降和抑制稳定性的下降。
(第一实施方式的第一变形例)
在第一实施方式中，变更部60根据通过编码器300检测出的位置FB(倾斜机构500的位置)来变更速度增益，但是也可以代替位置FB而根据通过位置指令部10生成的位置指令(倾斜机构500的位置)来变更速度增益。
此时，如图3所示，存储部50存储将位置指令(倾斜机构500的位置)作为输入，并将与输入的位置指令对应的速度增益的倍率作为输出的函数。具体地说，存储部50将位置指令与速度增益的倍率进行关联后的数据表作为函数进行存储。图3中，位置指令所表示的倾斜机构500的位置离垂直方向的位置(0)越远，速度增益的倍率被大致正比地设定得越大。
变更部60根据存储在存储部50中的函数来导出与位置指令对应的速度增益的倍率。具体地说，变更部60参照数据表并根据位置指令来决定速度增益的倍率。然后，变更部60将导出的倍率与存储在存储部50中的预定速度增益(固定值)相乘，从而变更速度增益。
(第一实施方式的第二变形例)
在第一实施方式中，存储部50存储了预定的速度增益(固定值)、用于变更预定的速度增益的倍率，但是也可以存储多个速度增益(变动值)。
具体地说，如图3所示，存储部50存储将位置FB或位置指令作为输入，并将与输入的位置FB或位置指令对应的速度增益作为输出的函数。具体地说，存储部50将位置FB或位置指令与速度增益进行关联后的数据表作为函数进行存储。图3中，位置FB或位置指令所表示的倾斜机构500的位置离垂直方向的位置(0)越远，速度增益被大致正比地设定得越大。
变更部60根据存储在存储部50中的函数来导出与位置FB或位置指令对应的速度增益。具体地说，变更部60参照数据表并根据速度FB或位置指令来决定速度增益。
(第二实施方式)
在第一实施方式中，变更了速度增益。在第二实施方式中，代替速度增益而变更转矩补偿。
第二实施方式的伺服电动机控制装置1的结构与图1以及图2所示的第一实施方式的伺服电动机控制装置1的结构相同。另外，在第二实施方式的伺服电动机控制装置1中，变更部60的功能以及存储在存储部50中的函数(表)与第一实施方式的伺服电动机控制装置1不同。
存储部50存储用于变更预定的转矩补偿的倍率来代替用于变更预定的速度增益的倍率。
具体地说，如图3所示，存储部50存储将位置FB(倾斜机构500的位置)作为输入，并将与输入的位置FB对应的转矩补偿的倍率作为输出的函数。具体地说，存储部50将位置FB与转矩补偿的倍率进行关联后的数据表作为函数进行存储。图3中，位置FB所表示的倾斜机构500的位置离垂直方向的位置(0)越远，转矩补偿的倍率被大致正比地设定得越大。
变更部60根据通过编码器300检测出的位置FB(倾斜机构500的位置)变更转矩补偿，并将变更后的转矩补偿和预定的速度增益提供给速度控制部30。
具体地说，变更部60根据存储在存储部50中的函数来导出与位置FB对应的转矩补偿的倍率。具体地说，变更部60参照数据表并根据位置FB来决定转矩补偿的倍率。然后，变更部60将导出的倍率与存储在存储部50中的预定转矩补偿(固定值)相乘，从而变更转矩补偿。
另外，变更部60将存储在存储部50中的预定的速度增益(固定值)设定为速度增益。
这里，例如当作用于倾斜轴X的负荷增加时，若增加输出转矩，则使速度控制部30的积分器增加到输出转矩的增加部分为止的时间变长。即伺服电动机控制装置1的响应性下降。
因此，在本实施方式的伺服电动机控制装置1中，变更部60根据倾斜机构(被驱动体)500的位置来变更转矩补偿。这样，当作用于倾斜轴X的负荷增加时，能够使转矩补偿增加，能够抑制速度控制部30的积分器为了输出转矩补偿部分的转矩而增加到需要的量为止的情况。即，能够抑制由于作用于倾斜机构500的倾斜轴X的负荷变动引起的响应性的下降。
(第二实施方式的第一变形例)
在第二实施方式中，变更部60根据通过编码器300检测出的位置FB(倾斜机构500的位置)来变更转矩补偿，但是也可以代替位置FB而根据通过位置指令部10生成的位置指令(倾斜机构500的位置)来变更速度增益。
此时，如图3所示，存储部50存储将位置指令(倾斜机构500的位置)作为输入，并将与输入的位置指令对应的转矩补偿的倍率作为输出的函数。具体地说，存储部50将位置指令与转矩补偿的倍率进行关联后的数据表作为函数进行存储。图3中，位置指令所表示的倾斜机构500的位置离垂直方向的位置(0)越远，转矩补偿的倍率被大致正比地设定得越大。
变更部60根据存储在存储部50中的函数来导出与位置指令对应的转矩补偿的倍率。具体地说，变更部60参照数据表并根据位置指令来决定转矩补偿的倍率。然后，变更部60将导出的倍率与存储在存储部50中的预定转矩补偿(固定值)相乘，从而变更转矩补偿。
(第二实施方式的第二变形例)
在第二实施方式中，存储部50存储了预定的转矩补偿(固定值)、用于变更预定的转矩补偿的倍率，但是也可以存储多个转矩补偿(变动值)。
具体地说，如图3所示，存储部50存储将位置FB或位置指令作为输入，并将与输入的位置FB或位置指令对应的转矩补偿作为输出的函数。具体地说，存储部50将位置FB或位置指令与转矩补偿进行关联后的数据表作为函数进行存储。图3中，位置FB或位置指令所表示的倾斜机构500的位置离垂直方向的位置(0)越远，转矩补偿被大致正比地设定得越大。
变更部60根据存储在存储部50中的函数来导出与位置FB或位置指令对应的转矩补偿。具体地说，变更部60参照数据表并根据位置FB或位置指令来决定转矩补偿。
以上，说明了本发明的实施方式，但是本发明不限于上述的实施方式。另外，本实施方式所记载的效果不过是列举了从本发明产生的最优的效果，本发明的效果不限于本实施方式所记载的效果。
例如，可以适当变更上述实施方式，也可以组合地实施。例如可以组合第一实施方式和第二实施方式，根据位置FB或位置指令来变更速度增益以及转矩补偿双方。
另外，在上述实施方式中，例示了对使机床的主轴单元倾斜(旋转)的倾斜机构(旋转机构)进行驱动控制的伺服电动机控制装置。但是，本发明的特征不限于此，而能够适用于将作用于驱动轴的负荷(负载(力矩))根据被驱动体的位置而发生变动的各种被驱动体进行驱动控制的伺服电动机控制装置。例如，本发明的特征能够适用于使机床的主轴单元滑动的滑动机构。另外，也能够适用于驱动控制工业机械等的被驱动体的伺服电动机控制装置。

Claims (5)

1.一种伺服电动机控制装置，其特征在于，
该伺服电动机控制装置具备：
伺服电动机；
被驱动体，其由上述伺服电动机进行驱动，作用于驱动轴的负荷根据上述被驱动体的位置而发生变动；
位置检测部，其检测上述被驱动体的位置；
速度检测部，其检测上述被驱动体的速度；以及
电动机控制部，其控制上述伺服电动机，
上述电动机控制部具有：
位置控制部，其根据上述被驱动体的位置指令与通过上述位置检测部检测出的位置反馈之间的位置偏差来生成速度指令；
速度控制部，其将速度增益乘以通过上述位置控制部生成的速度指令与通过上述速度检测部检测出的速度反馈之间的速度偏差，和/或加上转矩补偿来生成转矩指令；以及
变更部，其根据上述被驱动体的位置来变更上述速度增益与上述转矩补偿中的至少一个。
2.根据权利要求1所述的伺服电动机控制装置，其特征在于，
上述变更部使用通过上述位置检测部检测出的位置反馈作为上述被驱动体的位置。
3.根据权利要求1所述的伺服电动机控制装置，其特征在于，
上述变更部使用上述被驱动体的位置指令作为上述被驱动体的位置。
4.根据权利要求1～3中的任意一项所述的伺服电动机控制装置，其特征在于，
上述被驱动体由上述伺服电动机进行旋转驱动，
上述变更部使用上述被驱动体的旋转角度作为上述被驱动体的位置。
5.根据权利要求1～4中的任意一项所述的伺服电动机控制装置，其特征在于，
上述被驱动体包括主轴单元，该主轴单元包括驱动机床的工具的主轴用电动机。
CN201810777750.8A 2017-07-19 2018-07-16 伺服电动机控制装置 Active CN109286352B (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2017139811A JP6856469B2 (ja) 2017-07-19 2017-07-19 サーボモータ制御装置
JP2017-139811 2017-07-19

Publications (2)

Publication Number Publication Date
CN109286352A true CN109286352A (zh) 2019-01-29
CN109286352B CN109286352B (zh) 2023-06-02

Family

ID=64951498

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810777750.8A Active CN109286352B (zh) 2017-07-19 2018-07-16 伺服电动机控制装置

Country Status (4)

Country Link
US (1) US11347197B2 (zh)
JP (1) JP6856469B2 (zh)
CN (1) CN109286352B (zh)
DE (1) DE102018211561A1 (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111086050A (zh) * 2019-12-31 2020-05-01 西门子工厂自动化工程有限公司 瓦楞纸横切机的运动控制器和控制方法及瓦楞纸横切机

Citations (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS63109957A (ja) * 1986-10-29 1988-05-14 Toyota Motor Corp 傾斜軸を有する工作機械の傾斜角制御装置
JPS63238602A (ja) * 1986-09-29 1988-10-04 アセア　アクチーボラグ 産業用ロボットの制御パラメータを最適制御する方法および装置
US4819184A (en) * 1986-09-29 1989-04-04 Asea Aktiebolag Method and a device for optimum control of control parameters in an industrial robot
CN1285062A (zh) * 1998-02-27 2001-02-21 三菱电机株式会社 同步控制装置
CN1322311A (zh) * 1998-09-28 2001-11-14 株式会社安川电机 位置控制装置
CN1429355A (zh) * 2000-05-15 2003-07-09 株式会社安川电机 定位伺服控制器
CN1579702A (zh) * 2003-08-06 2005-02-16 山崎马扎克公司 用于机床的位置控制设备和位置控制方法
JP2005182437A (ja) * 2003-12-19 2005-07-07 Fanuc Ltd 数値制御装置及び数値制御方法
CN1761920A (zh) * 2003-03-17 2006-04-19 山洋电气株式会社 电机控制装置
CN101221448A (zh) * 2007-01-11 2008-07-16 大隈株式会社 旋转轴位置控制装置
CN101221425A (zh) * 2006-11-10 2008-07-16 东芝机械株式会社 五轴机床中用于斜向加工的位置保证系统
CN101236436A (zh) * 2007-01-29 2008-08-06 发那科株式会社 伺服电动机的控制装置
EP2253421A1 (en) * 2008-03-04 2010-11-24 Makino Milling Machine Co. Ltd. Machining method and machine tool
CN102467131A (zh) * 2010-11-12 2012-05-23 三菱电机株式会社 伺服控制器
CN102596496A (zh) * 2010-01-08 2012-07-18 三菱重工业株式会社 机床的机械位移修正系统
CN103858335A (zh) * 2011-10-13 2014-06-11 三菱电机株式会社 伺服控制装置
CN104281092A (zh) * 2013-07-08 2015-01-14 发那科株式会社 控制五轴加工机的数值控制装置
US20150205277A1 (en) * 2014-01-22 2015-07-23 Mitutoyo Corporation Drive controller, driving system, and drive control method
CN105027013A (zh) * 2013-03-07 2015-11-04 株式会社牧野铣床制作所 机床的进给轴控制方法及进给轴控制装置
CN105190462A (zh) * 2013-03-14 2015-12-23 三菱电机株式会社 伺服控制装置
CN105284045A (zh) * 2013-04-10 2016-01-27 松下知识产权经营株式会社 电动机驱动装置
CN105932920A (zh) * 2015-02-26 2016-09-07 山洋电气株式会社 电动机控制装置
CN106026799A (zh) * 2015-03-30 2016-10-12 Juki株式会社 电动机控制装置、电动机控制方法、缝纫机

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06155217A (ja) 1992-11-12 1994-06-03 Brother Ind Ltd 数値制御機械
JP2002178237A (ja) 2000-12-14 2002-06-25 Toyoda Mach Works Ltd パラレルリンク機構の制御方法
JP4299793B2 (ja) * 2005-01-20 2009-07-22 ファナック株式会社 制御装置
JP5324679B1 (ja) * 2012-04-10 2013-10-23 ファナック株式会社 工作機械の送り軸を駆動するサーボモータを制御するサーボモータ制御装置
JP5689494B2 (ja) * 2013-03-28 2015-03-25 ファナック株式会社 位置制御ゲインを生成する上位制御装置
CN107206559B (zh) 2015-02-27 2020-04-28 株式会社牧野铣床制作所 马达的控制方法、控制装置以及具备刀库的机床

Patent Citations (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS63238602A (ja) * 1986-09-29 1988-10-04 アセア　アクチーボラグ 産業用ロボットの制御パラメータを最適制御する方法および装置
US4819184A (en) * 1986-09-29 1989-04-04 Asea Aktiebolag Method and a device for optimum control of control parameters in an industrial robot
JPS63109957A (ja) * 1986-10-29 1988-05-14 Toyota Motor Corp 傾斜軸を有する工作機械の傾斜角制御装置
CN1285062A (zh) * 1998-02-27 2001-02-21 三菱电机株式会社 同步控制装置
CN1322311A (zh) * 1998-09-28 2001-11-14 株式会社安川电机 位置控制装置
CN1429355A (zh) * 2000-05-15 2003-07-09 株式会社安川电机 定位伺服控制器
CN1761920A (zh) * 2003-03-17 2006-04-19 山洋电气株式会社 电机控制装置
CN1579702A (zh) * 2003-08-06 2005-02-16 山崎马扎克公司 用于机床的位置控制设备和位置控制方法
JP2005182437A (ja) * 2003-12-19 2005-07-07 Fanuc Ltd 数値制御装置及び数値制御方法
CN101221425A (zh) * 2006-11-10 2008-07-16 东芝机械株式会社 五轴机床中用于斜向加工的位置保证系统
CN101221448A (zh) * 2007-01-11 2008-07-16 大隈株式会社 旋转轴位置控制装置
CN101236436A (zh) * 2007-01-29 2008-08-06 发那科株式会社 伺服电动机的控制装置
EP2253421A1 (en) * 2008-03-04 2010-11-24 Makino Milling Machine Co. Ltd. Machining method and machine tool
CN102596496A (zh) * 2010-01-08 2012-07-18 三菱重工业株式会社 机床的机械位移修正系统
CN102467131A (zh) * 2010-11-12 2012-05-23 三菱电机株式会社 伺服控制器
CN103858335A (zh) * 2011-10-13 2014-06-11 三菱电机株式会社 伺服控制装置
CN105027013A (zh) * 2013-03-07 2015-11-04 株式会社牧野铣床制作所 机床的进给轴控制方法及进给轴控制装置
CN105190462A (zh) * 2013-03-14 2015-12-23 三菱电机株式会社 伺服控制装置
CN105284045A (zh) * 2013-04-10 2016-01-27 松下知识产权经营株式会社 电动机驱动装置
CN104281092A (zh) * 2013-07-08 2015-01-14 发那科株式会社 控制五轴加工机的数值控制装置
US20150205277A1 (en) * 2014-01-22 2015-07-23 Mitutoyo Corporation Drive controller, driving system, and drive control method
CN105932920A (zh) * 2015-02-26 2016-09-07 山洋电气株式会社 电动机控制装置
CN106026799A (zh) * 2015-03-30 2016-10-12 Juki株式会社 电动机控制装置、电动机控制方法、缝纫机

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111086050A (zh) * 2019-12-31 2020-05-01 西门子工厂自动化工程有限公司 瓦楞纸横切机的运动控制器和控制方法及瓦楞纸横切机
CN111086050B (zh) * 2019-12-31 2021-12-28 西门子工厂自动化工程有限公司 瓦楞纸横切机的运动控制器和控制方法及瓦楞纸横切机

Also Published As

Publication number Publication date
US20190025792A1 (en) 2019-01-24
DE102018211561A1 (de) 2019-01-24
CN109286352B (zh) 2023-06-02
JP2019021098A (ja) 2019-02-07
JP6856469B2 (ja) 2021-04-07
US11347197B2 (en) 2022-05-31

Similar Documents

Publication Publication Date Title
CN101656507B (zh) 电动机控制装置
CN104589304A (zh) 机器人控制装置以及机器人
JP2010271854A (ja) デュアル位置フィードバック制御を行うサーボ制御装置
JP2013066954A (ja) ロボット及びロボットの制御方法
CN107294429B (zh) 多个电动机驱动用伺服控制装置
JP2008187799A (ja) サーボモータの制御装置
CN103167737B (zh) 电动机控制装置
JP6457435B2 (ja) 研削ロボットシステム
CN106003019A (zh) 机器人控制装置、机器人系统以及机器人控制方法
JP2018139044A (ja) サーボモータ制御装置、サーボモータ制御方法、及びサーボモータ制御用プログラム
CN111791087A (zh) 具有主轴以及进给轴的机床的控制装置
CN109286352A (zh) 伺服电动机控制装置
JP6370866B2 (ja) サーボモータ制御装置、サーボモータ制御方法、及びサーボモータ制御用プログラム
US9367045B2 (en) Servo control system for grinding inclined surface
JP5850646B2 (ja) 制御装置、アクチュエータシステム、及び制御方法
JP5499865B2 (ja) 多関節型ロボットの速度指令プロファイルの生成方法
JP5823045B2 (ja) トルク制御装置
EP3304228B1 (en) Robot system for synchronizing the movement of the robot arm
US20230333532A1 (en) Machine tool control device
JP5780783B2 (ja) 干渉力補償制御装置
JP5633268B2 (ja) ロボットの制御装置
JP4367041B2 (ja) 機械制御装置
JP4827016B2 (ja) 剛性同定装置およびそれを備えたモータ制御装置
JP7160737B2 (ja) 機械の制御装置
JP4241240B2 (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