JP2021022272A - Numerical control device and control method - Google Patents
Numerical control device and control method Download PDFInfo
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 61
- 230000001629 suppression Effects 0.000 claims abstract description 105
- 238000013016 damping Methods 0.000 claims abstract description 98
- 230000001133 acceleration Effects 0.000 claims abstract description 64
- 230000008569 process Effects 0.000 claims description 50
- 230000008859 change Effects 0.000 claims description 10
- 230000007246 mechanism Effects 0.000 description 18
- 101100120142 Saccharomyces cerevisiae (strain ATCC 204508 / S288c) FIR1 gene Proteins 0.000 description 8
- 239000000126 substance Substances 0.000 description 8
- 230000004044 response Effects 0.000 description 5
- 238000003754 machining Methods 0.000 description 4
- 238000011282 treatment Methods 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 238000005520 cutting process Methods 0.000 description 1
- 238000009499 grossing Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/414—Structure of the control system, e.g. common controller or multiprocessor systems, interface to servo, programmable interface controller
- G05B19/4142—Structure of the control system, e.g. common controller or multiprocessor systems, interface to servo, programmable interface controller characterised by the use of a microprocessor
-
- 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/34—Director, elements to supervisory
- G05B2219/34013—Servocontroller
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
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.
数値制御装置はテーブルの移動時、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.
以下、本発明の実施形態を説明する。図1に示す工作機械10は、主軸9に装着した工具4を高速回転し、テーブル50上に治具(図示略)で支持した被削材Wに接触することで、被削材Wの切削加工等を行う。数値制御装置20は、工作機械10の動作を制御する。工作機械10の左右方向、前後方向、上下方向は、夫々X軸方向、Y軸方向、Z軸方向である。
Hereinafter, embodiments of the present invention will be described. The
<工作機械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
As shown in FIG. 1, the
テーブル装置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
ベッド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
尚、テーブル装置40は、上記Y軸移動機構に加え、X軸の移動機構を備える。X軸移動機構は、Y軸移動機構をX軸方向に移動可能に支持する。X軸移動機構は、X軸モータ13(図2参照)を駆動源とし、Y軸移動機構の構造と同様である。
The
図2に示すように、操作盤16は、入力部17と表示部18を備える。入力部17は各種入力、指示、設定等を行う為の機器である。表示部18は各種画面を表示する機器である。
As shown in FIG. 2, the
<電気的構成>
図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
CPU21は、被削材Wを加工する為のNCプログラムを読込み、送り軸(X軸、Y軸、Z軸)、主軸9等の各駆動軸を目標位置に移動する為の制御指令を駆動回路26〜29に送信する。駆動回路26〜29は、CPU21から受信した制御指令(駆動信号)に応じて対応するモータ11〜14に駆動電流を夫々出力する。駆動回路26〜29はエンコーダ11A〜14Aからフィードバック信号(位置と速度の信号)を受け、モータ11〜14の位置と速度の制御を行う。操作盤16は、数値制御装置20の入出力部25に接続する。
The
<送り軸制御>
被削材Wに対して工具4をX軸方向又はY軸方向に相対移動させて加工するNCプログラムの指令(以下、「送り軸指令」と称す。)に基づき、工作機械10が駆動する場合を例示する。以下、被削材Wに対して工具4をY軸方向に相対移動させて加工する場合を例示して説明する。被削材Wに対して工具4をX軸方向に相対移動させて加工する場合については、工具4をY軸方向に相対移動させて加工する場合と同様であるので、説明は省略する。
<Feed axis control>
When the
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
上記において目標位置の時系列データを生成する時、はじめにCPU21は、送り軸指令の指定位置までテーブル50が移動する時の速度が一定に推移するように、各目標位置を決定する。次にCPU21は、速度の時系列変化を示す波形(以下、「速度波形」と称す。)に移動平均フィルタを適用することで、速度波形の形状に対応する加減速特性を調整する。移動平均フィルタは、有限時間のインパルス応答をもつデジタルフィルタ、即ちFIRフィルタである。CPU21は、移動平均フィルタを適用して算出した速度波形に基づき、所定周期毎の目標位置を決定する。CPU21は、決定した目標位置のデータを所定周期で駆動回路29に出力する。上記の移動平均フィルタの時定数を、加減速時定数と称す。移動平均フィルタを速度波形に適用して加減速特性を調整する処理を、加減速処理と称す。詳細は後述するが、CPU21は、後述する3つの加速度時定数(トルク抑制時定数t1、可変制振時定数t2、固定制振時定数t3)の各々を有する3つの移動平均フィルタ(第一フィルタFIR1、第二フィルタFIR2、第三フィルタFIR3)を速度波形に適用することで、加減速処理を実行する。
When generating the time-series data of the target position in the above, the
<トルク抑制時定数t1>
CPU21は、送り軸制御の実行時にY軸モータ14に生じるトルクの最大値(以下、「最大トルク」と称す)を制限する為、トルク抑制時定数t1を有する第一フィルタFIR1を速度波形に適用する。尚、送り軸制御の実行時におけるY軸モータ14の最大トルクは、負荷質量M1に応じて変化する。負荷質量M1は、テーブル50自体の質量、送り機構の等価質量、及び積載質量Mの総和に対応する。ここで送り機構の等価質量とは、テーブル50の送り機構を構成するY軸モータ14、継手43、ボールねじ44、ナット46のイナーシャの合計を質量に換算したものである。積載質量Mとは、テーブル50に設けた治具の質量、及び、治具が保持する被削材Wの質量の合計である。テーブル50の質量及び送り機構の等価質量は定数である。故に負荷質量M1は積載質量Mが変化するときに変化する。よって、最大トルクを抑制する為のトルク抑制時定数t1も、積載質量Mに応じて変化する。CPU21は、積載質量Mに応じた適切なトルク抑制時定数t1及び第一フィルタ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
トルク抑制時定数t1の算出方法は次の通りである。Y軸モータ14にて許容するトルクの最大値(以下、「定格トルク」という。)をTmax[N]と称す。Y軸モータ14が定格トルクTmaxで駆動した時のテーブル50の加速度を、a[m/s2]と称す。定格トルクTmaxと、負荷質量M1[kg]及び加速度aとは、次の式(1)の関係を満たす。
Tmax = M1×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-
Tmax = M 1 × a (1)
更に、工作機械10にて規定したテーブル50の最大速度を、Vmax[m/s]と称する。トルク抑制時定数t1と、最大速度Vmax、負荷質量M1、定格トルクTmax、加速度aとは、次の式(2)の関係を満たす。
t1 = Vmax/a = Vmax/(Tmax/M1) (2)
Further, the maximum speed of the table 50 defined by the
t 1 = Vmax / a = Vmax / (Tmax / M 1 ) (2)
<可変制振時定数t2、固定制振時定数t3>
CPU21は、送り軸制御の実行時において工作機械10に発生する振動を制限する為、可変制振時定数t2を有する第二フィルタFIR2、及び、固定制振時定数t3を有する第三フィルタFIR3を、夫々速度波形に適用する。尚、送り軸制御の実行により工作機械10に発生する振動は、移動物質量M2に応じて固有周波数が変化する振動(以下、「可変振動」という。)と、移動物質量M2に応じて固有周波数が変化しない振動(以下、「固定振動」という。)がある。移動物質量M2は、テーブル50の質量と積載質量Mの和である。この時テーブル50の質量は定数であるので、移動物質量M2は積載質量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
可変振動は、主に、送り軸制御の実行時においてテーブル50のY軸方向の振動である。図3は、積載質量Mに応じて可変制振周波数Fvarが変化する様子を示すグラフである。グラフにおいてピークを示す周波数が、可変制振周波数Fvarに対応する。図3(a)に示すように、積載質量Mが100kgの時、可変制振周波数Fvarは約40Hzである。図3(b)に示すように、積載質量Mが250kgの時、可変制振周波数Fvarは約35Hzである。可変制振周波数Fvarと移動物質量M2とは、次の式(3)の関係を満たす。
2π×Fvar = √(k/M2) (3)
移動物質量M2が積載質量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は、可変振動を抑制することが可能な移動平均フィルタの時定数である可変制振時定数t2を示す(式(4)参照)。
t2=1/Fvar = 2π×√(M2/k) (4)
CPU21は、積載質量Mに応じた適切な可変制振時定数t2に基づき第二フィルタ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
固定振動は、主に、送り軸制御の実行時において発生する機械全体の振動である。固定制振周波数Ffixの逆数1/Ffixは、固定振動を抑制することが可能な移動平均フィルタの時定数である固定制振時定数t3を示す(式(5)参照)。
t3=1/Ffix (5)
CPU21は、積載質量Mに依らず一定である固定制振時定数t3に基づき第三フィルタ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
<主処理>
図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
CPU21は、記憶装置24に記憶したNCプログラムの指令を1つ読み出す(S11)。CPU21は、読み出した指令に応じた工作機械10の動作が、早送り動作であるか判定する(S13)。早送り動作とは、工作機械10において設定可能な最大速度でX軸モータ13又はY軸モータ14が回転する動作を示す。
The
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
CPU21は、ROM22に記憶した定格トルクTmax(x)、最大速度Vmax(x)、最大積載質量Mmaxに対応するM1(x)を式(2)に代入し、X軸に対応するトルク抑制時定数t1の暫定値(トルク抑制時定数t1(x´)と称す。)を算出する。CPU21は、ROM22に記憶した係数k(x)、最大積載質量Mmaxに対応するM2(x)を式(4)に代入し、X軸に対応する可変制振時定数t2の暫定値(可変制振時定数t2(x´)と称す)を算出する。CPU21は、ROM22に記憶した固定制振周波数Ffix(x)を式(5)に代入し、X軸に対応する固定制振時定数t3の暫定値(固定制振時定数t3(x´)と称す)を算出する。CPU21は、トルク抑制時定数t1(x´)を有する第一フィルタFIR1と、可変制振時定数t2(x´)を有する第二フィルタFIR2と、固定制振時定数t3(x´)を有する第三フィルタFIR3(FIR3(x´)と称す)を用いて加減速処理を実行し、早送り動作においてX軸モータ13によりテーブル50をX軸方向に移動する為の速度波形を調整する。
The
尚、詳細説明は省略するが、CPU21は、Y軸に対応するトルク抑制時定数t1の暫定値(トルク抑制時定数t1(y´)と称す。)、可変制振時定数t2の暫定値(固定制振時定数t3(y´)と称す)、固定制振時定数t3の暫定値(固定制振時定数t3(y´)と称す)についても同様の方法で算出する。CPU21は、トルク抑制時定数t1(y´)を有する第一フィルタFIR1、可変制振時定数t2(y´)を有する第二フィルタFIR2、固定制振時定数t3(y´)を有する第三フィルタFIR3を用いて加減速処理を実行し、早送り動作においてY軸モータ14によりテーブル50をY軸方向に移動する為の速度波形を調整する。
Although detailed description will be omitted, the
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)に代入し、負荷質量M1を推定する。
M1 = T/a (6)
CPU21は更に、加速度a(x)及びトルクT(x)に基づき推定した負荷質量M1である負荷質量M1(x)に対応する積載質量M(x)と、加速度a(y)及びトルクT(y)に基づき推定した負荷質量M1である負荷質量M1(y)に対応する積載質量M(y)との平均値を、積載質量Mとして推定する(S23)。なお、「積載質量M=負荷質量M1−送り機構の等価質量−テーブル50の質量」である。本推定処理はX軸及びY軸が同時に早送り動作を行わない場合も実行可能である。X軸のみが早送り動作を行う場合、推定可能な負荷質量M1(x)に対応する積載質量M(x)を積載質量Mとして推定する。Y軸のみが早送り動作を行う場合、推定可能な負荷質量M2(y)に対応する積載質量M(y)を積載質量Mとして推定する。
The
M 1 = T / a (6)
The
CPU21は、推定した積載質量Mに対応する負荷質量M1(x)と、ROM22に記憶した定格トルクTmax(x)、最大速度Vmax(x)を式(2)に代入し、X軸に対応するトルク抑制時定数t1(トルク抑制時定数t1(x)と称す)を決定する(S25)。CPU21は、推定した積載質量Mに対応する移動物質量M2(x)と、ROM22に記憶した係数k(x)を式(4)に代入し、X軸に対応する可変制振時定数t2(可変制振時定数t2(x)と称す)を決定する(S27)。CPU21は、ROM22に記憶した固定制振周波数Ffix(x)を式(5)に代入し、X軸に対応する固定制振時定数t3(固定制振時定数t3(x)と称す)を決定する(S29)。尚、固定制振時定数t3(x)は、S19で早送り動作を実行する時に算出した固定制振時定数t3(x´)と同一である。尚、詳細説明は省略するが、CPU21は、Y軸に対応するトルク抑制時定数t1(トルク抑制時定数t1(y)と称す)、可変制振時定数t2(可変制振時定数t2(y)と称す)、固定制振時定数t3(固定制振時定数t3(y)と称す)についても同様の算出方法により決定する。CPU21は、決定したトルク抑制時定数t1(x)、t1(y)、可変制振時定数t2(x)、t2(y)、固定制振時定数t3(x)、t3(y)をRAM23に記憶する(S31)。CPU21は処理をS35に進める。
The
CPU21は、S11の処理で、NCプログラムの最後の指令を読み出したか判定する(S35)。CPU21は、NCプログラムの最後の指令を読み出していないと判定した場合(S35:NO)、処理をS11に戻す。CPU21は、NCプログラムの次の指令を1つ読み出し(S11)、処理をS13に進める。
The
CPU21は、早送り動作でないと判定した場合(S13:NO)、読み出した指令に応じた動作(通常動作と称す)で工作機械10が駆動するように、工作機械10を制御する(S15)。詳細はここには記述しないが、通常動作は切削動作、タップ動作、工具交換動作などを含み、それぞれに固有の時定数を用いて動作する。すなわち通常動作時においてテーブル50がX軸方向に移動する時、トルク抑制時定数t1(x)、可変制振時定数t2(x)、固定制振時定数t3(x)とは異なる時定数を用いて、X軸モータ13によりテーブル50をX軸方向に移動する為の速度波形を調整する。又、通常動作時においてテーブル50がY軸方向に移動する時、トルク抑制時定数t1(y)、可変制振時定数t2(y)、固定制振時定数t3(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
CPU21は、早送り動作であると判定し(S13:YES)、且つ、2回目以降の早送り動作であると判定した場合(S17:NO)、工作機械10が早送り動作で駆動するように、工作機械10を制御する(S33)。該時、CPU21は、早送り動作によりテーブル50がX軸方向に移動する時、S31の処理でRAM23に記憶したトルク抑制時定数t1(x)を有する第一フィルタFIR1、可変制振時定数t2(x)を有する第二フィルタFIR2、固定制振時定数t3(x)を有する第三フィルタFIR3を用いて加減速処理を実行し、X軸モータ13によりテーブル50をX軸方向に移動する為の速度波形を調整する。又、早送り動作によりテーブル50がY軸方向に移動する時、CPU21は、S31の処理でRAM23に記憶したトルク抑制時定数t1(y)を有する第一フィルタFIR1、可変制振時定数t2(y)を有する第二フィルタFIR2、固定制振時定数t3(y)を有する第三フィルタFIR3を用いて加減速処理を実行し、通常動作においてY軸モータ14によりテーブル50をY軸方向に移動する為の速度波形を調整する。CPU21は、調整した速度波形に基づいて送り軸制御を実行し、工作機械10による早送り動作を制御する(S33)。CPU21は、処理をS35に進める。
When the
CPU21は、S11の処理で、NCプログラムの最後の指令を読み出したと判定した場合(S35:YES)、主処理を終了する。
When the
<本発明の主たる作用、効果>
数値制御装置20は、積載質量M、最大速度Vmax、及び定格トルクTmaxに応じたトルク抑制時定数t1を決定し(S25)、トルク抑制時定数t1を有する第一フィルタFIR1を用いて加減速処理を実行する(S33)。故に、数値制御装置20は、積載質量Mの変化によってX軸モータ13及びY軸モータ14の加速度に応じたトルクが変化しても、X軸モータ13及びY軸モータ14の最大トルクが定格トルクTmaxを超えないように加減速処理を適切に実行できる。更に数値制御装置20は、工作機械10の可変振動を抑制するための可変制振時定数t2を決定し(S27)、可変制振時定数t2を有する第二フィルタFIR2を用いて加減速処理を実行する(S33)。故に、数値制御装置20は、積載質量Mに応じて可変振動の周波数が変化する場合でも、工作機械10の可変振動を適切に抑制できる。
<Main actions and effects of the present invention>
The
数値制御装置20は、積載質量Mと可変制振周波数Fvarとが非線形の関係を有することを前提として可変制振時定数t2を決定する。故に、数値制御装置20は、積載質量Mが変化したことに応じて可変制振周波数Fvarが変化する場合でも、可変振動を抑制可能な可変制振時定数t2を精度良く決定できる。
The
数値制御装置20は、工作機械1の固有振動を抑制する為の固定制振時定数t3を決定し(S29)、固定制振時定数t3を有する第三フィルタFIR3を用いて加減速処理を実行する(S33)。故に、数値制御装置20は、積載質量Mに応じて変化しない工作機械10の振動を適切に抑制できる。
The
数値制御装置20は、積載質量Mを推定し(S19〜S23)、推定した積載質量Mに基づいて、トルク抑制時定数t1及び可変制振時定数t2を決定する(S25、S27)。該時、数値制御装置20は、積載質量Mが未定である場合でも、トルク抑制時定数t1及び可変制振時定数t2を精度良く決定できる。該時、数値制御装置20は、積載質量Mに関する事前情報が不要となる。故に、数値制御装置20は、作業者が予め積載質量Mを測定しなくても、トルク抑制時定数t1及び可変制振時定数t2を精度良く決定できる。
The
数値制御装置20は、X軸方向及びY軸方向にテーブル50を移動可能である。数値制御装置20は、X軸及びY軸の夫々についてトルク抑制時定数t1、可変制振時定数t2、及び固定制振時定数t3を決定し、X軸及びY軸の夫々について加減速処理を実行する。従って、数値制御装置20は、X軸モータ13及びY軸モータ14の夫々について最大トルクが積載質量Mに応じて変化しても、加減速処理を適切に実行できる。
The
数値制御装置20は、加減速処理時の移動平均フィルタとして、FIRフィルタを用いる。これにより数値制御装置20は、加減速処理により速度波形を平滑化できる。
The
<変形例>
図6を参照し、変形例における主処理について説明する。図5と異なる点は、使用者が入力部17(図2参照)を介して入力した積載質量Mに基づいてトルク抑制時定数t1(x)、t1(y)、可変制振時定数t2(x)、t2(y)、固定制振時定数t3(x)、t3(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
CPU21は、入力部17を介して使用者が入力した積載質量Mを取得する(S51)。CPU21は、取得した積載質量Mに対応する負荷質量M1(x)と、定格トルクTmax(x)、最大速度Vmax(x)を式(2)に代入してトルク抑制時定数t1(x)を決定し、取得した積載質量Mに対応する負荷質量M1(y)と、定格トルクTmax(y)、最大速度Vmax(y)を式(2)に代入してトルク抑制時定数t1(y)を決定する(S53)。CPU21は、取得した積載質量Mに対応する移動物質量M2(x)と係数k(x)を式(4)に代入して可変制振時定数t2(x)を決定し、取得した積載質量Mに対応する移動物質量M2(y)と係数k(y)を式(4)に代入して可変制振時定数t2(y)を決定する(S55)。CPU21は、固定制振周波数Ffix(x)を式(5)に代入して固定制振時定数t3(x)を決定し、固定制振周波数Ffix(y)を式(5)に代入して固定制振時定数t3(y)を決定する(S57)。CPU21は、決定したトルク抑制時定数t1(x)、t1(y)、可変制振時定数t2(x)、t2(y)、固定制振時定数t3(x)、t3(y)をRAM23に記憶する(S59)。
The
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
CPU21は、S61の処理で、NCプログラムの最後の指令を読み出したか判定する(S69)。CPU21は、NCプログラムの最後の指令を読み出していないと判定した場合(S69:NO)、処理をS61に戻す。CPU21は、S61の処理で、NCプログラムの最後の指令を読み出したと判定した場合(S69:YES)、主処理を終了する。
The
<その他の変形例>
本発明は上記実施形態に限らない。加減速制御に用いた時定数の数は3つ(トルク抑制時定数t1、可変制振時定数t2、固定制振時定数t3)に限らず、他の時定数が用いられてもよい。
<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)に基づいてトルク抑制時定数t1を決定し、式(4)に基づいて可変制振時定数t2を決定した。これに対して数値制御装置20は、別の方法でトルク抑制時定数t1、可変制振時定数t2を決定してもよい。例えば数値制御装置20は、積載質量Mが0kg、100kg、250kgの場合のトルク抑制時定数t1、可変制振時定数t2を予め算出し、ROM22に記憶していてもよい。以下、積載質量Mが0kg、100kg、250kgの場合の夫々のトルク抑制時定数t1を、t1(0)、t1(100)、t1(250)と表記する。積載質量Mが0kg、100kg、250kgの場合の夫々の可変制振時定数t2を、t2(0)、t2(100)、t2(250)と表記する。数値制御装置20は、例えば積載質量Mが0〜100kgの範囲内の値(Maと表記する)の場合、トルク抑制時定数t1(0)、t1(100)、可変制振時定数t2(0)、t2(100)、を用いた線形補完により、以下の式(11−1)(11−2)に基づいてトルク抑制時定数t1と可変制振時定数t2を算出してもよい。
t1 = (t1(100)−t1(0))×Ma/(100−0) (11−1)
t2 = (t2(100)−t2(0))×Ma/(100−0) (11−2)
The
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と表記する)の場合、トルク抑制時定数t1(100)、t1(250)、可変制振時定数t2(100)、t2(250)を用いた線形補完により、以下の式(12−1)(12−2)に基づいてトルク抑制時定数t1と可変制振時定数t2を算出してもよい。
t1 = (t1(250)−t1(100))×Mb/(250−100) (12−1)
t2 = (t2(250)−t2(100))×Mb/(250−100) (12−2)
Similarly, in the
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)に代入することで可変制振時定数t2を決定してもよい。
The graph shown in FIG. 4 may be linearly approximated and an approximate function may be derived in advance. Even if the
数値制御装置20は、トルク抑制時定数t1を有する第一フィルタFIR1、及び、可変制振時定数t2を有する第二フィルタFIR2のみを用いて加減速制御を行ってもよい。この場合、数値制御装置20は、固定制振時定数t3を有する第三フィルタ3を用いなくてもよい。加減速制御は、X軸又はY軸のうち何れか一方について実行され、他方は実行されなくてもよい。加減速処理に用いる移動平均フィルタは、FIRフィルタに限らず、無限インパルス応答フィルタ(IIRフィルタ)でもよい。可変制振時定数t2及び可変制振時定数t2に応じたFIRフィルタを2つ以上用いて加減速処理を行っても良い。固定制振時定数t3及び固定制振時定数t3に応じたFIRフィルタを2つ以上用いて加減速処理を行っても良い。X軸の加減速制御を行う際にY軸の時定数も用いても良い。例えば、X軸のトルク抑制時定数t1(x)と、X軸の可変制振時定数t2(x)と、Y軸の可変制振時定数t2(y)と、X軸の固定制振時定数t3(x)の4つの時定数に対応するFIRフィルタを用いて加減速処理を行っても良い。同様にY軸の加減速制御を行う際に、X軸の時定数も用いても良い。Z軸の加減速を行う際に、X軸やY軸の加減速時定数を用いても良い。
The
<その他>
工作機械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
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又は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.
前記治具、及び、前記テーブル上の前記被削材を含む積載物の質量である積載質量に応じて変化する前記モータの最大トルクに応じた時定数であるトルク抑制時定数を決定する第一決定工程と、
前記積載質量に応じて変化する前記機械に固有の振動周波数に応じた可変制振周波数の逆数を、可変制振時定数として決定する第二決定工程と、
前記第一決定工程により決定した前記トルク抑制時定数を有する第一フィルタと、前記第二決定工程により決定した前記可変制振時定数を有する第二フィルタを用いて前記加減速処理を実行する処理工程と
を備えたことを特徴とする制御方法。 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.
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)
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 |
-
2019
- 2019-07-30 JP JP2019139576A patent/JP7238673B2/en active Active
Patent Citations (17)
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 |