(57)【要約】【課題】制御パラメータ選択信号、負荷慣性モーメント、目標応答周波数などを入力することなく、数十倍以上の大きな慣性モーメント比に対しても安定に動作するモータ制御装置とその制御方法を提供する。【解決手段】位置制御部（１）と、速度指令と速度信号と設定負荷慣性モーメントから第１トルク指令を生成する速度制御部（３）と、トルク指令に基づいてモータを駆動するモータ駆動部（４）と、位置検出器の位置検出信号から位置信号を生成する位置信号生成部（５）と、位置信号から速度信号を生成する速度信号生成部（６）と、速度信号とトルク指令から補正トルク指令を生成し第１トルク指令に加算して前記トルク指令を生成する慣性変動抑制部（７）と、第１トルク指令を位相補償をして新たな第１トルク指令を生成する位相補償部（３）と、トルク指令と速度信号から振動を検出し振動信号を生成する振動検出部（８）と、振動信号に応じて負荷慣性モーメントをモータ慣性モーメントの定数倍に設定する慣性モーメント設定部（９）と、を備えた。【選択図】図１
2008289218.tif 000002
【特許請求の範囲】
【請求項１】
位置指令と位置信号から速度指令を生成する位置制御部と、前記速度指令と速度信号と設定負荷慣性モーメントから第１トルク指令を生成する速度制御部と、トルク指令に基づいてモータを駆動するモータ駆動部と、前記モータに結合した位置検出器の位置検出信号から前記位置信号を生成する位置信号生成部と、前記位置信号から前記速度信号を生成する速度信号生成部と、前記速度信号と前記トルク指令から補正トルク指令を生成し第１トルク指令に加算して前記トルク指令を生成する慣性変動抑制部と、を備えたモータ制御装置において、
前記第１トルク指令に位相補償をして新たな第１トルク指令を生成する位相補償部と、
前記トルク指令と前記速度信号から振動を検出し振動信号を生成する振動検出部と、
前記振動信号に応じて負荷慣性モーメントをモータ慣性モーメントの定数倍に設定する慣性モーメント設定部と、
を備えることを特徴とするモータ制御装置。
【請求項２】
前記位相補償部は、位相進み補償であり、前記速度制御部はＰＩ制御をすることを特徴とする請求項１記載のモータ制御装置。
【請求項３】
前記位相補償部のかわりに前記速度制御部はＰＩＤ制御をすることを特徴とする請求項１記載のモータ制御装置。
【請求項４】
前記振動検出部は、前記トルク指令からモデル速度信号を生成するモータモデル部と、前記速度信号からモデル速度信号を減算して振動信号を生成すること減算器と、を備えることを特徴とする請求項１記載のモータ制御装置。
【請求項５】
前記慣性変動抑制部は、前記トルク指令と前記速度信号から外乱トルク推定信号を生成する外乱オブザーバと、前記外乱トルク推定信号を処理し新たな外乱トルク推定信号を生成するローパスフィルタと、前記外乱トルク推定信号にゲインを乗じて新たな外乱トルク推定信号を生成するゲイン部と、前記外乱トルク信号を前記トルク指令に加算して新たなトルク指令信号を生成する加算器と、を備えることを特徴とする請求項１記載のモータ制御装置。
【請求項６】
前記位相補償部は、トルク指令の位相を補償する代わりに前記速度指令と前記速度信号の位相を補償することを特徴とする請求項１記載のモータ制御装置。
【請求項７】
位置指令と位置信号から速度指令を生成する位置制御部と、前記速度指令と速度信号と設定負荷慣性モーメントから第１トルク指令を生成する速度制御部と、トルク指令に基づいてモータを駆動するモータ駆動部と、前記モータに結合した位置検出器の位置検出信号から前記位置信号を生成する位置信号生成部と、前記位置信号から前記速度信号を生成する速度信号生成部と、前記速度信号と前記トルク指令から補正トルク指令を生成し第１トルク指令に加算して前記トルク指令を生成する慣性変動抑制部と、を備えたモータ制御装置の制御方法において、
前記第１トルク指令に位相補償をして新たな第１トルク指令を生成するステップと、
前記トルク指令と前記速度信号から振動を検出し振動信号を生成するステップと、
前記振動信号に応じて負荷慣性モーメントをモータ慣性モーメントの定数倍に設定するステップと、
を備えることを特徴とするモータ制御装置の制御方法。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、モータを制御するモータ制御装置とその制御方法に関する。
【背景技術】
【０００２】
従来のモータ制御装置は、位置指令と位置信号から速度指令を生成する位置制御部と、速度指令と速度信号からトルク指令を生成する速度制御部と、トルク指令に基づいてモータを駆動するモータ駆動部と、モータに結合された位置検出器のモータ位置検出信号から位置信号を生成する位置信号生成部と、位置信号から速度信号を生成する速度信号生成部と、で構成されている。また、従来のゲインなどの制御パラメータを自動的に調整できるようにしたモータ制御装置は特許文献１に開示されている。
図６は、特許文献１に開示されたモータ制御装置の構成を示すブロック図である。図６において、１１１は指令発生部、１１２は位置制御部、１１３は速度制御部、１１４はトルクフィルタ部、１１５は電流制御部、１１６はモータ、１１７は検出器、１１８はメカ部、１１９は速度信号作成部、１２０は１パラメータチューニング部である。
１パラメータチューニング部１２０は、制御パラメ−タ選定信号を入力し、ユーザが希望する目標応答周波数ωｆから決定する手段、負荷慣性モーメント値ＪＬと目標応答周波数ωｆから決定する手段、メカ特性である共振周波数ωＨ及び反共振周波数ωＬと目標応答周波数ωｆから決定する手段の選択を行い、目標応答周波数ωｆから決定する手段が選ばれた場合は、目標応答周波数ωｆを入力し、速度ル−プゲインｋｖをｋｖ＝ωｆ、速度積分時定数ｔｉをｔｉ＝４／ωｆ、位置ル−プゲインｋｐをｋｐ＝ωｆ／４、トルクフィルタ定数ｔｆをｔｆ＝１／（ωｆ＊４）、電流ル−プゲインｋｉをｋｉ＝ωｆ＊４、電流積分時定数ｔａをｔａ＝１／ωｆ、速度信号作成部内のフィルタ時定数ｔｖをｔｖ＝２０．５／（ωｆ＊４）と設定して制御パラメータを生成する。また、負荷慣性モーメント値ＪＬと目標応答周波数ωｆから決定する手段が選ばれた場合は、前記負荷イナ−シャ値ＪＬを入力し、モ−タイナ−シャＪＭとの比から求めた慣性モーメント補正ゲインＪＣＯＭ＝（（ＪＬ＋ＪＭ）／ＪＭ）０．５を用いて、速度ル−プゲインｋｖをｋｖ＝ωｆ／ＪＣＯＭ、速度積分時定数ｔｉをｔｉ＝４／ωｆ＊ＪＣＯＭ、位置ル−プゲインｋｐをｋｐ＝ωｆ／４／ＪＣＯＭ、トルクフィルタ定数ｔｆをｔｆ＝１／（ωｆ＊４）＊ＪＣＯＭ、電流ル−プゲインｋｉをｋｉ＝ωｆ＊４／ＪＣＯＭ、電流積分時定数ｔａをｔａ＝１／ωｆ＊ＪＣＯＭ、速度信号作成部内のフィルタ時定数ｔｖをｔｖ＝２０．５／（ωｆ＊４）＊ＪＣＯＭと設定し、制御パラメータを生成する。また、メカ特性である共振周波数ωＨ及び反共振周波数ωＬと目標応答周波数ωｆから決定する手段が選ばれた場合は、メカの共振周波数ωＨ及び反共振周波数ωＬを入力し、モータ側イナ−シャＪ１をＪ１＝（ＪＭ＋ＪＬ）＊（ωＬ／ωＨ）２／ＪＭと表し、速度ル−プゲインｋｖをｋｖ＝ωｆ／Ｊ１、速度積分時定数ｔｉをｔｉ＝４／ωｆ＊Ｊ１、前記位置ル−プゲインｋｐをｋｐ＝ωｆ／４／Ｊ１、トルクフィルタ定数ｔｆをｔｆ＝１／（ωｆ＊４）＊Ｊ１、前記電流ル−プゲインｋｉをｋｉ＝ωｆ＊４／Ｊ１、電流積分時定数ｔａをｔａ＝１／ωｆ＊Ｊ１、速度信号作成部内のフィルタ時定数ｔｖをｔｖ＝２０．５／（ωｆ＊４）＊Ｊ１、と設定し、制御パラメータを生成する。このように１つのパラメータで７つの制御パラメータを自動的に決定でき、負荷の慣性モーメントの大きさや、メカ特性である反共振周波数と共振周波数を用いて、制御パラメータの設定指針を自動的に変更し、最適な制御パラメータを得るというものである。
【０００３】
また、特許文献２に開示された従来のモータ制御装置は、電動機の位置を検出する位置検出部と、位置検出部の出力を入力して前記電動機の速度を出力する速度演算部と、位置指令と電動機の位置との差を入力し速度指令を出力する位置制御部と、トルク指令と前記電動機の速度を入力し電動機の外乱を推定し新たなトルク指令を出力する慣性変動抑制部と、新たなトルク指令を入力し、電動機のトルクを制御するトルク制御部と、速度指令を入力し位相を進めた新たな速度指令を出力する位相補償部と、新たな速度指令と電動機の速度との差を入力し前記トルク指令を出力する速度制御部と、を備え、負荷慣性モーメントが未知な機構を駆動する。
図７は、特許文献２に開示されたモータ制御装置の構成を示す制御ブロック図である。
図７において、位置指令と電動機位置との偏差に基づいて速度指令を出力する位置制御部２１５と、速度指令の位相補償を行う位相補償部２１４と、位相補償された速度指令と電動機の速度との偏差に基づいてトルク指令を生成する速度制御部２１６と、慣性変動抑制部２１３と、トルク制御部２１７と、電動機２１８と、図示していないギヤ等の駆動部と、負荷と、電動機２１８の位置を検出する位置検出部２１Ｂと、位置検出部２１Ｂからの位置信号に基づいて電動機速度を演算する速度演算部１Ｃとを備えている。慣性変動抑制部２１３は、電動機の速度とトルク指令に基づいて外乱要素を演算する外乱オブザーバ２１０と、その出力の高調波雑音を除去する低域通過フィルタ２１１と、その出力にゲイン２１２を掛けて推定外乱トルクとしてトルク指令に加算し、新たなトルク指令として出力する加算器とを備えている。
１次外乱オブザーバで慣性変動抑制部を構成し位相進めフィルタを位相補償部とした時の計算機シミュレーション結果を図７に示す。
図８は、速度制御部に正しい慣性モーメント比を設定したときの電動機の速度と図６の構成で慣性モーメント比が０倍，５倍，１０倍，１５倍のときの電動機の速度である（計算機シミュレーション結果）。これらの図で電動機の速度が加速から等速に変化した直後の波形や減速からゼロ速に変化した直後の波形（図中、楕円で囲んだ部分）を比較すると、慣性モーメント比が０倍，５倍，１０倍，１５倍のときのすべてのグラフが重なっており、ほぼ同じ応答となっている。
【特許文献１】特開２００２−２７７７２号公報
【特許文献２】国際公開第０５／０９３９３９号パンフレット
【発明の開示】
【発明が解決しようとする課題】
【０００４】
しかしながら、従来例の特許文献１の場合は、制御パラメータ選択信号を入力し、さらに負荷慣性モーメントや目標応答周波数を入力したり、場合によっては共振周波数や反共振周波数を入力しなければならない。目標応答周波数や共振周波数、反共振周波数を入力するには特別な測定器が必要になったり複雑な計算が必要である。負荷慣性モーメントを同定する手法もあるが、微小移動時や、摩擦力等の外乱の影響を受け正確な同定が行えない場合があるといった問題があった。また、外乱を推定し補正したトルク指令を出力する慣性変動抑制を行う特許文献２のモータ制御装置においても、負荷慣性比が２５倍程度を超えると制御系が不安定になり振動的になるという問題があった。
【０００５】
本発明は、このような問題点に鑑みてなされたものであり、制御パラメータ選択信号、負荷慣性モーメント、目標応答周波数などを入力することなく、数十倍以上の大きな慣性モーメント比に対しても安定に動作するモータ制御装置とその制御方法を提供することを目的とする。
【課題を解決するための手段】
【０００６】
上記課題を解決するため、次のように構成した。
請求項１に記載の発明は、位置指令と位置信号から速度指令を生成する位置制御部と、  前記速度指令と速度信号と設定負荷慣性モーメントから第１トルク指令を生成する速度制御部と、トルク指令に基づいてモータを駆動するモータ駆動部と、前記モータに結合した位置検出器の位置検出信号から前記位置信号を生成する位置信号生成部と、前記位置信号から前記速度信号を生成する速度信号生成部と、前記速度信号と前記トルク指令から補正トルク指令を生成し第１トルク指令に加算して前記トルク指令を生成する慣性変動抑制部と、を備えたモータ制御装置において、前記第１トルク指令に位相補償をして新たな第１トルク指令を生成する位相補償部と、前記トルク指令と前記速度信号から振動を検出し振動信号を生成する振動検出部と、前記振動信号に応じて負荷慣性モーメントをモータ慣性モーメントの定数倍に設定する慣性モーメント設定部と、を備えることを特徴とするものである。
請求項２に記載の発明は、請求項１記載のモータ制御装置において、前記位相補償部は、位相進み補償であり、前記速度制御部はＰＩ処理をすることを特徴とするものである。
請求項３に記載の発明は、請求項１記載のモータ制御装置において、前記位相補償部のかわりに前記速度制御部はＰＩＤ制御処理をすることを特徴とするものである。
請求項４に記載の発明は、請求項１記載のモータ制御装置において、前記振動検出部は、前記トルク指令からモデル速度信号を生成するモータモデル部と、前記速度信号からモデル速度信号を減算して振動信号を生成すること減算器と、を備えることを特徴とするものである。
請求項５に記載の発明は、請求項１記載のモータ制御装置において、前記慣性変動抑制部は、前記トルク指令と前記速度信号から外乱トルク推定信号を生成する外乱オブザーバと、前記外乱トルク推定信号を処理し新たな外乱トルク推定信号を生成するローパスフィルタと、前記外乱トルク推定信号にゲインを乗じて新たな外乱トルク推定信号を生成するゲイン部と、前記外乱トルク信号を前記トルク指令に加算して新たなトルク指令信号を生成する加算器と、を備えることを特徴とするものである。
請求項６に記載の発明は、請求項１記載のモータ制御装置において、前記位相補償部は、トルク指令の位相を補償する代わりに前記速度指令と前記速度信号の位相を補償することを特徴とするものである。
請求項７に記載の発明は、位置指令と位置信号から速度指令を生成する位置制御部と、前記速度指令と速度信号と設定負荷慣性モーメントから第１トルク指令を生成する速度制御部と、トルク指令に基づいてモータを駆動するモータ駆動部と、前記モータに結合した位置検出器の位置検出信号から前記位置信号を生成する位置信号生成部と、前記位置信号から前記速度信号を生成する速度信号生成部と、前記速度信号と前記トルク指令から補正トルク指令を生成し第１トルク指令に加算して前記トルク指令を生成する慣性変動抑制部と、を備えたモータ制御装置の制御方法において、前記第１トルク指令に位相補償をして新たな第１トルク指令を生成するステップと、前記トルク指令と前記速度信号から振動を検出し振動信号を生成するステップと、前記振動信号に応じて負荷慣性モーメントをモータ慣性モーメントの定数倍に設定するステップと、を備えることを特徴とするものである。
【発明の効果】
【０００７】
本発明によると、負荷慣性モーメントを補正することによって負荷慣性モーメントがモータ慣性モーメントに対し、数十倍と非常に大きい場合でも安定に動作するモータ制御装置とその制御方法を提供することができる。
【発明を実施するための最良の形態】
【０００８】
以下、本発明の最良の実施形態について図に基づいて説明する。
【実施例１】
【０００９】
図１は、本発明によるモータ制御装置の実施例１の構成を示すブロック図である。
図１において、１は位置制御部、２は速度制御部、３は位相補償部、４はモータ駆動部、５は位置信号生成部、６は速度信号生成部、７は慣性変動抑制部、８は振動検出部、９は慣性モーメント設定部、１０はモータ、１１は位置検出器である。位置制御部１は上位コントローラからの位置指令と位置信号の差をＰＩＤ制御処理をして速度指令を生成する。速度制御部２は速度指令と速度信号の差をＰＩ制御処理または、ＰＩＤ制御処理をし、設定負荷慣性モーメントに応じて第１トルク指令を生成する。位相補償部３は第１トルク指令に位相進み補償を施し新たな第１トルク指令を生成する。慣性変動抑制部７は、モータに対する外乱を推定し、外乱を補正する補正トルク指令を生成し第トルク指令に加算してトルク指令を生成する。モータ駆動部４はトルク指令を電流指令に変換し、電流指令と電流信号を比較し電圧指令を生成、さらに、電圧指令からＰＷＭ信号を生成して電力増幅器を制御し、モータ１０に電圧を供給する。位置検出器１１はモータに結合されて２相パルス列信号やシリアル通信データを生成する。位置信号生成部５は２相パルス列信号やシリアル通信データを受けて位置信号を生成する。速度信号生成部６は位置信号を制御時間ごとに差分を演算し速度信号を生成する。
【００１０】
次に負荷慣性モーメントが変動した場合の応答特性を速度制御部がＰＩ制御とＰＩＤ制御の場合の比較を行う。図２は速度制御部がＰＩ制御の場合のシミュレーション結果である。条件は、制御時間Ｔｓ＝０．１ｍｓ、位置検出器の分解能は２π／２16ｒａｄ、位置制御比例ゲインＫｐ＝３００ｓ-1、速度制御比例ゲインＫｖ＝４Ｎｍｓ／ｒ、速度制御積分時定数Ｔｖｉ＝５０ｍｓ、電流制御時定数Ｔｃｆ＝０．０５ｍｓ、モータ慣性モーメントＪｍ＝０．００１ｋｇｍ2、負荷慣性モーメントはＪＬ＝０で、２・Ｊｍずつ増加させている。この条件の場合ＪＬ＝６・Ｊｍから振動しはじめている。図３は速度制御部がＰＩＤ制御の場合のシミュレーション結果である。条件は、図２の場合とほぼ同じであるがＫｖ＝１Ｎｍｓ／ｒ、速度制御微分時定数Ｔｖｄ＝０．８ｍｓを追加している。この条件の場合ＪＬ＝１０・ＪｍまではオーバシュートがないがＪＬ＝１２・Ｊｍあたりからオーバシュートを生じている。しかし、ＰＩ制御の場合よりもはるかに安定した動作を行わせることができる。
【００１１】
速度制御を構成するループに位相補償をすることでも同様の効果を得ることができる。実施例では位相補償部を設け、第１トルク指令に位相進み補償を施し、速度制御部をＰＩ制御にして同様の効果を得ている。また位相補償は、速度信号に施しても同様の効果を得ることができる。
【００１２】
本発明の特徴は、速度制御部をＰＩＤ制御にしたり位相補償部を設けたりすることに加えて振動検出部と慣性モーメント設定部を設けて負荷慣性モーメントがモータ慣性モーメントの数十倍になっても安定に制御できるようにした点である。
【００１３】
慣性モーメント補正の自動設定について説明する。振動検出部８は、速度信号とトルク指令より振動レベルを検出し、振動レベルが所定値を超えた場合、慣性モーメント設定部は負荷慣性モーメントをロータ慣性モーメントを補正（定数（Ａ）倍）する。
振動検出部８は図４のようにモータモデルにトルク指令を入力し、モータモデル速度出力と実際のモータ速度との偏差信号を振動レベル信号とする。モータモデルは負荷慣性モーメントをゼロとしてトルク指令に対する速度応答を生成する。実際に負荷が接続されていない場合は、前記モータモデル速度出力と前記実際のモータ速度は、同等となるが、実際の負荷が大きい場合は、前記モータモデル速度出力と前記実際のモータ速度の偏差が大きくなる。
【００１４】
図５は本発明のモータ制御装置の制御方法を示すフローチャートである。図５において、ステップＳＴ１で位置指令と位置信号から速度指令を生成し、ステップＳＴ２で速度指令速度信号と慣性モーメントから第１トルク指令を生成し、ステップＳＴ３で位置検出信号から位置信号を生成し、ステップＳＴ４で速度信号とトルク指令から補正トルク信号を生成し、ステップＳＴ５で第１トルク指令と補正トルクを加算してトルク指令を生成し、ステップＳＴ６で速度信号とトルク指令から振動信号を生成し、ステップＳＴ７で振動信号に応じてモータ慣性モーメントを定数倍し、ステップＳＴ８でトルク指令に基づいてモータを駆動する。なお、各ステップの順序はこれに限るものではない。
【図面の簡単な説明】
【００１５】
【図１】本発明の実施例１の構成を示すブロック図である。
【図２】速度制御がＰＩ制御の場合のシミュレーション結果である。
【図３】速度制御がＰＩＤ制御の場合のシミュレーション結果である。
【図４】本発明の振動検出部の構成を示すブロック図である。
【図５】本発明の制御方法を示すフローチャートである。
【図６】従来の特許文献１の構成を示すブロック図である。
【図７】従来の特許文献２の構成を示すブロック図である。
【図８】従来の特許文献２の位置制御応答を示すグラフである。
【符号の説明】
【００１６】
１  位置制御部
２  速度制御部
３  位相補償部
４  モータ駆動部
５  位置信号生成部
６  速度信号生成部
７  慣性変動抑制部
８  振動検出部
９  慣性モーメント設定部
１０  モータ
１１  位置検出器
【図１】
2008289218.tif 000003
【図２】
2008289218.tif 000004
【図３】
2008289218.tif 000005
【図４】
2008289218.tif 000006
【図５】
2008289218.tif 000007
【図６】
2008289218.tif 000008
【図７】
2008289218.tif 000009
【図８】
2008289218.tif 000010