JP3930262B2 - 数値制御装置 - Google Patents
数値制御装置 Download PDFInfo
- Publication number
- JP3930262B2 JP3930262B2 JP2001127853A JP2001127853A JP3930262B2 JP 3930262 B2 JP3930262 B2 JP 3930262B2 JP 2001127853 A JP2001127853 A JP 2001127853A JP 2001127853 A JP2001127853 A JP 2001127853A JP 3930262 B2 JP3930262 B2 JP 3930262B2
- Authority
- JP
- Japan
- Prior art keywords
- vibration
- unit
- movable
- numerical
- servo motor
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Images
Landscapes
- Numerical Control (AREA)
- Automatic Control Of Machine Tools (AREA)
Description
【発明の属する技術分野】
本発明は、可動部または駆動機構の動作を示す数値データに基づいて可動部を動作させるよう駆動機構を制御する数値制御装置に関し、特に、可動部を備えた装置の共振を抑制するための技術に関する。
【0002】
【従来の技術】
図4は、従来の数値制御装置の一例を示すブロック図である。ここでは、例として、可動部を三つ備えた装置(例えば工作機械等)の可動部を、3個のサーボモータ(5A,5B,5C)でそれぞれ駆動してその可動部の位置制御を行う数値制御装置において、ある1個のサーボモータ(例えば5B)に対して関数発生指令が行われる場合について説明する。上位制御装置1からの関数発生指令(例えば早送りのモード指令及び目標位置)が位置指令演算部2Bに入力される。位置指令演算部2Bは予め定められる加減速時間(換言すれば加速度あるいは減速度)で可動部を目標位置に移動させるための位置指令を生成する。ここで目標位置あるいは加減速時間などは数値データとして入力される。位置制御部3Bは、位置指令演算部2Bから位置指令を取得するとともに、サーボモータ5Bに取り付けられた位置センサ6Bからサーボモータ5Bの現在位置を取得する。そして位置制御部3Bは、この位置指令とサーボモータ5Bの現在位置とを一致させるように公知の位置制御手法を用いてトルク指令値を演算し、これをサーボモータ5Bに必要な電流指令値に変換してインバータ4Bに入力する。インバータ4Bはサーボモータ5Bに前記電流指令値に応じた電流を供給し、これによりサーボモータ5Bの位置が目標位置に一致するように制御される。
【0003】
【発明が解決しようとする課題】
このような従来の数値制御装置では、可動部を備えた装置の据付状態や設置場所の地盤の状態によっては、ワークやツールを交換して負荷イナーシャが増加したりした場合などに、モータの加減速時の衝撃によって可動部を備えた装置の一部または全体が大きく振動してしまうことがある。このような状態で動作させると位置指令と現在位置との誤差が増大するばかりでなく、可動部を備えた装置各部の寿命を短くする要因にもなる。
【0004】
【課題を解決するための手段】
上記課題に鑑み、本発明にかかる数値制御装置は、可動部または駆動機構の動作を示す予め設定された数値データに基づいて可動部を動作させるよう駆動機構を制御する制御部を備えた数値制御装置において、可動部を備えた送り装置の共振周波数を予め取得し、予め設定された振動レベル閾値と共に記憶する記憶部と、送り装置の振動を検出する振動検出部と、を備え、前記制御部は、前記振動検出部から検出した振動の周波数と記憶部に記憶された共振周波数とを比較し、検出した振動周波数が共振周波数あるいはその逓倍の周波数であって、かつ、検出した振動の振幅が振動レベル閾値を超えた場合には、送り装置の共振と判定し、予め設定された前記数値データによる動作時の加速度とは異なる加速度で可動部が動作するよう駆動機構を制御する。
【0005】
また本発明にかかる数値制御装置において、前記制御部は、前記振動検出部により可動部を備えた送り装置の共振が検出された際には、予め設定された前記数値データによる動作時の加速度を緩和して可動部が動作するよう駆動機構を制御する。
【0006】
また本発明にかかる数値制御装置において、前記駆動機構はサーボモータを備え、前記制御部はトルク指令値によって前記サーボモータを制御し、前記振動検出部は前記トルク指令値の変動により可動部を備えた送り装置の振動を検出するのが好適である。
【0007】
上記構成によれば、可動部を備えた送り装置の共振を検出してこれを抑制するように駆動機構を制御することができる。このため、位置指令と現在位置との誤差を減少させることができるとともに、可動部を備えた装置各部の寿命を長くすることができる。また、トルク指令値の変動によって振動を検出することにより、振動検出用の専用のセンサを設けずにすむ分、可動部を備えた送り装置の製作およびメンテナンスに要する手間およびコストを削減することができる。なお、以下、送り装置を単に装置ともいう。
【0008】
【発明の実施の形態】
実施の形態1.
図1は本実施形態にかかる数値制御装置のブロック図である。ここでは、一例として、複数(例えば三個)の可動部(例えばロボットアーム)を備えた装置(例えば工作機械等)の駆動機構(例えばサーボモータ5A,5B,5C)を駆動して可動部の位置制御を行う数値制御装置において、一つの駆動機構(例えばサーボモータ5B)に関数発生指令が行われる数値制御装置について説明する。
【0009】
上位制御装置1からの関数発生指令(例えば早送りのモード指令及び目標位置)が位置指令演算部2Bに入力され、位置指令演算部2Bは、予め定められる加減速時間(換言すれば加速度あるいは減速度)で可動部を目標位置に移動させるための位置指令を生成する。ここで目標位置あるいは加減速時間などは数値データとして入力される。位置制御部3Bは、位置指令演算部2Bから位置指令を取得するとともに、サーボモータ5Bに取り付けられた位置センサ6Bからサーボモータ5Bの現在位置を取得する。そして位置制御部3Bは、この位置指令とサーボモータ5Bの現在位置とを一致させるように公知の位置制御手法を用いてトルク指令値を演算し、これをサーボモータ5Bに必要な電流指令値に変換してインバータ4Bに入力する。インバータ4Bはサーボモータ5Bに前記電流指令値に応じた電流を供給し、これによりサーボモータ5Bの位置が目標位置に一致するように制御される。なお、本実施形態では、上位制御装置1、位置指令演算部(2A,2B,2C)、位置制御部(3A,3B,3C)および後述する加減速時間変更部(8A,8B,8C)が、数値制御装置の制御部に相当する。
【0010】
また本実施形態にかかる数値制御装置は、振動検出部7(例えばトルクピックアップ,加速度ピックアップなど)を備える。この振動検出部7は、可動部を備えた装置の共振を検出する。より具体的には、この振動検出部7は図示しない記憶部を備え、この記憶部には、予め検査によって取得された可動部を備えた装置の共振周波数と、予め設定された振動レベル閾値と、が記憶されている。振動検出部7は、検出した振動の周波数と記憶部に記憶された共振周波数とを比較し、検出した振動の周波数が共振周波数あるいはその逓倍の周波数であって、しかも検出した振動の振幅が振動レベル閾値を超えていた場合には、可動部を備えた装置の共振が発生したと判別する。
【0011】
また本実施形態にかかる数値制御装置は、加減速時間変更部(8A,8B,8C)を備える。この加減速時間変更部(8A,8B,8C)は、振動検出部7から可動部を備えた装置の共振が検出されたことを示す信号を受け取った場合には、可動部の加速時間および減速時間の変更(例えば増大)を指示する信号を、動作中(稼動中)の可動部および駆動機構に対応する位置指令演算部2Bに送信する。位置指令演算部2Bは、この信号の指示に従い、予め設定された加減速時間とは異なる加減速時間とする位置指令を位置制御部3Bに出力する。すなわち、本実施形態にかかる数値制御装置は、可動部を備えた装置の共振を検出した際には、可動部の加速度を変更して(例えば緩和して)可動部の動作に伴って生じる周波数を可動部を備えた装置の共振周波数からずらすことで、可動部を備えた装置の共振を抑制する。
【0012】
実施の形態2.
図2は本実施形態にかかる数値制御装置のブロック図である。ここでは、一例として、複数(例えば三個)の駆動機構(例えばサーボモータ5A,5B,5C)を駆動して可動部(例えばロボットアーム)の位置制御を行う数値制御装置において、一つの駆動機構(例えばサーボモータ5B)に関数発生指令が行われる数値制御装置について説明する。ただし、本実施形態にかかる数値制御装置は、振動検出部7としてトルク指令値をモニタするトルクモニタ部9を備える点が上記実施の形態1と異なる。
【0013】
上位制御装置1からの関数発生指令(例えば早送りのモード指令及び目標位置)が位置指令演算部2Bに入力され、位置指令演算部2Bは、予め定められる加減速時間(換言すれば加速度あるいは減速度)で可動部を目標位置に移動させるための位置指令を生成する。ここで目標位置あるいは加減速時間などは数値データとして入力される。位置制御部3Bは、位置指令演算部2Bから位置指令を取得するとともに、サーボモータ5Bに取り付けられた位置センサ6Bからサーボモータ5Bの現在位置を取得する。そして位置制御部3Bは、この位置指令とサーボモータ5Bの現在位置とを一致させるように公知の位置制御手法を用いてトルク指令値を演算し、これをサーボモータ5Bに必要な電流指令値に変換してインバータ4Bに入力する。インバータ4Bはサーボモータ5Bに前記電流指令値に応じた電流を供給し、これによりサーボモータ5Bの位置が目標位置に一致するように制御される。これらの構成および動作は上記実施の形態1と同様である。なお、本実施形態でも、上位制御装置1、位置指令演算部(2A,2B,2C)、位置制御部(3A,3B,3C)および加減速時間変更部(8A,8B,8C)が、数値制御装置の制御部に相当する。
【0014】
本実施形態にかかる数値制御装置は、振動検出部7としてトルク指令値をモニタするトルクモニタ部9を備える。より具体的には、トルクモニタ部9は、位置制御部(3A,3B,3C)からインバータ(4A,4B,4C)を通してサーボモータ(5A,5B,5C)に指令されるトルク指令値を検出する。そして、トルクモニタ部9は、複数(例えば三つ)のトルク指令値が同じ周波数で振動した場合に可動部を備えた装置が共振したと判別する。可動部を備えた装置に設置した複数の振動検出部7で同じ周波数の振動が検出された場合(例えば、この場合のように、複数の可動部の振動を検出するトルクモニタ部9で同じ周波数の振動が検出された場合)には、それら複数の振動検出部7を備えた可動部を備えた装置に振動が生じている(すなわち可動部を備えた装置側で共振が発生している)と考えることができる。したがって、このような構成により、可動部を備えた装置の共振を検出することができる。なお、本実施形態では、トルク指令値により可動部を備えた装置の共振を検出する。このような構成とすることにより、可動部を備えた装置上に別途振動検出部7を設置した場合に比して、可動部を備えた装置の製作およびメンテナンスに要する手間およびコストを抑制することができる。
【0015】
また、本実施形態にかかる数値制御装置は、加減速時間変更部(8A,8B,8C)を備える。この加減速時間変更部(8A,8B,8C)の動作は上記実施の形態1と同様である。
【0016】
ここで、本実施形態にかかる数値制御装置において可動部を備えた装置の共振を抑制した一例について、図3を参照して説明する。図3の上段(矢印より上側)は可動部を備えた装置の共振発生時の波形を示し、下段(矢印より下側)は共振抑制時の波形を示す。また、各段において、それぞれ上側は各サーボモータ(5A,5B,5C)の角速度ω、および下側は各サーボモータ(5A,5B,5C)に対するトルク指令値Tである。
【0017】
サーボモータ5Bのみ、ある加減速時間で加速、定速、減速の一連の動作をさせた際、ワークやツールを交換して負荷イナーシャが増加したり、可動部を備えた装置の据付状態や地盤の状態によっては、例えばサーボモータ5Bの加減速時の衝撃により可動部を備えた装置全体が大きく振動してしまう(可動部を備えた装置の共振状態)。この時、サーボモータ5A及びサーボモータ5Cは停止し続けようとするため、図3の上段に示すように、可動部を備えた装置全体の振動を打ち消す方向にトルク指令値が生成される。このとき、本実施形態にかかる数値制御装置では、上述したように加減速時間を変更する(例えば長くする)トルク指令値が生成されるので、可動部を備えた装置の共振は抑制され、サーボモータのトルク指令値の変動も低減する(図3の下段)。
【0018】
なお、本発明は上記実施形態には限定されない。上記実施の形態2では、振動検出部7としてのトルクモニタ部9は、複数のトルク指令値が同じ周波数で振動したことにより可動部を備えた装置の共振を検出したが、これには限られず、上記実施の形態1の振動検出部7と同様に、検出した振動の周波数と記憶部に記憶された共振周波数とを比較し、検出した振動の周波数が共振周波数あるいはその逓倍の周波数であって、しかも検出した振動の振幅が振動レベル閾値を超えていた場合には、可動部を備えた装置の共振が発生したと判別してもよい。
【0019】
また、可動部の負荷(例えばワークやツール等)毎に、共振を抑制することができた加減速パラメータ(例えば加減速時間等)を、図示しない記憶部に記憶させ、次回以降の処理動作時には、位置指令演算部(2A,2B,2C)が、その記憶部から負荷に応じた加減速パラメータを読み出し、その加減速パラメータを用いた位置指令を生成するよう、数値制御装置を構成してもよい。
【0020】
【発明の効果】
以上説明したように、本発明によれば、可動部を備えた装置の共振を検出してこれを抑制するように駆動機構を制御することができる。このため、位置指令と現在位置との誤差を減少させることができるとともに、可動部を備えた装置各部の寿命を長くすることができる。また、トルク指令値によって振動を検出することにより、振動検出用の専用のセンサを設けずにすむ分、可動部を備えた装置の製作およびメンテナンスに要する手間およびコストを削減することができる。
【図面の簡単な説明】
【図1】 本発明の第一の実施形態にかかる数値制御装置のブロック図である。
【図2】 本発明の第二の実施形態にかかる数値制御装置のブロック図である。
【図3】 本発明の第二の実施形態にかかる数値制御装置における各サーボモータの角速度およびトルク指令値の波形を示す図である。
【図4】 従来の数値制御装置のブロック図である。
【符号の説明】
1 上位制御装置、2A,2B,2C 位置指令算出部、3A,3B,3C 位置制御部、4A,4B,4C インバータ、5A,5B,5C サーボモータ、6A,6B,6C 位置センサ、7 振動検出部、8A,8B,8C 加減速時間変更部、9 トルクモニタ部。
Claims (3)
- 可動部または駆動機構の動作を示す予め設定された数値データに基づいて可動部を動作させるよう駆動機構を制御する制御部を備えた数値制御装置において、
可動部を備えた送り装置の共振周波数を予め取得し、予め設定された振動レベル閾値と共に記憶する記憶部と、送り装置の振動を検出する振動検出部と、を備え、
前記制御部は、前記振動検出部から検出した振動の周波数と記憶部に記憶された共振周波数とを比較し、検出した振動周波数が共振周波数あるいはその逓倍の周波数であって、かつ、検出した振動の振幅が振動レベル閾値を超えた場合には、送り装置の共振と判定し、
予め設定された前記数値データによる動作時の加速度とは異なる加速度で可動部が動作するよう駆動機構を制御することを特徴とする数値制御装置。 - 請求項1に記載の数値制御装置において、
前記制御部は、前記振動検出部により可動部を備えた送り装置の共振が検出された際には、予め設定された前記数値データによる動作時の加速度を緩和して可動部が動作するよう駆動機構を制御することを特徴とする数値制御装置。 - 請求項1に記載の数値制御装置において、
前記駆動機構はサーボモータを備え、
前記制御部はトルク指令値によって前記サーボモータを制御し、
前記振動検出部は前記トルク指令値の変動により可動部を備えた送り装置の振動を検出することを特徴とする数値制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2001127853A JP3930262B2 (ja) | 2001-04-25 | 2001-04-25 | 数値制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2001127853A JP3930262B2 (ja) | 2001-04-25 | 2001-04-25 | 数値制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2002323913A JP2002323913A (ja) | 2002-11-08 |
JP3930262B2 true JP3930262B2 (ja) | 2007-06-13 |
Family
ID=18976652
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2001127853A Expired - Fee Related JP3930262B2 (ja) | 2001-04-25 | 2001-04-25 | 数値制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3930262B2 (ja) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4261470B2 (ja) | 2004-11-30 | 2009-04-30 | ファナック株式会社 | 制御装置 |
JP7024561B2 (ja) * | 2018-03-30 | 2022-02-24 | ブラザー工業株式会社 | 工作機械、コンピュータプログラム及び制御方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH01289644A (ja) * | 1988-05-10 | 1989-11-21 | Matsushita Electric Ind Co Ltd | 駆動装置 |
JPH07328965A (ja) * | 1994-06-03 | 1995-12-19 | Toyota Motor Corp | 制振制御方法および固有振動周期測定方法および制振制御装置 |
JPH07328969A (ja) * | 1994-06-07 | 1995-12-19 | Daikin Ind Ltd | ロボット制御装置 |
-
2001
- 2001-04-25 JP JP2001127853A patent/JP3930262B2/ja not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2002323913A (ja) | 2002-11-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4565034B2 (ja) | イナーシャ推定を行う制御装置及び制御システム | |
US11014234B2 (en) | Control device and robot system | |
CN102514006B (zh) | 自动装置 | |
US20180281186A1 (en) | Robot control device and robot system | |
KR101495949B1 (ko) | 감속기의 이상 판정 방법, 이상 판정 장치 및 로봇 시스템 | |
TWI678065B (zh) | 馬達控制裝置 | |
US10864634B2 (en) | Control device and robot system | |
JP4261470B2 (ja) | 制御装置 | |
JP5566532B2 (ja) | モータ制御装置 | |
WO2006001479A1 (ja) | 異常検出方法およびモータ制御装置 | |
JP4391381B2 (ja) | 多関節ロボットの減速機の異常判定装置及び多関節ロボットの減速機の異常判定方法 | |
JPWO2004008624A1 (ja) | サーボ制御装置のゲイン調整方法 | |
JP5333813B2 (ja) | モータ制御装置及び機械システム | |
JP3930262B2 (ja) | 数値制御装置 | |
JP2009202335A (ja) | 減速機の異常判定装置及び減速機の異常判定方法 | |
JP4003741B2 (ja) | モータ制御装置 | |
US10814482B2 (en) | Robot controller | |
JPWO2008093486A1 (ja) | 慣性モーメント同定装置とその同定方法、ならびにその同定装置を備えたモータ制御装置 | |
JPH1110580A (ja) | 産業用ロボットの駆動軸制御方法及びその装置 | |
JP6101931B2 (ja) | モータ駆動装置 | |
CN111857045B (zh) | 数控装置和机床 | |
JP4752298B2 (ja) | モータ制御装置およびその制御方法 | |
JPH11245191A (ja) | 産業用ロボットの駆動軸制御方法及びその装置 | |
JP4390049B2 (ja) | サーボ制御装置およびその限界ゲイン抽出方法 | |
JP2005204472A5 (ja) |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20040702 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20060810 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20060815 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20061011 |
|
RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20061011 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20061205 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20070119 |
|
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: 20070306 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20070308 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 Ref document number: 3930262 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130316 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130316 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20160316 Year of fee payment: 9 |
|
LAPS | Cancellation because of no payment of annual fees |