JP3930262B2

JP3930262B2 - Numerical controller

Info

Publication number: JP3930262B2
Application number: JP2001127853A
Authority: JP
Inventors: 章人片岡
Original assignee: Okuma Corp
Current assignee: Okuma Corp
Priority date: 2001-04-25
Filing date: 2001-04-25
Publication date: 2007-06-13
Anticipated expiration: 2021-04-25
Also published as: JP2002323913A

Description

【０００１】
【発明の属する技術分野】
本発明は、可動部または駆動機構の動作を示す数値データに基づいて可動部を動作させるよう駆動機構を制御する数値制御装置に関し、特に、可動部を備えた装置の共振を抑制するための技術に関する。
【０００２】
【従来の技術】
図４は、従来の数値制御装置の一例を示すブロック図である。ここでは、例として、可動部を三つ備えた装置（例えば工作機械等）の可動部を、３個のサーボモータ（５Ａ，５Ｂ，５Ｃ）でそれぞれ駆動してその可動部の位置制御を行う数値制御装置において、ある１個のサーボモータ（例えば５Ｂ）に対して関数発生指令が行われる場合について説明する。上位制御装置１からの関数発生指令（例えば早送りのモード指令及び目標位置）が位置指令演算部２Ｂに入力される。位置指令演算部２Ｂは予め定められる加減速時間（換言すれば加速度あるいは減速度）で可動部を目標位置に移動させるための位置指令を生成する。ここで目標位置あるいは加減速時間などは数値データとして入力される。位置制御部３Ｂは、位置指令演算部２Ｂから位置指令を取得するとともに、サーボモータ５Ｂに取り付けられた位置センサ６Ｂからサーボモータ５Ｂの現在位置を取得する。そして位置制御部３Ｂは、この位置指令とサーボモータ５Ｂの現在位置とを一致させるように公知の位置制御手法を用いてトルク指令値を演算し、これをサーボモータ５Ｂに必要な電流指令値に変換してインバータ４Ｂに入力する。インバータ４Ｂはサーボモータ５Ｂに前記電流指令値に応じた電流を供給し、これによりサーボモータ５Ｂの位置が目標位置に一致するように制御される。
【０００３】
【発明が解決しようとする課題】
このような従来の数値制御装置では、可動部を備えた装置の据付状態や設置場所の地盤の状態によっては、ワークやツールを交換して負荷イナーシャが増加したりした場合などに、モータの加減速時の衝撃によって可動部を備えた装置の一部または全体が大きく振動してしまうことがある。このような状態で動作させると位置指令と現在位置との誤差が増大するばかりでなく、可動部を備えた装置各部の寿命を短くする要因にもなる。
【０００４】
【課題を解決するための手段】
上記課題に鑑み、本発明にかかる数値制御装置は、可動部または駆動機構の動作を示す予め設定された数値データに基づいて可動部を動作させるよう駆動機構を制御する制御部を備えた数値制御装置において、可動部を備えた送り装置の共振周波数を予め取得し、予め設定された振動レベル閾値と共に記憶する記憶部と、送り装置の振動を検出する振動検出部と、を備え、前記制御部は、前記振動検出部から検出した振動の周波数と記憶部に記憶された共振周波数とを比較し、検出した振動周波数が共振周波数あるいはその逓倍の周波数であって、かつ、検出した振動の振幅が振動レベル閾値を超えた場合には、送り装置の共振と判定し、予め設定された前記数値データによる動作時の加速度とは異なる加速度で可動部が動作するよう駆動機構を制御する。
【０００５】
また本発明にかかる数値制御装置において、前記制御部は、前記振動検出部により可動部を備えた送り装置の共振が検出された際には、予め設定された前記数値データによる動作時の加速度を緩和して可動部が動作するよう駆動機構を制御する。
【０００６】
また本発明にかかる数値制御装置において、前記駆動機構はサーボモータを備え、前記制御部はトルク指令値によって前記サーボモータを制御し、前記振動検出部は前記トルク指令値の変動により可動部を備えた送り装置の振動を検出するのが好適である。
【０００７】
上記構成によれば、可動部を備えた送り装置の共振を検出してこれを抑制するように駆動機構を制御することができる。このため、位置指令と現在位置との誤差を減少させることができるとともに、可動部を備えた装置各部の寿命を長くすることができる。また、トルク指令値の変動によって振動を検出することにより、振動検出用の専用のセンサを設けずにすむ分、可動部を備えた送り装置の製作およびメンテナンスに要する手間およびコストを削減することができる。なお、以下、送り装置を単に装置ともいう。
【０００８】
【発明の実施の形態】
実施の形態１．
図１は本実施形態にかかる数値制御装置のブロック図である。ここでは、一例として、複数（例えば三個）の可動部（例えばロボットアーム）を備えた装置（例えば工作機械等）の駆動機構（例えばサーボモータ５Ａ，５Ｂ，５Ｃ）を駆動して可動部の位置制御を行う数値制御装置において、一つの駆動機構（例えばサーボモータ５Ｂ）に関数発生指令が行われる数値制御装置について説明する。
【０００９】
上位制御装置１からの関数発生指令（例えば早送りのモード指令及び目標位置）が位置指令演算部２Ｂに入力され、位置指令演算部２Ｂは、予め定められる加減速時間（換言すれば加速度あるいは減速度）で可動部を目標位置に移動させるための位置指令を生成する。ここで目標位置あるいは加減速時間などは数値データとして入力される。位置制御部３Ｂは、位置指令演算部２Ｂから位置指令を取得するとともに、サーボモータ５Ｂに取り付けられた位置センサ６Ｂからサーボモータ５Ｂの現在位置を取得する。そして位置制御部３Ｂは、この位置指令とサーボモータ５Ｂの現在位置とを一致させるように公知の位置制御手法を用いてトルク指令値を演算し、これをサーボモータ５Ｂに必要な電流指令値に変換してインバータ４Ｂに入力する。インバータ４Ｂはサーボモータ５Ｂに前記電流指令値に応じた電流を供給し、これによりサーボモータ５Ｂの位置が目標位置に一致するように制御される。なお、本実施形態では、上位制御装置１、位置指令演算部（２Ａ，２Ｂ，２Ｃ）、位置制御部（３Ａ，３Ｂ，３Ｃ）および後述する加減速時間変更部（８Ａ，８Ｂ，８Ｃ）が、数値制御装置の制御部に相当する。
【００１０】
また本実施形態にかかる数値制御装置は、振動検出部７（例えばトルクピックアップ，加速度ピックアップなど）を備える。この振動検出部７は、可動部を備えた装置の共振を検出する。より具体的には、この振動検出部７は図示しない記憶部を備え、この記憶部には、予め検査によって取得された可動部を備えた装置の共振周波数と、予め設定された振動レベル閾値と、が記憶されている。振動検出部７は、検出した振動の周波数と記憶部に記憶された共振周波数とを比較し、検出した振動の周波数が共振周波数あるいはその逓倍の周波数であって、しかも検出した振動の振幅が振動レベル閾値を超えていた場合には、可動部を備えた装置の共振が発生したと判別する。
【００１１】
また本実施形態にかかる数値制御装置は、加減速時間変更部（８Ａ，８Ｂ，８Ｃ）を備える。この加減速時間変更部（８Ａ，８Ｂ，８Ｃ）は、振動検出部７から可動部を備えた装置の共振が検出されたことを示す信号を受け取った場合には、可動部の加速時間および減速時間の変更（例えば増大）を指示する信号を、動作中（稼動中）の可動部および駆動機構に対応する位置指令演算部２Ｂに送信する。位置指令演算部２Ｂは、この信号の指示に従い、予め設定された加減速時間とは異なる加減速時間とする位置指令を位置制御部３Ｂに出力する。すなわち、本実施形態にかかる数値制御装置は、可動部を備えた装置の共振を検出した際には、可動部の加速度を変更して（例えば緩和して）可動部の動作に伴って生じる周波数を可動部を備えた装置の共振周波数からずらすことで、可動部を備えた装置の共振を抑制する。
【００１２】
実施の形態２．
図２は本実施形態にかかる数値制御装置のブロック図である。ここでは、一例として、複数（例えば三個）の駆動機構（例えばサーボモータ５Ａ，５Ｂ，５Ｃ）を駆動して可動部（例えばロボットアーム）の位置制御を行う数値制御装置において、一つの駆動機構（例えばサーボモータ５Ｂ）に関数発生指令が行われる数値制御装置について説明する。ただし、本実施形態にかかる数値制御装置は、振動検出部７としてトルク指令値をモニタするトルクモニタ部９を備える点が上記実施の形態１と異なる。
【００１３】
上位制御装置１からの関数発生指令（例えば早送りのモード指令及び目標位置）が位置指令演算部２Ｂに入力され、位置指令演算部２Ｂは、予め定められる加減速時間（換言すれば加速度あるいは減速度）で可動部を目標位置に移動させるための位置指令を生成する。ここで目標位置あるいは加減速時間などは数値データとして入力される。位置制御部３Ｂは、位置指令演算部２Ｂから位置指令を取得するとともに、サーボモータ５Ｂに取り付けられた位置センサ６Ｂからサーボモータ５Ｂの現在位置を取得する。そして位置制御部３Ｂは、この位置指令とサーボモータ５Ｂの現在位置とを一致させるように公知の位置制御手法を用いてトルク指令値を演算し、これをサーボモータ５Ｂに必要な電流指令値に変換してインバータ４Ｂに入力する。インバータ４Ｂはサーボモータ５Ｂに前記電流指令値に応じた電流を供給し、これによりサーボモータ５Ｂの位置が目標位置に一致するように制御される。これらの構成および動作は上記実施の形態１と同様である。なお、本実施形態でも、上位制御装置１、位置指令演算部（２Ａ，２Ｂ，２Ｃ）、位置制御部（３Ａ，３Ｂ，３Ｃ）および加減速時間変更部（８Ａ，８Ｂ，８Ｃ）が、数値制御装置の制御部に相当する。
【００１４】
本実施形態にかかる数値制御装置は、振動検出部７としてトルク指令値をモニタするトルクモニタ部９を備える。より具体的には、トルクモニタ部９は、位置制御部（３Ａ，３Ｂ，３Ｃ）からインバータ（４Ａ，４Ｂ，４Ｃ）を通してサーボモータ（５Ａ，５Ｂ，５Ｃ）に指令されるトルク指令値を検出する。そして、トルクモニタ部９は、複数（例えば三つ）のトルク指令値が同じ周波数で振動した場合に可動部を備えた装置が共振したと判別する。可動部を備えた装置に設置した複数の振動検出部７で同じ周波数の振動が検出された場合（例えば、この場合のように、複数の可動部の振動を検出するトルクモニタ部９で同じ周波数の振動が検出された場合）には、それら複数の振動検出部７を備えた可動部を備えた装置に振動が生じている（すなわち可動部を備えた装置側で共振が発生している）と考えることができる。したがって、このような構成により、可動部を備えた装置の共振を検出することができる。なお、本実施形態では、トルク指令値により可動部を備えた装置の共振を検出する。このような構成とすることにより、可動部を備えた装置上に別途振動検出部７を設置した場合に比して、可動部を備えた装置の製作およびメンテナンスに要する手間およびコストを抑制することができる。
【００１５】
また、本実施形態にかかる数値制御装置は、加減速時間変更部（８Ａ，８Ｂ，８Ｃ）を備える。この加減速時間変更部（８Ａ，８Ｂ，８Ｃ）の動作は上記実施の形態１と同様である。
【００１６】
ここで、本実施形態にかかる数値制御装置において可動部を備えた装置の共振を抑制した一例について、図３を参照して説明する。図３の上段（矢印より上側）は可動部を備えた装置の共振発生時の波形を示し、下段（矢印より下側）は共振抑制時の波形を示す。また、各段において、それぞれ上側は各サーボモータ（５Ａ，５Ｂ，５Ｃ）の角速度ω、および下側は各サーボモータ（５Ａ，５Ｂ，５Ｃ）に対するトルク指令値Ｔである。
【００１７】
サーボモータ５Ｂのみ、ある加減速時間で加速、定速、減速の一連の動作をさせた際、ワークやツールを交換して負荷イナーシャが増加したり、可動部を備えた装置の据付状態や地盤の状態によっては、例えばサーボモータ５Ｂの加減速時の衝撃により可動部を備えた装置全体が大きく振動してしまう（可動部を備えた装置の共振状態）。この時、サーボモータ５Ａ及びサーボモータ５Ｃは停止し続けようとするため、図３の上段に示すように、可動部を備えた装置全体の振動を打ち消す方向にトルク指令値が生成される。このとき、本実施形態にかかる数値制御装置では、上述したように加減速時間を変更する（例えば長くする）トルク指令値が生成されるので、可動部を備えた装置の共振は抑制され、サーボモータのトルク指令値の変動も低減する（図３の下段）。
【００１８】
なお、本発明は上記実施形態には限定されない。上記実施の形態２では、振動検出部７としてのトルクモニタ部９は、複数のトルク指令値が同じ周波数で振動したことにより可動部を備えた装置の共振を検出したが、これには限られず、上記実施の形態１の振動検出部７と同様に、検出した振動の周波数と記憶部に記憶された共振周波数とを比較し、検出した振動の周波数が共振周波数あるいはその逓倍の周波数であって、しかも検出した振動の振幅が振動レベル閾値を超えていた場合には、可動部を備えた装置の共振が発生したと判別してもよい。
【００１９】
また、可動部の負荷（例えばワークやツール等）毎に、共振を抑制することができた加減速パラメータ（例えば加減速時間等）を、図示しない記憶部に記憶させ、次回以降の処理動作時には、位置指令演算部（２Ａ，２Ｂ，２Ｃ）が、その記憶部から負荷に応じた加減速パラメータを読み出し、その加減速パラメータを用いた位置指令を生成するよう、数値制御装置を構成してもよい。
【００２０】
【発明の効果】
以上説明したように、本発明によれば、可動部を備えた装置の共振を検出してこれを抑制するように駆動機構を制御することができる。このため、位置指令と現在位置との誤差を減少させることができるとともに、可動部を備えた装置各部の寿命を長くすることができる。また、トルク指令値によって振動を検出することにより、振動検出用の専用のセンサを設けずにすむ分、可動部を備えた装置の製作およびメンテナンスに要する手間およびコストを削減することができる。
【図面の簡単な説明】
【図１】本発明の第一の実施形態にかかる数値制御装置のブロック図である。
【図２】本発明の第二の実施形態にかかる数値制御装置のブロック図である。
【図３】本発明の第二の実施形態にかかる数値制御装置における各サーボモータの角速度およびトルク指令値の波形を示す図である。
【図４】従来の数値制御装置のブロック図である。
【符号の説明】
１上位制御装置、２Ａ，２Ｂ，２Ｃ位置指令算出部、３Ａ，３Ｂ，３Ｃ位置制御部、４Ａ，４Ｂ，４Ｃインバータ、５Ａ，５Ｂ，５Ｃサーボモータ、６Ａ，６Ｂ，６Ｃ位置センサ、７振動検出部、８Ａ，８Ｂ，８Ｃ加減速時間変更部、９トルクモニタ部。[0001]
BACKGROUND OF THE INVENTION
The present invention relates to a numerical control device that controls a drive mechanism to operate a movable portion based on numerical data indicating the operation of the movable portion or the drive mechanism, and in particular, a technique for suppressing resonance of a device having a movable portion. About.
[0002]
[Prior art]
FIG. 4 is a block diagram showing an example of a conventional numerical control device. Here, as an example, a movable part of an apparatus (for example, a machine tool) having three movable parts is driven by three servo motors (5A, 5B, 5C) to control the position of the movable part. A case where a function generation command is issued to a certain servo motor (for example, 5B) in the numerical controller will be described. A function generation command (for example, fast-forward mode command and target position) from the host control device 1 is input to the position command calculation unit 2B. The position command calculation unit 2B generates a position command for moving the movable unit to the target position with a predetermined acceleration / deceleration time (in other words, acceleration or deceleration). Here, the target position or acceleration / deceleration time is input as numerical data. The position control unit 3B acquires the position command from the position command calculation unit 2B, and acquires the current position of the servo motor 5B from the position sensor 6B attached to the servo motor 5B. Then, the position control unit 3B calculates a torque command value using a known position control method so that this position command and the current position of the servo motor 5B coincide with each other, and converts this to a current command value necessary for the servo motor 5B. Convert and input to the inverter 4B. The inverter 4B supplies current corresponding to the current command value to the servo motor 5B, and thereby the position of the servo motor 5B is controlled to coincide with the target position.
[0003]
[Problems to be solved by the invention]
In such a conventional numerical control device, depending on the installation state of the device having a movable part and the ground state of the installation site, when the load inertia is increased by exchanging workpieces or tools, the motor is added. A part or the whole of the apparatus provided with the movable part may vibrate greatly due to an impact during deceleration. When operated in such a state, not only the error between the position command and the current position increases, but also causes the life of each part of the apparatus including the movable part to be shortened.
[0004]
[Means for Solving the Problems]
In view of the above problems, the numerical control apparatus according to the present invention, numerical values having a control unit for controlling the drive mechanism so as to operate the movable unit based on a preset numerical data indicating the operation of the moving parts or the drive mechanism The control device includes a storage unit that acquires in advance a resonance frequency of a feeding device including a movable unit and stores the resonance frequency together with a preset vibration level threshold, and a vibration detection unit that detects vibration of the feeding device, and the control The unit compares the vibration frequency detected from the vibration detection unit with the resonance frequency stored in the storage unit, and the detected vibration frequency is the resonance frequency or a frequency multiplied by the resonance frequency, and the detected vibration amplitude. There if it exceeds the vibration level threshold, it is determined that the resonance of the feeding device, the driving machine to operate the movable unit at a different acceleration and acceleration during operation by preset the numerical data To control.
[0005]
In the numerical control apparatus according to the present invention, before Symbol controller, when the resonance of the feeding apparatus provided with a movable portion by the vibration detection unit is detected, the acceleration at the time of operation by preset the numerical data The drive mechanism is controlled so that the movable part operates by relaxing the above.
[0006]
In the numerical control device according to the present invention , the drive mechanism includes a servo motor, the control unit controls the servo motor based on a torque command value, and the vibration detection unit includes a movable portion based on a change in the torque command value. It is preferable to detect the vibration of the feeding device.
[0007]
According to the above configuration, it is possible to control the drive mechanism so as to suppress this by detecting the resonance of the feeding apparatus provided with a movable portion. For this reason, the error between the position command and the current position can be reduced, and the life of each part of the apparatus including the movable part can be extended. Also, by detecting vibration based on fluctuations in the torque command value , it is not necessary to provide a dedicated sensor for vibration detection, and the labor and cost required for production and maintenance of the feeding device having a movable part can be reduced. it can. Hereinafter, the feeding device is also simply referred to as a device.
[0008]
DETAILED DESCRIPTION OF THE INVENTION
Embodiment 1 FIG.
FIG. 1 is a block diagram of a numerical controller according to the present embodiment. Here, as an example, a drive mechanism (for example, servo motors 5A, 5B, 5C) of an apparatus (for example, a machine tool) having a plurality of (for example, three) movable parts (for example, robot arms) is driven to In the numerical control device that performs position control, a numerical control device in which a function generation command is issued to one drive mechanism (for example, servo motor 5B) will be described.
[0009]
A function generation command (for example, fast-forward mode command and target position) from the host controller 1 is input to the position command calculation unit 2B, and the position command calculation unit 2B determines a predetermined acceleration / deceleration time (in other words, acceleration or deceleration). ) To generate a position command for moving the movable part to the target position. Here, the target position or acceleration / deceleration time is input as numerical data. The position control unit 3B acquires the position command from the position command calculation unit 2B, and acquires the current position of the servo motor 5B from the position sensor 6B attached to the servo motor 5B. Then, the position control unit 3B calculates a torque command value using a known position control method so that this position command and the current position of the servo motor 5B coincide with each other, and converts this to a current command value necessary for the servo motor 5B. Convert and input to the inverter 4B. The inverter 4B supplies current corresponding to the current command value to the servo motor 5B, and thereby the position of the servo motor 5B is controlled to coincide with the target position. In the present embodiment, the host controller 1, position command calculation units (2A, 2B, 2C), position control units (3A, 3B, 3C) and acceleration / deceleration time changing units (8A, 8B, 8C) described later are provided. This corresponds to the control unit of the numerical control device.
[0010]
In addition, the numerical control device according to the present embodiment includes a vibration detection unit 7 (for example, a torque pickup, an acceleration pickup, etc.). The vibration detection unit 7 detects the resonance of the device including the movable unit. More specifically, the vibration detection unit 7 includes a storage unit (not shown), and the storage unit includes a resonance frequency of a device including a movable unit acquired in advance by inspection, and a preset vibration level threshold value. , Is stored. The vibration detection unit 7 compares the detected vibration frequency with the resonance frequency stored in the storage unit, and the detected vibration frequency is the resonance frequency or a multiplied frequency thereof, and the detected vibration amplitude is vibration. If the level threshold is exceeded, it is determined that resonance has occurred in the apparatus having the movable part.
[0011]
Further, the numerical control device according to the present embodiment includes an acceleration / deceleration time changing unit (8A, 8B, 8C). When the acceleration / deceleration time changing unit (8A, 8B, 8C) receives a signal from the vibration detecting unit 7 indicating that the resonance of the apparatus including the movable unit has been detected, the acceleration / deceleration time and deceleration of the movable unit are detected. A signal for instructing time change (for example, increase) is transmitted to the position command calculation unit 2B corresponding to the movable unit and the drive mechanism in operation (in operation). The position command calculation unit 2B outputs a position command with an acceleration / deceleration time different from the preset acceleration / deceleration time to the position control unit 3B according to the instruction of this signal. That is, the numerical control device according to the present embodiment changes the acceleration of the movable portion (for example, relaxes) when the resonance of the device including the movable portion is detected, and the frequency generated with the operation of the movable portion. Is shifted from the resonance frequency of the apparatus having the movable part, thereby suppressing the resonance of the apparatus having the movable part.
[0012]
Embodiment 2. FIG.
FIG. 2 is a block diagram of the numerical controller according to the present embodiment. Here, as an example, in a numerical control apparatus that drives a plurality of (for example, three) drive mechanisms (for example, servo motors 5A, 5B, and 5C) to control the position of a movable part (for example, a robot arm), A numerical control apparatus in which a function generation command is issued to (for example, the servo motor 5B) will be described. However, the numerical control apparatus according to the present embodiment is different from the first embodiment in that a torque monitoring unit 9 that monitors a torque command value is provided as the vibration detection unit 7.
[0013]
A function generation command (for example, fast-forward mode command and target position) from the host controller 1 is input to the position command calculation unit 2B, and the position command calculation unit 2B determines a predetermined acceleration / deceleration time (in other words, acceleration or deceleration). ) To generate a position command for moving the movable part to the target position. Here, the target position or acceleration / deceleration time is input as numerical data. The position control unit 3B acquires the position command from the position command calculation unit 2B, and acquires the current position of the servo motor 5B from the position sensor 6B attached to the servo motor 5B. Then, the position control unit 3B calculates a torque command value using a known position control method so that this position command and the current position of the servo motor 5B coincide with each other, and converts this to a current command value necessary for the servo motor 5B. Convert and input to the inverter 4B. The inverter 4B supplies current corresponding to the current command value to the servo motor 5B, and thereby the position of the servo motor 5B is controlled to coincide with the target position. These configurations and operations are the same as those in the first embodiment. In this embodiment, the host controller 1, the position command calculation units (2A, 2B, 2C), the position control units (3A, 3B, 3C), and the acceleration / deceleration time changing units (8A, 8B, 8C) It corresponds to the control unit of the control device.
[0014]
The numerical control apparatus according to the present embodiment includes a torque monitor unit 9 that monitors a torque command value as the vibration detection unit 7. More specifically, the torque monitor unit 9 detects a torque command value commanded from the position control unit (3A, 3B, 3C) to the servo motor (5A, 5B, 5C) through the inverter (4A, 4B, 4C). To do. And the torque monitor part 9 discriminate | determines that the apparatus provided with the movable part resonated when several (for example, three) torque command values vibrate with the same frequency. When vibrations of the same frequency are detected by a plurality of vibration detectors 7 installed in an apparatus having a movable part (for example, in this case, the same frequency is detected by the torque monitor unit 9 that detects vibrations of the plurality of movable parts. Is detected), a vibration is generated in the device including the movable portion including the plurality of vibration detection units 7 (that is, resonance is generated on the device side including the movable portion). Can be considered. Therefore, with such a configuration, it is possible to detect the resonance of the device including the movable part. In the present embodiment, the resonance of the device including the movable part is detected based on the torque command value. By adopting such a configuration, it is possible to suppress the labor and cost required for the manufacture and maintenance of the apparatus having the movable part, as compared with the case where the vibration detection part 7 is separately installed on the apparatus having the movable part. Can do.
[0015]
Further, the numerical control device according to the present embodiment includes an acceleration / deceleration time changing unit (8A, 8B, 8C). The operation of the acceleration / deceleration time changing unit (8A, 8B, 8C) is the same as that in the first embodiment.
[0016]
Here, an example in which the resonance of the apparatus including the movable part in the numerical control apparatus according to the present embodiment is suppressed will be described with reference to FIG. The upper part of FIG. 3 (above the arrow) shows the waveform when resonance occurs in the apparatus having the movable part, and the lower part (below the arrow) shows the waveform when resonance is suppressed. In each stage, the upper side is the angular velocity ω of each servo motor (5A, 5B, 5C), and the lower side is the torque command value T for each servo motor (5A, 5B, 5C).
[0017]
When only a servo motor 5B performs a series of acceleration, constant speed, and deceleration operations within a certain acceleration / deceleration time, the load inertia is increased by exchanging workpieces and tools, and the installation state and ground of the device with moving parts Depending on the state, for example, the entire apparatus including the movable part vibrates greatly due to an impact during acceleration / deceleration of the servo motor 5B (resonance state of the apparatus including the movable part). At this time, since the servo motor 5A and the servo motor 5C continue to stop, a torque command value is generated in a direction to cancel the vibration of the entire apparatus including the movable portion, as shown in the upper part of FIG. At this time, in the numerical control device according to the present embodiment, the torque command value for changing (for example, increasing) the acceleration / deceleration time is generated as described above. The fluctuation of the torque command value of the motor is also reduced (lower part of FIG. 3).
[0018]
In addition, this invention is not limited to the said embodiment. In the second embodiment, the torque monitor 9 as the vibration detector 7 detects the resonance of the device having the movable part due to the fact that a plurality of torque command values vibrate at the same frequency. However, the present invention is not limited to this. Similarly to the vibration detection unit 7 of the first embodiment, the detected vibration frequency is compared with the resonance frequency stored in the storage unit, and the detected vibration frequency is the resonance frequency or a frequency obtained by multiplying the resonance frequency. In addition, if the detected amplitude of vibration exceeds the vibration level threshold, it may be determined that resonance has occurred in the apparatus including the movable part.
[0019]
In addition, the acceleration / deceleration parameters (for example, acceleration / deceleration time, etc.) that can suppress the resonance are stored in a storage unit (not shown) for each load of the movable unit (for example, a workpiece or a tool), and the next and subsequent processing operations are performed. The numerical control device may be configured such that the position command calculation unit (2A, 2B, 2C) reads the acceleration / deceleration parameter corresponding to the load from the storage unit and generates a position command using the acceleration / deceleration parameter. Good.
[0020]
【The invention's effect】
As described above, according to the present invention, the drive mechanism can be controlled so as to detect and suppress the resonance of the device including the movable part. For this reason, the error between the position command and the current position can be reduced, and the life of each part of the apparatus including the movable part can be extended. Further, by detecting the vibration based on the torque command value, it is possible to reduce the labor and cost required for the manufacture and maintenance of the device including the movable part, as long as it is not necessary to provide a dedicated sensor for vibration detection.
[Brief description of the drawings]
FIG. 1 is a block diagram of a numerical controller according to a first embodiment of the present invention.
FIG. 2 is a block diagram of a numerical controller according to a second embodiment of the present invention.
FIG. 3 is a diagram showing waveforms of angular velocity and torque command value of each servo motor in the numerical controller according to the second embodiment of the present invention.
FIG. 4 is a block diagram of a conventional numerical control device.
[Explanation of symbols]
1 Host controller, 2A, 2B, 2C Position command calculation unit, 3A, 3B, 3C Position control unit, 4A, 4B, 4C inverter, 5A, 5B, 5C Servo motor, 6A, 6B, 6C Position sensor, 7 Vibration detection Part, 8A, 8B, 8C acceleration / deceleration time changing part, 9 torque monitor part.

Claims

可動部または駆動機構の動作を示す予め設定された数値データに基づいて可動部を動作させるよう駆動機構を制御する制御部を備えた数値制御装置において、
可動部を備えた送り装置の共振周波数を予め取得し、予め設定された振動レベル閾値と共に記憶する記憶部と、送り装置の振動を検出する振動検出部と、を備え、
前記制御部は、前記振動検出部から検出した振動の周波数と記憶部に記憶された共振周波数とを比較し、検出した振動周波数が共振周波数あるいはその逓倍の周波数であって、かつ、検出した振動の振幅が振動レベル閾値を超えた場合には、送り装置の共振と判定し、
予め設定された前記数値データによる動作時の加速度とは異なる加速度で可動部が動作するよう駆動機構を制御することを特徴とする数値制御装置。In a numerical control device including a control unit that controls the drive mechanism to operate the movable unit based on preset numerical data indicating the operation of the movable unit or the drive mechanism.
A storage unit that acquires in advance the resonance frequency of the feeding device including the movable unit and stores the resonance frequency with a preset vibration level threshold, and a vibration detection unit that detects the vibration of the feeding device,
The control unit compares the vibration frequency detected from the vibration detection unit with the resonance frequency stored in the storage unit, and the detected vibration frequency is the resonance frequency or a frequency obtained by multiplying the resonance frequency. When the vibration amplitude exceeds the vibration level threshold, it is determined that the feeder is resonant,
A numerical control apparatus for controlling a drive mechanism so that a movable part operates at an acceleration different from an acceleration during an operation based on the numerical data set in advance.

請求項１に記載の数値制御装置において、
前記制御部は、前記振動検出部により可動部を備えた送り装置の共振が検出された際には、予め設定された前記数値データによる動作時の加速度を緩和して可動部が動作するよう駆動機構を制御することを特徴とする数値制御装置。The numerical control apparatus according to claim 1,
When the vibration detecting unit detects the resonance of the feeding device including the movable unit, the control unit is driven so that the movable unit operates by relaxing acceleration during operation based on the preset numerical data. A numerical controller characterized by controlling a mechanism.

請求項１に記載の数値制御装置において、
前記駆動機構はサーボモータを備え、
前記制御部はトルク指令値によって前記サーボモータを制御し、
前記振動検出部は前記トルク指令値の変動により可動部を備えた送り装置の振動を検出することを特徴とする数値制御装置。The numerical control apparatus according to claim 1 ,
The drive mechanism includes a servo motor,
The control unit controls the servo motor by a torque command value,
The numerical controller according to claim 1, wherein the vibration detection unit detects a vibration of a feeding device including a movable unit based on a change in the torque command value .