JP7124761B2 - 調整支援装置、サーボドライバ、複数のサーボモータの制御パラメータ調整方法及びプログラム - Google Patents

Description

本発明は、調整支援装置、サーボドライバ、複数のサーボモータの制御パラメータ調整方法及びプログラムに関する。

従来、複数のサーボモータを制御する制御装置の制御パラメータは、制御装置の設計段階で予め算出し設定するか、経験やノウハウを有する作業者が調整していた。

特に、制御装置が複数のモータを制御する場合には、各軸に対して、上述の制御パラメータの調整が行われていた（例えば、特許文献１を参照）。

そのため、上述のような従来の方法では、制御パラメータの調整に時間がかかる場合があった。とりわけ、複数のモータを制御する制御装置における制御パラメータの調整において、制御パラメータのひとつであるイナーシャ比については、ガントリ機構やタンデム機構のように複数軸間の干渉が生じ得るために、正確なイナーシャ比を推定することが難しかった。

特開２０１１－２２６７６号公報

本発明は、上記のような問題に鑑みてなされたものであり、複数のサーボモータに対して、より正確な推定イナーシャ比による制御パラメータの調整が可能な技術を提供することを目的とする。

上記の課題を解決するための本発明は、
複数のサーボモータの制御パラメータの調整を支援する調整支援装置であって、
前記サーボモータによって駆動される負荷に対するイナーシャ比の推定値を含むパラメータを取得するパラメータ取得部と、
前記サーボモータを制御する際のイナーシャ比を含むパラメータを設定させるパラメータ設定制御部と、
を備え、
前記パラメータ設定制御部は、前記パラメータ取得部が、前記イナーシャ比の推定値を複数の前記サーボモータの全てについて取得した後に、複数の前記サーボモータの全てについて、取得された該イナーシャ比を設定させることを特徴とする。

このようにすれば、複数のサーボモータにおける推定イナーシャ比をパラメータ取得部が取得するのを待ってパラメータ設定制御部によって複数のサーボモータにイナーシャ比を設定することになるので、複数のサーボモータ間で、イナーシャ比の設定・更新のタイミングを揃えることができる。このため、より正確な推定イナーシャ比による制御パラメータの調整が可能となる。

また、本発明は、
複数の前記サーボモータのうちのいずれかについて前記イナーシャ比を推定する場合には、前記パラメータ設定制御部は、他の前記サーボモータについては、ゲイン及びイナーシャ比を同じ値に設定させるようにしてもよい。

このようにすれば、各サーボモータに対する制御側での応答性のばらつきをなくすことができるので、より正確なイナーシャ比の推定が可能なる。

また、本発明は、
前記パラメータ取得部が取得した前記イナーシャ比の推定値の妥当性を判断する妥当性判断部を備えるようにしてもよい。

このようにすれば、イナーシャ比に影響を与える要因を考慮した妥当性条件を設定することにより、この妥当性条件を満足するイナーシャ比推定値によって制御パラメータの調整が行われるので、より正確な推定イナーシャ比による調整が可能となる。

また、本発明は、
前記複数のサーボモータは、互いに軸干渉を生じ得る負荷を駆動するようにしてもよい。

このように、複数のサーボモータは、互いに軸干渉を生じ得る負荷を駆動する場合には、あるサーボモータが駆動する軸が他のサーボモータに対して負荷として作用し、イナーシャ比の正確な推定が難しいことがあるが、そのような場合にも、正確なイナーシャ比による制御パラメータの調整が可能となる。

また、本発明は、
複数のサーボモータをそれぞれ制御するサーボドライバであって、
前記サーボモータを制御する制御部と、
前記サーボモータによって駆動される負荷に対するイナーシャ比を含むパラメータを推定するパラメータ推定部と、
複数の前記サーボモータのそれぞれにおける前記パラメータの推定値の前記制御部への設定を同期させる設定同期を備えたことを特徴とする。

このように、サーボドライバ間で、イナーシャ比の設定タイミングを同期させることにより、それぞれのサーボモータに対して、より正確な推定イナーシャ比による制御パラメータの調整が可能となる。

また、本発明は、
前記複数のサーボモータは、互いに軸干渉を生じ得る負荷を駆動するようにしてもよい。

このように、複数のサーボモータは、互いに軸干渉を生じ得る負荷を駆動する場合には、あるサーボモータが駆動する軸が他のサーボモータに対して負荷として作用し、イナーシャ比の正確な推定が難しいことがある。しかし、そのような場合にも、サーボドライバ間で推定イナーシャ比の設定タイミングを揃えることにより、正確なイナーシャ比による制御パラメータの調整が可能となる。

また、本発明は、
複数のサーボモータの制御パラメータ調整方法であって、
複数の前記サーボモータのそれぞれによって駆動される負荷に対するイナーシャ比の推定値を含む制御パラメータを、複数の前記サーボモータの全てについて取得するステップ
と、
取得した前記制御パラメータを、複数の前記サーボモータのそれぞれを制御する際の制御パラメータとして設定するステップ、
を含む。

また、本発明は、
複数の前記サーボモータのそれぞれについてのイナーシャ比が推定される際に、他の前記サーボモータについては、ゲイン及びイナーシャ比を同じ値に設定させるステップ、
をさらに含むようにしてもよい。

また、本発明は、
複数の前記サーボモータから取得された前記制御パラメータが妥当であるか否かを判断するステップ、
をさらに含み、
妥当であると判断された前記制御パラメータを、複数の前記サーボモータのそれぞれを制御する際の制御パラメータとして設定するようにしてもよい。

また、本発明は、
前記複数のサーボモータは、互いに軸干渉を生じ得る負荷を駆動するようにしてもよい。

また、本発明は、
複数のサーボモータの制御パラメータ調整方法であって、
複数の前記サーボモータのそれぞれが、該サーボモータによって駆動される負荷に対するイナーシャ比を含む制御パラメータを推定するステップと、
複数の前記サーボモータのうち他の全てのサーボモータに対する前記制御パラメータの推定が完了するのを待って、前記複数の前記サーボモータのそれぞれを制御する際の制御パラメータとして、前記推定された制御パラメータを設定するステップを含む。

また、本発明は、
前記複数のサーボモータは、互いに軸干渉を生じ得る負荷を駆動するようにしてもよい。

また、本発明は、
複数のサーボモータの制御パラメータを調整するためのプログラムであって、
複数の前記サーボモータのそれぞれによって駆動される負荷に対するイナーシャ比の推定値を含む制御パラメータを、複数の前記サーボモータの全てについて取得するステップと、
取得した前記制御パラメータを、複数の前記サーボモータのそれぞれを制御する際の制御パラメータとして設定するステップ、
をコンピュータに実行させるプログラムである。

複数のサーボモータの制御パラメータ調整するためのプログラムであって、
複数の前記サーボモータのそれぞれが、該サーボモータによって駆動される負荷に対するイナーシャ比を含む制御パラメータを推定するステップと、
複数の前記サーボモータのうち他の全てのサーボモータに対する前記制御パラメータの推定が完了するのを待って、前記複数の前記サーボモータのそれぞれを制御する際の制御パラメータとして、前記推定された制御パラメータを設定するステップ、
をコンピュータに実行させるプログラムである。

本発明によれば、複数のサーボモータに対して、より正確なイナーシャ比による制御パラメータの調整が可能となる。

実施例１における制御システムの概略構成を示すブロック図である。 イナーシャ比を正確に推定できない場合の一例を示すグラフである。 イナーシャ比を正確に推定できない現象の原理を説明する図である。 実施例１におけるサーボドライバと調整支援装置の概略構成を示すブロック図である。 実施例１におけるイナーシャ比更新までの流れを示すフローチャートである。 実施例２におけるイナーシャ比更新までの流れを示すフローチャートである。 実施例３におけるサーボドライバと調整支援装置の概略構成を示すブロック図である。 実施例３におけるイナーシャ比更新までの流れを示すフローチャートである。 実施例４における制御システムの概略構成を示すブロック図である。 実施例４におけるサーボドライバの概略構成を示すブロック図である。 実施例４における推定イナーシャ比の設定同期処理の流れを示すフローチャートである。 実施例１の変形例における制御システムの概略構成を示すブロック図である。 実施例４の変形例における制御システムの概略構成を示すブロック図である。

〔適用例〕
以下、本発明の適用例について、図面を参照しつつ説明する。本発明は例えば、図１に示すような調整支援装置９に適用される。図１に示す制御システム１は、負荷機械２を駆動するサーボモータ３，４を制御するシステムであり、調整支援装置９、コントローラ７、サーボドライバ５，６、サーボモータ３，４及び負荷機械２を含む。負荷機械２は、複数のサーボモータ３，４によって駆動されるいわゆる多軸構成を有する。

多軸構成を有する負荷機械を含む制御システムにおいて制御パラメータを調整する際に、各軸のイナーシャ比の推定が行われる。このようなイナーシャ比の推定は、サーボドライバが備えるイナーシャ比推定部によって軸ごとに行われていた。しかし、多軸構成として、ガントリ機構やタンデム機構を含む負荷機械においては、複数のサーボモータによってそれぞれ駆動される軸間で干渉が生じ得る。とりわけ、複数のサーボモータによって駆動される要素の間の機械的連結の剛性が高い場合には、負荷機械を動作させるときに一方の軸が他方の軸に対して負荷として働き、一方の軸のイナーシャ比が大きく推定されることがある。図２は、このようにイナーシャ比が正確に推定できない場合の例を示す。図２の上段は、イナーシャ比推定のために負荷機械２を試行的に動作させるサーボモータ３，４の回転速度を示す（負荷機械２の概略構成については図３（Ｂ）参照）。図２の下段は、上段の負荷機械２に動作によって推定された第１軸２１と第２軸２２のイナーシャ比を示す。実線で示す第１軸２１が主となり、破線で示す第２軸２２が引っ張られる状態となっており、第２軸２２が第１軸２１に対して負荷のように作用している状態である。このため、第１軸２１の推定イナーシャ比は増加する一方で、第２軸２２の推定イナーシャ比は減少し、０になってしまい、第１軸２１及び第２軸２２のイナーシャ比を正確に推定す
ることができない。

図３（Ａ）及び図３（Ｂ）によって、上述の現象が生じる原理について説明する。図３（Ａ）において、（ａ），（ｂ）はそれぞれ第１軸２１と第２軸２２の推定イナーシャ比と制御帯域を模式的に示す。図３（Ｂ）は、負荷機械２のガントリ機構を模式的に示している。ここでは、平行に配置された第１軸２１と第２軸２２とに直交するように機械的に接続された機械要素２３が配置されている。また、図３（Ｂ）では、第１軸２１と第２軸の動作時のトルクの大きさを矢印の長さによって示している。図３（Ａ）に示すように、丸囲み数字「１」で示す状態では第１軸２１と第２軸の推定イナーシャ比は等しい。このとき、負荷機械の剛性が高い場合（各軸の負荷が同等の場合も同様）には、速度比例ゲインも第１軸２１と第２軸について等しく設定されていると、第１軸２１と第２軸に対する制御帯域も等しくなるので、図３（Ｂ）に示すように、第１軸２１と第２軸には同じトルクが発生する。丸囲み数字「１」から丸囲み数字「２」、丸囲み数字「２」から丸囲み数字「３」の状態へと移るに従って、第１軸２１の推定イナーシャ比は増加する（図３（Ａ）の第１軸２１と交差する斜線の位置が第１軸２１の推定イナーシャ比を示す。）。一方で、第２軸の推定イナーシャ比は減少する（図３（Ａ）の第２軸と交差する斜線の位置が第２軸の推定イナーシャ比を示す。）。このとき、第１軸２１のイナーシャ比が高くなる一方で第２軸のイナーシャ比が低くなると、見かけの制御帯域は第２軸の方が第１軸２１よりも低くなる。このため、図３（Ｂ）において、丸囲み数字「２」及び丸囲み数字「３」で示すように、より速度が増加するように第１軸２１に発生するトルクは増加するのに対し、第２軸に発生するトルクは減少し、丸囲み数字「３」ではほとんどトルクが発生していない状態となる。

軸干渉が生じ得る複数の軸ごとにサーボドライバ内でイナーシャ比を推定・更新するために、イナーシャ比を正確に推定できないことに鑑み、制御システム１は、軸干渉が生じ得る複数の軸に対するイナーシャ比の調整を支援する調整支援装置９を備えている。この調整支援装置９は、図４に示すように、コントローラ７の信号中継部７１を介して、サーボドライバ５，６と信号の送受信を行う。ここでは、調整支援装置９は、軸干渉が生じ得る軸に対するサーボドライバ５，６から、それぞれイナーシャ比の推定値を、ドライバ通信部５４，６４を介して取得する。そして、イナーシャ比設定制御部９２から、イナーシャ比の推定値を各サーボドライバ５，６に送信して、同じタイミングで更新させる。サーボドライバ５，６は、イナーシャ比設定制御部９２からドライバ通信部５４，６４を介して受信したイナーシャ比の推定値を記憶部５３，６３に記憶し、この記憶された推定イナーシャ比に基づいて制御部５１，６１がイナーシャ比の設定値を更新する。
このように調整支援装置９によって、イナーシャ比の設定タイミングを揃えることにより、軸干渉を生じ得る負荷機械２に対しても、イナーシャ比を正確に推定することができる。

調整支援装置９は、例えば、所定のプログラムを実行するパーソナルコンピュータやＰＬＣによって実現することができる。また、調整支援装置９は、サーボドライバ５，６及びコントローラ７とは別に構成される場合に限られない。軸干渉を生じ得る複数の軸に対するサーボドライバ５，６を共通して制御するコントローラが調整支援装置９を含んでもよい。また、軸干渉を生じ得る軸に対するサーボドライバ５，６が、調整支援装置９の機能を分担するようにしてもよい。この場合には、サーボドライバ５，６間で通信することにより、イナーシャ比の更新タイミングを揃えるようにすればよい。

〔実施例１〕
以下では、本発明の実施例に係る調整支援装置９について、図面を用いて、より詳細に説明する。

＜装置構成＞
図１は、本実施例に係る調整支援装置９を含む制御システム１の概略構成を示すブロック図である。負荷機械２は、ガントリ機構やタンデム機構のように軸干渉を生じ得る複数の軸を有する多軸構成の機械である。サーボモータ３，４はそれぞれ互いに軸干渉を生じ得る軸を駆動する。負荷機械２は、例えば、図３（Ｂ）に模式的に示すように構成され、サーボモータ３が第１軸２１を駆動し、サーボモータ４が第２軸を駆動する。サーボモータ３，４には、指令信号に従ってサーボモータ３，４の駆動信号を出力するサーボドライバ５，６がそれぞれ接続され、サーボドライバ５，６には、ユーザ又は外部装置からの入力に応じて指令信号を出力するコントローラ７８が接続されている。また、サーボドライバ５，６によるイナーシャ比の調整を支援する調整支援装置９が設けられている。図１では、軸干渉を生じ得る軸を二軸として構成を示しているが、軸干渉を生じ得る軸が三以上である負荷機械についても、各軸に対してサーボモータ、サーボドライバ、コントローラが設けられ、各サーボドライバに調整支援装置９が接続される。

図４は、サーボドライバ５，６とコントローラ７と調整支援装置９の概略構成を示すブロック図である。
サーボドライバ５，６は、コントローラ７から入力される指令に基づいてサーボモータ３，４に駆動電流を出力する制御部５１，６１を含む。制御部５１，６１は、位置制御器、速度制御器、トルク制御器等を含むが、これらは公知の構成を適宜採用することができるので詳細な説明は省略する。サーボドライバ５は、イナーシャ比を推定するためのイナーシャ比推定部５２を含む。コントローラ７は、サーボドライバ５，６と調整支援装置９との間での信号の送受信を中継する信号中継部７１を含む。コントローラ７は、数値制御プログラム等を実行するＣＰＵからなるプロセッサ、メモリ、通信部等を有するが、これらは公知の構成を適宜採用することができるので詳細な説明は省略する。調整支援装置９は、例えば、後述するイナーシャ比を調整するためのプログラムを実行するＣＰＵや当該プログラムやデータを記憶する記憶装置を有するコンピュータにより構成される。また、サーボドライバ５は、サーボモータ３を制御するために必要なイナーシャ比を含む種々の制御パラメータ等のデータや制御プログラムを記憶する記憶部５３を有する。さらに、サーボドライバ５は、外部と通信するためのドライバ通信部５４を有する。サーボドライバ６も同様に、制御部６１、イナーシャ比推定部６２、記憶部６３及びドライバ通信部６４を含むが、各部の構成はサーボドライバと同様であるので説明を省略する。

調整支援装置９は、イナーシャ比推定部５２，６２において推定されたイナーシャ比を、ドライバ通信部５４，６４及び信号中継部７１を介して、サーボドライバ５，６から取得するイナーシャ比取得部９１と、取得したイナーシャ比を、信号中継部７１を介して、それぞれのサーボドライバ５，６に送信するイナーシャ比設定制御部９２を有する。ここでは、イナーシャ比取得部９１がパラメータ取得部に、イナーシャ比設定制御部がパラメータ設定制御部にそれぞれ相当する。
サーボドライバ５，６において、信号中継部７１及びドライバ通信部５４，６４を介して、イナーシャ比設定制御部９２から受信したイナーシャ比は、記憶部５３，６３に記憶され、制御部５１，６１におけるイナーシャ比の更新の際に用いられる。

＜イナーシャ比調整方法＞
図５は、イナーシャ比調整方法としての、サーボドライバ５，６及び調整支援装置９によるイナーシャ比の更新までの流れを示すフローチャートである。
まず、イナーシャ比推定を行う軸を特定する変数ｉに対して、ｉ＝１とおく（ステップＳ１）。ここでは、イナーシャ比の推定を行うべき軸、すなわち、互いに軸干渉が生じ得る複数の軸には、当該軸を特定するために１から順に一意に番号が付されており、このように特定される軸を第ｉ軸として説明する。

次に、負荷機械２によって、軸干渉を生じ得る複数の軸を含む位置決め動作を試行する（ステップＳ２）。そして、第１軸２１のイナーシャ比の推定を行う（ステップＳ３）。推定された第１軸２１のイナーシャ比は、ドライバ通信部５４，６４を介して、調整支援装置９に送信され、イナーシャ比取得部９１に設けられた所定の記憶領域に記録される（ステップＳ４）。

次に、調整支援装置９では、イナーシャ比設定部が、関連軸、すなわち互いに軸干渉を生じ得る複数の軸の全て（図３（Ｂ）の例では第１軸２１及び第２軸２２に対応する）についてイナーシャ比が記憶されているかを判断する（ステップＳ５）。

ステップＳ５においてＹｅｓと判断された場合には、イナーシャ比設定部は、各軸に対するイナーシャ―比の推定値をイナーシャ比取得部９１から読み出して、各軸に対応するサーボドライバ５，６に送信する。サーボドライバ５，６は、ドライバ通信部５４，６４を介して受信したイナーシャ比の推定値を記憶部５３，６３に記憶し、制御部５１，６１が更新に用いるイナーシャ比として設定し、一連の処理を終了する。

ステップＳ５においてＮｏと判断された場合には、ｉをインクリメントし（ステップＳ７）、次の軸（ここでは第２軸）について、ステップＳ２～ステップＳ４の処理を繰り返す。そして、軸干渉が生じ得る複数の軸が二軸である場合には、ステップＳ５においてＹｅｓと判断されるので、ステップＳ６に進む。

このように、軸干渉を生じ得る負荷機械２を駆動・制御する制御システム１において、制御パラメータを調整する際に、各軸の状況に応じたイナーシャ比を正確に推定することができる。

〔実施例２〕
本実施例に係る調整支援装置９を含む制御システム１の構成は実施例１と同じであるので、実施例１と同じ構成については同じ符号を付して説明を省略する。
図６は、本実施例に係るサーボドライバ５，６及び調整支援装置９によるイナーシャ比の更新までの流れを示すフローチャートである。本実施例では、軸干渉を生じ得る複数軸のそれぞれについてイナーシャ比を推定する際に、関連軸についてゲイン及びイナーシャ比を同じ値に設定する（ステップＳ１１）。このように設定した後に、負荷機械２によって、軸干渉を生じ得る複数の軸を含む位置決め動作（ステップＳ２）以降の処理を行う。ステップＳ２以降の処理は実施例１と同じであるため、説明は繰り返さない。イナーシャ比の推定の対象となっている軸以外の関連軸については、対象となっている軸のイナーシャ比の推定が完了するまで、ステップＳ１１において設定されたゲイン及びイナーシャ比に固定される。

関連軸の軸制御の応答性が異なる状態でイナーシャ比の推定を行うと、ある軸の応答性が高くなり、その軸が大きなトルクを出力して動作することになり、イナーシャ比を正確に推定できない場合がある。しかし、上述のように、イナーシャ推定時に関連軸のゲイン及びイナーシャ比を同じ値に設定することにより、関連軸の軸制御の制御側の応答性を等しくすることができるので、イナーシャ比を正解に推定することができる。
なお、本実施例のように、軸制御の制御側の応答性を関連軸について同等となるように設定しても、各自によって駆動される実負荷が異なる場合には、負荷機械２における応答は異なるものとなる。しかし、関連軸の制御を位置制御で行う場合には、負荷が大きい分だけトルクを出力することとなるため、関連軸間で実負荷の配分が異なっていても正確なイナーシャ比を推定することができる。

〔実施例３〕
図７は、本実施例に係る調整支援装置及びサーボドライバの概略構成を示すブロック図である。実施例１及び実施例２と同じ構成については同じ符号を付して説明を省略する。
本実施例では、調整支援装置１９が、イナーシャ比取得部９１及びイナーシャ比設定制御部９２に加えて、妥当性判断部９３を有する。この妥当性判断部９３は、サーボドライバ５，６から取得したイナーシャ比が妥当であるか否かを判断する。これは、負荷機械２においてイナーシャ比の推定のために位置決め動作を試行する際に、この動作が加速度の低い動作である場合には、動作時のトルクがイナーシャ比によるものではなく、摩擦によるものと推定されるからである。

このようなイナーシャ比の推定値が妥当であるか否かの判断方法の例について説明する。イナーシャ比が推定される際には、動摩擦、粘性摩擦及び偏荷重も併せて推定されることが多いため、これらのパラメータによって（偏荷重＋動摩擦＋粘性摩擦）／イナーシャ比を判定値とする。負荷機械２の位置決め動作の加速度が小さい領域では、イナーシャ比が摩擦として推定されるために、イナーシャ比が小さく判定値が大きく表れる。一方で、負荷機械２の位置決め動作の加速度が大きい領域では、イナーシャ比の推定値はほぼ一定値となり、判定値は減少する。このような判定値の特定から、イナーシャ比の妥当性の判断条件として、判定値が１以上である場合に妥当でないと判断し、判定値が１未満である場合に妥当であると判断するようにする。これはイナーシャ比の推定値の妥当性条件の一例であるから、他の条件によってイナーシャ比の推定値の妥当性を判断してもよい。

＜イナーシャ比調整方法＞
図８は、本実施例に係るイナーシャ比調整方法としての、サーボドライバ５，６及び調整支援装置１９によるイナーシャ比の更新までの流れを示すフローチャートである。本実施例では、位置決め動作を試行し（ステップＳ２）、第ｉ軸のイナーシャ比の推定に加えて、偏荷重、動摩擦、粘性摩擦を推定する（ステップＳ２１）。そして、ステップＳ２１において、これらの推定値を、イナーシャ比取得部９１がサーボドライバ５，６からドライバ通信部５４，６４を介して取得し、妥当性判断部９３が、これらの推定値から判定値を算出し、妥当性条件を満たすか否かを判断する（ステップＳ２２）。

ステップＳ２２において、妥当性条件を満たすと判断した場合、すなわち判定値が１未満である場合はステップＳ４に進む。
ステップＳ２２において、妥当性条件を満たさないと判断した場合、すなわち判定値が１以上である場合は、ステップＳ１１に戻る。ステップＳ１１以降の処理を行う際には、イナーシャ設定制御部は、サーボドライバ５，６に位置決め動作の加速度を上げてイナーシャ比等の推定を行わせる。このとき、イナーシャ設定制御部は、メッセージを表示する等により、ユーザに位置決め動作の加速度を上げるように促してもよい。

このようにすれば、推定されたイナーシャ比の妥当性が判断されるので、より正確なイナーシャ比の推定が可能となる。

〔実施例４〕
＜装置構成＞
図９は、本実施例に係る制御システム１１の概略構成を示すブロック図である。本実施例は、実施例１に係る制御システム１における調整制御装置を備えておらず、実施例１とはサーボドライバの構成が異なる。実施例１と同じ構成については同じ符号を付して説明を省略する。図１０は、本実施例に係るサーボドライバ１５，１６の概略構成を示すブロック図である。図１１は、サーボドライバ１５，１６における推定イナーシャ比の設定同期処理の流れを示すフローチャートである。ここでは、サーボドライバが、イナーシャ比を調整するためのプログラムを実行するコンピュータに対応する。

サーボドライバ１５，１６は、それぞれ制御部５１，６１、イナーシャ推定部、記憶部５３，６３、ドライバ通信部５４，６４に加えて、設定同期部５５，６５を有する。互いに軸干渉を生じ得る複数の軸、すなわち関連軸に含まれる複数の軸は、関連軸に含まれる軸を識別する識別情報と当該軸のイナーシャ比推定に関する情報であるイナーシャ比推定フラグを関連付けたイナーシャ比推定テーブルを保有している。関連軸に含まれるいずれの軸もイナーシャ比推定を行っていない状態では、イナーシャ比推定フラグの値は０に設定されている。関連軸に含まれる複数の軸がイナーシャ比を推定する順序は予め定めておく。

図１１を参照して、本実施例に係るイナーシャ比調整方法としての、サーボドライバ１５，１６における推定イナーシャ比の設定同期処理の流れを説明する。
まず、設定同期部５５，６５では、イナーシャ比推定が許可されているか否かを判断する（ステップＳ３１）。すなわち、自らの軸にイナーシャ比推定の順番が巡ってきているかを判断する。第１軸２１が関連軸に含まれる軸のうち最初にイナーシャ比推定を行うべき軸であれば、関連軸に含まれる他の軸の状況にかかわらず、ステップＳ３１でＹｅｓと判断される。このときは、負荷機械２によって、関連軸を含む位置決め動作を試行し（ステップＳ３２）、第１軸２１のサーボドライバ１５，１６のイナーシャ推定部がイナーシャ比推定を行う（ステップＳ３３）。

第１軸２１のイナーシャ比の推定が完了すると、設定同期部５５は、自らが保有するイナーシャ比推定テーブルにおける第１軸２１のイナーシャ比推定フラグの値を１に更新する（ステップＳ３４）。そして、設定同期部５５は、ドライバ通信部５４を介して、関連軸に含まれる他の軸、例えば第２軸のサーボドライバ１６に対して、第１軸２１の識別情報とイナーシャ比推定フラグの値１を送信する（ステップＳ３５）。

第２軸のサーバドライバ１６の設定同期部６５は、第１軸２１からこの情報を受信すると、第１軸２１についてイナーシャ比推定フラグを１に更新する。関連軸に含まれる複数の軸のうち次にイナーシャ比推定を行うべき軸、ここでは第２軸のサーボドライバ１６の設定同期部６５では、予め定めれた順序で直前にイナーシャ比推定を行うこととされている軸についてのイナーシャ比推定フラグが０となっている場合には、イナーシャ比推定を行わない。すなわち、第２軸では、イナーシャ比推定が許可されていないので、ステップＳ３１においてＮｏと判断され、イナーシャ比推定が許可されるのを待機する。ここでは、第２軸のサーボドライバ１６が保有するイナーシャ比推定テーブルでは、直前にイナーシャ比推定を行うこととされている第１軸２１についてのイナーシャ比推定フラグが１に更新されており、ステップＳ３１においてＹｅｓと判断される。従って、第２軸のサーボドライバ１６の設定同期部６５は、イナーシャ比推定部６２にイナーシャ比の推定を行わせる（ステップＳ３２）。第２軸のイナーシャ比の推定が完了すると、同様に、イナーシャ比推定テーブルのイナーシャ比推定フラグを１に更新する（ステップＳ３４）とともに、関連軸に含まれる他の軸に対して、第２軸の識別情報とイナーシャ比推定フラグの値１を送信する（ステップＳ３５）。

第１軸２１に関する処理に戻ると、第１軸２１では、設定同期部５５がドライバ通信部５４を介して、関連軸に含まれる他の軸である第２軸からの識別情報とイナーシャ比推定フラグを受信する（ステップＳ３６）。そして、イナーシャ比推定テーブルにおける第２軸のイナーシャ比推定フラグを１に更新する（ステップＳ３７）。このように、関連軸に含まれる複数の軸で、順番にイナーシャ比推定が行われる。

そして、予め定められた順序において最後にイナーシャ比推定を行うこととされている軸についてのイナーシャ比推定が完了し、イナーシャ比推定テーブルにおいて関連軸に含まれる全ての軸についてイナーシャ比推定フラグが１に更新されるのを待機する（ステッ
プＳ３８）。そして、関連軸に含まれる全ての軸についてイナーシャ比推定フラグが１タイミングで、各軸のサーボドライバ１５，１６の設定同期部５５，５６は、自らの軸のイナーシャ比推定値を記憶部５３，６３に記憶させて、イナーシャ比を更新する（ステップＳ３９）。

このようにすれば、軸干渉を生じ得る複数の軸についてイナーシャ比推定のタイミングが揃えられるので、正確なイナーシャ比の推定が可能となる。

ここでは、軸干渉を生じ得る軸が二つである場合を示しているが、軸干渉を生じ得る軸が三つ以上ある場合には同様に、ドライバ通信部を介して、各サーボドライバ間で行う。
本実施例においても、イナーシャ比を推定する際に、関連軸に含まれる他の軸においてゲイン及びイナーシャ比を同じ値に設定するようにしてもよい。また、イナーシャ比を推定する際に妥当性を判断するようにしてもよい。
また、図４と同様に、ドライバ通信部５４，６４が、コントローラ７の信号中継部７１を介して通信するようにしてもよい。

〔変形例〕
実施例１の制御システム１においては、サーボドライバ５，６を制御するコントローラ７を介して、調整支援装置９が接続されていたが、制御システムの構成はこれに限られない。図１２には、実施例１の変形例に係る制御システム３１の構成を示す。制御システム３１では、サーボドライバ５，６はそれぞれコントローラ７，８によって制御される。そして、調整支援装置９は、コントローラ７，８を介することなく、サーボドライバ５，６と接続されている。サーボドライバ５，６及び調整支援装置９の構成及び動作については、図４に示した制御システム１におけるものとコントローラ７の信号中継部７１による信号の中継が省略されている点を除いて同一であるため、詳細な説明は省略する。
また、実施例４の制御システム１１においては、サーボドライバ５，６を制御するコントローラ７を介して、調整支援装置９が接続されていたが、制御システムの構成はこれに限られない。図１３には、実施例４の変形例に係る制御システム４１の構成を示す。制御システム４１では、サーボドライバ５，６はそれぞれコントローラ７，８によって制御される。サーボドライバ５，６の構成及び動作については、図１０に示した制御システム１１におけるものと同一であるため、詳細な説明は省略する。

なお、以下には本発明の構成要件と実施例の構成とを対比可能とするために、本発明の構成要件を図面の符号付きで記載しておく。
＜発明１＞
複数のサーボモータ（３，４）の制御パラメータの調整を支援する調整支援装置（９）であって、
前記サーボモータ（３，４）によって駆動される負荷に対するイナーシャ比の推定値を含むパラメータを取得するパラメータ取得部（９１）と、
前記サーボモータを制御する際のイナーシャ比を含むパラメータを設定させるパラメータ設定制御部（９２）と、
を備え、
前記パラメータ設定制御部（９２）は、前記パラメータ取得部（９１）が、前記イナーシャ比の推定値を複数の前記サーボモータの全て（３，４）について取得した後に、複数の前記サーボモータの全て（３，４）について、取得された該イナーシャ比を設定させることを特徴とする調整支援装置（９）。
＜発明２＞
複数のサーボモータ（３，４）をそれぞれ制御するサーボドライバ（１５，１６）であって、
前記サーボモータ（３，４）を制御する制御部（５１，６１）と、
前記サーボモータ（３，４）によって駆動される負荷に対するイナーシャ比を含むパラメータを推定するパラメータ推定部（５２，６２）と、
複数の前記サーボモータ（３，４）のそれぞれにおける前記パラメータの推定値の前記制御部（５１，６１）への設定を同期させる設定同期を備えたことを特徴とするサーボドライバ。
＜発明３＞
複数のサーボモータ（３，４）の制御パラメータ調整方法であって、
複数の前記サーボモータ（３，４）のそれぞれによって駆動される負荷に対するイナーシャ比の推定値を含む制御パラメータを、複数の前記サーボモータの全てについて取得するステップと、
取得した前記制御パラメータを、複数の前記サーボモータのそれぞれを制御する際の制御パラメータとして設定するステップ、
を含む複数のサーボモータの制御パラメータ調整方法。
＜発明４＞
複数のサーボモータ（３，４）の制御パラメータ調整方法であって、
複数の前記サーボモータ（３，４）のそれぞれが、該サーボモータ（３，４）によって駆動される負荷に対するイナーシャ比を含む制御パラメータを推定するステップと、
複数の前記サーボモータ（３，４）のうち他の全てのサーボモータに対する前記制御パラメータの推定が完了するのを待って、前記複数の前記サーボモータのそれぞれを制御する際の制御パラメータとして、前記推定された制御パラメータを設定するステップを含む複数のサーボモータの制御パラメータ調整方法。
＜発明５＞
複数のサーボモータ（３，４）の制御パラメータを調整するためのプログラムであって、
複数の前記サーボモータ（３，４）のそれぞれによって駆動される負荷に対するイナーシャ比の推定値を含む制御パラメータを、複数の前記サーボモータ（３，４）の全てについて取得するステップと、
取得した前記パラメータを、複数の前記サーボモータ（３，４）のそれぞれを制御する際の制御パラメータとして設定するステップ、
をコンピュータに実行させるプログラム
＜発明６＞
複数のサーボモータ（３，４）の制御パラメータ調整するためのプログラムであって、
複数の前記サーボモータ（３，４）のそれぞれが、該サーボモータ（３，４）によって駆動される負荷に対するイナーシャ比を含む制御パラメータを推定するステップと、
複数の前記サーボモータ（３，４）のうち他の全てのサーボモータに対する前記制御パラメータの推定が完了するのを待って、前記複数の前記サーボモータ（３，４）のそれぞれを制御する際の制御パラメータとして、前記推定された制御パラメータを設定するステップ、
をコンピュータに実行させるプログラム。

３，４ サーボモータ、９ 調整支援装置、１５，１６ サーボドライバ、２１ 第１軸、２２ 第２軸、２３ 機械要素、５５，５６ 設定同期部、９１ イナーシャ比取得部、９２ イナーシャ比設定制御部、９３ 妥当性判断部

Claims (14)

1. 複数のサーボモータの制御パラメータの調整を支援する調整支援装置であって、
   前記サーボモータによって駆動される負荷に対するイナーシャ比の推定値を含むパラメータを取得するパラメータ取得部と、
   前記サーボモータを制御する際のイナーシャ比を含むパラメータを設定させるパラメータ設定制御部と、
   を備え、
   前記パラメータ設定制御部は、前記パラメータ取得部が、前記イナーシャ比の推定値を複数の前記サーボモータの全てについて取得した後に、複数の前記サーボモータの全てについて、取得された該イナーシャ比を設定させることを特徴とする調整支援装置。
2. 複数の前記サーボモータのうちのいずれかについて前記イナーシャ比を推定する場合には、前記パラメータ設定制御部は、他の前記サーボモータについては、ゲイン及びイナーシャ比を同じ値に設定させることを特徴とする請求項１に記載の調整支援装置。
3. 前記パラメータ取得部が取得した前記イナーシャ比の推定値の妥当性を判断する妥当性判断部を備えたことを特徴とする請求項１又は２に記載の調整支援装置。
4. 前記複数のサーボモータは、互いに軸干渉を生じ得る負荷を駆動することを特徴とする請求項１ないし３のいずれか１項に記載の調整支援装置。
5. 複数のサーボモータをそれぞれ制御するサーボドライバであって、
   前記サーボモータを制御する制御部と、
   前記サーボモータによって駆動される負荷に対するイナーシャ比を含むパラメータを推定するパラメータ推定部と、
   複数の前記サーボモータのそれぞれにおける前記パラメータの推定値の前記制御部への設定を同期させる設定同期部を備えたことを特徴とするサーボドライバ。
6. 前記複数のサーボモータは、互いに軸干渉を生じ得る負荷を駆動することを特徴とする
   請求項５に記載のサーボドライバ。
7. 複数のサーボモータの制御パラメータ調整方法であって、
   複数の前記サーボモータのそれぞれによって駆動される負荷に対するイナーシャ比の推定値を含む制御パラメータを、複数の前記サーボモータの全てについて取得するステップと、
   取得した前記制御パラメータを、複数の前記サーボモータのそれぞれを制御する際の制御パラメータとして設定するステップ、
   を含む複数のサーボモータの制御パラメータ調整方法。
8. 複数の前記サーボモータのそれぞれについてのイナーシャ比が推定される際に、他の前記サーボモータについては、ゲイン及びイナーシャ比を同じ値に設定させるステップ、
   をさらに含む請求項７に記載の複数のサーボモータの制御パラメータ調整方法。
9. 複数の前記サーボモータから取得された前記制御パラメータが妥当であるか否かを判断するステップ、
   をさらに含み、
   妥当であると判断された前記制御パラメータを、複数の前記サーボモータのそれぞれを制御する際の制御パラメータとして設定することを特徴とする請求項７または８に記載の複数のサーボモータの制御パラメータ調整方法。
10. 前記複数のサーボモータは、互いに軸干渉を生じ得る負荷を駆動することを特徴とする請求項７ないし９のいずれか１項に記載の複数のサーボモータの制御パラメータ調整方法。
11. 複数のサーボモータの制御パラメータ調整方法であって、
    複数の前記サーボモータのそれぞれによって駆動される負荷に対するイナーシャ比を含む制御パラメータを推定するステップと、
    複数の前記サーボモータのうち他の全てのサーボモータに対する前記制御パラメータの推定が完了するのを待って、前記複数の前記サーボモータのそれぞれを制御する際の制御パラメータとして、前記推定された制御パラメータを設定するステップを含む複数のサーボモータの制御パラメータ調整方法。
12. 前記複数のサーボモータは、互いに軸干渉を生じ得る負荷を駆動することを特徴とする請求項１１に記載の複数のサーボモータの制御パラメータ調整方法。
13. 複数のサーボモータの制御パラメータを調整するためのプログラムであって、
    複数の前記サーボモータのそれぞれによって駆動される負荷に対するイナーシャ比の推定値を含む制御パラメータを、複数の前記サーボモータの全てについて取得するステップと、
    取得した前記制御パラメータを、複数の前記サーボモータのそれぞれを制御する際の制御パラメータとして設定するステップ、
    をコンピュータに実行させるプログラム。
14. 複数のサーボモータの制御パラメータ調整するためのプログラムであって、
    複数の前記サーボモータのそれぞれによって駆動される負荷に対するイナーシャ比を含む制御パラメータを推定するステップと、
    複数の前記サーボモータのうち他の全てのサーボモータに対する前記制御パラメータの推定が完了するのを待って、前記複数の前記サーボモータのそれぞれを制御する際の制御パラメータとして、前記推定された制御パラメータを設定するステップ、
    をコンピュータに実行させるプログラム。
    

Images