JP2021022272A - Numerical control device and control method - Google Patents

Numerical control device and control method Download PDF

Info

Publication number
JP2021022272A
JP2021022272A JP2019139576A JP2019139576A JP2021022272A JP 2021022272 A JP2021022272 A JP 2021022272A JP 2019139576 A JP2019139576 A JP 2019139576A JP 2019139576 A JP2019139576 A JP 2019139576A JP 2021022272 A JP2021022272 A JP 2021022272A
Authority
JP
Japan
Prior art keywords
time constant
filter
torque
mass
acceleration
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
JP2019139576A
Other languages
Japanese (ja)
Other versions
JP7238673B2 (en
Inventor
弦 寺田
Gen Terada
弦 寺田
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.)
Brother Industries Ltd
Original Assignee
Brother Industries Ltd
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 Brother Industries Ltd filed Critical Brother Industries Ltd
Priority to JP2019139576A priority Critical patent/JP7238673B2/en
Priority to CN202010530639.6A priority patent/CN112305996B/en
Publication of JP2021022272A publication Critical patent/JP2021022272A/en
Application granted granted Critical
Publication of JP7238673B2 publication Critical patent/JP7238673B2/en
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/414Structure of the control system, e.g. common controller or multiprocessor systems, interface to servo, programmable interface controller
    • G05B19/4142Structure of the control system, e.g. common controller or multiprocessor systems, interface to servo, programmable interface controller characterised by the use of a microprocessor
    • 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/34Director, elements to supervisory
    • G05B2219/34013Servocontroller

Landscapes

  • Engineering & Computer Science (AREA)
  • Computer Hardware Design (AREA)
  • Microelectronics & Electronic Packaging (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Numerical Control (AREA)
  • Feedback Control In General (AREA)

Abstract

To provide a numerical control device and control method capable of appropriately determining a time constant of a filter in order to limit acceleration and determining a variable vibration damping time constant corresponding to a vibration frequency unique to a machine which changes according to loading mass even if the maximum torque of a motor changes according to the loading mass.SOLUTION: A numerical control device executes acceleration/deceleration processing for processing, by filters, a velocity waveform generated from a position command of a table supporting a work material. A control unit of the numerical control device determines a torque suppression time constant corresponding to the maximum torque of a motor which changes according to loading mass of a table (S25). The control unit determines an inverse number of a variable vibration damping time frequency corresponding to a vibration frequency unique to a machine tool and changing according to the loading mass, as a variable vibration damping time constant (S27). The control unit executes acceleration/deceleration processing by using a first filter having the torque suppressing time constant and a second filter having the variable vibration damping time constant (S33).SELECTED DRAWING: Figure 5

Description

本発明は、数値制御装置及び制御方法に関する。 The present invention relates to a numerical control device and a control method.

特許文献1に記載の数値制御装置は交差する2軸方向の軸毎に設けたモータを制御し、被削材を支持するテーブルを所望の位置に移動する。第1低域通過フィルタは、2軸方向のうち一方の軸方向に発生する振動の周波数の逆数を時定数とする。第2低域通過フィルタは、2軸方向のうち他方の軸方向に発生する振動の周波数の逆数を時定数とする。数値制御装置は、モータ夫々を変速する変速信号を第1低域通過フィルタ及び第2低域通過フィルタに通過して平滑化する。 The numerical control device described in Patent Document 1 controls a motor provided for each axis in two intersecting axial directions, and moves a table supporting a work material to a desired position. The first low-pass filter uses the reciprocal of the frequency of vibration generated in one of the two axial directions as the time constant. The second low-pass filter uses the reciprocal of the frequency of vibration generated in the other axial direction of the two axial directions as the time constant. The numerical control device passes the shift signal for shifting the speed of each motor through the first low-pass filter and the second low-pass filter for smoothing.

特許第6107306号公報Japanese Patent No. 6107306

数値制御装置はテーブルの移動時、NCプログラムの位置指令から生成した速度波形にフィルタを適用してモータを駆動する。該フィルタの時定数は、モータの加速度が最大時のトルクである最大トルクが、モータの定格トルクを超えないことが好ましい。ここで、モータの最大トルクは、テーブルに積載する治具及び被削材の質量(積載質量と称す)に応じて変化する。しかし、特許文献1に記載の数値制御装置は、振動の周波数の逆数に応じて第1低域通過フィルタ及び第2低域通過フィルタの時定数を決定するのみであり、積載質量が変化しても時定数を変更しない。故に、積載質量に応じてモータの最大トルクが変化した時、加速度を制限する為の適切な時定数を決定できないという問題点がある。 When the table is moved, the numerical control device applies a filter to the velocity waveform generated from the position command of the NC program to drive the motor. As for the time constant of the filter, it is preferable that the maximum torque, which is the torque at the maximum acceleration of the motor, does not exceed the rated torque of the motor. Here, the maximum torque of the motor changes according to the mass (referred to as the loaded mass) of the jig and the work material to be loaded on the table. However, the numerical control device described in Patent Document 1 only determines the time constants of the first low-pass filter and the second low-pass filter according to the reciprocal of the vibration frequency, and the loaded mass changes. Does not change the time constant. Therefore, when the maximum torque of the motor changes according to the loaded mass, there is a problem that an appropriate time constant for limiting the acceleration cannot be determined.

本発明の目的は、積載質量に応じてモータの最大トルクが変化しても、加速度を制限する為のフィルタの時定数を適切に決定できると同時に、積載質量に応じて変化する機械に固有の振動周波数に応じた可変制振時定数を決定できる数値制御装置及び制御方法を提供することである。 An object of the present invention is unique to a machine that can appropriately determine the time constant of a filter for limiting acceleration even if the maximum torque of the motor changes according to the loaded mass, and at the same time, changes according to the loaded mass. It is an object of the present invention to provide a numerical control device and a control method capable of determining a variable vibration suppression time constant according to a vibration frequency.

本発明の第一態様に係る数値制御装置は、テーブルをモータで移動し、主軸に装着した工具で前記テーブル上に治具で支持した被削材を加工可能な機械の動作を制御し、前記テーブルの位置指令から生成した速度波形をフィルタで処理する加減速処理を実行可能な制御部を備えた数値制御装置において、前記制御部は、前記治具、及び、前記テーブル上の前記被削材を含む積載物の質量である積載質量に応じて変化する前記モータの最大トルクに応じた時定数であるトルク抑制時定数を決定する第一決定部と、前記積載質量に応じて変化する前記機械に固有の振動周波数に応じた可変制振周波数の逆数を、可変制振時定数として決定する第二決定部と、前記第一決定部により決定した前記トルク抑制時定数を有する第一フィルタと、前記第二決定部により決定した前記可変制振時定数を有する第二フィルタを用いて前記加減速処理を実行する処理部とを備えたことを特徴とする。 The numerical control device according to the first aspect of the present invention moves a table with a motor, controls the operation of a machine capable of processing a work material supported by a jig on the table with a tool mounted on a spindle, and controls the operation of the machine. In a numerical control device including a control unit capable of executing acceleration / deceleration processing for processing a speed waveform generated from a position command of a table with a filter, the control unit is the jig and the work material on the table. The first determination unit that determines the torque suppression time constant, which is the time constant according to the maximum torque of the motor, which changes according to the load mass, which is the mass of the load including the above, and the machine, which changes according to the load mass. A second determination unit that determines the inverse number of the variable vibration suppression frequency according to the vibration frequency inherent in the above as a variable vibration suppression time constant, and a first filter having the torque suppression time constant determined by the first determination unit. It is characterized by including a processing unit that executes the acceleration / deceleration process using the second filter having the variable vibration suppression time constant determined by the second determination unit.

第一態様において、数値制御装置は、積載質量に応じて変化するモータの最大トルクに応じたトルク抑制時定数を決定し、トルク抑制時定数を有する第一フィルタを用いて加減速処理を実行する。故に、数値制御装置は、積載質量の変化によってモータの加速度に応じたトルクが変化しても、最大トルクが定格トルクを超えないように加減速処理を適切に実行できる。更に数値制御装置は、前記積載質量に応じて変化する機械に固有の振動周波数に応じた可変制振時定数を決定し、可変制振時定数を有する第二フィルタを用いて加減速処理を実行する。故に、数値制御装置は、積載質量に応じて周波数が変化する機械の振動も適切に抑制できる。 In the first aspect, the numerical control device determines the torque suppression time constant according to the maximum torque of the motor that changes according to the loaded mass, and executes the acceleration / deceleration process using the first filter having the torque suppression time constant. .. Therefore, the numerical control device can appropriately execute the acceleration / deceleration process so that the maximum torque does not exceed the rated torque even if the torque corresponding to the acceleration of the motor changes due to the change in the load mass. Further, the numerical control device determines a variable vibration damping time constant according to the vibration frequency peculiar to the machine, which changes according to the loaded mass, and executes acceleration / deceleration processing using a second filter having a variable vibration damping time constant. To do. Therefore, the numerical control device can appropriately suppress the vibration of the machine whose frequency changes according to the loaded mass.

第一態様において、前記積載質量と前記可変制振周波数とが非線形の関係を有してもよい。該時、数値制御装置は、積載質量に基づいて可変制振時定数を精度良く決定できる。 In the first aspect, the load mass and the variable damping frequency may have a non-linear relationship. At this time, the numerical control device can accurately determine the variable vibration damping time constant based on the loaded mass.

第一態様において、前記制御部は、前記積載質量に応じて変化しない前記機械に固有の振動周波数に応じた固定制振周波数の逆数を、固定制振時定数として決定する第三決定部を更に備え、前記処理部は、前記第三決定部により決定した前記固定制振時定数を有する第三フィルタを更に用いて前記加減速処理を実行してもよい。故に、数値制御装置は、積載質量に応じて変化しない機械の振動を適切に抑制できる。 In the first aspect, the control unit further comprises a third determination unit that determines the reciprocal of the fixed vibration damping frequency according to the vibration frequency peculiar to the machine, which does not change according to the loaded mass, as the fixed vibration damping time constant. In addition, the processing unit may execute the acceleration / deceleration processing by further using a third filter having the fixed vibration damping time constant determined by the third determination unit. Therefore, the numerical control device can appropriately suppress the vibration of the machine which does not change according to the loaded mass.

第一態様において、前記制御部は、前記テーブルの移動時、前記モータのトルクと加速度とを取得する取得部と、前記取得部により取得した前記トルクと前記加速度とに基づき、前記積載質量を推定する推定部とを更に実行し、前記第一決定部は、前記推定部により推定した前記積載質量に基づき、前記トルク抑制時定数を決定し、前記第二決定部は、前記推定部により推定した前期積載質量に基づき、前記可変制振時定数を決定してもよい。該時、数値制御装置は、作業者が予め積載質量を測定しなくても、トルク抑制時定数及び可変制振時定数を精度良く決定できる。 In the first aspect, the control unit estimates the load mass based on the acquisition unit that acquires the torque and acceleration of the motor when the table is moved, and the torque and acceleration acquired by the acquisition unit. The first determination unit determines the torque suppression time constant based on the load mass estimated by the estimation unit, and the second determination unit estimates by the estimation unit. The variable vibration damping time constant may be determined based on the load mass in the previous period. At this time, the numerical control device can accurately determine the torque suppression time constant and the variable vibration suppression time constant without the operator measuring the loaded mass in advance.

第一態様において、前記テーブルは、交差する二軸方向へ移動可能であって、前記モータは、前記二軸方向の軸毎に夫々設け、前記第一決定部は、前記軸毎に前記トルク抑制時定数を決定し、前記第二決定部は、前記軸毎に前記可変制振時定数を決定し、前記処理部は、前記軸毎に前記加減速処理を実行可能であってもよい。数値制御装置は、テーブルの二つの移動方向の夫々に対応するモータの最大トルクが積載質量に応じて変化しても、加減速処理を適切に実行できる。 In the first aspect, the table is movable in the intersecting biaxial directions, the motor is provided for each of the axes in the biaxial direction, and the first determination unit suppresses the torque for each of the axes. The time constant may be determined, the second determination unit may determine the variable vibration damping time constant for each of the axes, and the processing unit may be able to execute the acceleration / deceleration process for each of the axes. The numerical control device can appropriately execute the acceleration / deceleration process even if the maximum torque of the motor corresponding to each of the two moving directions of the table changes according to the load mass.

第一態様において、前記フィルタはFIRフィルタであってもよい。該時、数値制御装置は、加減速処理により速度波形を適切に平滑化できる。 In the first aspect, the filter may be an FIR filter. At this time, the numerical control device can appropriately smooth the velocity waveform by the acceleration / deceleration process.

本発明の第二態様に係る制御方法は、テーブルをモータで移動し、主軸に装着した工具で前記テーブル上に治具で支持した被削材を加工可能な機械の動作を制御し、前記テーブルの位置指令から生成した速度波形をフィルタで処理する加減速処理を実行可能な制御方法であって、前記治具、及び、前記テーブル上の前記被削材を含む積載物の質量である積載質量に応じて変化する前記モータの最大トルクに応じた時定数であるトルク抑制時定数を決定する第一決定工程と、前記積載質量に応じて変化する前記機械に固有の振動周波数に応じた可変制振周波数の逆数を、可変制振時定数として決定する第二決定工程と、前記第一決定工程により決定した前記トルク抑制時定数を有する第一フィルタと、前記第二決定工程により決定した前記可変制振時定数を有する第二フィルタを用いて前記加減速処理を実行する処理工程とを備えたことを特徴とする。第二態様によれば、第一態様と同様の効果を奏することができる。 In the control method according to the second aspect of the present invention, the table is moved by a motor, and the operation of a machine capable of processing a work material supported by a jig on the table with a tool mounted on a spindle is controlled. It is a control method capable of executing acceleration / deceleration processing that processes the velocity waveform generated from the position command of the above, and is the mass of the load including the jig and the work material on the table. The first determination step of determining the torque suppression time constant, which is the time constant according to the maximum torque of the motor, which changes according to the load, and the variable control according to the vibration frequency peculiar to the machine, which changes according to the load mass. A second determination step in which the inverse number of the vibration frequency is determined as a variable vibration suppression time constant, a first filter having the torque suppression time constant determined in the first determination step, and the variable determination in the second determination step. It is characterized by including a processing step of executing the acceleration / deceleration process using a second filter having a vibration damping time constant. According to the second aspect, the same effect as that of the first aspect can be obtained.

工作機械10の概略側面図。Schematic side view of the machine tool 10. 数値制御装置20と工作機械10の電気的構成を示すブロック図。The block diagram which shows the electrical structure of a numerical control device 20 and a machine tool 10. 可変振動の周波数特性を示すグラフ。A graph showing the frequency characteristics of variable vibration. 積載質量Mと可変制振周波数Fvarとの関係を示すグラフ。The graph which shows the relationship between the load mass M and the variable vibration damping frequency Fvar. 主処理の流れ図。Flow diagram of main processing. 変形例における主処理の流れ図。The flow chart of the main processing in the modification.

以下、本発明の実施形態を説明する。図1に示す工作機械10は、主軸9に装着した工具4を高速回転し、テーブル50上に治具(図示略)で支持した被削材Wに接触することで、被削材Wの切削加工等を行う。数値制御装置20は、工作機械10の動作を制御する。工作機械10の左右方向、前後方向、上下方向は、夫々X軸方向、Y軸方向、Z軸方向である。 Hereinafter, embodiments of the present invention will be described. The machine tool 10 shown in FIG. 1 cuts the work material W by rotating the tool 4 mounted on the spindle 9 at high speed and contacting the work material W supported by a jig (not shown) on the table 50. Perform processing, etc. The numerical control device 20 controls the operation of the machine tool 10. The horizontal direction, the front-rear direction, and the vertical direction of the machine tool 10 are the X-axis direction, the Y-axis direction, and the Z-axis direction, respectively.

<工作機械10の構成>
図1に示すように、工作機械10は、ベッド部2、コラム5、主軸ヘッド7、主軸9、テーブル装置40、操作盤16(図2参照)等を備える。工作機械10は、テーブル装置40のテーブル50がX軸、Y軸の二軸方向に移動する。ベッド部2は、工作機械10の土台である。コラム5は、ベッド部2上面後部に固定する。主軸ヘッド7は、コラム5前面に沿ってZ軸方向に移動する。コラム5は前面にZ軸移動機構(図示略)を備える。Z軸移動機構は、Z軸モータ11(図2参照)を駆動源とする。Z軸移動機構は、後述するY軸移動機構と同様の構造である。主軸9は主軸ヘッド7内部をZ軸方向に延び、回転可能に設ける。主軸9の下端部に設けた工具装着穴(図示略)は、主軸9下部に設ける。工具4は工具装着穴に装着する。
<Structure of machine tool 10>
As shown in FIG. 1, the machine tool 10 includes a bed portion 2, a column 5, a spindle head 7, a spindle 9, a table device 40, an operation panel 16 (see FIG. 2), and the like. In the machine tool 10, the table 50 of the table device 40 moves in the biaxial directions of the X-axis and the Y-axis. The bed portion 2 is the base of the machine tool 10. The column 5 is fixed to the rear portion of the upper surface of the bed portion 2. The spindle head 7 moves in the Z-axis direction along the front surface of the column 5. The column 5 is provided with a Z-axis moving mechanism (not shown) on the front surface. The Z-axis movement mechanism uses a Z-axis motor 11 (see FIG. 2) as a drive source. The Z-axis moving mechanism has the same structure as the Y-axis moving mechanism described later. The spindle 9 extends inside the spindle head 7 in the Z-axis direction and is rotatably provided. A tool mounting hole (not shown) provided at the lower end of the spindle 9 is provided at the lower portion of the spindle 9. The tool 4 is mounted in the tool mounting hole.

テーブル装置40は、ベッド部2上面で且つ主軸ヘッド7下方に設ける。テーブル装置40は、テーブル50をX軸とY軸の二軸方向に移動可能に支持する。なお、説明の便宜上、図1に示すテーブル装置40は、テーブル50をY軸方向に移動するY軸移動機構のみを図示し、X軸移動機構は省略する。テーブル装置40は、ベッド41、Y軸ガイドレール42、Y軸モータ14、継手43、ボールねじ44、軸受部45、ナット46、テーブル50等を備える。ベッド41、Y軸ガイドレール42、Y軸モータ14、継手43、ボールねじ44、軸受部45、ナット46は、Y軸移動機構を構成する。 The table device 40 is provided on the upper surface of the bed portion 2 and below the spindle head 7. The table device 40 supports the table 50 so as to be movable in the biaxial directions of the X-axis and the Y-axis. For convenience of explanation, the table device 40 shown in FIG. 1 illustrates only the Y-axis moving mechanism that moves the table 50 in the Y-axis direction, and omits the X-axis moving mechanism. The table device 40 includes a bed 41, a Y-axis guide rail 42, a Y-axis motor 14, a joint 43, a ball screw 44, a bearing portion 45, a nut 46, a table 50, and the like. The bed 41, the Y-axis guide rail 42, the Y-axis motor 14, the joint 43, the ball screw 44, the bearing portion 45, and the nut 46 constitute a Y-axis moving mechanism.

ベッド41は、ベッド部2上面に設置する。ベッド41は左右方向中央部にY軸方向に長い凹部(図示略)を備え、該凹部の内側に、後述するY軸移動機構の大部分を格納する。Y軸ガイドレール42は、ベッド41上部に設け、Y軸方向に延びる。Y軸ガイドレール42は、テーブル50をY軸方向に移動可能に案内する。Y軸モータ14は、ベッド41の凹部後側に設ける。ボールねじ44は、ベッド41の凹部内側に設け、Y軸方向に延びる。継手43は、Y軸モータ14の前方に突出する出力軸と、ボールねじ44の後端部を互いに連結する。軸受部45は、ボールねじ44前端部を回転可能に支持する。故にY軸モータ14の出力軸が回転すると、継手43を介してボールねじ44は回転する。ナット46はテーブル50の下面に固定し、ボールねじ44に螺合する。故にボールねじ44の回転に伴い、テーブル50はナット46と共にY軸方向に移動する。 The bed 41 is installed on the upper surface of the bed portion 2. The bed 41 is provided with a recess (not shown) long in the Y-axis direction in the central portion in the left-right direction, and most of the Y-axis moving mechanism described later is stored inside the recess. The Y-axis guide rail 42 is provided on the upper part of the bed 41 and extends in the Y-axis direction. The Y-axis guide rail 42 guides the table 50 so as to be movable in the Y-axis direction. The Y-axis motor 14 is provided on the rear side of the recess of the bed 41. The ball screw 44 is provided inside the recess of the bed 41 and extends in the Y-axis direction. The joint 43 connects the output shaft protruding forward of the Y-axis motor 14 and the rear end of the ball screw 44 to each other. The bearing portion 45 rotatably supports the front end portion of the ball screw 44. Therefore, when the output shaft of the Y-axis motor 14 rotates, the ball screw 44 rotates via the joint 43. The nut 46 is fixed to the lower surface of the table 50 and screwed into the ball screw 44. Therefore, as the ball screw 44 rotates, the table 50 moves in the Y-axis direction together with the nut 46.

尚、テーブル装置40は、上記Y軸移動機構に加え、X軸の移動機構を備える。X軸移動機構は、Y軸移動機構をX軸方向に移動可能に支持する。X軸移動機構は、X軸モータ13(図2参照)を駆動源とし、Y軸移動機構の構造と同様である。 The table device 40 includes an X-axis moving mechanism in addition to the Y-axis moving mechanism. The X-axis moving mechanism supports the Y-axis moving mechanism so as to be movable in the X-axis direction. The X-axis movement mechanism has the same structure as the Y-axis movement mechanism, using the X-axis motor 13 (see FIG. 2) as a drive source.

図2に示すように、操作盤16は、入力部17と表示部18を備える。入力部17は各種入力、指示、設定等を行う為の機器である。表示部18は各種画面を表示する機器である。 As shown in FIG. 2, the operation panel 16 includes an input unit 17 and a display unit 18. The input unit 17 is a device for performing various inputs, instructions, settings, and the like. The display unit 18 is a device that displays various screens.

<電気的構成>
図2に示すように、数値制御装置20は、CPU21、ROM22、RAM23、記憶装置24、入出力部25、駆動回路26〜29等を備える。CPU21は、数値制御装置20を統括制御する。ROM22は、CPU21が後述の主処理を実行する為のプログラム、設定値を記憶する。RAM23は、各種処理実行中の各種データを記憶する。記憶装置24は不揮発性メモリであり、NCプログラムの他、各種データを記憶する。入出力部25は、操作盤16に接続する。駆動回路26〜29はサーボアンプである。Z軸モータ11はエンコーダ11Aを備える。主軸モータ12はエンコーダ12Aを備える。X軸モータ13はエンコーダ13Aを備える。Y軸モータ14はエンコーダ14Aを備える。駆動回路26はZ軸モータ11とエンコーダ11Aに接続する。駆動回路27は主軸モータ12とエンコーダ12Aに接続する。駆動回路28はX軸モータ13とエンコーダ13Aに接続する。駆動回路29はY軸モータ14とエンコーダ14Aに接続する。
<Electrical configuration>
As shown in FIG. 2, the numerical control device 20 includes a CPU 21, a ROM 22, a RAM 23, a storage device 24, an input / output unit 25, drive circuits 26 to 29, and the like. The CPU 21 controls the numerical control device 20 in an integrated manner. The ROM 22 stores a program and a set value for the CPU 21 to execute a main process described later. The RAM 23 stores various data during execution of various processes. The storage device 24 is a non-volatile memory and stores various data in addition to the NC program. The input / output unit 25 is connected to the operation panel 16. The drive circuits 26 to 29 are servo amplifiers. The Z-axis motor 11 includes an encoder 11A. The spindle motor 12 includes an encoder 12A. The X-axis motor 13 includes an encoder 13A. The Y-axis motor 14 includes an encoder 14A. The drive circuit 26 is connected to the Z-axis motor 11 and the encoder 11A. The drive circuit 27 is connected to the spindle motor 12 and the encoder 12A. The drive circuit 28 is connected to the X-axis motor 13 and the encoder 13A. The drive circuit 29 is connected to the Y-axis motor 14 and the encoder 14A.

CPU21は、被削材Wを加工する為のNCプログラムを読込み、送り軸(X軸、Y軸、Z軸)、主軸9等の各駆動軸を目標位置に移動する為の制御指令を駆動回路26〜29に送信する。駆動回路26〜29は、CPU21から受信した制御指令(駆動信号)に応じて対応するモータ11〜14に駆動電流を夫々出力する。駆動回路26〜29はエンコーダ11A〜14Aからフィードバック信号(位置と速度の信号)を受け、モータ11〜14の位置と速度の制御を行う。操作盤16は、数値制御装置20の入出力部25に接続する。 The CPU 21 reads the NC program for processing the work material W, and sends a control command for moving each drive axis such as the feed axis (X axis, Y axis, Z axis) and the spindle 9 to the target position. Send to 26-29. The drive circuits 26 to 29 output drive currents to the corresponding motors 11 to 14 in response to the control command (drive signal) received from the CPU 21. The drive circuits 26 to 29 receive feedback signals (position and speed signals) from the encoders 11A to 14A and control the positions and speeds of the motors 11 to 14. The operation panel 16 is connected to the input / output unit 25 of the numerical control device 20.

<送り軸制御>
被削材Wに対して工具4をX軸方向又はY軸方向に相対移動させて加工するNCプログラムの指令(以下、「送り軸指令」と称す。)に基づき、工作機械10が駆動する場合を例示する。以下、被削材Wに対して工具4をY軸方向に相対移動させて加工する場合を例示して説明する。被削材Wに対して工具4をX軸方向に相対移動させて加工する場合については、工具4をY軸方向に相対移動させて加工する場合と同様であるので、説明は省略する。
<Feed axis control>
When the machine tool 10 is driven based on an NC program command (hereinafter referred to as "feed axis command") for machining by moving the tool 4 relative to the work material W in the X-axis direction or the Y-axis direction. Is illustrated. Hereinafter, a case where the tool 4 is moved relative to the work material W in the Y-axis direction for machining will be described as an example. The case of machining by moving the tool 4 relative to the work material W in the X-axis direction is the same as the case of machining by moving the tool 4 relative to the Y-axis direction, and thus the description thereof will be omitted.

CPU21は送り軸指令を読み込んだ時、被削材Wを保持したテーブル50を送り軸指令により指定した位置まで移動する為、テーブル50の目標位置の時系列データを生成する。CPU21は、所定周期で目標位置のデータを駆動回路29に出力する。駆動回路29は、CPU21が出力した目標位置のデータに基づき、Y軸モータ14を駆動する。Y軸モータ14は、テーブル50を目標位置までY軸方向に移動する。CPU21が駆動回路29に目標位置のデータを入力する都度、駆動回路29はY軸モータ14を駆動する。CPU21はX軸モータ13についても同様に駆動する。これにより、テーブル50は、送り軸指令により指定した位置(以下、「指令位置」と称す。)に最終的に到達する。送り軸指令に基づきCPU21が実行する上記の制御を、「送り軸制御」と称す。 When the CPU 21 reads the feed axis command, the table 50 holding the work material W is moved to the position specified by the feed axis command, so that time series data of the target position of the table 50 is generated. The CPU 21 outputs the data of the target position to the drive circuit 29 at a predetermined cycle. The drive circuit 29 drives the Y-axis motor 14 based on the target position data output by the CPU 21. The Y-axis motor 14 moves the table 50 to the target position in the Y-axis direction. Each time the CPU 21 inputs the data of the target position to the drive circuit 29, the drive circuit 29 drives the Y-axis motor 14. The CPU 21 drives the X-axis motor 13 in the same manner. As a result, the table 50 finally reaches the position designated by the feed axis command (hereinafter, referred to as “command position”). The above-mentioned control executed by the CPU 21 based on the feed axis command is referred to as "feed axis control".

上記において目標位置の時系列データを生成する時、はじめにCPU21は、送り軸指令の指定位置までテーブル50が移動する時の速度が一定に推移するように、各目標位置を決定する。次にCPU21は、速度の時系列変化を示す波形(以下、「速度波形」と称す。)に移動平均フィルタを適用することで、速度波形の形状に対応する加減速特性を調整する。移動平均フィルタは、有限時間のインパルス応答をもつデジタルフィルタ、即ちFIRフィルタである。CPU21は、移動平均フィルタを適用して算出した速度波形に基づき、所定周期毎の目標位置を決定する。CPU21は、決定した目標位置のデータを所定周期で駆動回路29に出力する。上記の移動平均フィルタの時定数を、加減速時定数と称す。移動平均フィルタを速度波形に適用して加減速特性を調整する処理を、加減速処理と称す。詳細は後述するが、CPU21は、後述する3つの加速度時定数(トルク抑制時定数t、可変制振時定数t、固定制振時定数t)の各々を有する3つの移動平均フィルタ(第一フィルタFIR1、第二フィルタFIR2、第三フィルタFIR3)を速度波形に適用することで、加減速処理を実行する。 When generating the time-series data of the target position in the above, the CPU 21 first determines each target position so that the speed at which the table 50 moves to the designated position of the feed axis command changes constantly. Next, the CPU 21 adjusts the acceleration / deceleration characteristics corresponding to the shape of the velocity waveform by applying the moving average filter to the waveform showing the time-series change of the velocity (hereinafter, referred to as “velocity waveform”). The moving average filter is a digital filter having an impulse response for a finite time, that is, an FIR filter. The CPU 21 determines the target position for each predetermined cycle based on the velocity waveform calculated by applying the moving average filter. The CPU 21 outputs the determined target position data to the drive circuit 29 at a predetermined cycle. The time constant of the above moving average filter is referred to as an acceleration / deceleration time constant. The process of applying the moving average filter to the velocity waveform to adjust the acceleration / deceleration characteristics is called the acceleration / deceleration process. Although the details will be described later, the CPU 21 has three moving average filters (torque suppression time constant t 1 , variable vibration suppression time constant t 2 , fixed vibration suppression time constant t 3 ) having each of the three acceleration time constants (torque suppression time constant t 1 , fixed vibration suppression time constant t 3 ) described later. Acceleration / deceleration processing is executed by applying the first filter FIR1, the second filter FIR2, and the third filter FIR3) to the velocity waveform.

<トルク抑制時定数t
CPU21は、送り軸制御の実行時にY軸モータ14に生じるトルクの最大値(以下、「最大トルク」と称す)を制限する為、トルク抑制時定数tを有する第一フィルタFIR1を速度波形に適用する。尚、送り軸制御の実行時におけるY軸モータ14の最大トルクは、負荷質量Mに応じて変化する。負荷質量Mは、テーブル50自体の質量、送り機構の等価質量、及び積載質量Mの総和に対応する。ここで送り機構の等価質量とは、テーブル50の送り機構を構成するY軸モータ14、継手43、ボールねじ44、ナット46のイナーシャの合計を質量に換算したものである。積載質量Mとは、テーブル50に設けた治具の質量、及び、治具が保持する被削材Wの質量の合計である。テーブル50の質量及び送り機構の等価質量は定数である。故に負荷質量Mは積載質量Mが変化するときに変化する。よって、最大トルクを抑制する為のトルク抑制時定数tも、積載質量Mに応じて変化する。CPU21は、積載質量Mに応じた適切なトルク抑制時定数t及び第一フィルタFIR1を決定して速度波形に適用することにより、積載質量Mに応じてY軸モータ14の最大トルクが変化した時も、最大トルクを制限しつつ送り軸制御を実行できる。
<Torque suppression time constant t 1 >
In order to limit the maximum value of torque generated in the Y-axis motor 14 (hereinafter referred to as "maximum torque") when the feed axis control is executed, the CPU 21 uses the first filter FIR1 having the torque suppression time constant t 1 as a velocity waveform. Apply. The maximum torque of the Y-axis motor 14 at the time of the feed axis control execution will vary depending on the load mass M 1. The load mass M 1 corresponds to the total mass of the table 50 itself, the equivalent mass of the feed mechanism, and the load mass M. Here, the equivalent mass of the feed mechanism is the total of the inertias of the Y-axis motor 14, the joint 43, the ball screw 44, and the nut 46 constituting the feed mechanism of the table 50 converted into mass. The load mass M is the total mass of the jig provided on the table 50 and the mass of the work material W held by the jig. The mass of the table 50 and the equivalent mass of the feed mechanism are constants. Therefore, the load mass M 1 changes when the load mass M changes. Therefore, the torque suppression time constant t 1 for suppressing the maximum torque also changes according to the load mass M. The CPU 21 determines an appropriate torque suppression time constant t 1 and a first filter FIR 1 according to the load mass M and applies them to the velocity waveform, so that the maximum torque of the Y-axis motor 14 changes according to the load mass M. At times, feed axis control can be performed while limiting the maximum torque.

トルク抑制時定数tの算出方法は次の通りである。Y軸モータ14にて許容するトルクの最大値(以下、「定格トルク」という。)をTmax[N]と称す。Y軸モータ14が定格トルクTmaxで駆動した時のテーブル50の加速度を、a[m/s]と称す。定格トルクTmaxと、負荷質量M[kg]及び加速度aとは、次の式(1)の関係を満たす。
Tmax = M×a (1)
The calculation method of the torque suppression time constant t 1 is as follows. The maximum value of torque allowed by the Y-axis motor 14 (hereinafter referred to as "rated torque") is referred to as Tmax [N]. The acceleration of the table 50 when the Y-axis motor 14 is driven with the rated torque Tmax is referred to as a [m / s 2 ]. The rated torque Tmax, the load mass M 1 [kg], and the acceleration a satisfy the relationship of the following equation (1).
Tmax = M 1 × a (1)

更に、工作機械10にて規定したテーブル50の最大速度を、Vmax[m/s]と称する。トルク抑制時定数tと、最大速度Vmax、負荷質量M、定格トルクTmax、加速度aとは、次の式(2)の関係を満たす。
= Vmax/a = Vmax/(Tmax/M) (2)
Further, the maximum speed of the table 50 defined by the machine tool 10 is referred to as Vmax [m / s]. The torque suppression time constant t 1 and the maximum velocity Vmax, load mass M 1 , rated torque Tmax, and acceleration a satisfy the relationship of the following equation (2).
t 1 = Vmax / a = Vmax / (Tmax / M 1 ) (2)

<可変制振時定数t、固定制振時定数t
CPU21は、送り軸制御の実行時において工作機械10に発生する振動を制限する為、可変制振時定数tを有する第二フィルタFIR2、及び、固定制振時定数tを有する第三フィルタFIR3を、夫々速度波形に適用する。尚、送り軸制御の実行により工作機械10に発生する振動は、移動物質量Mに応じて固有周波数が変化する振動(以下、「可変振動」という。)と、移動物質量Mに応じて固有周波数が変化しない振動(以下、「固定振動」という。)がある。移動物質量Mは、テーブル50の質量と積載質量Mの和である。この時テーブル50の質量は定数であるので、移動物質量Mは積載質量Mに応じて変化する。すなわち、可変振動は積載質量Mに応じて変化する。固定周波数とは、テーブル50が移動した時に工作機械10が最も振動し易い周波数であり、工作機械10の構成等に応じて定まる固有の周波数を意味する。固有周波数の逆数を時定数として有する移動平均フィルタを速度波形に適用することで、送り軸制御の実行時における工作機械10の振動を制限できる。以下、可変振動の固有周波数を、可変制振周波数Fvarと称し、固定振動の固有周波数を、固定制振周波数Ffixと称す。
<Variable damping time constant t 2 , fixed damping time constant t 3 >
CPU21 is to limit the vibration generated in the machine tool 10 at the time of the feed axis control run, the second filter FIR2 having a variable damping time constant t 2, and a third filter having a fixed damping time constant t 3 FIR3 is applied to each velocity waveform. The vibration generated in the machine tool 10 due to the execution of the feed axis control depends on the vibration in which the natural frequency changes according to the amount of moving substance M 2 (hereinafter referred to as "variable vibration") and the amount of moving substance M 2 . There is vibration in which the natural frequency does not change (hereinafter referred to as "fixed vibration"). The amount of transferred substance M 2 is the sum of the mass of the table 50 and the loaded mass M. At this time, since the mass of the table 50 is constant, the amount of moving substance M 2 changes according to the loaded mass M. That is, the variable vibration changes according to the loaded mass M. The fixed frequency is a frequency at which the machine tool 10 is most likely to vibrate when the table 50 is moved, and means a unique frequency determined according to the configuration of the machine tool 10 or the like. By applying a moving average filter having the reciprocal of the natural frequency as a time constant to the velocity waveform, it is possible to limit the vibration of the machine tool 10 when the feed axis control is executed. Hereinafter, the natural frequency of the variable vibration is referred to as a variable damping frequency Fvar, and the natural frequency of the fixed vibration is referred to as a fixed damping frequency Ffix.

可変振動は、主に、送り軸制御の実行時においてテーブル50のY軸方向の振動である。図3は、積載質量Mに応じて可変制振周波数Fvarが変化する様子を示すグラフである。グラフにおいてピークを示す周波数が、可変制振周波数Fvarに対応する。図3(a)に示すように、積載質量Mが100kgの時、可変制振周波数Fvarは約40Hzである。図3(b)に示すように、積載質量Mが250kgの時、可変制振周波数Fvarは約35Hzである。可変制振周波数Fvarと移動物質量Mとは、次の式(3)の関係を満たす。
2π×Fvar = √(k/M) (3)
移動物質量Mが積載質量Mによって変化するので、Fvarは積載質量Mによって変化する。尚、kはテーブル50のY軸方向の剛性であり、設計値もしくは、式(3)に実測値を代入することで求められる係数である。図4は、積載質量Mと可変制振周波数Fvarとの関係を、式(3)に基づきグラフ化したものである。このように、積載質量Mと可変制振周波数Fvarとは、非線形の関係を有する。
The variable vibration is mainly the vibration in the Y-axis direction of the table 50 when the feed axis control is executed. FIG. 3 is a graph showing how the variable damping frequency Fvar changes according to the loaded mass M. The frequency showing the peak in the graph corresponds to the variable damping frequency Fvar. As shown in FIG. 3A, when the loaded mass M is 100 kg, the variable damping frequency Fvar is about 40 Hz. As shown in FIG. 3B, when the loaded mass M is 250 kg, the variable damping frequency Fvar is about 35 Hz. The variable damping frequency Fvar and the amount of moving substance M 2 satisfy the relationship of the following equation (3).
2π x Fvar = √ (k / M 2 ) (3)
Since the amount of transferred substance M 2 changes with the loaded mass M, Fvar changes with the loaded mass M. Note that k is the rigidity of the table 50 in the Y-axis direction, and is a coefficient obtained by substituting the design value or the measured value into the equation (3). FIG. 4 is a graph showing the relationship between the loaded mass M and the variable damping frequency Fvar based on the equation (3). As described above, the loaded mass M and the variable damping frequency Fvar have a non-linear relationship.

可変制振周波数Fvarの逆数1/Fvarは、可変振動を抑制することが可能な移動平均フィルタの時定数である可変制振時定数tを示す(式(4)参照)。
=1/Fvar = 2π×√(M/k) (4)
CPU21は、積載質量Mに応じた適切な可変制振時定数tに基づき第二フィルタFIR2を決定し、速度波形に適用する。これにより、CPU21は、可変振動を抑制しつつ送り軸制御を実行できる。
The reciprocal 1 / Fvar of the variable damping frequency Fvar indicates the variable damping time constant t 2 which is the time constant of the moving average filter capable of suppressing the variable vibration (see equation (4)).
t 2 = 1 / Fvar = 2π × √ (M 2 / k) (4)
CPU21 is a second filter FIR2 determined based on the appropriate variable damping time constant t 2 corresponding to the load weight M, applied to the velocity waveform. As a result, the CPU 21 can execute the feed axis control while suppressing the variable vibration.

固定振動は、主に、送り軸制御の実行時において発生する機械全体の振動である。固定制振周波数Ffixの逆数1/Ffixは、固定振動を抑制することが可能な移動平均フィルタの時定数である固定制振時定数tを示す(式(5)参照)。
=1/Ffix (5)
CPU21は、積載質量Mに依らず一定である固定制振時定数tに基づき第三フィルタFIR3を決定して速度波形に適用する。これにより、CPU21は、固定振動を抑制しつつ送り軸制御を実行できる。
The fixed vibration is mainly the vibration of the entire machine generated when the feed axis control is executed. The reciprocal 1 / Ffix of the fixed vibration damping frequency Ffix indicates the fixed vibration damping time constant t 3 which is the time constant of the moving average filter capable of suppressing the fixed vibration (see equation (5)).
t 3 = 1 / Ffix (5)
CPU21 applies the velocity waveform to determine the third filter FIR3 based on certain fixed damping time constant t 3 is regardless of the load mass M. As a result, the CPU 21 can execute the feed axis control while suppressing the fixed vibration.

<主処理>
図5を参照し、主処理について説明する。CPU21は、ROM22に記憶したプログラムを読み出して実行することにより、主処理を開始する。CPU21は、主処理の実行時、ROM22に記憶した設定値を参照する。該設定値は、X軸に対応する定格トルクTmax、最大速度Vmax、係数k、固定制振周波数Ffixと、Y軸に対応する定格トルクTmax、最大速度Vmax、係数k、固定制振周波数Ffixと、最大積載質量Mmaxである。最大積載質量Mmaxは、工作機械10において許容する最大の積載質量Mである。
<Main processing>
The main processing will be described with reference to FIG. The CPU 21 starts the main process by reading and executing the program stored in the ROM 22. The CPU 21 refers to the set value stored in the ROM 22 when the main process is executed. The set values are the rated torque Tmax, maximum speed Vmax, coefficient k, and fixed vibration damping frequency Ffix corresponding to the X-axis, and the rated torque Tmax, maximum speed Vmax, coefficient k, and fixed vibration damping frequency Ffix corresponding to the Y-axis. , Maximum loading mass Mmax. The maximum load mass Mmax is the maximum load mass M allowed in the machine tool 10.

CPU21は、記憶装置24に記憶したNCプログラムの指令を1つ読み出す(S11)。CPU21は、読み出した指令に応じた工作機械10の動作が、早送り動作であるか判定する(S13)。早送り動作とは、工作機械10において設定可能な最大速度でX軸モータ13又はY軸モータ14が回転する動作を示す。 The CPU 21 reads out one command of the NC program stored in the storage device 24 (S11). The CPU 21 determines whether the operation of the machine tool 10 in response to the read command is a fast-forward operation (S13). The fast-forward operation means an operation in which the X-axis motor 13 or the Y-axis motor 14 rotates at a maximum speed that can be set in the machine tool 10.

CPU21は、早送り動作であると判定した場合(S13:YES)、NCプログラムに基づき工作機械10が早送り動作を初めて実行するか判定する(S17)。CPU21は、早送り動作を初めて実行すると判定した場合(S17:YES)、処理をS19に進める。以下では、X軸モータ13及びY軸モータ14が夫々最大速度で回転する早送り動作であることを前提とする。X軸に対応する定格トルクTmax、最大速度Vmax、係数k、固定制振周波数Ffixを、各々、定格トルクTmax(x)、最大速度Vmax(x)、係数k(x)、固定制振周波数Ffix(x)と称す。Y軸に対応する定格トルクTmax、最大速度Vmax、係数k、固定制振周波数Ffixを、各々、定格トルクTmax(y)、最大速度Vmax(y)、係数k(y)、固定制振周波数Ffix(y)と称す。CPU21は、積載質量Mを推定する為、S19〜S23の処理を実行する。 When the CPU 21 determines that the fast-forward operation is performed (S13: YES), the CPU 21 determines whether the machine tool 10 executes the fast-forward operation for the first time based on the NC program (S17). When the CPU 21 determines that the fast-forward operation is executed for the first time (S17: YES), the CPU 21 advances the process to S19. In the following, it is assumed that the X-axis motor 13 and the Y-axis motor 14 each rotate at the maximum speed in a fast-forward operation. Rated torque Tmax, maximum speed Vmax, coefficient k, fixed vibration damping frequency Ffix corresponding to the X axis, respectively, rated torque Tmax (x), maximum speed Vmax (x), coefficient k (x), fixed vibration damping frequency Ffix, respectively. It is called (x). Rated torque Tmax, maximum speed Vmax, coefficient k, fixed vibration damping frequency Ffix corresponding to the Y axis, respectively, rated torque Tmax (y), maximum speed Vmax (y), coefficient k (y), fixed vibration damping frequency Ffix, respectively. It is called (y). The CPU 21 executes the processes S19 to S23 in order to estimate the loaded mass M.

CPU21は、ROM22に記憶した定格トルクTmax(x)、最大速度Vmax(x)、最大積載質量Mmaxに対応するM(x)を式(2)に代入し、X軸に対応するトルク抑制時定数tの暫定値(トルク抑制時定数t(x´)と称す。)を算出する。CPU21は、ROM22に記憶した係数k(x)、最大積載質量Mmaxに対応するM(x)を式(4)に代入し、X軸に対応する可変制振時定数tの暫定値(可変制振時定数t(x´)と称す)を算出する。CPU21は、ROM22に記憶した固定制振周波数Ffix(x)を式(5)に代入し、X軸に対応する固定制振時定数tの暫定値(固定制振時定数t(x´)と称す)を算出する。CPU21は、トルク抑制時定数t(x´)を有する第一フィルタFIR1と、可変制振時定数t(x´)を有する第二フィルタFIR2と、固定制振時定数t(x´)を有する第三フィルタFIR3(FIR3(x´)と称す)を用いて加減速処理を実行し、早送り動作においてX軸モータ13によりテーブル50をX軸方向に移動する為の速度波形を調整する。 The CPU 21 substitutes M 1 (x) corresponding to the rated torque Tmax (x), the maximum speed Vmax (x), and the maximum load mass Mmax stored in the ROM 22 into the equation (2), and when the torque is suppressed corresponding to the X axis. (referred to as the torque restriction time constant t 1 (x').) provisional value of the constant t 1 is calculated. The CPU 21 substitutes the coefficient k (x) stored in the ROM 22 and the M 2 (x) corresponding to the maximum load mass Mmax into the equation (4), and substitutes the provisional value of the variable vibration suppression time constant t 2 corresponding to the X axis ( The variable vibration damping time constant t 2 (referred to as'x')) is calculated. CPU21 is fixed damping frequency Ffix stored in the ROM22 (x) is substituted into Equation (5), fixed damping when the provisional value of the constant t 3 when corresponding to the X-axis (fixed damping time constant t 3 (x' ) Is calculated. The CPU 21 includes a first filter FIR1 having a torque suppression time constant t 1 (x'), a second filter FIR2 having a variable vibration suppression time constant t 2 (x'), and a fixed vibration suppression time constant t 3 (x'). The acceleration / deceleration process is executed using the third filter FIR3 (referred to as FIR3 (x')) having), and the speed waveform for moving the table 50 in the X-axis direction is adjusted by the X-axis motor 13 in the fast-forward operation. ..

尚、詳細説明は省略するが、CPU21は、Y軸に対応するトルク抑制時定数tの暫定値(トルク抑制時定数t(y´)と称す。)、可変制振時定数tの暫定値(固定制振時定数t(y´)と称す)、固定制振時定数tの暫定値(固定制振時定数t(y´)と称す)についても同様の方法で算出する。CPU21は、トルク抑制時定数t(y´)を有する第一フィルタFIR1、可変制振時定数t(y´)を有する第二フィルタFIR2、固定制振時定数t(y´)を有する第三フィルタFIR3を用いて加減速処理を実行し、早送り動作においてY軸モータ14によりテーブル50をY軸方向に移動する為の速度波形を調整する。 Although detailed description will be omitted, the CPU 21 has a provisional value of the torque suppression time constant t 1 corresponding to the Y axis (referred to as the torque suppression time constant t 1 (y ′)) and the variable vibration suppression time constant t 2 . calculated provisional value (fixed damping time constant t 3 referred to as (y ')), the provisional value of the fixed damping time constant t 3 (referred to as the fixed damping time constant t 3 (y')) similar method for To do. The CPU 21 uses a first filter FIR1 having a torque suppression time constant t 1 (y ′), a second filter FIR2 having a variable vibration suppression time constant t 2 (y ′), and a fixed vibration suppression time constant t 3 (y ′). Acceleration / deceleration processing is executed using the third filter FIR3, and the speed waveform for moving the table 50 in the Y-axis direction is adjusted by the Y-axis motor 14 in the fast-forward operation.

CPU21は、調整した速度波形に基づいて送り軸制御を実行し、工作機械10による早送り動作を制御する(S19)。駆動回路28は、S19により工作機械10が早送り動作を実行する間、エンコーダ13Aが出力する信号に基づき、X軸モータ13の加速度a(x)及びトルクT(x)を特定する。駆動回路29は、S19により工作機械10が早送り動作を実行する間、エンコーダ14Aが出力する信号に基づき、Y軸モータ14の加速度a(y)及びトルクT(y)を特定する。CPU21は、駆動回路28、29が特定したX軸モータ13及びY軸モータ14の各々の加速度a(x)、a(y)(加速度aと総称する)、及びトルクT(x)、T(y)(トルクTと総称する)を取得する(S21)。CPU21は、加速度a及びトルクTを次の式(6)に代入し、負荷質量Mを推定する。
= T/a (6)
CPU21は更に、加速度a(x)及びトルクT(x)に基づき推定した負荷質量Mである負荷質量M(x)に対応する積載質量M(x)と、加速度a(y)及びトルクT(y)に基づき推定した負荷質量Mである負荷質量M(y)に対応する積載質量M(y)との平均値を、積載質量Mとして推定する(S23)。なお、「積載質量M=負荷質量M−送り機構の等価質量−テーブル50の質量」である。本推定処理はX軸及びY軸が同時に早送り動作を行わない場合も実行可能である。X軸のみが早送り動作を行う場合、推定可能な負荷質量M(x)に対応する積載質量M(x)を積載質量Mとして推定する。Y軸のみが早送り動作を行う場合、推定可能な負荷質量M(y)に対応する積載質量M(y)を積載質量Mとして推定する。
The CPU 21 executes feed axis control based on the adjusted velocity waveform, and controls the fast-forward operation by the machine tool 10 (S19). The drive circuit 28 identifies the acceleration a (x) and the torque T (x) of the X-axis motor 13 based on the signal output by the encoder 13A while the machine tool 10 executes the fast-forward operation by S19. The drive circuit 29 identifies the acceleration a (y) and the torque T (y) of the Y-axis motor 14 based on the signal output by the encoder 14A while the machine tool 10 executes the fast-forward operation by S19. The CPU 21 includes accelerations a (x), a (y) (collectively referred to as acceleration a), and torques T (x), T (generally referred to as acceleration a) of the X-axis motor 13 and the Y-axis motor 14 specified by the drive circuits 28 and 29. y) (collectively referred to as torque T) is acquired (S21). CPU21 is the acceleration a and torque T are substituted into the following equation (6), to estimate the load mass M 1.
M 1 = T / a (6)
The CPU 21 further includes a load mass M (x) corresponding to a load mass M 1 (x), which is a load mass M 1 estimated based on the acceleration a (x) and the torque T (x), and the acceleration a (y) and the torque. T the average value of the load mass M corresponding to the load weight M 1 is a load mass M 1 which is estimated based on (y) (y) (y ), is estimated as a payload M (S23). It should be noted that "load mass M = load mass M 1- equivalent mass of feed mechanism-mass of table 50". This estimation process can be executed even when the X-axis and the Y-axis do not perform the fast-forward operation at the same time. When only the X-axis performs the fast-forward operation, the load mass M (x) corresponding to the estimated load mass M 1 (x) is estimated as the load mass M. When only the Y-axis performs the fast-forward operation, the load mass M (y) corresponding to the estimated load mass M 2 (y) is estimated as the load mass M.

CPU21は、推定した積載質量Mに対応する負荷質量M(x)と、ROM22に記憶した定格トルクTmax(x)、最大速度Vmax(x)を式(2)に代入し、X軸に対応するトルク抑制時定数t(トルク抑制時定数t(x)と称す)を決定する(S25)。CPU21は、推定した積載質量Mに対応する移動物質量M(x)と、ROM22に記憶した係数k(x)を式(4)に代入し、X軸に対応する可変制振時定数t(可変制振時定数t(x)と称す)を決定する(S27)。CPU21は、ROM22に記憶した固定制振周波数Ffix(x)を式(5)に代入し、X軸に対応する固定制振時定数t(固定制振時定数t(x)と称す)を決定する(S29)。尚、固定制振時定数t(x)は、S19で早送り動作を実行する時に算出した固定制振時定数t(x´)と同一である。尚、詳細説明は省略するが、CPU21は、Y軸に対応するトルク抑制時定数t(トルク抑制時定数t(y)と称す)、可変制振時定数t(可変制振時定数t(y)と称す)、固定制振時定数t(固定制振時定数t(y)と称す)についても同様の算出方法により決定する。CPU21は、決定したトルク抑制時定数t(x)、t(y)、可変制振時定数t(x)、t(y)、固定制振時定数t(x)、t(y)をRAM23に記憶する(S31)。CPU21は処理をS35に進める。 The CPU 21 substitutes the load mass M 1 (x) corresponding to the estimated load mass M, the rated torque Tmax (x) and the maximum speed Vmax (x) stored in the ROM 22 into the equation (2), and corresponds to the X axis. The torque suppression time constant t 1 (referred to as the torque suppression time constant t 1 (x)) is determined (S25). The CPU 21 substitutes the moving substance amount M 2 (x) corresponding to the estimated loaded mass M and the coefficient k (x) stored in the ROM 22 into the equation (4), and the variable vibration damping time constant t corresponding to the X axis. 2 (referred to as a variable vibration damping time constant t 2 (x)) is determined (S27). The CPU 21 substitutes the fixed vibration damping frequency Ffix (x) stored in the ROM 22 into the equation (5), and the fixed vibration damping time constant t 3 corresponding to the X axis (referred to as the fixed vibration damping time constant t 3 (x)). Is determined (S29). The fixed vibration damping time constant t 3 (x) is the same as the fixed vibration damping time constant t 3 (x') calculated when the fast-forward operation is executed in S19. Although detailed description is omitted, the CPU 21 has a torque suppression time constant t 1 (referred to as torque suppression time constant t 1 (y)) and a variable vibration suppression time constant t 2 (variable vibration suppression time constant) corresponding to the Y axis. t 2 is referred to as (y)), referred to as fixed damping time constant t 3 (fixed damping time constant t 3 (y)) is determined by the same method of calculation also. The CPU 21 has determined torque suppression time constants t 1 (x), t 1 (y), variable vibration suppression time constants t 2 (x), t 2 (y), fixed vibration suppression time constants t 3 (x), t. 3 (y) is stored in the RAM 23 (S31). The CPU 21 advances the process to S35.

CPU21は、S11の処理で、NCプログラムの最後の指令を読み出したか判定する(S35)。CPU21は、NCプログラムの最後の指令を読み出していないと判定した場合(S35:NO)、処理をS11に戻す。CPU21は、NCプログラムの次の指令を1つ読み出し(S11)、処理をS13に進める。 The CPU 21 determines whether or not the last command of the NC program has been read in the process of S11 (S35). When the CPU 21 determines that the last command of the NC program has not been read (S35: NO), the processing returns to S11. The CPU 21 reads one of the next commands of the NC program (S11) and proceeds with the process to S13.

CPU21は、早送り動作でないと判定した場合(S13:NO)、読み出した指令に応じた動作(通常動作と称す)で工作機械10が駆動するように、工作機械10を制御する(S15)。詳細はここには記述しないが、通常動作は切削動作、タップ動作、工具交換動作などを含み、それぞれに固有の時定数を用いて動作する。すなわち通常動作時においてテーブル50がX軸方向に移動する時、トルク抑制時定数t(x)、可変制振時定数t(x)、固定制振時定数t(x)とは異なる時定数を用いて、X軸モータ13によりテーブル50をX軸方向に移動する為の速度波形を調整する。又、通常動作時においてテーブル50がY軸方向に移動する時、トルク抑制時定数t(y)、可変制振時定数t(y)、固定制振時定数t(y)とは異なる時定数を用いて、Y軸モータ14によりテーブル50をY軸方向に移動する為の速度波形を調整する。CPU21は、調整した速度波形に基づいて送り軸制御を実行し、工作機械10による通常動作を制御する(S15)。CPU21は、処理をS35に進める。 When it is determined that the operation is not the fast-forward operation (S13: NO), the CPU 21 controls the machine tool 10 so that the machine tool 10 is driven by an operation (referred to as a normal operation) according to the read command (S15). Although details are not described here, the normal operation includes a cutting operation, a tap operation, a tool changing operation, and the like, and operates using a time constant unique to each. That is, when the table 50 moves in the X-axis direction during normal operation, it is different from the torque suppression time constant t 1 (x), the variable vibration suppression time constant t 2 (x), and the fixed vibration suppression time constant t 3 (x). Using the time constant, the X-axis motor 13 adjusts the speed waveform for moving the table 50 in the X-axis direction. Further, when the table 50 moves in the Y-axis direction during normal operation, what are the torque suppression time constant t 1 (y), the variable vibration suppression time constant t 2 (y), and the fixed vibration suppression time constant t 3 (y)? Using different time constants, the Y-axis motor 14 adjusts the speed waveform for moving the table 50 in the Y-axis direction. The CPU 21 executes feed axis control based on the adjusted velocity waveform, and controls the normal operation by the machine tool 10 (S15). The CPU 21 advances the process to S35.

CPU21は、早送り動作であると判定し(S13:YES)、且つ、2回目以降の早送り動作であると判定した場合(S17:NO)、工作機械10が早送り動作で駆動するように、工作機械10を制御する(S33)。該時、CPU21は、早送り動作によりテーブル50がX軸方向に移動する時、S31の処理でRAM23に記憶したトルク抑制時定数t(x)を有する第一フィルタFIR1、可変制振時定数t(x)を有する第二フィルタFIR2、固定制振時定数t(x)を有する第三フィルタFIR3を用いて加減速処理を実行し、X軸モータ13によりテーブル50をX軸方向に移動する為の速度波形を調整する。又、早送り動作によりテーブル50がY軸方向に移動する時、CPU21は、S31の処理でRAM23に記憶したトルク抑制時定数t(y)を有する第一フィルタFIR1、可変制振時定数t(y)を有する第二フィルタFIR2、固定制振時定数t(y)を有する第三フィルタFIR3を用いて加減速処理を実行し、通常動作においてY軸モータ14によりテーブル50をY軸方向に移動する為の速度波形を調整する。CPU21は、調整した速度波形に基づいて送り軸制御を実行し、工作機械10による早送り動作を制御する(S33)。CPU21は、処理をS35に進める。 When the CPU 21 determines that the fast-forward operation is performed (S13: YES) and determines that the second and subsequent fast-forward operations are performed (S17: NO), the machine tool 10 is driven by the fast-forward operation. 10 is controlled (S33). At this time, when the table 50 moves in the X-axis direction due to the fast-forward operation, the CPU 21 has a first filter FIR1 having a torque suppression time constant t 1 (x) stored in the RAM 23 in the process of S31, and a variable vibration suppression time constant t. Acceleration / deceleration processing is executed using the second filter FIR2 having 2 (x) and the third filter FIR3 having the fixed vibration suppression time constant t 3 (x), and the table 50 is moved in the X-axis direction by the X-axis motor 13. Adjust the speed waveform to do. Further, when the table 50 moves in the Y-axis direction due to the fast-forward operation, the CPU 21 has a first filter FIR1 having a torque suppression time constant t 1 (y) stored in the RAM 23 in the process of S31, and a variable vibration suppression time constant t 2. Acceleration / deceleration processing is executed using the second filter FIR2 having (y) and the third filter FIR3 having the fixed vibration damping time constant t 3 (y), and the table 50 is moved in the Y-axis direction by the Y-axis motor 14 in normal operation. Adjust the velocity waveform to move to. The CPU 21 executes feed axis control based on the adjusted velocity waveform, and controls the fast-forward operation by the machine tool 10 (S33). The CPU 21 advances the process to S35.

CPU21は、S11の処理で、NCプログラムの最後の指令を読み出したと判定した場合(S35:YES)、主処理を終了する。 When the CPU 21 determines that the last command of the NC program has been read in the process of S11 (S35: YES), the CPU 21 ends the main process.

<本発明の主たる作用、効果>
数値制御装置20は、積載質量M、最大速度Vmax、及び定格トルクTmaxに応じたトルク抑制時定数tを決定し(S25)、トルク抑制時定数tを有する第一フィルタFIR1を用いて加減速処理を実行する(S33)。故に、数値制御装置20は、積載質量Mの変化によってX軸モータ13及びY軸モータ14の加速度に応じたトルクが変化しても、X軸モータ13及びY軸モータ14の最大トルクが定格トルクTmaxを超えないように加減速処理を適切に実行できる。更に数値制御装置20は、工作機械10の可変振動を抑制するための可変制振時定数tを決定し(S27)、可変制振時定数tを有する第二フィルタFIR2を用いて加減速処理を実行する(S33)。故に、数値制御装置20は、積載質量Mに応じて可変振動の周波数が変化する場合でも、工作機械10の可変振動を適切に抑制できる。
<Main actions and effects of the present invention>
The numerical control device 20 determines the torque suppression time constant t 1 according to the load mass M, the maximum speed Vmax, and the rated torque Tmax (S25), and applies the torque suppression time constant t 1 using the first filter FIR 1 having the torque suppression time constant t 1. The deceleration process is executed (S33). Therefore, in the numerical control device 20, even if the torque corresponding to the acceleration of the X-axis motor 13 and the Y-axis motor 14 changes due to the change of the loaded mass M, the maximum torque of the X-axis motor 13 and the Y-axis motor 14 is the rated torque. Acceleration / deceleration processing can be appropriately executed so as not to exceed Tmax. Further, the numerical control device 20 determines a variable vibration damping time constant t 2 for suppressing the variable vibration of the machine tool 10 (S27), and accelerates / decelerates using the second filter FIR 2 having the variable vibration damping time constant t 2. The process is executed (S33). Therefore, the numerical control device 20 can appropriately suppress the variable vibration of the machine tool 10 even when the frequency of the variable vibration changes according to the loaded mass M.

数値制御装置20は、積載質量Mと可変制振周波数Fvarとが非線形の関係を有することを前提として可変制振時定数tを決定する。故に、数値制御装置20は、積載質量Mが変化したことに応じて可変制振周波数Fvarが変化する場合でも、可変振動を抑制可能な可変制振時定数tを精度良く決定できる。 The numerical control device 20 determines the variable damping time constant t 2 on the premise that the loaded mass M and the variable damping frequency Fvar have a non-linear relationship. Therefore, the numerical control device 20 can accurately determine the variable vibration damping time constant t 2 capable of suppressing the variable vibration even when the variable vibration damping frequency Fvar changes according to the change in the loaded mass M.

数値制御装置20は、工作機械1の固有振動を抑制する為の固定制振時定数tを決定し(S29)、固定制振時定数tを有する第三フィルタFIR3を用いて加減速処理を実行する(S33)。故に、数値制御装置20は、積載質量Mに応じて変化しない工作機械10の振動を適切に抑制できる。 The numerical control device 20 determines a fixed vibration damping time constant t 3 for suppressing the natural vibration of the machine tool 1 (S29), and accelerates / decelerates using a third filter FIR 3 having a fixed vibration damping time constant t 3 (S29). Is executed (S33). Therefore, the numerical control device 20 can appropriately suppress the vibration of the machine tool 10 which does not change according to the loaded mass M.

数値制御装置20は、積載質量Mを推定し(S19〜S23)、推定した積載質量Mに基づいて、トルク抑制時定数t及び可変制振時定数tを決定する(S25、S27)。該時、数値制御装置20は、積載質量Mが未定である場合でも、トルク抑制時定数t及び可変制振時定数tを精度良く決定できる。該時、数値制御装置20は、積載質量Mに関する事前情報が不要となる。故に、数値制御装置20は、作業者が予め積載質量Mを測定しなくても、トルク抑制時定数t及び可変制振時定数tを精度良く決定できる。 The numerical control device 20 estimates the load mass M (S19 to S23), and determines the torque suppression time constant t 1 and the variable vibration suppression time constant t 2 based on the estimated load mass M (S25, S27). At this time, the numerical control device 20 can accurately determine the torque suppression time constant t 1 and the variable vibration suppression time constant t 2 even when the load mass M is undecided. At this time, the numerical control device 20 does not need prior information regarding the load mass M. Therefore, the numerical control device 20 can accurately determine the torque suppression time constant t 1 and the variable vibration suppression time constant t 2 without the operator measuring the load mass M in advance.

数値制御装置20は、X軸方向及びY軸方向にテーブル50を移動可能である。数値制御装置20は、X軸及びY軸の夫々についてトルク抑制時定数t、可変制振時定数t、及び固定制振時定数tを決定し、X軸及びY軸の夫々について加減速処理を実行する。従って、数値制御装置20は、X軸モータ13及びY軸モータ14の夫々について最大トルクが積載質量Mに応じて変化しても、加減速処理を適切に実行できる。 The numerical control device 20 can move the table 50 in the X-axis direction and the Y-axis direction. The numerical control device 20 determines the torque suppression time constant t 1 , the variable vibration suppression time constant t 2 , and the fixed vibration suppression time constant t 3 for each of the X-axis and the Y-axis, and adds the torque suppression time constant t 3 for each of the X-axis and the Y-axis. Execute deceleration processing. Therefore, the numerical control device 20 can appropriately execute the acceleration / deceleration process even if the maximum torque of each of the X-axis motor 13 and the Y-axis motor 14 changes according to the load mass M.

数値制御装置20は、加減速処理時の移動平均フィルタとして、FIRフィルタを用いる。これにより数値制御装置20は、加減速処理により速度波形を平滑化できる。 The numerical control device 20 uses an FIR filter as a moving average filter during acceleration / deceleration processing. As a result, the numerical control device 20 can smooth the velocity waveform by the acceleration / deceleration process.

<変形例>
図6を参照し、変形例における主処理について説明する。図5と異なる点は、使用者が入力部17(図2参照)を介して入力した積載質量Mに基づいてトルク抑制時定数t(x)、t(y)、可変制振時定数t(x)、t(y)、固定制振時定数t(x)、t(y)を決定する点である。該為、CPU21は積載質量の推定を行わない。以下、図5と相違する処理について詳細に説明し、同一処理についての説明は簡略化する。
<Modification example>
The main processing in the modified example will be described with reference to FIG. The difference from FIG. 5 is that the torque suppression time constants t 1 (x), t 1 (y), and the variable vibration suppression time constant are based on the load mass M input by the user via the input unit 17 (see FIG. 2). This is a point for determining t 2 (x), t 2 (y), fixed vibration suppression time constants t 3 (x), and t 3 (y). Therefore, the CPU 21 does not estimate the loaded mass. Hereinafter, the processing different from that of FIG. 5 will be described in detail, and the description of the same processing will be simplified.

CPU21は、入力部17を介して使用者が入力した積載質量Mを取得する(S51)。CPU21は、取得した積載質量Mに対応する負荷質量M(x)と、定格トルクTmax(x)、最大速度Vmax(x)を式(2)に代入してトルク抑制時定数t(x)を決定し、取得した積載質量Mに対応する負荷質量M(y)と、定格トルクTmax(y)、最大速度Vmax(y)を式(2)に代入してトルク抑制時定数t(y)を決定する(S53)。CPU21は、取得した積載質量Mに対応する移動物質量M(x)と係数k(x)を式(4)に代入して可変制振時定数t(x)を決定し、取得した積載質量Mに対応する移動物質量M(y)と係数k(y)を式(4)に代入して可変制振時定数t(y)を決定する(S55)。CPU21は、固定制振周波数Ffix(x)を式(5)に代入して固定制振時定数t(x)を決定し、固定制振周波数Ffix(y)を式(5)に代入して固定制振時定数t(y)を決定する(S57)。CPU21は、決定したトルク抑制時定数t(x)、t(y)、可変制振時定数t(x)、t(y)、固定制振時定数t(x)、t(y)をRAM23に記憶する(S59)。 The CPU 21 acquires the load mass M input by the user via the input unit 17 (S51). The CPU 21 substitutes the load mass M 1 (x) corresponding to the acquired load mass M, the rated torque Tmax (x), and the maximum speed Vmax (x) into the equation (2), and the torque suppression time constant t 1 (x). ) Is determined, and the load mass M 1 (y) corresponding to the acquired load mass M, the rated torque Tmax (y), and the maximum speed Vmax (y) are substituted into the equation (2), and the torque suppression time constant t 1 (Y) is determined (S53). The CPU 21 substitutes the amount of moving material M 2 (x) and the coefficient k (x) corresponding to the acquired loaded mass M into the equation (4) to determine the variable vibration damping time constant t 2 (x), and acquires the variable vibration damping time constant t 2 (x). The variable vibration damping time constant t 2 (y) is determined by substituting the moving substance amount M 2 (y) corresponding to the loaded mass M and the coefficient k (y) into the equation (4) (S55). The CPU 21 substitutes the fixed damping frequency Ffix (x) into the equation (5) to determine the fixed damping time constant t 3 (x), and substitutes the fixed damping frequency Ffix (y) into the equation (5). To determine the fixed vibration damping time constant t 3 (y) (S57). The CPU 21 has determined torque suppression time constants t 1 (x), t 1 (y), variable vibration suppression time constants t 2 (x), t 2 (y), fixed vibration suppression time constants t 3 (x), t. 3 (y) is stored in the RAM 23 (S59).

CPU21は、記憶装置24に記憶したNCプログラムの指令を1つ読み出す(S61)。CPU21は、読み出した指令に応じた工作機械10の動作が、早送り動作であるか判定する(S63)。CPU21は、早送り動作であると判定した場合(S63:YES)、工作機械10が早送り動作で駆動するように、工作機械10を制御する(S65)。該処理の詳細は、図5のS33と同一である。CPU21は、処理をS69に進める。一方、CPU21は、早送り動作でないと判定した場合(S63:NO)、読み出した指令に応じた通常動作で工作機械10が駆動するように、工作機械10を制御する(S67)。該処理の詳細は図5のS15と同一である。CPU21は、処理をS69に進める。 The CPU 21 reads out one command of the NC program stored in the storage device 24 (S61). The CPU 21 determines whether the operation of the machine tool 10 in response to the read command is a fast-forward operation (S63). When the CPU 21 determines that the fast-forward operation is performed (S63: YES), the CPU 21 controls the machine tool 10 so that the machine tool 10 is driven by the fast-forward operation (S65). The details of the process are the same as in S33 of FIG. The CPU 21 advances the process to S69. On the other hand, when the CPU 21 determines that the fast-forward operation is not performed (S63: NO), the CPU 21 controls the machine tool 10 so that the machine tool 10 is driven by the normal operation according to the read command (S67). The details of the process are the same as in S15 of FIG. The CPU 21 advances the process to S69.

CPU21は、S61の処理で、NCプログラムの最後の指令を読み出したか判定する(S69)。CPU21は、NCプログラムの最後の指令を読み出していないと判定した場合(S69:NO)、処理をS61に戻す。CPU21は、S61の処理で、NCプログラムの最後の指令を読み出したと判定した場合(S69:YES)、主処理を終了する。 The CPU 21 determines whether or not the last command of the NC program has been read in the process of S61 (S69). When the CPU 21 determines that the last command of the NC program has not been read (S69: NO), the process returns to S61. When the CPU 21 determines in the process of S61 that the last command of the NC program has been read (S69: YES), the CPU 21 ends the main process.

<その他の変形例>
本発明は上記実施形態に限らない。加減速制御に用いた時定数の数は3つ(トルク抑制時定数t、可変制振時定数t、固定制振時定数t)に限らず、他の時定数が用いられてもよい。
<Other variants>
The present invention is not limited to the above embodiment. The number of time constants used for acceleration / deceleration control is not limited to three (torque suppression time constant t 1 , variable vibration suppression time constant t 2 , fixed vibration suppression time constant t 3 ), and other time constants may be used. Good.

数値制御装置20は、式(2)に基づいてトルク抑制時定数tを決定し、式(4)に基づいて可変制振時定数tを決定した。これに対して数値制御装置20は、別の方法でトルク抑制時定数t、可変制振時定数tを決定してもよい。例えば数値制御装置20は、積載質量Mが0kg、100kg、250kgの場合のトルク抑制時定数t、可変制振時定数tを予め算出し、ROM22に記憶していてもよい。以下、積載質量Mが0kg、100kg、250kgの場合の夫々のトルク抑制時定数tを、t(0)、t(100)、t(250)と表記する。積載質量Mが0kg、100kg、250kgの場合の夫々の可変制振時定数tを、t(0)、t(100)、t(250)と表記する。数値制御装置20は、例えば積載質量Mが0〜100kgの範囲内の値(Maと表記する)の場合、トルク抑制時定数t(0)、t(100)、可変制振時定数t(0)、t(100)、を用いた線形補完により、以下の式(11−1)(11−2)に基づいてトルク抑制時定数tと可変制振時定数tを算出してもよい。
= (t(100)−t(0))×Ma/(100−0) (11−1)
= (t(100)−t(0))×Ma/(100−0) (11−2)
The numerical control device 20 determines the torque suppression time constant t 1 based on the equation (2), and determines the variable vibration suppression time constant t 2 based on the equation (4). On the other hand, the numerical control device 20 may determine the torque suppression time constant t 1 and the variable vibration suppression time constant t 2 by another method. For example, the numerical control device 20 may calculate in advance the torque suppression time constant t 1 and the variable vibration suppression time constant t 2 when the loaded mass M is 0 kg, 100 kg, and 250 kg, and store them in the ROM 22. Hereinafter, the torque suppression time constants t 1 when the loaded mass M is 0 kg, 100 kg, and 250 kg are referred to as t 1 (0), t 1 (100), and t 1 (250), respectively. The variable vibration damping time constants t 2 when the loaded mass M is 0 kg, 100 kg, and 250 kg are referred to as t 2 (0), t 2 (100), and t 2 (250). For example, when the load mass M is a value in the range of 0 to 100 kg (expressed as Ma), the numerical control device 20 has a torque suppression time constant t 1 (0), t 1 (100), and a variable vibration suppression time constant t. The torque suppression time constant t 1 and the variable vibration suppression time constant t 2 are calculated based on the following equations (11-1) and (11-2) by linear complementation using 2 (0) and t 2 (100). You may.
t 1 = (t 1 (100) -t 1 (0)) x Ma / (100-0) (11-1)
t 2 = (t 2 (100) -t 2 (0)) x Ma / (100-0) (11-2)

同様に、数値制御装置20は、例えば積載質量Mが100〜250kgの範囲内の値(Mbと表記する)の場合、トルク抑制時定数t(100)、t(250)、可変制振時定数t(100)、t(250)を用いた線形補完により、以下の式(12−1)(12−2)に基づいてトルク抑制時定数tと可変制振時定数tを算出してもよい。
= (t(250)−t(100))×Mb/(250−100) (12−1)
= (t(250)−t(100))×Mb/(250−100) (12−2)
Similarly, in the numerical control device 20, for example, when the loaded mass M is a value in the range of 100 to 250 kg (denoted as Mb), the torque suppression time constants t 1 (100), t 1 (250), and variable vibration damping By linear complementation using the time constants t 2 (100) and t 2 (250), the torque suppression time constant t 1 and the variable vibration suppression time constant t 2 are based on the following equations (12-1) and (12-2). May be calculated.
t 1 = (t 1 (250) -t 1 (100)) x Mb / (250-100) (12-1)
t 2 = (t 2 (250) -t 2 (100)) x Mb / (250-100) (12-2)

図4に示すグラフが線形近似され、近似関数が予め導出されてもよい。数値制御装置20は、導出した近似関数に積載質量Mを代入することにより、可変制振周波数Fvarを算出し、式(4)に代入することで可変制振時定数tを決定してもよい。 The graph shown in FIG. 4 may be linearly approximated and an approximate function may be derived in advance. Even if the numerical control device 20 calculates the variable vibration damping frequency Fvar by substituting the loaded mass M into the derived approximate function and substitutes it in the equation (4) to determine the variable vibration damping time constant t 2. Good.

数値制御装置20は、トルク抑制時定数tを有する第一フィルタFIR1、及び、可変制振時定数tを有する第二フィルタFIR2のみを用いて加減速制御を行ってもよい。この場合、数値制御装置20は、固定制振時定数tを有する第三フィルタ3を用いなくてもよい。加減速制御は、X軸又はY軸のうち何れか一方について実行され、他方は実行されなくてもよい。加減速処理に用いる移動平均フィルタは、FIRフィルタに限らず、無限インパルス応答フィルタ(IIRフィルタ)でもよい。可変制振時定数t及び可変制振時定数tに応じたFIRフィルタを2つ以上用いて加減速処理を行っても良い。固定制振時定数t及び固定制振時定数tに応じたFIRフィルタを2つ以上用いて加減速処理を行っても良い。X軸の加減速制御を行う際にY軸の時定数も用いても良い。例えば、X軸のトルク抑制時定数t(x)と、X軸の可変制振時定数t(x)と、Y軸の可変制振時定数t(y)と、X軸の固定制振時定数t(x)の4つの時定数に対応するFIRフィルタを用いて加減速処理を行っても良い。同様にY軸の加減速制御を行う際に、X軸の時定数も用いても良い。Z軸の加減速を行う際に、X軸やY軸の加減速時定数を用いても良い。 The numerical control device 20 comprises a first filter FIR1 having time constants t 1 torque restriction, and may be carried out acceleration and deceleration control using only the second filter FIR2 having a variable damping time constant t 2. In this case, the numerical control device 20 does not have to use the third filter 3 having the fixed vibration damping time constant t 3 . Acceleration / deceleration control may be performed on either the X-axis or the Y-axis and may not be performed on the other. The moving average filter used for the acceleration / deceleration process is not limited to the FIR filter, but may be an infinite impulse response filter (IIR filter). Acceleration / deceleration processing may be performed using two or more FIR filters corresponding to the variable vibration damping time constant t 2 and the variable vibration damping time constant t 2 . Acceleration / deceleration processing may be performed using two or more FIR filters corresponding to the fixed vibration damping time constant t 3 and the fixed vibration damping time constant t 3 . The Y-axis time constant may also be used when performing X-axis acceleration / deceleration control. For example, the X-axis torque suppression time constant t 1 (x), the X-axis variable vibration suppression time constant t 2 (x), the Y-axis variable vibration suppression time constant t 2 (y), and the X-axis fixation. Acceleration / deceleration processing may be performed using an FIR filter corresponding to the four time constants of the vibration damping time constant t 3 (x). Similarly, when performing acceleration / deceleration control on the Y-axis, the time constant on the X-axis may also be used. When accelerating or decelerating the Z-axis, the acceleration / deceleration time constant of the X-axis or the Y-axis may be used.

<その他>
工作機械1は本発明の「機械」の一例である。CPU21は本発明の「制御部」の一例である。S25、S53の処理を行うCPU21は本発明の「第一決定部」の一例である。S27、S55の処理を行うCPU21は本発明の「第二決定部」の一例である。S33、S65の処理を行うCPU21は本発明の「処理部」の一例である。S29、S57の処理を行うCPU21は本発明の「第三決定部」の一例である。S25、S53の処理は本発明の「第一決定工程」の一例である。S27、S55の処理は本発明の「第二決定工程」の一例である。S33、S65の処理は本発明の「処理工程」の一例である。
<Others>
The machine tool 1 is an example of the "machine" of the present invention. The CPU 21 is an example of the "control unit" of the present invention. The CPU 21 that performs the processes of S25 and S53 is an example of the "first determination unit" of the present invention. The CPU 21 that performs the processing of S27 and S55 is an example of the "second determination unit" of the present invention. The CPU 21 that performs the processing of S33 and S65 is an example of the "processing unit" of the present invention. The CPU 21 that performs the processes of S29 and S57 is an example of the "third determination unit" of the present invention. The processing of S25 and S53 is an example of the "first determination step" of the present invention. The treatments of S27 and S55 are an example of the "second determination step" of the present invention. The treatment of S33 and S65 is an example of the "treatment step" of the present invention.

1 :工作機械
4 :工具
9 :主軸
10 :工作機械
13 :X軸モータ
14 :Y軸モータ
16 :操作盤
20 :数値制御装置
21 :CPU
50 :テーブル
FIR1 :第一フィルタ
FIR2 :第二フィルタ
FIR3 :第三フィルタ
Ffix :固定制振周波数
Fvar :可変制振周波数
M :積載質量
t1 :トルク抑制時定数
t2 :可変制振時定数
t3 :固定制振時定数
1: Machine tool 4: Tool 9: Main shaft 10: Machine tool 13: X-axis motor 14: Y-axis motor 16: Operation panel 20: Numerical control device 21: CPU
50: Table FIR1: First filter FIR2: Second filter FIR3: Third filter Ffix: Fixed damping frequency Fvar: Variable damping frequency M: Loaded mass t1: Torque suppression time constant t2: Variable damping time constant t3: Fixed Vibration suppression time constant

Claims (7)

テーブルをモータで移動し、主軸に装着した工具で前記テーブル上に治具で支持した被削材を加工可能な機械の動作を制御し、前記テーブルの位置指令から生成した速度波形をフィルタで処理する加減速処理を実行可能な制御部を備えた数値制御装置において、
前記制御部は、
前記治具、及び、前記テーブル上の前記被削材を含む積載物の質量である積載質量に応じて変化する前記モータの最大トルクに応じた時定数であるトルク抑制時定数を決定する第一決定部と、
前記積載質量に応じて変化する前記機械に固有の振動周波数に応じた可変制振周波数の逆数を、可変制振時定数として決定する第二決定部と、
前記第一決定部により決定した前記トルク抑制時定数を有する第一フィルタと、前記第二決定部により決定した前記可変制振時定数を有する第二フィルタを用いて前記加減速処理を実行する処理部と
を備えたことを特徴とする数値制御装置。
The table is moved by a motor, the operation of a machine capable of processing a work material supported by a jig on the table with a tool mounted on the spindle is controlled, and the velocity waveform generated from the position command of the table is processed by a filter. In a numerical control device equipped with a control unit capable of executing acceleration / deceleration processing
The control unit
First, the torque suppression time constant, which is the time constant according to the maximum torque of the motor, which changes according to the load mass, which is the mass of the load including the work material on the jig and the work material, is determined. Decision department and
A second determination unit that determines the reciprocal of the variable damping frequency according to the vibration frequency peculiar to the machine, which changes according to the loaded mass, as the variable damping time constant.
A process of executing the acceleration / deceleration process using the first filter having the torque suppression time constant determined by the first determination unit and the second filter having the variable vibration damping time constant determined by the second determination unit. A numerical control device characterized by having a unit.
前記積載質量と前記可変制振周波数とが非線形の関係を有することを特徴とする請求項1に記載の数値制御装置。 The numerical control device according to claim 1, wherein the loaded mass and the variable vibration damping frequency have a non-linear relationship. 前記制御部は、
前記積載質量に応じて変化しない前記機械に固有の振動周波数に応じた固定制振周波数の逆数を、固定制振時定数として決定する第三決定部を更に備え、
前記処理部は、
前記第三決定部により決定した前記固定制振時定数を有する第三フィルタを更に用いて前記加減速処理を実行することを特徴とする請求項1又は2に記載の数値制御装置。
The control unit
Further provided with a third determination unit that determines the reciprocal of the fixed vibration damping frequency according to the vibration frequency peculiar to the machine, which does not change according to the loaded mass, as the fixed vibration damping time constant.
The processing unit
The numerical control device according to claim 1 or 2, wherein the acceleration / deceleration process is further performed by further using a third filter having the fixed vibration damping time constant determined by the third determination unit.
前記制御部は、
前記テーブルの移動時、前記モータのトルクと加速度とを取得する取得部と、
前記取得部により取得した前記トルクと前記加速度とに基づき、前記積載質量を推定する推定部と
を更に実行し、
前記第一決定部は、
前記推定部により推定した前記積載質量に基づき、前記トルク抑制時定数を決定し、
前記第二決定部は、
前記推定部により推定した前期積載質量に基づき、前記可変制振時定数を決定することを特徴とする請求項1から3の何れかに記載の数値制御装置。
The control unit
An acquisition unit that acquires the torque and acceleration of the motor when the table is moved,
Based on the torque and the acceleration acquired by the acquisition unit, the estimation unit for estimating the loaded mass is further executed.
The first decision unit
The torque suppression time constant is determined based on the load mass estimated by the estimation unit.
The second decision unit
The numerical control device according to any one of claims 1 to 3, wherein the variable vibration damping time constant is determined based on the load mass estimated in the previous period by the estimation unit.
前記テーブルは、交差する二軸方向へ移動可能であって、
前記モータは、前記二軸方向の軸毎に夫々設け、
前記第一決定部は、前記軸毎に前記トルク抑制時定数を決定し、
前記第二決定部は、前記軸毎に前記可変制振時定数を決定し、
前記処理部は、前記軸毎に前記加減速処理を実行可能であること
を特徴とする請求項1から4の何れかに記載の数値制御装置。
The table is movable in the intersecting biaxial directions and
The motor is provided for each of the axes in the biaxial direction.
The first determination unit determines the torque suppression time constant for each of the axes.
The second determination unit determines the variable vibration damping time constant for each of the axes.
The numerical control device according to any one of claims 1 to 4, wherein the processing unit can execute the acceleration / deceleration process for each of the axes.
前記フィルタはFIRフィルタであることを特徴とする請求項1から5の何れかに記載の数値制御装置。 The numerical control device according to any one of claims 1 to 5, wherein the filter is an FIR filter. テーブルをモータで移動し、主軸に装着した工具で前記テーブル上に治具で支持した被削材を加工可能な機械の動作を制御し、前記テーブルの位置指令から生成した速度波形をフィルタで処理する加減速処理を実行可能な制御方法であって、
前記治具、及び、前記テーブル上の前記被削材を含む積載物の質量である積載質量に応じて変化する前記モータの最大トルクに応じた時定数であるトルク抑制時定数を決定する第一決定工程と、
前記積載質量に応じて変化する前記機械に固有の振動周波数に応じた可変制振周波数の逆数を、可変制振時定数として決定する第二決定工程と、
前記第一決定工程により決定した前記トルク抑制時定数を有する第一フィルタと、前記第二決定工程により決定した前記可変制振時定数を有する第二フィルタを用いて前記加減速処理を実行する処理工程と
を備えたことを特徴とする制御方法。
The table is moved by a motor, the operation of a machine capable of processing a work material supported by a jig on the table with a tool mounted on the spindle is controlled, and the velocity waveform generated from the position command of the table is processed by a filter. It is a control method that can execute acceleration / deceleration processing.
First, the torque suppression time constant, which is the time constant according to the maximum torque of the motor, which changes according to the load mass, which is the mass of the load including the work material on the jig and the work material, is determined. The decision process and
The second determination step of determining the reciprocal of the variable damping frequency according to the vibration frequency peculiar to the machine, which changes according to the loaded mass, as the variable damping time constant.
A process of executing the acceleration / deceleration process using the first filter having the torque suppression time constant determined by the first determination step and the second filter having the variable vibration damping time constant determined by the second determination step. A control method characterized by having a process.
JP2019139576A 2019-07-30 2019-07-30 Numerical controller and control method Active JP7238673B2 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2019139576A JP7238673B2 (en) 2019-07-30 2019-07-30 Numerical controller and control method
CN202010530639.6A CN112305996B (en) 2019-07-30 2020-06-11 Numerical control device and control method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2019139576A JP7238673B2 (en) 2019-07-30 2019-07-30 Numerical controller and control method

Publications (2)

Publication Number Publication Date
JP2021022272A true JP2021022272A (en) 2021-02-18
JP7238673B2 JP7238673B2 (en) 2023-03-14

Family

ID=74336425

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019139576A Active JP7238673B2 (en) 2019-07-30 2019-07-30 Numerical controller and control method

Country Status (1)

Country Link
JP (1) JP7238673B2 (en)

Citations (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS59168513A (en) * 1983-03-16 1984-09-22 Fanuc Ltd Acceleration and deceleration control system
JPH0212407A (en) * 1988-06-30 1990-01-17 Okuma Mach Works Ltd Numerical controller
JPH04283047A (en) * 1991-03-12 1992-10-08 Yamazaki Mazak Corp Machining center
JP2004188541A (en) * 2002-12-11 2004-07-08 Yamazaki Mazak Corp Feed shaft parameter adjusting system for machine tool
JP2004237398A (en) * 2003-02-06 2004-08-26 Mori Seiki Co Ltd Control device of nc machine tool feed mechanism part
JP2007072943A (en) * 2005-09-09 2007-03-22 Tokyo Univ Of Agriculture & Technology Position controller
JP2008243176A (en) * 2007-02-28 2008-10-09 Fuji Mach Mfg Co Ltd Position controller
US20090265029A1 (en) * 2008-04-18 2009-10-22 Foxnum Technology Co., Ltd. Machine tool and control method thereof
JP2012168926A (en) * 2011-01-28 2012-09-06 Okuma Corp Position control device
JP2014191631A (en) * 2013-03-27 2014-10-06 Brother Ind Ltd Numerical controller and drive control method
JP5810283B2 (en) * 2013-04-10 2015-11-11 パナソニックIpマネジメント株式会社 Motor drive device
JP5865116B2 (en) * 2012-02-24 2016-02-17 オークマ株式会社 Position control device
JP2016133987A (en) * 2015-01-20 2016-07-25 ブラザー工業株式会社 Numerical control device and control method
JP2017138821A (en) * 2016-02-04 2017-08-10 ブラザー工業株式会社 Vibration suppression device and vibration suppression method
JP2018118362A (en) * 2017-01-27 2018-08-02 東芝機械株式会社 Machine tool and vibration suppression method
JP6664107B2 (en) * 2013-03-29 2020-03-13 パナソニックIpマネジメント株式会社 Servo adjustment method of motor drive device and servo adjustment device for performing servo adjustment of motor drive device

Patent Citations (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS59168513A (en) * 1983-03-16 1984-09-22 Fanuc Ltd Acceleration and deceleration control system
JPH0212407A (en) * 1988-06-30 1990-01-17 Okuma Mach Works Ltd Numerical controller
JPH04283047A (en) * 1991-03-12 1992-10-08 Yamazaki Mazak Corp Machining center
JP2004188541A (en) * 2002-12-11 2004-07-08 Yamazaki Mazak Corp Feed shaft parameter adjusting system for machine tool
JP2004237398A (en) * 2003-02-06 2004-08-26 Mori Seiki Co Ltd Control device of nc machine tool feed mechanism part
JP2007072943A (en) * 2005-09-09 2007-03-22 Tokyo Univ Of Agriculture & Technology Position controller
JP2008243176A (en) * 2007-02-28 2008-10-09 Fuji Mach Mfg Co Ltd Position controller
US20090265029A1 (en) * 2008-04-18 2009-10-22 Foxnum Technology Co., Ltd. Machine tool and control method thereof
JP2012168926A (en) * 2011-01-28 2012-09-06 Okuma Corp Position control device
JP5695555B2 (en) * 2011-01-28 2015-04-08 オークマ株式会社 Position control device
JP5865116B2 (en) * 2012-02-24 2016-02-17 オークマ株式会社 Position control device
JP2014191631A (en) * 2013-03-27 2014-10-06 Brother Ind Ltd Numerical controller and drive control method
JP6664107B2 (en) * 2013-03-29 2020-03-13 パナソニックIpマネジメント株式会社 Servo adjustment method of motor drive device and servo adjustment device for performing servo adjustment of motor drive device
JP5810283B2 (en) * 2013-04-10 2015-11-11 パナソニックIpマネジメント株式会社 Motor drive device
JP2016133987A (en) * 2015-01-20 2016-07-25 ブラザー工業株式会社 Numerical control device and control method
JP2017138821A (en) * 2016-02-04 2017-08-10 ブラザー工業株式会社 Vibration suppression device and vibration suppression method
JP2018118362A (en) * 2017-01-27 2018-08-02 東芝機械株式会社 Machine tool and vibration suppression method

Also Published As

Publication number Publication date
JP7238673B2 (en) 2023-03-14
CN112305996A (en) 2021-02-02

Similar Documents

Publication Publication Date Title
JP5566469B2 (en) Numerical control method
JP6107306B2 (en) Numerical control apparatus and drive control method
US9477218B2 (en) Numerical control method and numerical control device of machine tool
JP4474328B2 (en) Drilling machine
JP6903485B2 (en) Vibration damping device and processing machine
JP6893792B2 (en) Machine tools and vibration suppression methods
JP7230872B2 (en) Numerical controller and numerical control method
JP5321515B2 (en) Numerical control device for machine tools
JP2021022272A (en) Numerical control device and control method
CN112305996B (en) Numerical control device and control method
JP3686015B2 (en) Orbit boring control method
CN110320858B (en) Machine tool and smoothing method
JP6922815B2 (en) Numerical control device and control method
CN112748702B (en) Vibration suppressing method and vibration suppressing device
JP6647422B2 (en) Feed axis control method and feed axis control device for machine tool
JP5334932B2 (en) Parameter setting method and parameter setting device
JP7226070B2 (en) Numerical controller
JP2021064363A (en) Numerical value control unit and control method
JP2006198742A (en) Drill
JP2021038817A (en) Setting method of parameter, and control device
US11003171B2 (en) Parameter setting device, system, and parameter setting method
JPH1063339A (en) Controller of numerical value control machine tool
JP2023149799A (en) Numerical control device, and control method of numerical control device
JP2022131354A (en) Vibration suppression method, vibration suppression device, and machine tool
JP2023051255A (en) Controller and speed control method

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20211221

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20220728

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20220802

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20220928

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20230131

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20230213

R150 Certificate of patent or registration of utility model

Ref document number: 7238673

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150