(57)【要約】  モータ駆動装置（１）は、位置指令を生成する位置指令生成部（１１）と、負荷（４）及びモータ（２）を含む装置の振動を抑制する１段以上の制振フィルタを含み、装置のモデルに対応するモデルパラメータに基づいて決定された制振フィルタを位置指令に適用し、当該制振フィルタが適用されたフィルタ適用後位置指令を出力する制振フィルタ部（１２）と、フィルタ適用後位置指令に基づいてモータ（２）にトルク指令を与えるサーボ制御部（１３）と、ローパスフィルタ部（１４１）と、ローパスフィルタ部（１４１）を通したモータの回転速度及びトルク指令からモデルパラメータを推定するパラメータ推定部（１４２）と、モデルにおける振動発生の有無を判定する振動判定部（１４３）とを備える。
2019239791.tif 000002
【特許請求の範囲】
【請求項１】
負荷が接続されるモータを駆動するモータ駆動装置であって、
前記モータの目標位置に対応する位置指令を生成する位置指令生成部と、
前記負荷及び前記モータを含む装置の振動を抑制する１段以上の制振フィルタを含み、前記１段以上の制振フィルタのうち、前記装置のモデルに対応するモデルパラメータに基づいて決定された制振フィルタを前記位置指令に適用し、当該制振フィルタが適用されたフィルタ適用後位置指令を出力する制振フィルタ部と、
前記フィルタ適用後位置指令に基づいて前記モータにトルク指令を与えるサーボ制御部と、
予め定められたカットオフ周波数以上の周波数成分を除去するローパスフィルタ部と、
前記ローパスフィルタ部を通した前記モータの回転速度及び前記トルク指令から前記モデルパラメータを推定するパラメータ推定部と、
前記装置における振動発生の有無を判定する振動判定部とを備える
モータ駆動装置。
【請求項２】
前記パラメータ推定部は、前記モータの回転速度と前記パラメータ推定部が推定した前記モデルパラメータとを用いて中間トルクを推定する中間トルク推定部を有し、
前記振動判定部は前記中間トルクと前記トルク指令と前記パラメータ推定部が推定した前記モデルパラメータとを用いて前記モデルにおける振動発生の有無を判定する
請求項１に記載のモータ駆動装置。
【請求項３】
負荷が接続されるモータを駆動するモータ駆動装置のサーボ調整方法であって、
前記モータ駆動装置は、
前記モータの目標位置に対応する位置指令を生成する位置指令生成部と、
前記負荷及び前記モータを含む装置の振動を抑制する１段以上の制振フィルタを含み、前記１段以上の制振フィルタのうち、前記装置のモデルに対応するモデルパラメータに基づいて決定された制振フィルタを前記位置指令に適用し、当該制振フィルタが適用されたフィルタ適用後位置指令を出力する制振フィルタ部と、
前記フィルタ適用後位置指令に基づいて前記モータにトルク指令を与えるサーボ制御部とを備え、
前記サーボ調整方法は、
前記１段以上の制振フィルタのうちｉ段（ｉ≧０）の制振フィルタが設定されている場合に、前記位置指令生成部が生成した前記位置指令に基づき前記負荷の位置決め動作を行う位置決めステップと、
前記モデルが２慣性系と仮定して、ローパスフィルタを施した前記モータの回転速度及び前記トルク指令から前記モデルパラメータを推定する推定ステップと、
前記モデルにおいて第ｉ＋１慣性系の振動成分の発生の有無を判定する判定ステップと、
前記判定ステップにおいて、前記第ｉ＋１慣性系の振動成分の発生が有ると判定した場合、第ｉ＋１段目の制振フィルタを有効にし、推定した前記モデルパラメータを設定する設定ステップとを含み、
前記推定ステップ、前記判定ステップ及び前記設定ステップを、前記判定ステップで振動成分の発生が無いと判定されるまで繰り返す
サーボ調整方法。
【請求項４】
前記推定ステップにおいて、前記モータの回転速度と前記推定ステップにおいて推定した前記モデルパラメータとを用いて中間トルクを推定し、
前記判定ステップにおいて、前記中間トルクと前記トルク指令と前記推定ステップにおいて推定した前記モデルパラメータとを用いて前記モデルにおける振動発生の有無を判定する
請求項３に記載のサーボ調整方法。
【請求項５】
前記ローパスフィルタのカットオフ周波数を降下させる降下ステップをさらに含み、
前記推定ステップと前記降下ステップとを繰り返し、前記カットオフ周波数が、前記推定ステップで推定された前記モデルの共振周波数以下になったときの前記モデルパラメータを前記第ｉ＋１段目の制振フィルタに適用する
請求項３又は４に記載のサーボ調整方法。
【発明の詳細な説明】
【技術分野】
【０００１】
本開示は、モータ駆動装置及びサーボ調整方法に関する。
【背景技術】
【０００２】
従来のモータ駆動装置は、サーボモータを外部指令通りに駆動制御する位置、速度及び電流の制御などの基本機能を有する。さらに、駆動する負荷としての装置の振動を除去する制振フィルタと呼ばれる機能をモータ駆動装置に搭載する技術が提案されている（例えば、特許文献１）。特許文献１に開示された制振フィルタは、負荷としての装置の共振周波数や反共振周波数、イナーシャなどのモデルパラメータに基づいて振動を除去する。このような制振フィルタを高精度に機能させるためには、モータ駆動装置の各モデルパラメータを精度良く推定しなければならない。【０００３】
この種のモデルパラメータ推定手法に関する技術として、例えば特許文献２及び特許文献３に開示された技術が知られている。特許文献２には、モータ制御装置に多数の周波数成分を含むトルク指令を与え、このトルク指令とモータ実速度とから周波数特性を生成し、その周波数特性を基に負荷としての装置のモデルパラメータを推定する技術が開示されている。【０００４】
一方で特許文献３には、負荷としての装置が通常の位置決め動作をしている状態でトルク指令及びモータ回転速度を測定し、そのデータに基づいてモデルパラメータを推定する技術が開示されている。
【先行技術文献】
【特許文献】
【０００５】
【特許文献１】特開２０１０−１３６５０４号公報
【特許文献２】特開２００８−１９９７５９号公報
【特許文献３】特開２００９−８１９８５号公報
【発明の概要】
【発明が解決しようとする課題】
【０００６】
しかしながら、上記の各技術は以下のような問題点を有している。【０００７】
特許文献２に開示された技術では、様々な周波数成分を含むトルク指令を与えるので、負荷としての装置に大きな負荷が加わる。また、例えば、当該装置として位置決めを行う装置を用いる場合、実際の位置決め動作でモデルパラメータを推定するわけではないので、実動作上で制振フィルタが必要か否かの判断が付かない。例えば、装置の特性として振動が発生する場合でも、実際の位置決め動作では振動しないということがある。このような場合に上記技術は対応できない。【０００８】
特許文献３に開示された技術では、負荷としての装置が２慣性系であることを前提としてモデルパラメータを推定しており、剛体モデルか否かを判断することができない。そのため、制振フィルタが不要な剛体モデルの装置を動作させる場合であっても、不必要に制振フィルタを適用してしまい、結果として位置決め速度の低下を招く。また、多慣性系の装置を動作させる場合であったとしても、当該装置が、例えば、２慣性系なのか３慣性系なのかによって適用するべき制振フィルタの段数も異なる。当該装置がどのようなモデルであるのかが分からなければ、適用すべき制振フィルタの段数を判断できないため、誤ったモデルの制振フィルタを適用し得る。【０００９】
本開示はこれらの課題を解決するものであり、負荷及びモータを含む装置のモデルに必要な制振フィルタの段数を判定し、かつ、当該制振フィルタを高精度に機能させることができるモータ駆動装置及びサーボ調整方法を提供することを目的とする。
【課題を解決するための手段】
【００１０】
上記課題を解決するために、本開示に係るモータ駆動装置の一態様は、負荷が接続されるモータを駆動するモータ駆動装置であって、前記モータの目標位置に対応する位置指令を生成する位置指令生成部と、前記負荷及び前記モータを含む装置の振動を抑制する１段以上の制振フィルタを含み、前記１段以上の制振フィルタのうち、前記装置のモデルに対応するモデルパラメータに基づいて決定された制振フィルタを前記位置指令に適用し、当該制振フィルタが適用されたフィルタ適用後位置指令を出力する制振フィルタ部と、前記フィルタ適用後位置指令に基づいて前記モータにトルク指令を与えるサーボ制御部と、予め定められたカットオフ周波数以上の周波数成分を除去するローパスフィルタ部と、前記ローパスフィルタ部を通した前記モータの回転速度及び前記トルク指令から前記モデルパラメータを推定するパラメータ推定部と、前記装置における振動発生の有無を判定する振動判定部とを備える。【００１１】
これにより、負荷及びモータを含む装置のモデルに対応するモデルパラメータを推定できる。さらに、推定したモデルパラメータと、トルク指令とを用いて、振動が発生したか否かを判定することで、モデルに必要な制振フィルタの段数を判定できる。また、ローパスフィルタ部によって、パラメータ推定部に入力される信号の高周波成分を除去することにより、モデルパラメータを高精度に推定できる。さらに、高精度に推定したモデルパラメータを用いることで制振フィルタを高精度に機能させることができる。【００１２】
また、上記課題を解決するために、本開示に係るサーボ調整方法の一態様は、負荷が接続されるモータを駆動するモータ駆動装置のサーボ調整方法であって、前記モータ駆動装置は、前記モータの目標位置に対応する位置指令を生成する位置指令生成部と、前記負荷及び前記モータを含む装置の振動を抑制する１段以上の制振フィルタを含み、前記１段以上の制振フィルタのうち、前記装置のモデルに対応するモデルパラメータに基づいて決定された制振フィルタを前記位置指令に適用し、当該制振フィルタが適用されたフィルタ適用後位置指令を出力する制振フィルタ部と、前記フィルタ適用後位置指令に基づいて前記モータにトルク指令を与えるサーボ制御部とを備え、前記サーボ調整方法は、前記１段以上の制振フィルタのうちｉ段（ｉ≧０）の制振フィルタが設定されている場合に、前記位置指令生成部が生成した前記位置指令に基づき前記負荷の位置決め動作を行う位置決めステップと、前記モデルが２慣性系と仮定して、ローパスフィルタを施した前記モータの回転速度及び前記トルク指令から前記モデルパラメータを推定する推定ステップと、前記モデルにおいて第ｉ＋１慣性系の振動成分の発生の有無を判定する判定ステップと、前記判定ステップにおいて、前記第ｉ＋１慣性系の振動成分の発生が有ると判定した場合、第ｉ＋１段目の制振フィルタを有効にし、推定した前記モデルパラメータを設定する設定ステップとを含み、前記推定ステップ、前記判定ステップ及び前記設定ステップを、前記判定ステップで振動成分の発生が無いと判定されるまで繰り返す。【００１３】
これにより、負荷及びモータを含む装置のモデルに対応するモデルパラメータを推定できる。さらに、推定したモデルパラメータと、トルク指令とを用いて、振動が発生したか否かを判定することで、モデルに必要な制振フィルタの段数を判定できる。また、ローパスフィルタを施すことでモータの回転速度及びトルク指令の高周波成分を除去することにより、モデルパラメータを高精度に推定できる。さらに、高精度に推定したモデルパラメータを用いることで制振フィルタを高精度に機能させることができる。
【発明の効果】
【００１４】
本開示により、負荷及びモータを含む装置のモデルに必要な制振フィルタの段数を判定し、かつ、当該制振フィルタを高精度に機能させることができるモータ駆動装置及びサーボ調整方法を提供できる。
【図面の簡単な説明】
【００１５】
【図１】図１は、実施の形態に係るモータ駆動装置の構成を示すブロック図である。
【図２】図２は、実施の形態に係るモータ駆動装置の制振フィルタ部の構成を示すブロック図である。
【図３】図３は、実施の形態に係るモデルにおけるトルク指令と回転速度との関係を示す図である。
【図４】図４は、実施の形態に係るモータ駆動装置のパラメータ推定部の詳細構成を示すブロック図である。
【図５】図５は、実施の形態に係るモータ駆動装置の振動判定部の詳細構成を示すブロック図である。
【図６】図６は、実施の形態に係るサーボ調整方法を示すフローチャートである。
【図７】図７は、実施の形態に係るモデルパラメータ及び中間トルクの推定方法を示すフローチャートである。
【発明を実施するための形態】
【００１６】
以下、本開示の実施の形態について、図面を用いて詳細に説明する。なお、以下で説明する実施の形態は、いずれも本開示の一具体例を示すものである。以下の実施の形態で示される数値、形状、構成要素、構成要素の配置位置及び接続形態、ステップ、ステップの順序等は、一例であり、本開示を限定する主旨ではない。また、以下の実施の形態における構成要素のうち、本開示の最上位概念を示す独立請求項に記載されていない構成要素については、任意の構成要素として説明される。また、各図は、必ずしも厳密に図示したものではない。各図において、実質的に同一の構成については同一の符号を付し、重複する説明は省略又は簡略化する。
【００１７】
（実施の形態）
実施の形態に係るモータ駆動装置について図１を用いて説明する。図１は、本実施の形態に係るモータ駆動装置１の構成例を示すブロック図である。図１には、モータ駆動装置１の他に、モータ２、検出器３及び負荷４も併せて示されている。
【００１８】
モータ２は、モータ駆動装置１によって駆動される電動機であって負荷４が接続される。
【００１９】
検出器３は、モータ２の回転速度を検出する計測機器である。検出器３として例えばエンコーダを用いることができる。
【００２０】
負荷４は、モータ２に接続される装置である。本実施の形態では、負荷４は、モータ駆動装置１によって位置決め動作を行う装置である。負荷４として、例えば、半導体製造装置、工作機械などの産業用装置を用いることができる。
【００２１】
モータ駆動装置１は、負荷４が接続されるモータ２を駆動する駆動装置である。図１に示されるように、モータ駆動装置１は、機能的には、位置指令生成部１１、制振フィルタ部１２、サーボ制御部１３及び制振フィルタ設定部１４を備える。
【００２２】
位置指令生成部１１は、モータ２の目標位置に対応する位置指令を生成する。本実施の形態では、位置指令生成部１１は、指定された位置決め動作に基づいて位置指令を生成し、制振フィルタ部１２に出力する。位置決め動作は、モータ駆動装置１の外部から指定されてもよいし、モータ駆動装置１の内部で指定されてもよい。
【００２３】
制振フィルタ部１２は、位置指令生成部１１から入力された位置指令に、モデルパラメータに基づいて装置振動を抑制するように加工したフィルタを施し、フィルタを施されたフィルタ適用後位置指令を出力する。ここで、制振フィルタ部１２について図２を用いて説明する。
【００２４】
図２は、本実施の形態に係るモータ駆動装置１の制振フィルタ部１２の構成を示すブロック図である。なお、図２には、位置指令生成部１１及びサーボ制御部１３も併せて示されている。図２に示されるように、制振フィルタ部１２は、負荷４及びモータ２を含む装置の振動を抑制する１段以上の制振フィルタを含む。本実施の形態では、制振フィルタ部１２は、Ｎ段（Ｎ≧１）の制振フィルタＦ１〜ＦＮを含む。
【００２５】
図２に示されるように、制振フィルタ部１２は、Ｎ段の制振フィルタＦ１〜ＦＮの各々の前段に配置され、制振フィルタの有効及び無効を切り替える制振フィルタ切替部Ｓ１〜ＳＮを有する。以上のような構成により、制振フィルタ部１２は、１段以上の制振フィルタのうち、負荷４及びモータ２を含む装置のモデルに対応するモデルパラメータに基づいて決定された制振フィルタを位置指令に適用し、当該制振フィルタが適用されたフィルタ適用後位置指令を出力する。
【００２６】
なお、図１に示される例では、制振フィルタ設定部１４は、モータ駆動装置１の内部に配置されているが、モータ駆動装置１の外部に配置されてもよい。
【００２７】
サーボ制御部１３は、制振フィルタ部１２から出力されたフィルタ適用後位置指令に基づいてモータ２にトルク指令を与える。サーボ制御部１３は、制振フィルタ部１２から出力されたフィルタ適用後位置指令と検出器３が示す回転位置とからモータ２へ与えるトルク指令を生成する。
【００２８】
制振フィルタ設定部１４は、ローパスフィルタ部１４１、パラメータ推定部１４２及び振動判定部１４３を有する。ローパスフィルタ部１４１は、予め定められたカットオフ周波数以上の周波数成分を除去するフィルタである。ローパスフィルタ部１４１は、検出器３によって検出されたモータ２の回転位置から計算されるモータ２の回転速度、及び、トルク指令の高周波成分をそれぞれ除去したローパスフィルタ後の回転速度とローパスフィルタ後のトルク指令とを生成する。
【００２９】
パラメータ推定部１４２は、ローパスフィルタ部１４１を通したモータ２の回転速度及びトルク指令からモデルパラメータを推定する。パラメータ推定部１４２は、負荷４及びモータ２を含む装置のモデルを２慣性系と仮定し、総イナーシャ、共振周波数、共振減衰比、反共振周波数及び共振減衰比を推定する機能を有する。
【００３０】
振動判定部１４３は、負荷４及びモータ２を含む装置のモデルにおける振動発生の有無を判定する。本実施の形態では、振動判定部１４３は、トルク指令とパラメータ推定部１４２が生成する共振周波数、反共振周波数及び中間トルクとから、位置決め動作時の負荷４の振動の有無を判定する。制振フィルタ部１２はこれらのモデルパラメータと振動発生の有無の判定結果とを基に制振フィルタ部１２の設定を行う。
【００３１】
次に、負荷４及びモータ２を含む装置のモデルについて図３を用いて説明する。図３は、本実施の形態に係るモデルにおけるトルク指令と回転速度との関係を示す図である。本実施の形態では、モデルとしてＮ＋１慣性系モデルを用いる。図３に示されるように、当該モデルは、剛体特性部３０と、第１振動特性部Ｉ１から第Ｎ振動特性部ＩＮまでの振動特性部とで示される。Ｎ＋１慣性系モデルを用いているため、図３には、第１振動特性部Ｉ１から第Ｎ振動特性部ＩＮまで示されているが、例えば、モデルが２慣性系の場合には第１振動特性部Ｉ１のみのブロック図で表され、モデルが３慣性系の場合には第１振動特性部Ｉ１及び第２振動特性部Ｉ２のみのブロック図で表される。図３に示されるτｉｎはサーボ制御部１３から生成されるトルク指令、ωｍは検出器３の出力から算出されるモータ２の回転速度である。また、Ｊａｌｌは総イナーシャ、ωｐ（ｉ）は第ｉ振動特性部Ｉｉの共振周波数、ζｐ（ｉ）は第ｉ振動特性部Ｉｉの共振減衰比、ωｚ（ｉ）は第ｉ振動特性部Ｉｉの反共振周波数、ζｚ（ｉ）は第ｉ振動特性部Ｉｉの反共振減衰比をそれぞれ表す。これらのパラメータは、本実施の形態に係るパラメータ推定部１４２によって推定されるモデルパラメータである。さらに、τＭ（ｉ）は第ｉ振動特性部Ｉｉの中間トルクでモータ２の回転速度ωｍと推定されたモデルパラメータから算出される値である。回転速度ωｍとトルク指令τｉｎとの関係を伝達関数で表すと、以下の式（１）となる。
【００３２】
【数１】
2019239791.tif 000003
【００３３】
さらに、回転速度ωｍと第１慣性系Ｉ１の中間トルクτＭ（１）との関係、及び、第ｉ慣性系Ｉｉの中間トルクτＭ（ｉ）と第ｉ＋１慣性系Ｉｉ＋１の中間トルクτＭ（ｉ＋１）との関係は、それぞれ式（２）及び式（３）で表される。
【００３４】
【数２】
2019239791.tif 000004
【００３５】
【数３】
2019239791.tif 000005
【００３６】
次に、パラメータ推定部１４２について図４を用いて説明する。図４は、本実施の形態に係るモータ駆動装置１のパラメータ推定部１４２の詳細構成を示すブロック図である。パラメータ推定部１４２は、中間トルク推定部１４２ａと、２慣性系モデルパラメータ推定部１４２ｂとを有し、モデルを２慣性系と仮定して推定を行う。
【００３７】
中間トルク推定部１４２ａは、モータ２の回転速度とパラメータ推定部１４２が推定したモデルパラメータとを用いて中間トルクを推定する。図４に示すとおり、パラメータ推定部１４２においては、モータ２の回転速度ωｍとトルク指令τｉｎ及び、本実施の形態により既に推定された第１振動特性部Ｉ１から第ｉ振動特性部Ｉｉまでのモデルパラメータ
【００３８】
【数４】
2019239791.tif 000006
【００３９】
と、推定された総イナーシャ
【００４０】
【数５】
2019239791.tif 000007
【００４１】
とが入力となる。ただし、ｉ＝０のときは、回転速度ωｍ及びトルク指令τｉｎのみが入力となる。
【００４２】
中間トルク推定部１４２ａは式（３）の関係を用いて、中間トルクτＭ（ｉ＋１）を算出する。具体的には回転速度ωｍと各推定されたモデルパラメータとが与えられているので、式（３）の伝達関数の逆数で表されるフィルタをτＭ（ｉ）に施すと中間トルクの推定値
【００４３】
【数６】
2019239791.tif 000008
【００４４】
が得られる。なお、式（３）では連続系の伝達関数として表されている。離散系の伝達関数の場合、式（３）を双一次変換法で離散化することで、中間トルクτＭ（ｉ＋１）はτＭ（ｉ）に対しデジタルＩＩＲフィルタを施すことで得られる関係となるため、中間トルクの推定値は、この関係を用いて算出されてもよい。
【００４５】
２慣性系モデルパラメータ推定部１４２ｂでは、中間トルクの推定値
【００４６】
【数７】
2019239791.tif 000009
【００４７】
とτｉｎとが以下の式（４）の関係を有すると仮定する。
【００４８】
【数８】
2019239791.tif 000010
【００４９】
これにより、モデルパラメータ
【００５０】
【数９】
2019239791.tif 000011
【００５１】
の推定を行う。
【００５２】
このようなモデルパラメータの推定においては、特許文献２などで示されている最小二乗法による方法の適用が例として挙げられる。なお、モデルパラメータ
【００５３】
【数１０】
2019239791.tif 000012
【００５４】
は全て０以上になるので、この条件を制約条件式とした最適化問題を最急降下法などの最適化手法を用いて解いてもよい。この方法を用いることで、パラメータ推定部１４２の出力として第ｉ＋１慣性系のモデルパラメータ
【００５５】
【数１１】
2019239791.tif 000013
【００５６】
及び中間トルク
【００５７】
【数１２】
2019239791.tif 000014
【００５８】
の推定結果が得られる。
【００５９】
なお、ｉ＝０のときのみ、以下の式（５）で表される仮定を用いる。
【００６０】
【数１３】
2019239791.tif 000015
【００６１】
これにより、総イナーシャを含めてモデルパラメータの推定を行った後、推定された総イナーシャ
【００６２】
【数１４】
2019239791.tif 000016
【００６３】
を用いて中間トルク
【００６４】
【数１５】
2019239791.tif 000017
【００６５】
の推定を行う。また、総イナーシャが別途推定済みだった場合、その結果を用いてもよい。
【００６６】
次に、振動判定部１４３について説明する。図５は、本実施の形態に係るモータ駆動装置１の振動判定部１４３の詳細構成を示すブロック図である。図５に示されるように、振動判定部１４３は、トルク比較振動判定部１４３ａと、周波数比較振動判定部１４３ｂと、判定結合部１４３ｃとを有する。振動判定部１４３はトルク指令τｉｎと推定された中間トルク
【００６７】
【数１６】
2019239791.tif 000018
【００６８】
共振周波数
【００６９】
【数１７】
2019239791.tif 000019
【００７０】
及び反共振周波数
【００７１】
【数１８】
2019239791.tif 000020
【００７２】
とを入力として振動発生の有無、つまり第ｉ＋１段目の制振フィルタの要否を判定する。
【００７３】
具体的には、第ｉ＋１慣性系の振動成分が発生しない場合、つまり第ｉ＋１段目の制振フィルタが不要の場合は、中間トルクτＭ（ｉ＋１）とトルク指令τｉｎとは、ほぼ一致するはずである。従って、振動判定部１４３のトルク比較振動判定部１４３ａは、推定された中間トルク
【００７４】
【数１９】
2019239791.tif 000021
【００７５】
とτｉｎとの差分の最大値が閾値以内であれば第ｉ＋１慣性系の振動は発生していないと判断し、第ｉ＋１段目の制振フィルタは不要という出力を行う。なお、ここで振動判定を行う場合に、当該差分の平均値又は中央値を用いてもよい。
【００７６】
さらに、共振周波数と反共振周波数値の比が１となる特性は、剛体モデルが示す特性である。剛体モデルでは振動が発生しないため、周波数比較振動判定部１４３ｂでは、比
【００７７】
【数２０】
2019239791.tif 000022
【００７８】
が閾値以上の場合に振動無しと判断する。
【００７９】
判定結合部１４３ｃは、トルク比較振動判定部１４３ａ及び周波数比較振動判定部１４３ｂの判定結果を結合して最終的に第ｉ＋１段目の制振フィルタの要否の判定を行う。判定結合部１４３ｃが行う判定結合は、両判定結果の論理和でもよいし、論理積でもよい。
【００８０】
次に、本実施の形態に係るモータ駆動装置１におけるサーボ調整方法について図６を用いて説明する。図６は、本実施の形態に係るサーボ調整方法を示すフローチャートである。図６における変数ｉは、処理時における設定済み制振フィルタの段数を示す。
【００８１】
図６に示されるように、まず、設定済み制振フィルタ数ｉを０に設定する（Ｓ０）。
【００８２】
次に、ステップＳ１では、位置指令生成部１１が生成した位置指令に基づき負荷の位置決め動作を行う。ここでは、実際に位置指令生成部１１から位置指令を出力し、モータ２を駆動させる。制振フィルタ設定部１４は、このときのサーボ制御部１３から出力されるトルク指令τｉｎと検出器３の出力から算出されるモータの回転速度ωｍとを時系列的に記録する。
【００８３】
次に、ステップＳ２では、モデルが２慣性系と仮定して、ローパスフィルタを施したモータ２の回転速度ωｍ及びトルク指令τｉｎからモデルパラメータを推定する。ステップＳ２において、モータ２の回転速度ωｍと、本ステップにおいて推定したモデルパラメータとを用いて中間トルクを推定する。このステップではモデルが２慣性系と仮定してモデルパラメータを推定するが、モデルが実際には３次、４次などの高次の慣性系であっても、精度良くモデルパラメータを推定するためには、高周波振動成分の影響を除去し、推定したい低周波成分のみを残す必要がある。そのため回転速度ωｍ及びトルク指令τｉｎに対し、ローパスフィルタ部１４１のローパスフィルタを施して高周波成分を除去する。ただし、推定したい共振周波数及び反共振周波数が未知のため、ローパスフィルタのカットオフ周波数は一意に定めることはできない。そこで、本実施の形態では、ローパスフィルタのカットオフ周波数を徐々に下げていき、その都度、モデルパラメータの推定を行い、推定された共振周波数がカットオフ周波数よりも大きくなったときの推定値をモデルパラメータの推定結果として採用する。ステップＳ２の具体的な方法を図７を用いて説明する。図７は、本実施の形態に係るモデルパラメータ及び中間トルクの推定方法を示すフローチャートである。
【００８４】
図７に示されるように、ステップＳ２１では、ローパスフィルタのカットオフ周波数を初期化する。ここでは、カットオフ周波数の初期値をなるべく大きく設定する。例えば、カットオフ周波数の初期値をモータ駆動装置１の制振周波数と設定し得る最大値としてもよい。
【００８５】
次に、ステップＳ２２では、回転速度ωｍ及びトルク指令τｉｎに対し、指定したカットオフ周波数のローパスフィルタを施し、ローパスフィルタを施した回転速度ωｍ’とトルク指令τｉｎ’とを得る。続いて、回転速度ωｍ’及びトルク指令τｉｎ’をパラメータ推定部１４２に入力して、各モデルパラメータの中間トルクの推定結果を得る。
【００８６】
次に、ステップ２３において、変数ｉが０か否かを判定する。ここでｉが０でなければ（Ｓ２３でＮｏ）、ステップＳ２３１にて中間トルクの推定を行い、その推定結果からステップＳ２４１にてモデルパラメータ（共振周波数、反共振周波数、共振減衰比、反共振減衰比）の推定を行う。一方で、ｉ＝０であれば（Ｓ２３でＹｅｓ）、ステップＳ２３２にてモデルパラメータの推定を行い、その結果からステップＳ２４２にて中間トルクを推定する。
【００８７】
次に、ステップＳ２５では、ローパスフィルタのカットオフ周波数と推定した共振周波数
【００８８】
【数２１】
2019239791.tif 000023
【００８９】
とを比較する。カットオフ周波数が当該共振周波数より大きければ（Ｓ２５でＮｏ）、ステップＳ２６でカットオフ周波数を降下させて更新し、ステップＳ２２に戻る。上記モデルパラメータを推定するステップとステップＳ２６とを繰り返し、カットオフ周波数が推定された共振周波数以下になったときに（Ｓ２５でＹｅｓ）、ステップＳ２を終了し、そのときに推定したモデルパラメータと中間トルクとをパラメータ推定部１４２は出力する。このように、本実施の形態では、回転速度ωｍ及びトルク指令τｉｎから共振周波数より高い周波数成分を最大限に除去できるため、より高精度にモデルパラメータを推定できる。
【００９０】
図６に戻り、ステップＳ３では、モデルにおいて第ｉ＋１慣性系の振動成分の発生の有無を判定する。具体的には、中間トルクとトルク指令と推定したモデルパラメータとを用いてモデルにおける振動発生の有無を判定する。本実施の形態では、トルク指令τｉｎとステップＳ２が出力した中間トルク並びに共振周波数及び反共振周波数から、上述の振動判定部１４３を用いて振動発生の有無を判定する。
【００９１】
ステップＳ３で第ｉ＋１慣性系の振動成分の発生が無いと判断した場合（Ｓ３で振動無し）、第ｉ＋１段目の制振フィルタの設定を行うことなく、処理を終了する。ステップＳ３で第ｉ＋１慣性系の振動成分の発生が有ると判断した場合（Ｓ３で振動有り）、ステップＳ４に移行する。
【００９２】
ステップＳ４では第ｉ＋１段目の制振フィルタに対し、第ｉ＋１段目の制振フィルタを有効化し、推定したモデルパラメータ
【００９３】
【数２２】
2019239791.tif 000024
【００９４】
の設定を行う。
【００９５】
そして、ステップＳ５において、設定済み制振フィルタ数を表す変数ｉをｉ＋１に更新する。続いて、ステップＳ６において、変数ｉがモータ駆動装置１に搭載している制振フィルタの段数Ｎより小さいか否かを判断する。ここで変数ｉが段数Ｎより小さいならば（Ｓ６でＹｅｓ）、ステップＳ２に戻る。一方、変数ｉが段数Ｎ以上ならば（Ｓ６でＮｏ）、処理を終了する。
【００９６】
このようにトルク指令τｉｎと中間トルクτＭとの関係から振動発生の有無を判定し、制振フィルタの要否を判断する処理を繰り返すことで、必要とされる制振フィルタの段数を判断するのと同時に各制振フィルタに設定するモデルパラメータを推定することができる。
【００９７】
以上のように、本実施の形態に係るモータ駆動装置１では、負荷４及びモータ２を含む装置のモデルに対応するモデルパラメータを推定できる。さらに、推定したモデルパラメータと、トルク指令とを用いて、振動が発生したか否かを判定することで、モデルに必要な制振フィルタの段数を判定できる。また、ローパスフィルタ部１４１によって、パラメータ推定部に入力される信号の高周波成分を除去することにより、モデルパラメータを高精度に推定できる。さらに、高精度に推定したモデルパラメータを用いることで制振フィルタを高精度に機能させることができる。
【００９８】
また、中間トルク及びトルク指令とモデルパラメータとを用いて振動発生の有無を判定することで、高精度に振動発生の有無を判定できる。
【００９９】
以上のように、本実施の形態に係るモータ駆動装置１は、負荷４が接続されるモータ２を駆動するモータ駆動装置１であって、モータ２の目標位置に対応する位置指令を生成する位置指令生成部１１と、負荷４及びモータを含む装置の振動を抑制する１段以上の制振フィルタを含み、当該１段以上の制振フィルタのうち、当該装置のモデルに対応するモデルパラメータに基づいて決定された制振フィルタを位置指令に適用し、当該制振フィルタが適用されたフィルタ適用後位置指令を出力する制振フィルタ部１２と、フィルタ適用後位置指令に基づいてモータ２にトルク指令を与えるサーボ制御部１３と、予め定められたカットオフ周波数以上の周波数成分を除去するローパスフィルタ部１４１と、ローパスフィルタ部１４１を通したモータ２の回転速度及びトルク指令からモデルパラメータを推定するパラメータ推定部１４２と、当該装置における振動発生の有無を判定する振動判定部１４３とを備える。
【０１００】
これにより、負荷４及びモータ２を含む装置のモデルに対応するモデルパラメータを推定できる。さらに、推定したモデルパラメータと、トルク指令とを用いて、振動が発生したか否かを判定することで、モデルに必要な制振フィルタの段数を判定できる。また、ローパスフィルタ部１４１によって、パラメータ推定部１４２に入力される信号の高周波成分を除去することにより、モデルパラメータを高精度に推定できる。さらに、高精度に推定したモデルパラメータを用いることで制振フィルタを高精度に機能させることができる。
【０１０１】
また、本実施の形態に係るモータ駆動装置１の一態様において、パラメータ推定部１４２は、モータ２の回転速度とパラメータ推定部１４２が推定したモデルパラメータとを用いて中間トルクを推定する中間トルク推定部１４２ａを有し、振動判定部１４３は中間トルクとトルク指令とパラメータ推定部１４２が推定したモデルパラメータとを用いてモデルにおける振動発生の有無を判定してもよい。
【０１０２】
このように、中間トルク及びトルク指令とモデルパラメータとを用いることで、高精度に振動発生の有無を判定できる。
【０１０３】
また、本実施の形態に係るサーボ調整方法は、負荷４が接続されるモータ２を駆動するモータ駆動装置１のサーボ調整方法であって、モータ駆動装置１は、モータ２の目標位置に対応する位置指令を生成する位置指令生成部１１と、負荷４及びモータ２を含む装置の振動を抑制する１段以上の制振フィルタを含み、１段以上の制振フィルタのうち、当該装置のモデルに対応するモデルパラメータに基づいて決定された制振フィルタを位置指令に適用し、当該制振フィルタが適用されたフィルタ適用後位置指令を出力する制振フィルタ部１２と、フィルタ適用後位置指令に基づいてモータ２にトルク指令を与えるサーボ制御部１３とを備え、サーボ調整方法は、１段以上の制振フィルタのうちｉ段（ｉ≧０）の制振フィルタが設定されている場合に、位置指令生成部１１が生成した位置指令に基づき負荷４の位置決め動作を行う位置決めステップと、モデルが２慣性系と仮定して、ローパスフィルタを施したモータ２の回転速度及びトルク指令からモデルパラメータを推定する推定ステップと、モデルにおいて第ｉ＋１慣性系の振動成分の発生の有無を判定する判定ステップと、判定ステップにおいて、第ｉ＋１慣性系の振動成分の発生が有ると判定した場合、第ｉ＋１段目の制振フィルタを有効にし、推定したモデルパラメータを設定する設定ステップとを含み、推定ステップ、判定ステップ及び設定ステップを、判定ステップで振動成分の発生が無いと判定されるまで繰り返す。
【０１０４】
これにより、負荷４及びモータ２を含む装置のモデルに対応するモデルパラメータを推定できる。さらに、推定したモデルパラメータと、トルク指令とを用いて、振動が発生したか否かを判定することで、モデルに必要な制振フィルタの段数を判定できる。また、ローパスフィルタを施すことでモータ２の回転速度及びトルク指令の高周波成分を除去することにより、モデルパラメータを高精度に推定できる。さらに、高精度に推定したモデルパラメータを用いることで制振フィルタを高精度に機能させることができる。
【０１０５】
また、本実施の形態に係るサーボ調整方法において、推定ステップにおいて、モータ２の回転速度と推定ステップにおいて推定したモデルパラメータとを用いて中間トルクを推定し、判定ステップにおいて、中間トルクとトルク指令と推定ステップにおいて推定したモデルパラメータとを用いてモデルにおける振動発生の有無を判定してもよい。
【０１０６】
このように、中間トルク及びトルク指令とモデルパラメータとを用いることで、高精度に振動発生の有無を判定できる。
【０１０７】
また、本実施の形態に係るサーボ調整方法において、ローパスフィルタのカットオフ周波数を降下させる降下ステップをさらに含み、推定ステップと降下ステップとを繰り返し、カットオフ周波数が、推定ステップで推定されたモデルの共振周波数以下になったときのモデルパラメータを第ｉ＋１段目の制振フィルタに適用してもよい。
【０１０８】
これにより、共振周波数より高い周波数成分を最大限に除去できるため、より高精度にモデルパラメータを推定できる。
【０１０９】
（変形例など）
以上、本開示に係るモータ駆動装置及びサーボ調整方法について、実施の形態に基づいて説明したが、本開示は、上記実施の形態に限定されるものではない。
【０１１０】
本開示で述べたモデルパラメータの推定方法は、サーボ内のモータ駆動装置内部での実装とされているが、これはモータ駆動装置１の備える図示しない通信インターフェース（ＲＳ２３２、ＲＳ４８５、ＵＳＢ通信、Ｅｔｈｅｒｎｅｔ接続、Ｂｌｕｅｔｏｏｔｈ（登録商標）通信や無線ＬＡＮなどの無線接続手段など）を通じて、対応した通信手段を備えたパソコンやコンソールなど、別の装置に搭載されていてもよい。またパラメータ推定部のすべての機能をモータ駆動装置１に内蔵しても、なんら本開示の効果を妨げるものではない。
【０１１１】
また、本開示に係るモータ駆動装置１の各構成要素は、専用のハードウェアで構成されるか、各構成要素に適したソフトウェアプログラムを実行することによって実現されてもよい。各構成要素は、ＣＰＵ又はプロセッサなどのプログラム実行部が、ハードディスク又は半導体メモリなどの記録媒体に記録されたソフトウェアプログラムを読み出して実行することによって実現されてもよい。
【０１１２】
そのほか、実施の形態に対して当業者が思いつく各種変形を施して得られる形態や、本開示の趣旨を逸脱しない範囲で実施の形態における構成要素及び機能を任意に組み合わせることで実現される形態も本開示に含まれる。
【産業上の利用可能性】
【０１１３】
本開示に係るモータ駆動装置は、装置やサーボに詳細な知識を持たない作業者でも、位置決め動作から装置のモデルパラメータと適切な制振フィルタの段数を得ることができる手段を提供するものである。このため、本開示に係るモータ駆動装置及びサーボ調整方法は、例えば、半導体製造装置、工作機械などの位置決め動作における振動を抑制することが求められる産業用装置において特に有用である。
【符号の説明】
【０１１４】
１  モータ駆動装置
２  モータ
３  検出器
４  負荷
１１  位置指令生成部
１２  制振フィルタ部
１３  サーボ制御部
１４  制振フィルタ設定部
１４１  ローパスフィルタ部
１４２  パラメータ推定部
１４２ａ  中間トルク推定部
１４２ｂ  ２慣性系モデルパラメータ推定部
１４３  振動判定部
１４３ａ  トルク比較振動判定部
１４３ｂ  周波数比較振動判定部
１４３ｃ  判定結合部
【図１】
2019239791.tif 000025
【図２】
2019239791.tif 000026
【図３】
2019239791.tif 000027
【図４】
2019239791.tif 000028
【図５】
2019239791.tif 000029
【図６】
2019239791.tif 000030
【図７】
2019239791.tif 000031
【国際調査報告】
2019239791.tif 000032
2019239791.tif 000033