JP2004215455A - 多軸電動機制御装置の共振周波数検出装置 - Google Patents
多軸電動機制御装置の共振周波数検出装置 Download PDFInfo
- Publication number
- JP2004215455A JP2004215455A JP2003001939A JP2003001939A JP2004215455A JP 2004215455 A JP2004215455 A JP 2004215455A JP 2003001939 A JP2003001939 A JP 2003001939A JP 2003001939 A JP2003001939 A JP 2003001939A JP 2004215455 A JP2004215455 A JP 2004215455A
- Authority
- JP
- Japan
- Prior art keywords
- signal
- resonance frequency
- frequency
- motor control
- command
- 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
Images
Classifications
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P5/00—Arrangements specially adapted for regulating or controlling the speed or torque of two or more electric motors
- H02P5/46—Arrangements specially adapted for regulating or controlling the speed or torque of two or more electric motors for speed regulation of two or more dynamo-electric motors in relation to one another
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P25/00—Arrangements or methods for the control of AC motors characterised by the kind of AC motor or by structural details
- H02P25/16—Arrangements or methods for the control of AC motors characterised by the kind of AC motor or by structural details characterised by the circuit arrangement or by the kind of wiring
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Control Of Electric Motors In General (AREA)
- Control Of Multiple Motors (AREA)
Abstract
【解決手段】機械41,42を駆動する電動機31,32と、電動機31,32を駆動する制御器21,22とを有する電動機制御系を複数備え、各電動機制御系に、機械41,42の動作量を検出する検出器51,52と、検出器51,52の信号を周波数分析し、共振周波数として出力する信号処理器61,62と、信号処理器61,62の信号をグラフ化または数値化して出力する出力装置81,82とを備えた多軸電動機制御装置の共振周波数検出装置において、機械41,42に振動を伝える制御指令を電動機制御系に与える指令発生器11を設け、複数の検出器51,52の信号を信号処理器61に入力して共振周波数として出力するようにした。
【選択図】 図1
Description
【発明の属する技術分野】
本発明は、電動機を用いた位置決め装置に関するものであり、特に位置決め制御系を利用して多軸機械の共振周波数を検出する多軸電動機制御装置の共振周波数検出装置に関する。
【0002】
【従来の技術】
半導体製造装置や工作機械、産業用ロボット等では、電動機を用いて位置決め制御されることが多い。その位置決め精度には、機械の共振周波数が大きく影響するため、前もって正確な共振周波数をつかんでおくことが望ましく、同時に、制御系が組まれて稼動している状態で正確に測れることが望まれる。この必要性から、従来はFFT(高速フーリエ変換)を用いて周波数特性を解析し、共振周波数を割り出すという方法が用いられている。この従来技術を図に基づいて説明する。
【0003】
図14は電動機制御系に組み込まれた従来の共振周波数検出装置(特許文献1参照)の構成を示すブロック図である。図において、従来の共振周波数検出装置は、指令発生器11と、この指令発生器11からの指令信号Cを受けて電動機31,32に駆動電流を供給する制御器21,22と、電動機31,32と、電動機31,32によって駆動される機械41,42と、電動機31,32の電動機動作量m1,m2を検出する検出器51,52と、検出器51,52の出力である応答信号S1,S2に対してFFT演算を実施して共振周波数検出結果f1,f2を算出するFFTアナライザ121,122と、共振周波数検出結果f1,f2を出力する出力装置81,82とを備えている。
【0004】
この従来の共振周波数検出装置において、指令発生器11は指令信号Cを生成し、制御器21,22に入力する。この指令に応じて制御器21,22が電動機31,32に電流を供給すると、電動機31,32が機械41,42を駆動する。このとき、検出器51,52は、電動機31,32の回転位置や回転速度等の電動機動作量m1,m2を検出して応答信号S1,S2を出力する。FFTアナライザ121,122は応答信号S1,S2を入力するとFFT演算を実施し、共振周波数検出結果f1,f2を算出する。出力装置81,82は共振周波数検出結果f1,f2を入力すると数値やグラフ化して可視化したものを出力する。このようにして共振周波数が単軸ごとに計測される。
【0005】
【特許文献1】
特開平6−78575号公報
【0006】
【発明が解決しようとする課題】
従来技術では、単軸ごとに共振周波数を計測するために、指令発生器から出された指令によって動作する1軸の共振周波数しか測定できず、動作軸に影響を与える他軸の共振周波数を測定することができない。そのために、従来では個別の軸ごとにサーボ調整を行うが、複数軸が稼動する場合には発振が起こることがあり、サーボ調整が難しいという問題があった。
そこで本発明は、複数軸を持つ機械においても、動作軸に影響を与える他軸の共振周波数を把握してサーボ調整を容易にすることのできる多軸電動機制御装置の共振周波数検出装置を提供することを目的とする。
【0007】
【課題を解決するための手段】
上記問題を解決するため、請求項1に記載の発明は、複数軸を有する機械の一つの軸を駆動する電動機と、制御指令を受けて前記電動機を駆動する制御器とを有する電動機制御系を前記機械の複数軸についてそれぞれ備え、各電動機制御系に、前記機械の動作量を検出する検出器と、前記検出器の信号を周波数分析し、共振周波数として出力する信号処理器と、前記信号処理器の信号をグラフ化または数値化して出力する出力装置とを備えた多軸電動機制御装置の共振周波数検出装置において、前記機械に振動を伝える制御指令を前記電動機制御系の少なくとも一方に与える少なくとも1つの指令発生器を設け、前記複数の検出器の信号を前記複数の信号処理器に入力して共振周波数として出力するようにしたことを特徴とするものである。
この発明においては、指令発生器からの指令信号に従って駆動される各電動機の動作量を検出し、信号処理器にその信号を入力することにより、ある動作軸と他の動作軸との共振周波数を検出して、動作軸間の影響を把握することが可能となる。
【0008】
請求項2に記載の発明は、前記信号処理器は、前記複数の検出器の信号を入力して、信号の和を共振周波数として出力するようにしたことを特徴とする。
この発明においては、複数の検出器の信号の和を共振周波数として出力することにより、ある動作軸と他の動作軸との共振周波数を検出して、動作軸間の影響を把握することが可能となる。
請求項3に記載の発明は、前記検出器は電動機の位置または速度、あるいは前記機械の可動部の位置または速度を検出するものであることを特徴とする。
この発明においては、指令発生器からの指令信号に従って駆動される各電動機の動作量である位置または速度、あるいは前記機械の可動部の位置または速度を検出し、信号処理器にその信号を入力することにより、ある動作軸と他の動作軸との共振周波数を検出して、動作軸間の影響を把握することが可能となる。
請求項4に記載の発明は、前記複数の電動機制御系の一部または全てがオープンループの場合には、前記指令発生器の信号は当該オープンループの電動機制御系の制御器に入力されることを特徴とする。
この発明においては、指令発生器の信号は当該オープンループの電動機制御系の動作量を検出し、信号処理器にその信号を入力することにより、ある動作軸と他の動作軸との共振周波数を検出して、動作軸間の影響を把握することが可能となる。
請求項5に記載の発明は、前記複数の電動機制御系の一部または全てにおいて、前記指令発生器からの制御指令と前記検出器からの前記機械の動作量との偏差に応じた制御指令を前記制御器に与える閉ループ制御器を備えたことを特徴とする。
この発明においては、指令発生器からの制御指令と検出器からの機械の動作量との偏差に応じた制御指令を制御器に与える閉ループ制御器を通過した各電動機の動作量を検出し、信号処理器にその信号を入力することにより、ある動作軸と他の動作軸との共振周波数を検出して、動作軸間の影響を把握することが可能となる。
【0009】
請求項6に記載の本発明は、前記電動機制御系の一部または全てにおいて、前記検出器からの前記機械の動作量と動作指令との偏差に応じた制御指令を出力する閉ループ制御器と、その制御指令に含まれる所定の帯域の信号を低減するフィルタ処理部とを備え、前記フィルタ処理部の出力と前記指令発生器からの指令信号との和が前記制御器に入力されていることを特徴とする。
この発明においては、信号処理器に前記フィルタ処理部の出力と前記指令発生器からの指令信号との和を入力することにより、ある動作軸と他の動作軸との共振周波数を検出して、動作軸間の影響を把握することが可能となる。
請求項7に記載の発明は、前記制御指令は、掃引正弦波信号であり、前記信号処理器は前記指令発生器が出力する前記掃引正弦波信号の周波数情報と少なくとも1つ前記検出器の信号を入力し、前記検出器の信号の絶対値が最大となる前記正弦波信号の周波数を共振周波数として出力するものであることを特徴とする。
この発明においては、前記検出器の信号の絶対値が最大となる前記正弦波信号の周波数を共振周波数として出力することにより、ある動作軸と他の動作軸との共振周波数を検出して、動作軸間の影響を把握することが可能となる。
請求項8に記載の発明は、前記出力装置は、少なくとも1つの前記信号処理器の信号を周波数特性として出力するものであることを特徴とする。
この発明においては、前記出力装置は、少なくとも1つの前記信号処理器の信号をグラフ化または数値化して共振周波数を確認することが可能となる。
請求項9に記載の発明は、前記指令発生器から機械に振動を伝える制御指令は、最小周波数Fminから最大周波数Fmaxまでの範囲に周波数が制限されており、前記信号処理器は、前記検出器の信号を所定の周波数範囲に制限して入力するとともに、前記最小周波数Fmin以上の周波数だけを検出することを特徴とする。
この発明においては、前記信号処理器は、前記検出器の信号を所定の周波数範囲に制限して入力することにより、前記最小周波数Fmin以上の共振周波数を把握することが可能となる。
【0010】
請求項10に記載の発明は、前記指令発生器から機械に振動を伝える制御指令は、最小周波数Fminから最大周波数Fmaxまでの範囲に周波数が制限されており、前記信号処理器は、前記検出器の信号を所定の周波数範囲に制限して入力するとともに、前記最小周波数Fminより大きい検出最小周波数Flim以上の周波数だけを検出することを特徴とする。
この発明においては、前記信号処理器は、前記検出器の信号を所定の周波数範囲に制限して入力することにより、前記最小周波数Fminより大きいFlim以上の共振周波数を把握することが可能となる。
請求項11に記載の発明は、前記検出器と前記信号処理器の間にハイパスフィルタが設けられていることを特徴とする。
この発明においては、信号処理器にハイパスフィルタ通過後の信号を入力することにより、ある周波数以上をカットした共振周波数を把握することが可能となる。
請求項12に記載の発明は、ある軸の前記検出器の信号を他軸の信号処理器に入力するスイッチが設けられていることを特徴とする。
この発明においては、スイッチが設けられていることにより、軸間の影響を1つ、もしくは複数の信号処理器で把握することが可能となる。
【0011】
【発明の実施の形態】
以下、本発明の実施の形態を、図1〜図13に基づいて説明する。
<第1実施形態>
図1は本発明の第1実施形態に係る共振周波数検出装置の構成を示すブロック図である。なお、図14に示した従来の共振周波数検出装置の構成に対応する部分については、同一の符号を付している。
図1において、共振周波数検出装置は、1軸目の電動機制御系と、2軸目の電動機制御系とを有し、指令発生器11と、制御器21,22と、電動機31,32と、電動機31,32によって駆動される機械41,42と、電動機31,32の電動機動作量m1,m2を検出する検出器51,52と、検出器51,52の出力である応答信号S1,S2に対して信号処理を行って共振周波数検出結果f1,f2を算出する信号処理器61,62と、共振周波数検出結果f1,f2を出力する出力装置81,82と、2軸目の検出器52の応答信号S2を1軸目の信号処理器61に加算するためのスイッチ151とを備えている。図1の電動機制御装置は機械41,42が固定台等に共に搭載された一体の構成となっている。
【0012】
この第1実施形態の共振周波数検出装置において、指令発生器11は指令信号Cを出力し、制御器21は、指令発生器11から受けた指令信号Cに従って電動機31を駆動する。電動機31,32に連結された検出器51,52の出力は電動機動作量m1,m2を検出し、応答信号S1,S2として信号処理器61,62に送る。電動機31と機械41、また電動機32と機械42はそれぞれ連結されているため、電動機動作量m1,m2を検出すれば、機械41の共振特性と機械41に影響を与える機械42の共振特性を検出できる。この応答信号S1,S2は機械41,42が周波数に依存して少しの外力でも大きな反応を示す共振周波数を持つため、信号処理器61,62が周波数分析すると共振周波数を検出することができる。信号処理器61,62の出力である周波数特性検出結果f1,f2は、出力装置81,82にそれぞれの結果をグラフ化または数値化して出力できる。
2軸目の検出器52の出力側と1軸目の信号処理器61とはスイッチ151で接続されており、スイッチ151がoffの時は、応答信号S1,S2として信号処理器61,62に送り周波数特性検出結果f1,f2を検出する。スイッチ151がonの時は、応答信号S2は信号処理器61に入力され、信号処理器61で応答信号S1とS2の和を検出することにより、機械41の共振特性と機械41に影響を与える機械42の共振特性を1つの出力装置81で検出し、出力する。
なお、第1実施形態では電動機制御系が2つの例を示したが、3つ以上の場合にも適用することができる。
【0013】
<第2実施形態>
図2は本発明の第2実施形態の構成を示すブロック図であり、指令発生器11から出力される指令信号Cが制御器21と制御器22の両方に入力するように設けられ、同時に2つの電動機31,32を動作させる点が図1に示した第1実施形態と異なっている。共振周波数は第1実施形態と同様にして検出できる。
この第2実施形態においては、指令発生器11から指令信号Cに従って駆動される各電動機31,32の電動機動作量m1,m2を検出し、各信号処理器51,52に各信号を入力することにより、各電動機制御系の共振周波数を検出することが可能となる。さらに、各電動機動作量m1,m2の和を1つの信号処理器61に入力することにより、動作軸間の影響を把握することができる。
なお、第2実施形態では応答信号S2を信号処理器61に入力するようにスイッチ151を設定したが、応答信号S1を信号処理器62に入力するようにスイッチを設けてもよい。
また、図2では2つの電動機制御系を動作させているが、いくつあってもよい。
【0014】
<第3実施形態>
図3は第3実施形態の構成を示すブロック図であり、指令発生器12から出力される指令信号Cが制御器22に入力するように設け、同時に2つの電動機31,32を動作させる点が図1と異なっている。
共振周波数は第1実施形態または第2実施形態と同様にして検出できる。
この第3実施形態においては、2つの指令発生器11,12から同じ指令信号もしくは異なる指令信号を各電動機制御系に与えて各電動機31,32の電動機動作量m1,m2を検出し、各信号処理器61,62に各信号を入力することにより、各電動機制御系の共振周波数を検出することが可能となる。さらに、各電動機動作量m1,m2の和を1つの信号処理器61に入力することにより、動作軸間の影響を把握することができる。
なお、図3では指令発生器と電動機制御系の組み合わせが2つであるが、いくつあってもよい。
【0015】
<第4実施形態>
図4は第4実施形態の構成を示すブロック図であり、指令発生器12から出力される指令信号Cが制御器22、23に入力するように設け、同時に3つの電動機31,32、33を動作させる点と、検出器52、53とスイッチ151,152を並列に構成した点が図1と異なっている。
スイッチ151,152がoffの時は、応答信号S2、S3は信号処理器62、63に入力される。
スイッチ151がonの時は、応答信号S2は信号処理器61に入力される。
スイッチ152がonの時は、応答信号S3が信号処理器61に入力される。
スイッチ152、153がonの時は、応答信号S2、S3は信号処理器61に入力される。
共振周波数は第1実施形態から第3実施形態のいずれかと同様にして検出できる。
この第4実施形態においては、1つの指令発生器11で1つの電動機制御系を、その他の指令発生器12でその他の電動機制御系に同じ指令信号もしくは異なる指令信号を各電動機制御系に与えて、各電動機31,32,33の電動機動作量m1,m2,m3を検出し、各信号処理器61,62,63に各信号を入力することにより、各電動機制御系の共振周波数を検出することが可能となる。さらに、各電動機動作量m1,m2,m3の和を1つの信号処理器61に入力することにより、動作軸間の影響を把握することが可能となる。
なお、第4実施形態では、応答信号S2、S3を信号処理器61に入力するようにスイッチを設けているが、応答信号S1,S3を信号処理器62に、応答信号S1,S2を信号処理器63に入力するようにスイッチを設けてもよい。
また、図4では指令発生器11で動作している電動機制御系が1つ、指令発生器12で動作している電動機制御系が2つであるが、指令発生器、電動機制御系はいくつあってもよい。
【0016】
<第5実施形態>
図5は第5実施形態の構成を示すブロック図であり、1つ以上の電動機制御系が閉ループをなしている場合のブロック図である。図5においては、検出器51,52は電動機31,32の電動機動作量m1,m2を検出するように設けられており、また、制御器21,22の前段に閉ループ制御器71,72が設けられ、その前段に減算器が設けられている。そして減算器の(+)端子に印加される指令と検出器51,52の信号が指令信号Cと比較され、その差を受けた閉ループ制御器71,72が、その差を小さくするよう働いて制御器21,22に指令を出力する。この閉ループ制御系に指令発生器11と信号処理器61,62、出力装置81,82、スイッチ151が追加され、指令発生器11の指令信号Cが減算器の(+)端子に印加される。共振周波数は第1実施形態から第4実施形態のいずれかと同様にして検出できる。
この第5実施形態においては、指令発生器11から指令信号に従って駆動される各電動機31,32の電動機動作量m1,m2を検出し、各信号処理器61,62に各信号を入力することにより、各電動機制御系の共振周波数を検出することが可能となる。さらに、各電動機動作量m1,m2の和を1つの信号処理器61に入力することにより、動作軸間の影響を把握することができる。
なお、図5では電動機制御系が2つであるが、いくつであっても良い。
【0017】
<第6実施形態>
図6は第6実施形態の構成を示すブロック図であり、図5において指令発生器11が出力する指令信号Cを減算器の(+)端子に印加していたものを、制御器21と閉ループ制御器71の間に設けた加算器の一方の入力端子に変えたものである。このような構成としても、共振周波数は第1実施形態から第5実施形態のいずれかと同様にして検出できる。
この第6実施形態においては、指令発生器11から指令信号に従って駆動される各電動機31,32の電動機動作量m1,m2を検出し、各信号処理器61,62に各信号を入力することにより、機械41の共振周波数と機械41に影響を与える機械42の共振周波数を検出することが可能となる。さらに、各電動機動作量m1,m2の和を1つの信号処理器61に入力することにより、動作軸間の影響を把握することができる。
なお、図6では電動機制御系が2つであるが、いくつであってもよい。
【0018】
<第7実施形態>
図7は第7実施形態の構成を示すブロック図である。この図は、図6の閉ループ制御器71,72の後段にフィルタ処理部81,82を追加挿入して設けた構成になっており、フィルタ処理部131,132は外部から指令を与えてフィルタ特性を変えることができるようになっている。第6実施形態と同様にして信号処理器61が共振周波数を検出し、その共振周波数検出結果f1,f2をフィルタ処理部131,132に入力すると、その入力に応じてフィルタ処理部131,132が設定され、共振周波数の帯域の特性を抑えるフィルタとすることができる。共振周波数が検出できれば、共振周波数検出結果f1,f2をもとにフィルタ処理部131,132の設定値を自動的に決定できる。共振周波数は第1実施形態から第6実施形態のいずれかと同様にして検出できる。
この第7実施形態においては、指令発生器11から指令信号に従って駆動される各電動機31,32の電動機動作量m1,m2を検出し、各信号処理器61,62に各信号を入力することにより、機械41の共振周波数と機械41に影響を与える機械42の共振周波数を検出することが可能となる。さらに、各電動機動作量m1,m2の和を1つの信号処理器61に入力することにより、動作軸間の影響を把握することができる。
なお、この実施形態では指令信号Cをフィルタ処理部131,132と制御器21,22の間に設けた加算器の一方を入力としたが、閉ループ制御器71,72の前段に設けた減算器の(+)端子に入力してもよい。
また、図7では電動機制御系が2つであるが、いくつであってもよい。
【0019】
<第8実施形態>
図8は第8実施形態の構成を示すブロック図であり、図7の閉ループ制御器71,72と、その前段の減算器付近の構成を変えた構成になっている。閉ループ制御器7B1,7B2は、減算器、位置制御器91,92、加算器、速度制御器101,102、速度演算器111,112から構成されている。この図で位置制御器91,92の前段にある減算器の(+)端子には、大きさが0の動作指令Mを与えており、これによって位置ずれしないで共振周波数の検出が行なわれる。閉ループ制御器7B1,7B2では、電動機動作量m1,m2を検出して得られた応答信号S1,S2が、減算器を経由して位置制御器91,92に入力され、同時に、速度演算器111,112を経由して速度制御器101,102に入力される。そして速度制御器101,102は位置制御器91,92の出力と一致するように制御し、位置制御器91,92は電動機動作量m1,m2の位置が動作指令Mの0位置と一致するように制御する。共振周波数は第1実施形態から第6実施形態のいずれかと同様にして検出できる。
この第8実施形態においては、指令発生器11から指令信号に従って駆動される各電動機31,32の電動機動作量m1,m2を検出し、各信号処理器61,62に各信号を入力することにより、機械41の共振周波数と機械41に影響を与える機械42の共振周波数を検出することが可能となる。さらに、各電動機動作量m1,m2の和を1つの信号処理器61に入力することにより、動作軸間の影響を把握することができる。
なお、図8では電動機制御系が2つであるが、いくつであってもよい。
【0020】
図9は第7および第8実施形態の共振周波数検出装置で検出した共振周波数に基づいてフィルタ処理部131,132のフィルタ特性を設定し、その後、設定したフィルタ処理部131,132のフィルタ特性を生かして通常の運転をしているときの構成を示すブロック図である。この制御系で動作指令Mを入力すると、閉ループ制御器71,72は、電動機動作量m1,m2と動作指令Mが一致するように制御し、共振を抑えるフィルタ処理部131,132がうまく機能して電動機動作量m1,m2と動作指令Mがより一致しやすくなっている。
なお、図9の構成と図7の構成は、スイッチを設けて切り替えられるようにしてもよい。また、図5、図6、図7、図9では閉ループ制御器71,72を1つの制御器として示したが、図8の閉ループ制御器7B1,7B2の構成のように位置制御器91,92、速度演算器111,112、速度制御器101,102を含む構成としてもよい。また、機械の動作量が指令信号と一致するように電動機31,32の動作を検出器51,52が検出した応答信号S1,S2に基づき制御するのであれば、内部構成を変更した閉ループ制御器71,72でもよい。フィルタ処理部81,82や制御器21,22を含めて順番や構成を変更してもよい。
また、図9の例では電動機制御系が2つであるが、いくつであってもよい。
【0021】
<第9実施形態>
図10は第9実施形態を示すブロック図であり、指令発生器11から出力される周波数情報Aが信号処理器61に入力するように配置した点と、信号処理器61の計算方法が図1に示した第1実施形態と異なっている。
スイッチ151がoffの時は、信号処理器61は掃引正弦波指令の周波数情報Aと応答信号S1を受け取り、スイッチ151がonの時は、信号処理器61は掃引正弦波指令の周波数情報Aと応答信号S1,S2を受け取り、最小周波数Fminを過ぎた検出最小下限周波数Flimから共振周波数の検出のための演算を行う。検出最小下限周波数Flim以上で、図11のように、応答信号S1,S2の絶対値が最大となるときの掃引正弦波の周波数を共振周波数と判断して共振周波数検出結果f1,f2を出力する。
【0022】
図12は掃引正弦波の周波数と時間の関係を示すグラフである。t0からte間の時間中、最小周波数Fminから検出最小下限周波数Flimを経て、最大周波数Fmaxまで周波数が変化する掃引正弦波指令を指令信号Cとなる。信号処理器61は検出最小下限周波数Flimより高い周波数となる時間tsからte間において、共振周波数の検出を実施する。なお、掃引正弦波の周波数と時間の関係は、直線に限られることは無く、任意の曲線であっても構わない。また、検出最小下限周波数Flimを最小周波数Fminと同様に取り扱っても構わない。
信号処理器61は、2つ以上の応答信号を加算し、1つの応答信号にすることができる。
なお、図10では電動機制御系が2つであるが、いくつであってもよい。
【0023】
<第10実施形態>
図13は第10実施形態の構成を示すブロック図である。図において、141,142はハイパスフィルタ手段である。指令信号Cが制御器21に、周波数情報Aが信号処理器61に入力するように設け、検出器51,52が電動機動作量m1,m2を検出し、これを応答信号S1,S2として、ハイパスフィルタ手段141,142を経由して信号処理器61,62に送る点が図1に示した第1実施形態と異なっている。
なお、この実施形態では信号処理器61は検出最小下限周波数Flim以上という条件を付けなかったが、第8実施形態と同様に、検出最小下限周波数Flim以上で、応答信号の絶対値が最大となるときの掃引正弦波の周波数を共振周波数と判断して出力してもよい。
この第10実施形態においては、指令発生器11から指令信号に従って駆動される各電動機31,32の電動機動作量m1,m2を検出し、各信号処理器61,62に各信号を入力することにより、機械41の共振周波数と機械41に影響を与える機械42の共振周波数を検出することが可能となる。さらに、各電動機動作量m1,m2の和を1つの信号処理器61に入力することにより、動作軸間の影響を把握することができる。
また、図13では、電動機制御系が2つであるが、いくつであってもよい。
なお、第1実施形態から第10実施形態では、検出器51,52,53は電動機31,32,33に連結して電動機動作量m1,m2,m3を検出しているが、検出器51,52,53を機械41,42、43に連結して機械動作量x1,x2,x3を直接検出してもよい。
【0024】
【発明の効果】
以上述べたように、本発明によれば、指令発生器からの指令信号に従って駆動される各電動機の動作量を検出し、信号処理器にその信号の和を入力するようにしたので、複数軸を持つ機械において、動作軸と動作軸に影響を及ぼす他軸の共振周波数を検出することができる。
また、共振周波数を検出すると共に、フィルタ処理部を設け、共振周波数を抑えるフィルタ処理入力値を自動入力して設定することにより、自動的に電動機制御装置の性能を向上することができる。
【図面の簡単な説明】
【図1】本発明の第1実施形態に係る共振周波数検出装置の構成を示すブロック図である。
【図2】本発明の第2実施形態の構成を示すブロック図である。
【図3】本発明の第3実施形態の構成を示すブロック図である。
【図4】本発明の第4実施形態の構成を示すブロック図である。
【図5】本発明の第5実施形態の構成を示すブロック図である。
【図6】本発明の第6実施形態の構成を示すブロック図である。
【図7】本発明の第7実施形態の構成を示すブロック図である。
【図8】本発明の第8実施形態の構成を示すブロック図である。
【図9】本発明の第9実施形態の構成を示すブロック図である。
【図10】指令発生器が生成する指令信号の時間波形図である。
【図11】本発明を適用した掃引正弦波の周波数と時間の関係を示すグラフである。
【図12】本発明の第10実施形態の構成を示すブロック図である。
【図13】フィルタ設定後の構成を示すブロック図である。
【図14】従来技術を適用した電動機制御系の構成を示すブロック図である。
【符号の説明】
11,12:指令発生器
21,22,23:制御器
31,32,33:電動機
41,42,43:機械
51,52,53:検出器
61,62,63:信号処理器
71,72,7B1,7B2:閉ループ制御器
81,82:出力装置
91,92:速度制御器
101,102:位置制御器
111,112:速度演算器
121,122:FFTアナライザ
131,132:フィルタ処理部
141,142:ハイパスフィルタ
Claims (12)
- 複数軸を有する機械の一つの軸を駆動する電動機と、制御指令を受けて前記電動機を駆動する制御器とを有する電動機制御系を前記機械の複数軸についてそれぞれ備え、各電動機制御系に、前記機械の動作量を検出する検出器と、前記検出器の信号を周波数分析し、共振周波数として出力する信号処理器と、前記信号処理器の信号をグラフ化または数値化して出力する出力装置とを備えた多軸電動機制御装置の共振周波数検出装置において、
前記機械に振動を伝える制御指令を前記電動機制御系の少なくとも一方に与える少なくとも1つの指令発生器を設け、前記複数の検出器の信号を前記複数の信号処理器に入力して共振周波数として出力するようにしたことを特徴とする多軸電動機制御装置の共振周波数検出装置。 - 前記信号処理器は、前記複数の検出器の信号を入力して、信号の和を共振周波数として出力するようにしたことを特徴とする請求項1記載の多軸電動機制御装置の共振周波数検出装置。
- 前記検出器は電動機の位置または速度、あるいは前記機械の可動部の位置または速度を検出するものであることを特徴とする請求項1または2に記載の多軸電動機制御装置の共振周波数検出装置。
- 前記複数の電動機制御系の一部または全てがオープンループの場合には、前記指令発生器の信号は当該オープンループの電動機制御系の制御器に入力されることを特徴とする請求項1から3のいずれかの項に記載の多軸電動機制御装置の共振周波数検出装置。
- 前記複数の電動機制御系の一部または全てにおいて、前記指令発生器からの制御指令と前記検出器からの前記機械の動作量との偏差に応じた制御指令を前記制御器に与える閉ループ制御器を備えたことを特徴とする請求項1から3のいずれかの項に記載の多軸電動機制御装置の共振周波数検出装置。
- 前記電動機制御系の一部または全てにおいて、前記検出器からの前記機械の動作量と動作指令との偏差に応じた制御指令を出力する閉ループ制御器と、その制御指令に含まれる所定の帯域の信号を低減するフィルタ処理部とを備え、前記フィルタ処理部の出力と前記指令発生器からの指令信号との和が前記制御器に入力されていることを特徴とする請求項1から3のいずれかの項に記載の多軸電動機制御装置の共振周波数検出装置。
- 前記制御指令は、掃引正弦波信号であり、前記信号処理器は前記指令発生器が出力する前記掃引正弦波信号の周波数情報と少なくとも1つ前記検出器の信号を入力し、前記検出器の信号の絶対値が最大となる前記正弦波信号の周波数を共振周波数として出力するものであることを特徴とする請求項1から6のいずれかの項に記載の多軸電動機制御装置の共振周波数検出装置。
- 前記出力装置は、少なくとも1つの前記信号処理器の信号を周波数特性として出力するものであることを特徴とする請求項1から7のいずれかの項に記載の多軸電動機制御装置の共振周波数検出装置。
- 前記指令発生器から機械に振動を伝える制御指令は、最小周波数Fminから最大周波数Fmaxまでの範囲に周波数が制限されており、前記信号処理器は、前記検出器の信号を所定の周波数範囲に制限して入力するとともに、前記最小周波数Fmin以上の周波数だけを検出することを特徴とする請求項1から8のいずれかの項に記載の多軸電動機制御装置の共振周波数検出装置。
- 前記指令発生器から機械に振動を伝える制御指令は、最小周波数Fminから最大周波数Fmaxまでの範囲に周波数が制限されており、前記信号処理器は、前記検出器の信号を所定の周波数範囲に制限して入力するとともに、前記最小周波数Fminより大きい検出最小周波数Flim以上の周波数だけを検出することを特徴とする請求項1から8のいずれかの項に記載の多軸電動機制御装置の共振周波数検出装置。
- 前記検出器と前記信号処理器の間にハイパスフィルタが設けられていることを特徴とする請求項1から10のいずれかの項に記載の多軸電動機制御装置の共振周波数検出装置
- ある軸の前記検出器の信号を他軸の信号処理器に入力するスイッチが設けられていることを特徴とする請求項1から11のいずれかの項に記載の多軸電動機制御装置の共振周波数検出装置。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003001939A JP4396100B2 (ja) | 2003-01-08 | 2003-01-08 | 多軸電動機制御装置の共振周波数検出装置 |
KR1020057012792A KR20050096931A (ko) | 2003-01-08 | 2003-12-15 | 다축 전동기 제어 장치의 공진 주파수 검출 장치 |
US10/541,571 US7075263B2 (en) | 2003-01-08 | 2003-12-15 | Multi-axis motor control device resonance frequency detection device |
PCT/JP2003/016060 WO2004064239A1 (ja) | 2003-01-08 | 2003-12-15 | 多軸電動機制御装置の共振周波数検出装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003001939A JP4396100B2 (ja) | 2003-01-08 | 2003-01-08 | 多軸電動機制御装置の共振周波数検出装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2004215455A true JP2004215455A (ja) | 2004-07-29 |
JP4396100B2 JP4396100B2 (ja) | 2010-01-13 |
Family
ID=32708839
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2003001939A Expired - Fee Related JP4396100B2 (ja) | 2003-01-08 | 2003-01-08 | 多軸電動機制御装置の共振周波数検出装置 |
Country Status (4)
Country | Link |
---|---|
US (1) | US7075263B2 (ja) |
JP (1) | JP4396100B2 (ja) |
KR (1) | KR20050096931A (ja) |
WO (1) | WO2004064239A1 (ja) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009015448A (ja) * | 2007-07-02 | 2009-01-22 | Fanuc Ltd | 制御装置 |
JP2014233147A (ja) * | 2013-05-29 | 2014-12-11 | 三菱電機株式会社 | モータ制御システムおよびモータ制御方法 |
CN110347115A (zh) * | 2018-04-08 | 2019-10-18 | 华中科技大学 | 主轴共振转速在线检测和优化的方法及系统 |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7541766B1 (en) * | 2004-06-01 | 2009-06-02 | Sato Jeffrey S | System and method for the intelligent use of software deadband control in a control system |
DE502005004724D1 (de) * | 2005-02-04 | 2008-08-28 | Trumpf Werkzeugmaschinen Gmbh | Verfahren zur Bewegungsaufteilung einer Relativbewegung zwischen einem Werkstück und einem Werkzeug einer Werkzeugmaschine |
JP6469071B2 (ja) * | 2016-12-26 | 2019-02-13 | 株式会社Subaru | 車両の制動制御装置 |
Family Cites Families (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5048552A (en) * | 1990-06-28 | 1991-09-17 | Bourne Douglas A | Universal trip valve operators and trip actuating seismic vibration sensors and transducers therefor |
JP2744731B2 (ja) | 1992-05-07 | 1998-04-28 | 山洋電気株式会社 | サーボ系のノッチフィルタ自動調整方法及び装置 |
JP2869281B2 (ja) * | 1993-02-12 | 1999-03-10 | 株式会社神戸製鋼所 | モータ駆動系の制御装置 |
JP2616746B2 (ja) * | 1995-06-12 | 1997-06-04 | 日本電気株式会社 | 磁気ディスク装置 |
JPH10210781A (ja) * | 1997-01-24 | 1998-08-07 | Yaskawa Electric Corp | モータ制御装置 |
US6326758B1 (en) * | 1999-12-15 | 2001-12-04 | Reliance Electric Technologies, Llc | Integrated diagnostics and control systems |
JP4273560B2 (ja) * | 1999-03-23 | 2009-06-03 | パナソニック株式会社 | モータの制御装置 |
DE19983362T1 (de) * | 1999-05-14 | 2001-08-16 | Mitsubishi Electric Corp | Servosteuervorrichtung |
US6250146B1 (en) * | 1999-09-14 | 2001-06-26 | Cleveland Motion Controls, Inc. | Web tension transducer apparatus |
JP2001157478A (ja) * | 1999-11-19 | 2001-06-08 | Yaskawa Electric Corp | モータ制御装置 |
EP1283593B1 (en) * | 2000-04-20 | 2009-08-05 | Kabushiki Kaisha Yaskawa Denki | Motor controller |
US6831804B2 (en) * | 2000-06-20 | 2004-12-14 | Seagate Technology Llc | Method and apparatus for handling resonance effects in disc drives using active damping |
JP2002171778A (ja) | 2000-09-25 | 2002-06-14 | Aisin Seiki Co Ltd | 電動モータの振動抑制制御装置及び電動モータの振動抑制制御における設計手法 |
JP2002175101A (ja) * | 2000-09-28 | 2002-06-21 | Yaskawa Electric Corp | サーボ系のパラメータ設計方法 |
JP2002304219A (ja) * | 2001-04-04 | 2002-10-18 | Yaskawa Electric Corp | モータ制御装置およびメカ特性測定方法 |
JP2003241535A (ja) * | 2002-02-20 | 2003-08-29 | Ricoh Co Ltd | ベルト移動装置および該装置を備えた画像形成装置 |
US6936990B2 (en) * | 2002-03-29 | 2005-08-30 | Matsushita Electric Industrial Co., Ltd. | Method for controlling electric motor and apparatus for controlling the same |
-
2003
- 2003-01-08 JP JP2003001939A patent/JP4396100B2/ja not_active Expired - Fee Related
- 2003-12-15 US US10/541,571 patent/US7075263B2/en not_active Expired - Fee Related
- 2003-12-15 WO PCT/JP2003/016060 patent/WO2004064239A1/ja active Application Filing
- 2003-12-15 KR KR1020057012792A patent/KR20050096931A/ko not_active Application Discontinuation
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009015448A (ja) * | 2007-07-02 | 2009-01-22 | Fanuc Ltd | 制御装置 |
US7808199B2 (en) | 2007-07-02 | 2010-10-05 | Fanuc Ltd | Control apparatus |
JP2014233147A (ja) * | 2013-05-29 | 2014-12-11 | 三菱電機株式会社 | モータ制御システムおよびモータ制御方法 |
CN110347115A (zh) * | 2018-04-08 | 2019-10-18 | 华中科技大学 | 主轴共振转速在线检测和优化的方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
US20060108961A1 (en) | 2006-05-25 |
WO2004064239A1 (ja) | 2004-07-29 |
JP4396100B2 (ja) | 2010-01-13 |
US7075263B2 (en) | 2006-07-11 |
KR20050096931A (ko) | 2005-10-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Contreras-Medina et al. | FPGA-based multiple-channel vibration analyzer for industrial applications in induction motor failure detection | |
JP3975812B2 (ja) | 電動機制御装置の共振周波数検出装置 | |
US20080186194A1 (en) | Dynamic condition monitoring system employing a multi-core processor | |
CN111721567A (zh) | 一种电机动态转矩波动的测试方法及测试系统 | |
US7532951B2 (en) | Method of automatically setting vibration suppression filter | |
JP2004215455A (ja) | 多軸電動機制御装置の共振周波数検出装置 | |
JP2010051061A (ja) | サーボ解析機能を備えたシミュレーションシステム | |
CN113806876B (zh) | 机器人的状态判断方法及装置 | |
JP2006197726A (ja) | 位置決め制御装置および位置決め制御方法 | |
CN105262402B (zh) | 无刷直流电机转矩波动检测系统 | |
CN107992109A (zh) | 全闭环定位控制系统及方法 | |
WO2013135138A1 (zh) | 一种利用伺服驱动器测定机械共振频率的方法 | |
Usynin et al. | Pulse-vector control with indirect determination of rotor angular position | |
JP4664576B2 (ja) | サーボ制御装置 | |
Eriksson et al. | Rapid prototyping:-development and evaluation of Field Oriented Control using LabView FPGA | |
CN109002062A (zh) | 伺服电动机控制装置 | |
CN118157520B (zh) | 电机定子的调整方法、调整装置及调整工装 | |
JP2005278349A (ja) | 電動機制御装置 | |
CN106814316A (zh) | 微型电机的抖动检测处理系统及方法 | |
JP2003061379A (ja) | モータ制御装置の周波数特性演算装置 | |
JP3226831B2 (ja) | 磁石解析装置 | |
CN116879717A (zh) | 旋变模型电路及测试方法 | |
Zanardelli et al. | Failure prognosis for permanent magnet ac machines based on time-frequency analysis | |
CN115102445A (zh) | 一种电机驱动方法、装置、电机系统和存储介质 | |
JP2000084875A (ja) | 多軸コントローラ |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20051206 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20081216 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20090210 |
|
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: 20090929 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20091012 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121030 Year of fee payment: 3 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121030 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20131030 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20141030 Year of fee payment: 5 |
|
LAPS | Cancellation because of no payment of annual fees |