(57)【要約】【課題】  手動調整を行わなくとも、機械振動を最小限に抑え、目標応答および外乱応答特性を最適に調整できるモータ制御装置と制御方法を提供する。【解決手段】  モータ速度またはトルクを基に振動信号を生成する機械振動信号生成部９と、設定された基準機械振動を超えたか判定する機械振動検出部１０と、振動を検出した場合は、機械振動振動信号を所定サンプリング時間で一定時間データを蓄積し、周波数解析をして振動周波数を検出する振動周波数検出部１１と、設定された位置決め完了幅、許容オーバーシュート量および整定時間などから位置決め条件を生成し、位置決め条件を満足するか判定する位置決め判定部１３と、振動を監視し１つのパラメータの値を基に速度制御ゲイン、積分ゲインを調整する速度制御調整部１２と、位置決め条件を満足する範囲でフィードフォワード部の調整ゲインを調整するフィードフォワード調整部１４とを備えた。 【選択図】図１
2006254630.tif 000002
【特許請求の範囲】
【請求項１】
機械の位置を制御する位置制御部と、速度を制御する速度制御部と、前記速度制御部が生成するトルク指令に対し、特定の周波数成分を除去するノッチフィルタを有するトルクフィルタ部と、外乱特性を変更しないまま目標応答特性を変更するフィードフォワード部と、を備えたモータ制御装置において、  
モータの速度または、トルクを基に機械振動信号を生成する機械振動信号作成部と、
予め設定された基準機械振動を超えたか否かを判定する機械振動検出部と、
前記機械振動検出部にて機械振動を検出した場合には、機械振動振動信号を所定のサンプリング時間で一定時間データを蓄積し、蓄積したデータを周波数解析して振動周波数を検出する振動周波数検出部と、
予め設定された位置決め完了幅、許容オーバーシュート量および整定時間から位置決め条件を生成し、位置決め動作毎に前記位置決め条件を満足するか否かを判定する位置決め判定部と、
前記機械振動検出部にて機械振動を監視しながら１つのパラメータＫｇを期待する応答周波数に設定すると、速度制御ゲインは前記パラメータＫｇに等しく、速度制御積分ゲインは前記パラメータＫｇの１／４に自動的に調整する速度制御調整部と、
前記位置決め条件を満足する範囲で前記フィードフォワード部の目標応答特性調整ゲインを調整するフィードフォワード調整部と、
を備えることを特徴とするモータ制御装置。 
【請求項２】
機械の位置を制御する位置制御部と、速度を制御する速度制御部と、前記速度制御部が生成するトルク指令に対し、特定の周波数成分を除去するノッチフィルタとを有するトルクフィルタ部と、外乱特性を変更しないまま目標応答特性を変更するフィードフォワード部と、を備えたモータ制御装置のモータ制御方法において、
速度または、トルクを基に作成された機械振動信号が予め設定された基準機械振動を超えたか否かを判定するステップと、
機械振動振動信号を所定のサンプリング時間で一定時間データを蓄積し、蓄積したデータを周波数解析して振動周波数を検出するステップと、
予め設定された位置決め完了幅、許容オーバーシュート量および整定時間から作成された位置決め条件を位置決め動作毎に満足するか否かを判定するステップと、
１つのパラメータＫｇの値を基に速度制御ゲインを前記パラメータＫｇに等しく、速度制御積分ゲインを前記パラメータＫｇの１／４に自動的に調整するステップと、
位置決め動作を繰り返し実行し、機械振動を監視しながら前記パラメータＫｇを上昇させ、前記検出された振動周波数を基に前記ノッチフィルタを設定して更に前記パラメータＫｇを上昇させて速度制御ゲイン、速度制御積分ゲインを調整するステップと、
速度制御部調整後、前記位置決め条件を満足する範囲で前記フィードフォワード部の目標応答特性調整ゲインを上昇するステップと、
を備えることを特徴とするモータ制御方法。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、制御パラメータの自動調整が可能なモータ制御装置およびその制御方法に関する。
【背景技術】
【０００２】
自動的に制御ゲインやノッチフィルタなどの制御パラメータを調整する装置の従来例として、特許文献１がある。
従来の技術のモータ制御装置について図３を用いて説明する。図３において、１０１は目標位置に対して位置を制御する位置制御部、１０２は速度指令に対し速度を制御する速度制御部、１０３は特定の周波数成分を除去するノッチフィルタ有するトルクフィルタ部、１０４はトルク指令に従ってモータを駆動する駆動部、１０５はモータ、１０６はモータによって駆動される機械、１０７はモータの位置を検出する位置検出器、３０１は位置偏差を変数とする評価関数による応答判断部、３０２はワンパラメータチューニング部であり、応答判断部３０１から出力される制御パラメ−タＫｇ、ノッチ周波数およびノッチフィルタ帯域幅を入力し、位置制御部１０１、速度制御部１０２およびトルクフィルタ部１０３に最適な制御パラメ−タを設定する。ここで最適なパラメータは例えば特許文献２で提案している方法で設定すればよい。図４は特許文献２に開示されているブロック図で、５１０はワンパラメータチューニング部、５１１は指令発生部、５１２は位置制御部、５１３はトルクフィルタ部、５１４は電流制御部、５１５はモータ、５１６は検出器、５１７はメカ部である。構成としては特許文献１とほぼ同じである。また、図５はワンパラメータチューニングの詳細を示す図で、図４のワンパラメータチューニング部５１０では制御パラメータ選定信号を入力し、判定器５３１ で、ユーザが希望する目標応答周波数ω fから決定する手段５３２と、負荷イナーシャ値J Lと目標応答周波数ω fから決定する手段５３３ と、メカ特性である共振周波数ωＨ及び反共振周波数ω Lと目標応答周波数ω fから決定する手段５３４の選択を行う。
ユーザが希望する目標応答周波数ω fから決定する手段が選ばれた場合は、目標応答周波数ω fを入力し、メインパラメータk gをk g =ω f、補助ゲインk pをk p = 3、補助ゲインk dをk d = 3、補助ゲインk iをk i = 1、トルクフィルタ定数t f をt f = 1 / (ω f *4 )、電流ループゲインk aをk a =ω f * 4、電流積分時定数t aをt a = 1 /ω f、前記時定数t vのローパスフィルタをt v = 2 0 . 5 / (ω f * 4 )、と設定し、演算により算出された制御パラメータを出力する。
負荷イナーシャ値J Lと目標応答周波数ω fから決定する手段が選ばれた場合は、モータイナーシャJ Mとの比から求めたイナーシャ補正ゲインJ C O M = ( ( J L + J M ) / J M )0 . 5 を用いて、前記メインパラメータk gをk g =ω f / J C O M、補助ゲインk pをk p = 3、補助ゲインk dをk d =3、補助ゲインk iをk i = 1、トルクフィルタ定数t fをt f = 1 / (ω f * 4 ) * J C O M、電流ループゲインk aをk a =ω f * 4 / J C O M、電流積分時定数t aをt a = 1 /ω f * J C O M、時定数t vのローパスフィルタをt v = 2 0 . 5 / (ω f * 4 ) * J C O M、と設定し、演算により算出された制御パラメータを出力する。メカ特性である共振周波数ω H及び反共振周波数ω Lと目標応答周波数ω fから決定する手段が選ばれた場合は、メカの共振周波数ω H及び反共振周波数ω Lと目標応答周波数ω fを入力し、モータ側イナーシャJ 1をJ 1 - = ( J M + J L ) * (ω L /ω H ) ２ / J Mと表し、メインパラメータk gをk g =ω f / J 1、補助ゲインk pをk p = 3、補助ゲインk dをk d = 3、補助ゲインk iをk i = 1、トルクフィルタ定数t fをt f = 1 / (ω f * 4 ) * J 1、電流ループゲインk aをk a =ω f * 4 / J 1、電流積分時定数t aをt a = 1 /ω f * J 1、時定数t vのローパスフィルタをt v = 2 0 . 5 / (ω f * 4 ) * J 1、と設定し、上記演算により算出された制御パラメータを出力する。以上の制御パラメータは安定条件と実験を繰り返すことにより決定される。例えば、メインパラメータと補助ゲインk p、k i、k dは、速度フィルタとトルクフィルタを適用せず、電流制御部とモータを１ / J S ２とおき、位置指令からモータ位置までの伝達関数の分母を３重根条件で解いて決定される。なお、それぞれの制御パラメータの整合を重根条件で解かれているが、安定条件を満たす範囲で解いて制御パラメータを設定すれば良い。また、１つのパラメータで８つの制御パラメータを自動的に決定できることに加えて、負荷のイナーシャの大きさや、メカ特性である反共振周波数と共振周波数を用いて、制御パラメータの設定指針を自動的に変更し、最適な制御パラメータを得る事ができるというものである。このように、従来の技術では、評価関数を用いて応答を診断し、位置制御部、速度制御部およびトルクフィルタ部の制御ゲインを１つのパラメ-タで自動的に設定する。また、振動がある場合は、評価関数が最小となるようにノッチ周波数を探索することでノッチフィルタを設定する。
【特許文献１】特開２００３−９５６２号（第４−５頁、図２）
【特許文献２】特許第３５５０６５７号公報
【発明の開示】
【発明が解決しようとする課題】
【０００３】
しかしながら、従来の技術では、評価関数によって、ノッチフィルタ周波数を探索するため、探索中、振動が持続してしまい、最悪の場合、機械にダメージを与えてしまう恐れがあった。また、フィードフォワード部の調整を行っていないため、目標応答特性の調整は、別途、手動調整を行なわなければならないという問題点があった。
本発明はこのような問題点に鑑みてなされたものであり、手動調整を行わなくとも、機械振動を最小限に抑え、目標応答および外乱応答特性を最適に調整できるモータ制御装置と制御方法を提供することを目的とする。
【課題を解決するための手段】
【０００４】
上記問題を解決するため、本発明は、次のようにしたのである。
請求項１に記載の発明は、モータまたは機械系の位置を制御する位置制御部と、モータまたは機械系の速度を制御する速度制御部とモータへのトルク指令に対し、特定の周波数成分を除去するノッチフィルタとを有するトルクフィルタ部と、外乱特性を変更しないまま、モータまたは機械系の目標応答特性を変更するフィードフォワード部とを備えたサーボモータ制御装置において、モータの速度または、トルクを基に機械振動信号を作成する機械振動信号作成部と、予め設定された基準機械振動を超えたか否かを判定する機械振動検出部と、前記機械振動検出部にて機械振動を検出した場合には、機械振動振動信号を所定のサンプリング時間で一定時間データを蓄積し、蓄積したデータを周波数解析して振動周波数を検出する振動周波数検出部と、予め設定された位置決め完了幅、許容オーバーシュート量および整定時間から位置決め条件を作成し、位置決め動作毎に前記位置決め条件を満足するか否かを判定する位置決め判定部と前記機械振動検出部にて機械振動を監視しながら１つのパラメータＫｇの値を期待する応答周波数に設定すると、速度制御ゲインは前記パラメータＫｇに等しく、速度制御積分ゲインは前記パラメータＫｇの１／４に自動的に調整する速度制御調整部と前記位置決め条件を満足する範囲で前記フィードフォワード部の目標応答特性調整ゲインを調整するフィードフォワード調整部を有することを特徴とするものである。
【０００５】
請求項２に記載の発明は、モータまたは機械系の位置を制御する位置制御部と、モータまたは機械系の速度を制御する速度制御部とモータへのトルク指令に対し、特定の周波数成分を除去するノッチフィルタとを有するトルクフィルタ部と、外乱特性を変更しないまま、モータまたは機械系の目標応答特性を変更するフィードフォワード部とを備えたモータ制御装置の制御方法において、モータの速度または、トルクを基に作成された機械振動信号が予め設定された基準機械振動を超えたか否かを判定するステップと、機械振動振動信号を所定のサンプリング時間で一定時間データを蓄積し、蓄積したデータを周波数解析して振動周波数を検出するステップと、予め設定された位置決め完了幅、許容オーバーシュート量および整定時間から作成された位置決め条件を位置決め動作毎に満足するか否かを判定するステップと１つのパラメータＫｇの値を基に速度制御ゲインを前記パラメータＫｇに等しく、速度制御積分ゲインを前記パラメータＫｇの１／４に自動的に調整するステップと、位置決め動作を繰り返し実行し、機械振動を監視しながら前記パラメータＫｇを上昇させ、前記検出された振動周波数を基に前記ノッチフィルタを設定して更に前記パラメータＫｇを上昇させて速度制御ゲイン、速度制御積分ゲインを調整するステップと、速度制御部調整後、前記位置決め条件を満足する範囲で前記フィードフォワード部の目標応答特性調整ゲインを上昇するという手順を取ったものである。
【発明の効果】
【０００６】
本発明によると、手動調整を行わなくとも、機械振動を最小限に抑え、目標応答および外乱応答特性を最適に調整できるモータ制御装置と制御方法を提供することができる。
【発明を実施するための最良の形態】
【０００７】
以下、本発明の方法の具体的実施例について、図に基づいて説明する。
【実施例１】
【０００８】
図１は、本発明を実現する制御ブロック図である。図１において１は目標位置に対してモータの位置を制御する位置制御部、２は速度指令に対しモータの速度を制御する速度制御部、３は特定の周波数成分を除去するノッチフィルタ有するトルクフィルタ部、４はトルク指令に従ってモータを駆動する駆動部、５はモータ、６はモータによって駆動される機械系、７はモータの位置を検出する位置検出器、８は目標位置を基に位置制御部および速度制御部にフィードフォワード信号を入力するフィードフォワード部、９はトルク指令とモータ速度を基に機械振動信号を作成する機械振動信号作成部、１０は機械振動信号と予め設定された基準振動レベルを比較し、機械振動を検出する機械振動検出部、１１は機械振動信号を所定のサンプリング時間で一定時間データを蓄積し、蓄積したデータを周波数解析して振動周波数を測定する振動周波数検出部、１２は機械振動を監視しながら１つのパラメータＫｇの値を上昇し、速度制御ゲインおよび速度制御積分ゲインを調整する。ここで，パラメータＫｇは，目標とする応答周波数ωfに対してＫｇ＝ωfとなるパラメータであり，Ｋｇを調整することによって，式（１）および式（２）により速度制御ゲインＫｖおよび速度制御積分ゲインＫｉが同時に調整される。これは，速度指令から速度フィードバックまでの伝達関数の分母を重根となる条件から決定される。
Ｋｖ＝Ｋｇ                                                （１）
Ｋｉ＝Ｋｇ／４                                            （２）  
更に、検出された振動周波数を基にノッチフィルタ調整を行う速度制御調整部、１３は目標位置およびモータ位置から予め設定された位置決め完了幅から逸脱しないか、あるいは許容オーバーシュート量以内であるか、また整定時間から位置決め条件を作成し、位置決め条件を満足しているかを判定する位置決め判定部、１４は位置決め条件を満足する範囲で目標応答特性調整ゲインを調整するフィードフォワード調整部である。
【０００９】
図２は、本発明の方法を示す調整手順のフローチャートである。
図２において、まず、パラメータＫｇを初期値に設定する（ステップ１）。ここで初期値には、動作しても発振しない程度の小さいＫｇとする。次に、運転を開始した後、１０の振動検出部にて振動検出を行い、振動したか否かを判定する（ステップ２）。次に振動を検出した場合は、ノッチフィルタが既に有効であるかを判別し、ノッチフィルタが無効である場合は、１１の振動周波数検出部にて検出された振動周波数をノッチフィルタの中心周波数に設定する（ステップ３）。ノッチフィルタが既に有効の場合は、Ｋｇを所定量小さくする（ステップ４）。またステップ２にて振動検出されなかった場合は、Ｋｇを調整最大値まで所定量ずつ大きくする（ステップ５）。
なお、パラメータＫｇは，目標とする応答周波数ωfと同義であるから，パラメータＫｇを大きくすると、速度制御ゲインＫｖ、速度制御積分ゲインＫｉともに上昇し、外乱特性が向上するような調整となる。
ステップ４にてＫｇを下げた後、目標応答特性の調整を行う。まず、目標応答特性調整ゲインを初期化する（ステップ６）。次に位置決め条件を満足するか否かを判定する（ステップ７）。ここで位置決め条件は、位置決め完了幅を逸脱し、振動していないか？オーバーシュート量が所定値以内か？または、整定時間が短縮されたか？の少なくとも１つ以上の条件とする。次に。位置決め条件が満足された場合、目標応答特性調整ゲインを調整最大値まで所定量ずつ大きくする（ステップ８）。また、ステップ７にて位置決め条件が不満足となった場合は、目標応答特性調整ゲインを所定量小さくし（ステップ９）、調整を終了する。
【産業上の利用可能性】
【００１０】
本発明のモータ制御装置と制御方法は、ノッチフィルタ設定時間が短縮され、不要な機械振動を起さないために、一般産業機械だけではなく、ロボットや工作機械への適用が期待できる。
【図面の簡単な説明】
【００１１】
【図１】本発明のサーボ調整装置の構成を示す制御ブロック図
【図２】本発明の調整方法の処理手順を示すフローチャート
【図３】従来のモータ制御装置（特許文献１）の構成を示すブロック図
【図４】従来のモータ制御装置（特許文献２）の構成を示すブロック図
【図５】従来のモータ制御装置（特許文献２）の１パラメータチューニングの詳細を示した図。
【符号の説明】
【００１２】
１  位置制御部
２  速度制御部
３  トルクフィルタ部
４  駆動部
５  モータ
６  機械系
７  位置検出器
８  フィードフォワード部
９  機械振動信号作成部
１０  機械振動検出部
１１  振動周波数検出部
１２  速度制御調整部
１３  位置決め判定部
１４  フィードフォワード調整部
３０１  応答判断部
３０２  ワンパラメータチューニング部
【図１】
2006254630.tif 000003
【図２】
2006254630.tif 000004
【図３】
2006254630.tif 000005
【図４】
2006254630.tif 000006
【図５】
2006254630.tif 000007