JP5362339B2 - モータ制御装置 - Google Patents

Description

本発明はモータ制御装置及びその設計方法に関する。

多慣性共振特性を有する機械装置をモータによって駆動する場合の速度制御器は、従来のＰＩ（比例積分）制御器を用いるだけでは機械装置の反共振特性や共振特性による振動が発生するという問題や、高周波数領域においてトルク制御系やモータ位置又は速度検出器における遅れによって制御系が不安定になり易いという問題がある。

このような問題を解消すべく、特許文献１にはＦＢ（フィードバック）制御器による振動抑制装置が提案されている。また、特許文献２には振動抑制器を備えたＦＢ制御器によるモータ制御装置が提案されている。

目標動作に対する追従特性を独立して調整することが可能なＦＦ（フィードフォワード）制御器に関しても、装置の振動特性を考慮することによって、目標動作によって振動を励起しない駆動が実現出来る。この様な振動特性を考慮したＦＦ制御器の調整方法に関しては、特許文献３に提案されている。但し、ＦＢ制御器において振動抑制補償を行っている場合とそうでない場合には、振動抑制補償器の特性に見合った補償入力をＦＦ制御器にて生成する必要があり、ＦＦ制御器とＦＢ制御器を互いに関連させた調整方法が必要となる。

特開２００２−３２５４７３号公報 特開２００２−３３５６８６号公報 特許第３４０４３８８号公報

しかし、特許文献１〜３に記載された発明には下記の様な問題点が存在する。

（特許文献１）
１．トルク制御系やモータ位置又は速度検出器における遅れに起因する高周波数領域における不安定化が考慮された制御系になっていない。
２．ＦＢ制御器の調整方法が不明である。
３．ＦＦ制御器の調整方法が不明である。

（特許文献２）
１．トルク制御系やモータ位置又は速度検出器における遅れに起因する高周波数領域における不安定化が考慮された制御系になっていない。
２．ＦＦ制御器の調整方法が不明である。

（特許文献３）
１．ＦＦ制御器、ＦＢ制御器共に、機械装置の共振特性を考慮した制御器及びその調整方法となっておらず、共振特性を考慮した制御系のような高い性能が得られない。
２．トルク制御系やモータ位置又は速度検出器における遅れに起因する高周波数領域における不安定化が考慮された制御系になっていない。

以上のような従来の問題点を鑑み、本発明は、機械装置の共振特性、高周波数領域における不安定化を考慮した制御装置及びその調整方法を提供しようとするものである。

具体的には、モータ駆動による多慣性共振特性を持つ機械装置の運動制御において、機械装置の振動を抑制しつつ、適切な指令応答特性を得ることのできる制御装置及びその設計方法を提供しようとするものである。

本発明の態様によるモータ制御装置は、モータと負荷及びこれらを結合する結合部とを含む多慣性共振系を制御対象とし、制御指令値と制御対象からフィードバックされる状態量との差に基づいてモータを制御する閉ループ制御系を備え、該閉ループ制御系はモータ速度指令からモータトルク指令を決定する第１の制御手段を含む。

本モータ制御装置においては、更に、前記状態量に応じて振動を抑制する制振制御手段を備え、前記第１の制御手段の第１のゲイン、前記制振制御手段の第２のゲインを、閉ループ制御系の感度特性のカットオフ周波数ω_Ｓ、閉ループ制御系の相補感度特性のカットオフ周波数ω_ＣＳを調整パラメータとして決定するようにされる。

なお、前記閉ループ制御系の感度特性がω_Ｓ＞ωの低周波領域でｓ／ω_Ｓに漸近し、閉ループ制御系の相補感度特性がω_ＣＳ＜ωの高周波領域でω_ＣＳ／ｓに漸近するように調整される（但し、ｓはラプラス演算子）ことが望ましい。

更に、前記制振制御手段のもう一つの第３のゲインを、前記多慣性共振系の振動減衰特性の調整パラメータｋ_ｄで決定するようにしても良い。

なお、前記第１〜第３のゲインをそれぞれ、ｋ_ωＭ、ｋ_θＴ、ｋ_ωＴとした場合、これら第１〜第３のゲインは以下数１、

（但し、Ｊ_Ｍはモータのロータ部のイナーシャ、Ｊ_Ｌは負荷のイナーシャ、ωａは１次の共振特性の反共振周波数）
で表される。

更に、前記制振制御手段は、負荷位置とモータ位置との差を負荷とモータの相対変位として演算する演算手段と、前記相対変位から負荷とモータの相対速度を算出する手段と、前記相対変位が入力され前記第２のゲインｋ_θＴをゲインとする第２の制御手段と、前記相対速度が入力され前記第３のゲインｋ_ωＴをゲインとする第３の制御手段とを含むもので良い。

前記制振制御手段はまた、モータ位置からモータ速度を算出する手段と、算出されたモータ速度と前記モータトルク指令とを用いて負荷とモータの相対変位の推定値と、負荷とモータの相対速度の推定値を求める状態オブザーバと、前記相対変位の推定値が入力され前記第２のゲインｋ_θＴをゲインとする第２の制御手段と、前記相対速度の推定値が入力され前記第３のゲインｋ_ωＴをゲインとする第３の制御手段とを含むものでも良い。

前記カットオフ周波数ω_Ｓと前記カットオフ周波数ω_ＣＳの比率を固定値として設定し、前記カットオフ周波数ω_Ｓ、前記カットオフ周波数ω_ＣＳの一方を調整パラメータとして用いるようにしても良い。また、前記制御指令値と前記制御対象からフィードバックされる状態量との差を演算する演算手段の前段に、フィードフォワード制御器を備えるようにしても良い。

本発明の他の態様によれば、モータと負荷及びこれらを結合する結合部とを含む多慣性共振系を制御対象とし、制御指令値と制御対象からフィードバックされる状態量との差に基づいてモータを制御する閉ループ制御系を備え、該閉ループ制御系はモータ速度指令からモータトルク指令を決定する第１の制御手段を含むモータ制御装置の設計方法が提供される。

本設計方法は、閉ループ制御系の感度特性の利得が０ｄＢ以下になる周波数領域を設定する第１のステップと、閉ループ制御系の相補感度特性の利得が０ｄＢ以下になる周波数領域を設定する第２のステップを有することを特徴とする。なお、更に、前記多慣性共振系の振動減衰特性の調整パラメータｋ_ｄを設定する第３のステップを有していても良い。

本発明によれば、状態フィードバックを用いる閉ループ制御系の設計を、閉ループ制御系の感度特性のカットオフ周波数ω_Ｓ、閉ループ制御系の相補感度特性のカットオフ周波数ω_ＣＳ、振動減衰特性の調整パラメータｋ_ｄのうち、少なくともカットオフ周波数ω_Ｓ、カットオフ周波数ω_ＣＳの調整パラメータによって行うことにより、感度特性、相補感度特性、減衰性という制御上重要な特性のうち、少なくとも感度特性、相補感度特性を互いに干渉せずに調整することが可能となる。

これにより、モータ駆動による多慣性共振特性を持つ機械装置の運動制御において、機械装置の振動を抑制しつつ、適切な指令応答特性を得ることができる。

はじめに、本発明を理解し易くするために、本発明の基礎となる構成について説明する。

図４は、モデル追従制御法によるＦＦ制御器と、位置Ｐ（比例）速度ＰＩ（比例積分）制御器とを組み合せた制御装置の一般的な構成を示すブロック図である。ここでは、負荷を、結合部（動力伝達機構等）を介してモータで駆動する機械装置を想定し、制御対象を２慣性共振モデルとして考えることを前提としている。

図４において、制御対象としてのプラント（ｐｌａｎｔ）１００に、モータトルク（制御入力）τ_Ｍが入力され、検出器（図示省略）によりモータ位置θ_Ｍが検出される。τ_ｄはモータ外乱トルクであり、θ_Ｌは負荷位置を示す。位置指令θ_Ｒは追従特性モデルＭを経由して負荷位置指令θ_ＬＲとなる。Ｐ_Ｌ２Ｍは負荷位置θ_Ｌからモータトルクτ_Ｍへの開ループ伝達特性を示し、Ｐ_Ｌ２τは負荷位置θ_Ｌからモータ位置θ_Ｍへの開ループ伝達特性を示す。ｋ_θＭはモータ位置ＦＢ制御器（Ｐ又はＰＩ）のゲイン（パラメータ）、ｋ_ωＭはモータ速度ＦＢ制御器（Ｐ又はＰＩ）のゲイン（パラメータ）をそれぞれ示す。

図４では、開ループ伝達特性Ｐ_Ｌ２τを経て得られるモータ位置指令θ_ＭＲとモータ位置θ_Ｍとの差を演算器１０１で演算してゲインｋ_θＭのモータ位置ＦＢ制御器へ入力することによりモータ速度を得るようにし、このモータ速度とモータ位置θ_Ｍを微分して得られるモータ速度ω_Ｍとの差を演算器１０２で演算してモータ速度ＦＢ制御器へ入力することによりモータトルクを得るようにしている。以上のような構成は、ＦＢ制御器と呼ぶことができる。なお、ｓはラプラス演算子である。

一方、開ループ伝達特性Ｐ_Ｌ２Ｍを経て得られるトルクτ_ＦＦとモータ速度ＦＢ制御器からのモータトルクを、モータ速度ＦＢ制御器とプラント１００との間に設けた加算器１０３で加算してモータトルク指令τ_Ｍを得るようにしている。追従特性モデルＭ、開ループ伝達特性Ｐ_Ｌ２τ、Ｐ_Ｌ２Ｍを持つ要素を含む構成はＦＦ制御器と呼ぶことができる。なお、このＦＦ制御器は、モータ位置指令θ_ＭＲを微分してモータ速度指令ω_ＭＲを得、演算器１０２に与える要素をも含む。

ところで、機械装置は一般的には複数の共振特性を有するが、本発明では最も支配的な特性である１次の共振特性を対象にした制御装置について考える。

２慣性共振系の制御対象を１次の共振特性のみで近似した運動特性は以下の数２のような状態空間表現により表すことができ、ブロック線図で表すと図５の様になる。

ここで、式（２）中の変数は制御対象の特性を表すパラメータであり、Ｊ_Ｍはモータのロータ部のイナーシャ、Ｊ_Ｌは負荷のイナーシャ、Ｋ_Ｇは１次の共振特性を表すモータと負荷の結合部（動力伝達機構等）の等価結合剛性、Ｂ_Ｇはその減衰特性を表す結合部の等価粘性をそれぞれ表している。

また、図５において図４で説明した要素と同じ要素には同じ符号を付しており、それら以外の要素であるω_Ｌは負荷速度、θ_Ｔは負荷とモータの相対変位（負荷位置とモータ位置の差）、ω_Ｔは負荷とモータの相対速度（負荷速度とモータ速度の差）、τ_Ｔは負荷とモータの相互作用トルク、τ_ｄＬは負荷外乱トルクである。

以上のような一般的な構成に対し、図１、図２は、それぞれ本発明による制御装置の実施形態の構成を示す。

図１は、図４で説明した構成に制振制御器１０を追加した構成となっている。制振制御器１０は制御対象における状態量のフィードバック値として負荷位置θ_Ｌ、モータ位置θ_Ｍを受け、これらの状態量から演算器１４により負荷とモータの相対変位θ_Ｔを演算する。制振制御器１０はまた、相対変位θ_Ｔを微分して負荷とモータの相対速度ω_Ｔを算出する。制振制御器１０は、相対速度ω_Ｔについてはゲインｋ_ωＴの制御器（第３の制御手段）１２を通し、相対変位θ_Ｔについてはゲインｋ_θＴの制御器（第２の制御手段）１３を通したうえで両者を加算器１１で加算して加算器１０３’に与える。

なお、図１では、制振制御器１０を新たに備えることにより、ＦＦ制御器２０においては負荷位置θ_Ｌからモータトルクτ_Ｍへの開ループ伝達特性をＰ’_Ｌ２Ｍで示し、これを経て得られるトルクをτ’_ＦＦで示している。そして、加算器１０３’が、ゲインｋ_ωｍのモータ速度ＦＢ制御器（第１の制御手段）からのモータトルクと、ＦＦ制御器２０からのトルクτ’_ＦＦと、制振制御器１０の出力を加算してモータトルク指令τ_Ｍをモータに与える。

以上の構成は、状態量としての負荷位置θ_Ｌ、モータ位置θ_Ｍをそのまま用いる、状態ＦＢ速度制御装置と呼ぶことができる。

一方、図２は、図１の制振制御器１０に代えて、状態オブザーバ（ｓｔａｔｅ ｏｂｓｅｒｖｅｒ）１５を持つ制振制御器１０’を備えている。状態オブザーバ１５は、状態量としてのモータ位置θ_Ｍを微分して算出したモータ速度ω_Ｍとモータトルク指令τ_Ｍとを用いて負荷とモータの相対速度の推定値ω_Ｔ＾と、負荷とモータの相対変位の推定値θ_Ｔ＾を推定する。制振制御器１０’は、相対速度の推定値ω_Ｔ＾についてはゲインｋ_ωＴの制御器を通し、相対変位の推定値θ_Ｔ＾についてはゲインｋ_θＴの制御器を通したうえで両者を加算器１１’で加算して加算器１０３’に与える。この構成も、状態ＦＢ速度制御装置と呼ぶことができる。

いずれにしても、本実施形態では、図１のように状態量を直接計測するか、あるいは図２のように状態オブザーバ１５を用いて推定値を得るなどして、モータ速度（ω_Ｍ）のほか、モータと負荷の相対速度（ω_Ｔ）、モータと負荷の相対変位（θ_Ｔ）、あるいはそれらの推定値を得て、フィードバック制御を行う。

本実施形態では、上記の信号、つまりモータ速度（ω_Ｍ）、相対速度（ω_Ｔ）、相対変位（θ_Ｔ）、相対速度の推定値（ω_Ｔ＾）、相対変位の推定値（θ_Ｔ＾）に対して乗じるＦＢゲインｋ_ωＭ、ｋ_θＴ、ｋ_ωＴを上記式（１）の様に決定する。

ここで、上記式（１）中のω_Ｓは感度関数（感度特性）のカットオフ周波数、ω_ＣＳは相補感度特性（相補感度関数）のカットオフ周波数、ｋ_ｄは振動減衰特性の調整パラメータを表しており、制御特性を調整するパラメータである。また、ω_ａ（＝√Ｋ_Ｇ／Ｊ_Ｌ）は１次の共振特性の内の反共振周波数を表している。なお、感度関数のカットオフ周波数というのは、感度関数の利得が０ｄＢ以下または−３ｄＢ以下となる低周波領域側の周波数を示し、相補感度関数のカットオフ周波数というのは、相補感度関数の利得が０ｄＢ以下または−３ｄＢ以下となる高周波領域側の周波数を示す。

これまでは、ｋ_ωＭ、ｋ_ωＴ、ｋ_θＴは、単にゲインとして決めるという考えしかなく、これらのゲインを決定した後、出力を見て、再度、ゲイン調整を行なうという考え方しかなかった。

これに対し、本実施形態では、ゲインｋ_ωＭ、ｋ_ωＴ、ｋ_θＴを式（１）に基づいて感度特性のカットオフ周波数ω_Ｓ、相補感度特性のカットオフ周波数ω_ＣＳで決定できるようにしている。これを以下に説明する。

図１、図２に示されるようなフィードバックを施すと、上記式（２）で表される機械装置の速度制御系の特性方程式Ｃは以下の数３で表すことができる。

また、モータの速度指令と実際のモータ速度との偏差をモータ速度偏差とすると、モータ速度指令からモータ速度偏差までの伝達特性Ｓは、感度特性と呼ばれ、以下の数４で表される。

一方、モータの速度指令から実際のモータ速度までの伝達特性Ｔは、相補感度特性と呼ばれ、以下の数５で表される。

上記式から、感度特性Ｓは、分子多項式のｓのゼロ次項が無いことから、低周波領域では周波数に比例してゲインが低下する。その時のゲイン曲線は周波数ωに対してω／ω_Ｓに漸近する。

一方、相補感度特性Ｔは、分子多項式のｓ^３の項が無いことから、分母多項式と分子多項式のｓの次数差が１となっており、高周波領域では周波数に反比例してゲインが低下する。その時のゲイン曲線は周波数ωに対してω_ＣＳ／ωに漸近する。

上記の様子を図３（ａ）に示す。図３（ａ）では、ゲイン特性をラプラス演算子ｓを用いて表しており、感度特性Ｓの低域特性がｓ／ω_Ｓに、相補感度特性Ｔの高域特性がω_ＣＳ／ｓに、それぞれ漸近している様子が見て取れる。これをボード線図で示すと、図３（ｂ）のようになる。

ところで、図１、図２に示すような制御装置の閉ループ制御系を簡略化して示すと、図６のようになる。そして、このような閉ループ制御系における感度特性Ｓ、相補感度特性Ｔについて考えると以下のようになる。

感度特性Ｓ＝Ｅ／Ｒ＝１／（１＋ＣＰ）
相補感度特性Ｔ＝Ｙ／Ｅ＝ＣＰ／（１＋ＣＰ）

ここで、感度特性Ｓ＝Ｅ／Ｒなので図３（ｂ）のボード線図において感度特性Ｓのゲインが低いところの周波数領域（ω_Ｓ＞ω）では、誤差のゲインが低いので応答性が良い。一方、相補感度特性Ｔ＝Ｙ／Ｅなので、図３（ｂ）のボード線図において相補感度特性Ｔのゲインが低いところの周波数領域（ω_Ｔ＜ω）では、ノイズ感度が低く、ノイズ特性、安定性が向上する。

以上の様に、式（１）の様なゲインの設定方法を採用することによって、応答性と安定性を独立させた制御特性の設計を容易に実現することが出来る。

本実施形態による状態ＦＢ速度制御装置では、感度関数や、相補感度関数を設定するわけではなく、低周波領域で感度特性Ｓに漸近する関数ｓ／ω_Ｓを設定し、高周波領域で相補感度特性Ｔに漸近する関数ω_ＣＳ／ｓを設定するようにしている。よって、制御装置に入力する数値はカットオフ周波数ω_Ｓとω_ＣＳだけでよく、入力すると、制御系の感度特性Ｓがω_Ｓ＞ωの領域でｓ／ω_Ｓに漸近し、相補感度特性Ｔがω_ＣＳ＜ωの領域でω_ＣＳ／ｓに漸近するような制御装置が設計される。

なお、相補感度特性Ｔのカットオフ周波数ω_ＣＳと感度特性Ｓのカットオフ周波数ω_Ｓの比率を固定的に設定することによって、調整パラメータをどちらか一方のみにし、調整を容易にすることも可能である。この場合、ω_ＣＳ／ω_Ｓ＝１．５〜６程度が望ましい。

同時に、式（１）に見られるように、ゲインｋ_ωＴによって、応答性と安定性とは独立させて、振動の減衰特性を調整することが可能となる。式（１）における第３式の振動減衰特性の調整パラメータｋ_ｄは、ねじり角速度のフィードバックゲインを決定するパラメータ、言い換えればねじり振動の減衰を調整するパラメータと考えることができ、概ね±６の範囲で調整することで良好な応答を得ることが可能である。

また、一般的に積分補償により定常偏差を補償したりするが、速度ループ積分補償ゲインの調整は感度特性のカットオフ周波数ω_ｓの１／３以下程度の帯域に設定すれば、その他の特性との大きな干渉を起こさずに容易に導入することが可能である。同様に、上記では速度制御系の設計方法を説明しているが、その外部ループとして位置制御系を構成する場合も、位置ループゲインを感度特性のカットオフ周波数ω_ｓの１／３以下程度の帯域に設定すれば、その他の特性との大きな干渉を起こさずに容易に導入することが可能である。

なお、上記実施形態とは別の構成として、モータ速度の比例補償のみを施した場合には、感度特性はω／［ｋ_ωＭ／（Ｊ_Ｌ＋Ｊ_Ｍ）］、相補感度特性は（ｋ_ωＭ／Ｊ_Ｍ）／ωにそれぞれ漸近する。よって、感度特性を変化させると同時に相補感度特性も変化してしまい、特に負荷のイナーシャＪ_ＬがモータのイナーシャＪ_Ｍに対して非常に大きい場合（例えば、１０倍以上）には、感度特性と相補感度特性の漸近する周波数特性が大きく離れてしまい、応答性の向上と安定余裕の確保の両立が困難になる。

次に、ＦＦ制御器２０の設計（調整）方法を説明する。

本実施形態では、前述したように、ＦＦ制御器２０にはモデル追従制御手法を用いる。

モデル追従制御手法では、最終的に制御したい負荷の先端部などに対して与える運動特性をモデル特性として設定する。このモデル特性は、１次遅れや高次遅れであったり、遅れ特性に対して積分補償をしたものであったりする。そして、制御対象の制御入力であるモータトルクからフィードバックする各状態量に対する伝達特性の逆特性とモデル特性とを掛け合わせたものを各状態量への動作指令として入力すると同時に、この運動に見合うモータトルクを入力する。この様な指令入力を行うことにより、各状態量を所望の運動状態であるモデル特性に追従させることが可能となる。

ここで、多慣性共振系のもっとも簡単な制御系の一つである、モータ速度のＰＩ（比例積分）制御の外部ループに位置のＰ（比例）制御を行う場合（Ｐ−ＰＩ制御系）の構成を考える。

この時、モデル追従制御系を構成するには、前述したように、ＦＦ制御器においてモータ位置指令θ_ＭＲ、モータ速度指令ω_ＭＲ、モータトルクτ_ＦＦをそれぞれ算出する。この時の各入力の算出式は下記の数６のようになる。

ここで、前述したように、θ_ＬＲは負荷位置指令であり負荷の動作に対する指令値であるものとする。また、Ｍはモデル特性、Ｐ_Ｌ２τは負荷位置θ_Ｌからモータ位置θ_Ｍまでの伝達特性、Ｐ_Ｌ２Ｍは負荷位置θ_Ｌからモータトルクτ_Ｍまでの伝達特性の逆関数であり、それぞれ下記の数７で表される。

上記のような状態フィードバックを施している場合、フィードバックしている各状態量に対しても動作指令が必要となる。しかし、これに対して各々の動作指令を生成する演算を行うと、演算量が非常に増加する為、好ましくない。これに対して、上記式（６）における伝達特性Ｐ_Ｌ２τを、上記のＰ−ＰＩ制御系に対して付加しているフィードバック量のみに着目して変形すると以下の数８となる。

よって、上記式（６）で表されていたＰ−ＰＩ制御系に対するモデル追従制御系の各入力の内、モータトルクのみを以下の数９で表されるトルクτ’_ＦＦに変更するだけで、上記のような状態フィードバックに対応したモデル追従制御系の入力を得ることが可能となる。

式（７）の第２式と式（８）は同じ次数の伝達方程式であるので、式（６）の第３式と式（９）のモータトルク入力の伝達特性も同じ次数の伝達方程式となる。よって、上記の様にモデル追従制御系の各入力を算出することにより、演算量の増加は全く生じずに上記状態フィードバックに対応したＦＦ制御器２０を得ることが出来る。

以上説明した２つの実施形態による、多慣性共振系の１次共振特性を対象にした制御装置の設計方法を用いることにより、以下の効果が得られる。

１．状態フィードバックを用いる制御系の調整を、感度特性のカットオフ周波数ω_Ｓ、相補感度特性のカットオフ周波数ω_ＣＳ、振動減衰特性の調整パラメータｋ_ｄの各調整パラメータによって行うことにより、感度特性、相補感度特性、減衰性という制御上重要な特性を互いに干渉せずに調整することが可能となる。

２．ω_ＣＳ／ω_Ｓを固定とすることにより、調整パラメータを更に減じ、容易に調整を行うことが可能となる。

３．上記の様な速度制御系は、速度ループ積分補償、位置制御ループを容易に追加することが可能であり、高性能な速度サーボ制御、位置サーボ制御を容易に実現し、且つ、容易に調整することが可能である。

４．上記の様な、速度又は位置制御系に対して、モデル追従制御手法によるＦＦ制御器を調整する場合、本実施形態によるモータトルク入力演算式を用いることで、演算量を増加させずに適切なモータトルク入力を算出することが可能となる。

５．上記の様な、ＦＢ制御器、ＦＦ制御器の設計（調整）方法は、制御器の調整則と制御対象の特性同定部が独立しているセルフチューニング制御手法によるオートチューニングに用いることが可能であり、オートチューニングによる調整と、ユーザによる微調整などの介入を容易に両立することが可能である。

６．上記の様な、ＦＢ制御器、ＦＦ制御器の設計（調整）方法は、制御に用いるフィードバック信号を全て実際に計測する場合にも適用可能であり、例えばモータ速度の様に式（２）の状態量の可観測性が得られるだけの計測量から状態観測器によって得た信号をフィードバックする場合にも適用可能である。

図１は、本発明による制御装置の実施形態の構成を示すブロック図である。 図２は、本発明による制御装置の他の実施形態の構成を示すブロック図である。 図３（ａ）、（ｂ）は、本発明の実施形態における感度特性、相補感度特性を周波数とゲインとの関係で示すと共に、各特性と漸近線との関係を説明するための図である。 図４は、モデル追従制御法によるＦＦ制御器と、位置Ｐ（比例）速度ＰＩ（比例積分）制御器とを組み合せた制御装置の一般的な構成を示すブロック図である。 図５は、２慣性共振系の制御対象を１次の共振特性のみで近似した運動特性のブロック線図を示す。 図６は、図１、図２に示すような制御装置の閉ループ制御系を簡略化して示した図である。

符号の説明

１０、１０’ 制振制御器
１１、１１’、１０３、１０３’ 加算器
１２ 状態オブザーバ
２０ ＦＦ制御器
１００ 制御対象としてのプラント
１０１、１０２ 演算器

Claims (7)

1. モータと負荷及びこれらを結合する結合部とを含む多慣性共振系を制御対象とし、制御指令値と制御対象からフィードバックされる状態量との差に基づいてモータを制御する閉ループ制御系を備えたモータ制御装置において、
   前記閉ループ制御系は、
   モータ速度指令からモータトルク指令を決定するモータトルク指令決定手段と、
   前記状態量に応じて振動を抑制する制振制御手段と、を備え、
   前記モータトルク指令決定手段の第１のゲイン、前記制振制御手段の第２のゲインは、閉ループ制御系の感度特性のカットオフ周波数ω_Ｓ、閉ループ制御系の相補感度特性のカットオフ周波数ω_ＣＳを用いて決定され、且つ、前記閉ループ制御系の感度特性がω _Ｓ ＞ωの低周波領域でｓ／ω _Ｓ に漸近し、閉ループ制御系の相補感度特性がω _ＣＳ ＜ωの高周波領域でω _ＣＳ ／ｓに漸近するように調整される（但し、ｓはラプラス演算子）ことを特徴とするモータ制御装置。
2. 前記制振制御手段の第３のゲインを、前記多慣性共振系の振動減衰特性の調整パラメータｋ_ｄで決定することを特徴とする請求項１に記載のモータ制御装置。
3. 前記第１〜第３のゲインをそれぞれ、ｋ_ωＭ、ｋ_θＴ、ｋ_ωＴとした場合、これら第１〜第３のゲインは以下の式（１）、
   

   

   （但し、Ｊ_Ｍはモータのロータ部のイナーシャ、Ｊ_Ｌは負荷のイナーシャ、ω_ａは１次の共振特性の反共振周波数）
   で表されることを特徴とする請求項２に記載のモータ制御装置。
4. 前記制振制御手段は、
   負荷位置とモータ位置との差を負荷とモータの相対変位として演算する演算手段と、
   前記相対変位から負荷とモータの相対速度を算出する手段と、
   前記相対変位が入力され前記第２のゲインｋ_θＴをゲインとする制御手段と、
   前記相対速度が入力され前記第３のゲインｋ_ωＴをゲインとする別の制御手段とを含むことを特徴とする請求項３に記載のモータ制御装置。
5. 前記制振制御手段は、
   モータ位置からモータ速度を算出する手段と、
   算出されたモータ速度と前記モータトルク指令とを用いて負荷とモータの相対変位の推定値と、負荷とモータの相対速度の推定値を求める状態オブザーバと、
   前記相対変位の推定値が入力され前記第２のゲインｋ_θＴをゲインとする制御手段と、
   前記相対速度の推定値が入力され前記第３のゲインｋ_ωＴをゲインとする別の制御手段とを含むことを特徴とする請求項３に記載のモータ制御装置。
6. 前記カットオフ周波数ω_Ｓと前記カットオフ周波数ω_ＣＳの比率を固定値として設定し、前記カットオフ周波数ω_Ｓ、前記カットオフ周波数ω_ＣＳの一方を調整パラメータとして用いることを特徴とする請求項１〜５のいずれか１項に記載のモータ制御装置。
7. 前記制御指令値と前記制御対象からフィードバックされる状態量との差を演算する演算手段の前段に、フィードフォワード制御器を備えることを特徴とする請求項１〜６のいずれか１項に記載のモータ制御装置。

Images