(57)【要約】【課題】レゾルバやエンコーダなどのセンサから出力される信号に基づいてモータを制御するモータ制御装置で使用する補正データを高精度に作成することができ、モータ制御の精度を向上させる。【解決手段】回転軸が一定速度で正回転する定速度領域を含む往路駆動パターンでモータを駆動しながら回転軸が定速度領域で一回転以上正回転する間に指令信号をサンプリングして正回転時指令情報を取得し、回転軸が一定速度で逆回転する定速度領域を含む復路駆動パターンでモータを駆動しながら回転軸が定速度領域で一回転以上逆回転する間に指令信号をサンプリングして得られる逆回転時指令情報を取得し、正回転時指令情報および逆回転時指令情報を用いて補正データを作成する。【選択図】図６
2015159709.tif 000002
【特許請求の範囲】
【請求項１】
指令信号に応じて回転するモータの回転軸の回転角度に対応してセンサから出力される信号に基づいて前記回転軸の回転位置に関連する位置検出信号を生成し、前記位置検出信号を補正データで補正して得られる補正済位置信号をフィードバックして前記モータを制御するモータ制御装置において前記補正データを作成する補正データ作成方法であって、
前記回転軸が一定速度で正回転する定速度領域を含む往路駆動パターンで前記モータを駆動しながら前記回転軸が前記定速度領域で一回転以上正回転する間に前記指令信号をサンプリングして正回転時指令情報を取得し、
前記回転軸が前記一定速度で逆回転する定速度領域を含む復路駆動パターンで前記モータを駆動しながら前記回転軸が前記定速度領域で一回転以上逆回転する間に前記指令信号をサンプリングして得られる逆回転時指令情報を取得し、
前記正回転時指令情報および前記逆回転時指令情報を用いて前記補正データを作成することを特徴とする補正データ作成方法。
【請求項２】
請求項１に記載の補正データ作成方法であって、
前記正回転時のサンプリングと前記逆回転時のサンプリングとは、ともにＮ（ただし、Ｎは２以上の自然数）回行われる補正データ作成方法。
【請求項３】
請求項２に記載の補正データ作成方法であって、
前記正回転時のサンプリングと前記逆回転時のサンプリングとをそれぞれ１回行う一対のサンプリング動作が前記Ｎ回繰り返される補正データ作成方法。
【請求項４】
請求項３に記載の補正データ作成方法であって、
前記一対のサンプリング動作を前記Ｎ回繰り返した後で前記補正データを決定する補正データ作成方法。
【請求項５】
請求項１ないし４のいずれか一項に記載の補正データ作成方法であって、
前記指令信号は前記モータに与える電流に関連する信号であり、前記正回転時指令情報および前記逆回転時指令情報は前記回転軸の回転角度毎の電流指令値である補正データ作成方法。
【請求項６】
請求項１ないし４のいずれか一項に記載の補正データ作成方法であって、
前記指令信号は前記モータに与える電流に関連する信号であり、前記正回転時指令情報および前記逆回転時指令情報は前記回転軸の回転角度毎の前記モータの電流検出信号である補正データ作成方法。
【請求項７】
請求項５または６に記載の補正データ作成方法であって、
前記指令信号のサンプリングは前記回転軸の回転角度毎に行われる補正データ作成方法。
【請求項８】
請求項７に記載の補正データ作成方法であって、
前記位置検出信号を前記補正データで補正することなくフィードバックして前記モータを往復駆動し、前記往路駆動中に取得した前記正回転時指令情報から直流成分を取り除いて正回転電流リプルを求めるとともに前記復路駆動中に取得した前記逆回転時指令情報から直流成分を取り除いて逆回転電流リプルを求め、前記回転軸の回転角度毎に前記正回転電流リプルと前記逆回転電流リプルの平均を演算して得られる回転角度毎の平均電流リプルを位相合わせ情報として求める第１工程と、
前記位相合わせ情報から前記補正データを求める第２工程と
を備える補正データ作成方法。
【請求項９】
請求項７に記載の補正データ作成方法であって、
前記位置検出信号を前記補正データで補正することなくフィードバックして前記モータを往復駆動し、前記往路駆動中に取得した前記正回転時指令情報と、前記復路駆動中に取得した前記逆回転時指令情報との平均を前記回転軸の回転角度毎に演算して得られる回転角度毎の平均電流リプルを位相合わせ情報として求める第１工程と、
前記位相合わせ情報から前記補正データを求める第２工程と
を備える補正データ作成方法。
【請求項１０】
請求項８または９に記載の補正データ作成方法であって、
前記第２工程では、前記位相合わせ情報を構成する回転角度毎の平均電流リプルに相似比を掛け合わせて得られる回転角度毎の相似比合わせ済データに基づいて前記補正データを求める補正データ作成方法。
【請求項１１】
請求項１０に記載の補正データ作成方法であって、
前記相似比の候補として互いに異なる複数の相似比候補値を準備しておき、
前記相似比候補値毎に、当該相似比候補値を前記位相合わせ情報に掛け合わせて得られるデータに基づき前記位置検出信号を補正して得られる補正済位置信号をフィードバックして前記モータを往復駆動し、前記往路駆動中に取得した前記正回転時指令情報から直流成分を取り除いて正回転電流リプルを求めるとともに前記復路駆動中に取得した前記逆回転時指令情報から直流成分を取り除いて逆回転電流リプルを求め、前記回転軸の回転角度毎に前記正回転電流リプルと前記逆回転電流リプルの平均を演算して得られる回転角度毎の平均電流リプルのうち最大値と最小値の差を電流リプル振幅として算出し、
前記複数の電流リプル振幅のうち最小値となる相似比候補値を前記相似比として設定する補正データ作成方法。
【請求項１２】
請求項１０に記載の補正データ作成方法であって、
前記相似比の候補として互いに異なる複数の相似比候補値を準備しておき、
前記相似比候補値毎に、当該相似比候補値を前記位相合わせ情報に掛け合わせて得られるデータに基づき前記位置検出信号を補正して得られる補正済位置信号をフィードバックして前記モータを往復駆動し、前記往路駆動中に取得した前記正回転時指令情報と、前記復路駆動中に取得した前記逆回転時指令情報との平均を前記回転軸の回転角度毎に演算して得られる回転角度毎の平均電流リプルのうち最大値と最小値の差を電流リプル振幅として算出し、
前記複数の電流リプル振幅のうち最小値となる相似比候補値を前記相似比として設定する補正データ作成方法。
【請求項１３】
請求項１０ないし１２のいずれか一項に記載の補正データ作成方法であって、
前記第２工程では、前記回転軸の回転角度毎の相似比合わせ済データのうち回転角度がゼロである相似比合わせ済データをオフセットデータとし、前記回転角度毎の相似比合わせ済データから前記オフセットデータを引いたオフセット合わせ済データを前記補正データとする補正データ作成方法。
【請求項１４】
請求項８ないし１３のいずれか一項に記載の補正データ作成方法であって、
前記第１工程での前記一定速度の絶対値は、前記第２工程での前記一定速度の絶対値よりも大きい補正データ作成方法。
【請求項１５】
請求項１ないし１４のいずれか一項に記載の補正データ作成方法であって、
前記センサはレゾルバであり、
前記一定速度は１５[ｒｐｓ]ないし１００[ｒｐｓ]である補正データ作成方法。
【請求項１６】
指令信号に応じて回転するモータの回転軸の回転角度に対応してセンサから出力される信号に基づいて前記回転軸の回転位置に関連する位置検出信号を生成し、前記位置検出信号を補正データで補正して得られる補正済位置信号をフィードバックして前記モータを制御するモータ制御装置であって、
前記補正データを作成する補正データ作成部を備え、
前記補正データを作成するときには、
前記モータ駆動部は、前記回転軸が一定速度で正回転する定速度領域を含む往路駆動パターンで前記モータを駆動する往路駆動と、前記回転軸が前記一定速度で逆回転する定速度領域を含む復路駆動パターンで前記モータを駆動する復路駆動とを実行し、
前記補正データ作成部は、前記往路駆動中に前記回転軸が前記定速度領域で一回転以上正回転する間に前記指令信号をサンプリングして正回転時指令情報を取得し、前記復路駆動中に前記回転軸が前記定速度領域で一回転以上逆回転する間に前記指令信号をサンプリングして得られる逆回転時指令情報を取得し、前記正回転時指令情報および前記逆回転時指令情報を用いて前記補正データを作成する
ことを特徴とするモータ制御装置。
【発明の詳細な説明】
【技術分野】
【０００１】
この発明は、モータの回転軸に接続されるレゾルバやエンコーダなどのセンサから出力される信号に基づいて回転軸の位置検出信号を生成し、さらに当該位置検出信号を補正データで補正して得られる補正済位置信号をフィードバックしてモータを制御するモータ制御装置および同装置で使用する補正データを作成する補正データ作成方法に関するものである。
【背景技術】
【０００２】
モータ制御技術においては、位置指令と実際のモータの回転軸の回転位置との位置偏差を得るために、回転軸の回転位置を検出することが必要となる。この位置検出手段の一つに、レゾルバがある。ここで、レゾルバを用いる場合には、レゾルバの位置検出誤差を考慮した位置補正技術が必要となる。そこで、例えば特許文献１や特許文献２に記載の装置では、補正データを予めメモリに記憶しておき、モータ制御時には、レゾルバから出力される信号に基づき作成した位置検出信号を補正データで補正して補正済位置信号を作成し、当該補正済位置信号でモータをフィードバック制御している。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特許第２５４１１６９号公報
【特許文献２】特許第５２８１１０２号公報
【発明の概要】
【発明が解決しようとする課題】
【０００４】
特許文献１および特許文献２ではレゾルバで検出された位置検出信号から補正データを作成しているが、当該補正データが必ずしも高精度なものであるとはいえず、当該補正データを用いて位置検出信号を補正してもモータを高精度に制御することは困難であった。
【０００５】
この発明は上記課題に鑑みなされたものであり、レゾルバやエンコーダなどのセンサから出力される信号に基づいてモータを制御するモータ制御装置で使用する補正データを高精度に作成することができ、モータ制御の精度を向上させることを目的とする。
【課題を解決するための手段】
【０００６】
この発明の第１態様は、指令信号に応じて回転するモータの回転軸の回転角度に対応してセンサから出力される信号に基づいて回転軸の回転位置に関連する位置検出信号を生成し、位置検出信号を補正データで補正して得られる補正済位置信号をフィードバックしてモータを制御するモータ制御装置において補正データを作成する補正データ作成方法であって、回転軸が一定速度で正回転する定速度領域を含む往路駆動パターンでモータを駆動しながら回転軸が定速度領域で一回転以上正回転する間に指令信号をサンプリングして正回転時指令情報を取得し、回転軸が一定速度で逆回転する定速度領域を含む復路駆動パターンでモータを駆動しながら回転軸が定速度領域で一回転以上逆回転する間に指令信号をサンプリングして得られる逆回転時指令情報を取得し、正回転時指令情報および逆回転時指令情報を用いて補正データを作成することを特徴としている。
【０００７】
また、この発明の第２態様は、指令信号に応じて回転するモータの回転軸の回転角度に対応してセンサから出力される信号に基づいて回転軸の回転位置に関連する位置検出信号を生成し、位置検出信号を補正データで補正して得られる補正済位置信号をフィードバックしてモータを制御するモータ制御装置であって、補正データを作成する補正データ作成部を備え、補正データを作成するときには、モータ駆動部は、回転軸が一定速度で正回転する定速度領域を含む往路駆動パターンでモータを駆動する往路駆動と、回転軸が一定速度で逆回転する定速度領域を含む復路駆動パターンでモータを駆動する復路駆動とを実行し、補正データ作成部は、往路駆動中に回転軸が定速度領域で一回転以上正回転する間に指令信号をサンプリングして正回転時指令情報を取得し、復路駆動中に回転軸が定速度領域で一回転以上逆回転する間に指令信号をサンプリングして得られる逆回転時指令情報を取得し、正回転時指令情報および逆回転時指令情報を用いて補正データを作成することを特徴としている。
【０００８】
このように構成された発明では、モータを往路駆動パターンおよび復路駆動パターンで駆動しながら正回転時指令情報および逆回転時指令情報をそれぞれ取得する。この正回転時指令情報は、回転軸が定速度領域で一回転以上正回転する間に指令信号をサンプリングして得られるものである。また、逆回転時指令情報は、回転軸が定速度領域で一回転以上逆回転する間に指令信号をサンプリングして得られるものである。したがって、後で詳述するように、正回転時指令情報および逆回転時指令情報に含まれる誤差の増加方向および位相の変化方向が互いに正反対であり、このような特性を利用することで正回転時指令情報および逆回転時指令情報から補正データを高精度に作成することが可能となる。また、こうして作成される補正データを用いたフィードバック制御を行うことでモータ制御の精度が向上する。
【発明の効果】
【０００９】
以上のように、本発明によれば、正回転時指令情報および逆回転時指令情報を用いてモータ制御装置で使用する補正データを作成しているため、補正データを高精度に作成することができ、モータ制御の精度を向上させることが可能となる。
【図面の簡単な説明】
【００１０】
【図１】本発明の基礎となる知見を得るために用いたモータ制御装置の構成および当該装置により検出された動的実誤差と電流リプルとの関係を示す図である。
【図２】図１（ａ）に示す装置において認められる静的実誤差と正回転時の動的実誤差との関係を示す図である。
【図３】図１（ａ）に示す装置において認められる静的実誤差と逆回転時の動的実誤差との関係を示す図である。
【図４】静的実誤差、正回転時の動的実誤差および逆回転時の動的実誤差の関係を示す図である。
【図５】本発明にかかるモータ制御装置の一実施形態の電気的構成を示す図である。
【図６】図５に示すモータ制御装置における補正データ作成動作を示すフローチャートである。
【図７】補正データ作成中のモータの回転速度パターンを示す図である。
【図８】正回転および逆回転の電流リプルの一例を示すグラフである。
【図９】位相合わせ動作の一例を示すグラフである。
【図１０】相似比合わせ動作の一例を示すグラフである。
【図１１】オフセット合わせ動作を示すグラフである。
【図１２】補正データを用いることによる静的実誤差の改善を示すグラフである。
【発明を実施するための形態】
【００１１】
Ａ．レゾルバの位置検出誤差と電流指令との相似関係
本願発明者は、図１（ａ）に示す構成を有するモータ制御装置により種々の実験を行い、レゾルバの位置検出誤差と電流指令との間に相似関係が存在するという知見を得た。ここで実験に使用したモータ制御装置１００はロボットコントローラであり、当該モータ制御装置１００によりモータＭを回転駆動する。このモータＭの回転軸には、図１（ａ）に示すように、レゾルバＲｅを取り付けるだけでなく、レゾルバＲｅよりも高精度に位置を検出することが可能な基準位置検出器Ｅが取り付けられており、レゾルバＲｅおよび基準位置検出器Ｅによる検出信号がそれぞれモータ制御装置１００に出力される。なお、同図（ａ）中の符号ＰＣはシリアル通信インターフェース（ＲＳ２３２Ｃ）を介してモータ制御装置１００に接続されたパーソナルコンピュータである。
【００１２】
また、図１（ｂ）はレゾルバＲｅを用いたときの動的実誤差と電流指令の関係を示す図である。この実験結果はモータＭを３０［ｒｐｓ］の一定速で回転させている間にサンプリングしたものである。同図（ｂ）中の動的実誤差は一定速動作状態で計測したレゾルバと基準位置検出器の検出位置の差を意味しており、本実施形態では各回転角度におけるレゾルバＲｅの検出位置から基準位置検出器Ｅの検出位置を差し引いた値を用いており、この動的実誤差によってレゾルバＲｅの位置検出誤差を示している。また、電流指令は一定速動作状態での電流指令値のＡＣ成分、つまり電流リプルを示しており、本実施形態では一回転区間の間にサンプリングした電流指令信号の区間平均を求めるとともに、当該区間中の電流指令信号から上記区間平均を差し引いて電流リプルを求めている。なお、同図（ｂ）の横軸、つまり回転角度は、基準位置検出器Ｅの検出位置を角度換算したものである。
【００１３】
同図（ｂ）から明らかなように、レゾルバＲｅの位置検出誤差である動的実誤差は電流指令値のＡＣ成分（電流リプル）と相似関係を有している。したがって、本願発明者は、電流リプルから動的実誤差を推定することができ、その推定誤差から補正データを作成し、当該補正データによりレゾルバＲｅの位置検出信号を補正することで位置精度を向上させることが可能であるという知見を得た。さらに、本願発明者は種々の定速度（１５［ｒｐｓ］、３０［ｒｐｓ］、６０［ｒｐｓ］）でモータＭを正回転させながら動的実誤差を計測し、その計測結果を静的実誤差とともに図２にまとめた。また、モータＭを逆回転させた場合の動的実誤差についても計測し、その計測結果を静的実誤差とともに図３にまとめた。なお、この「静的実誤差」とは静止状態で計測したレゾルバＲｅと基準位置検出器Ｅの検出角度の差を意味している。
【００１４】
図２は図１（ａ）に示す装置において認められる静的実誤差と正回転時の動的実誤差との関係を示す図である。また、図３は図１（ａ）に示す装置において認められる静的実誤差と逆回転時の動的実誤差との関係を示す図である。さらに、図４は図１（ａ）に示す装置において同一の定速度でモータを往復駆動した際に正回転時動的実誤差、逆回転時動的実誤差および静的実誤差の関係を示す図である。なお、これら図において、「静止」とは静止状態で計測したレゾルバＲｅと基準位置検出器Ｅの検出角度の差である静的実誤差を示している。
【００１５】
正回転時には、図２に示すように、速度の上昇に伴って位相が遅れるとともに、（−）側の誤差が増加している。これに対し、逆回転時には、図３に示すように横軸の回転角度が３６０゜から０゜方向に走査されるため、速度の上昇に伴って位相が遅れるとともに、（＋）側の誤差が増加している。この主たる理由のひとつはモータ制御装置１００に内蔵されるＲＤ変換器に起因すると考えられる。この「ＲＤ変換器」はレゾルバ−デジタル変換器であり、レゾルバの出力信号をデジタルの角度データに変換処理する機能を有するものである。したがって、ＲＤ変換器の遅れ系により、遅れのない基準位置検出器Ｅの検出結果に対してレゾルバＲｅの検出結果では誤差が増大するとともに位相も遅れる傾向にあると考察される。
【００１６】
また、モータＭを定速度、例えば６０［ｒｐｓ］で正回転させる時の動的実誤差、同速度で逆回転させる時の動的実誤差および静的実誤差を同一グラフにプロットすると、図４に示すように、誤差の増加方向および位相の変化方向が正回転および逆回転で正反対であり、正回転時の動的実誤差と逆回転時の動的実誤差との平均が静的実誤差に近似している。つまり、同一の定速度でモータＭを往復駆動しながら正回転時の動的実誤差と逆回転時の動的実誤差とを求め、さらに回転角度毎に両者の値を平均化することで静的実誤差を近似的に求めることができるという知見を本願発明者は得た。なお、図２ないし図４では、１５〜６０［ｒｐｓ］の計測結果のみを示しているが、６０〜１００［ｒｐｓ］についても同様の計測結果が得られ、上記知見が成立する。
【００１７】
そして、このような知見に基づき本願発明者は、モータＭの回転軸が定速度で正回転する定速度領域を含む往路駆動パターンと同速度で逆回転する定速度領域を含む復路駆動パターンとでモータＭを往復駆動しながら正回転時動的実誤差と逆回転時動的実誤差を取得した後でそれらから補正データを高精度に作成することが可能であるとの結論を得た。以下、上記知見を用いて補正データを作成する発明の一実施形態について図５ないし図１２を参照しつつ説明する。
【００１８】
Ｂ．実施形態
図５は本発明にかかるモータ制御装置の一実施形態の電気的構成を示す図である。このモータ制御装置１は、位置指令信号に基づいてモータＭを駆動するモータ駆動部２と、補正データを作成する補正データ作成部３とを備えている。以下では、先にモータ駆動部２の構成を説明した後で、補正データ作成部３の構成を説明する。
【００１９】
モータ駆動部２では、位置制御部２１が外部から与えられる位置指令信号と後で説明する補正済位置信号との差に基づいて速度指令信号を出力する。速度制御部２２は、上記補正済位置信号を微分器２３で微分することで算出されるモータＭの駆動速度と速度指令信号との差に基づいて電流指令信号を出力する。この電流指令信号は後述する補正データ作成部３に出力されるとともに電流制御部２４に出力される。この電流制御部２４は電流指令信号に基づいて駆動指令信号を電流センサ２５を介してモータＭに出力する。より詳しくは、電流センサ２５は電流制御部２４から出力された駆動指令信号を検出して駆動指令信号の電流値を示す電流検出信号を電流制御部２４の入力側にフィードバックする。そして、電流制御部２４は電流検出信号と電流指令信号との差に基づいて駆動指令信号を出力する。そして、駆動指令信号を受けたモータＭは、この駆動指令信号に応じたトルクを出力する。
【００２０】
また、モータＭの回転軸（図示省略）にはレゾルバＲｅが接続されており、回転軸の回転位置を検出して回転位置を示すアナログ信号を出力する。このアナログ信号はＲＤ変換器２６に入力されてデジタルの位置検出信号に変換され、出力される。この位置検出信号に対して次に説明する補正データ作成部３で作成された補正信号を加えて補正した信号が上記補正済位置信号であり、上記したように位置制御部２１および微分器２３に与えられる。
【００２１】
次に、補正データ作成部３の構成について説明した後で、補正データの作成方法について説明する。この補正データ作成部３は、ＣＰＵ（Central Processing Unit）等のような演算機能を有する演算処理部３１と、４つのメモリ３２１〜３２４を有する記憶部３２とを備えている。演算処理部３１は、モータ駆動部２によってモータＭが所定の駆動パターンで往復駆動されている間に、予め記憶されているプログラムに従って速度制御部２２から出力される電流指令信号をサンプリングし、さらに次に詳述する位相合わせ処理、相似比合わせ処理およびオフセット合わせ処理を実行して補正データを作成する。このように、本実施形態では、演算処理部３１は、電流指令値サンプリング部３１１、位相合わせ部３１２、相似比合わせ部３１３およびオフセット合わせ部３１４として機能する。
【００２２】
図６は図５に示すモータ制御装置における補正データ作成動作を示すフローチャートである。本実施形態では、モータＭやレゾルバＲｅの取付や交換などが行われた場合やユーザにより補正データの作成が指令された場合、モータＭが装置に組み込まれた状態、例えばモータＭをロボットの駆動源として用いる場合にはモータＭの回転軸にロボットの可動部（ボールネジなどの移動機構部）が連結された状態のまま以下に説明する補正データ作成処理が実行される。
【００２３】
ステップＳ１では、モータ駆動部２によってモータＭを動作させてロボットを移動させる距離と定速度領域の速度Ｖ０＋、Ｖ０−（ただし、｜Ｖ０＋｜＝｜Ｖ０−｜）とが設定される。これらの設定により補正データ作成処理を行う際にモータＭがロボットを駆動してロボットが動作する動作パターン、つまりモータ駆動部２によるモータＭの駆動パターンを決定する。また、モータ駆動部２の動作モードとして、予め複数の動作モードが用意されているが、補正データの作成処理においては最初、モータ駆動部２に補正信号を出力しない、つまり補正データによる補正を行わずにモータＭを駆動する「補正無し動作」を選択し（ステップＳ２）、位相合わせ処理を実行する（ステップＳ３〜Ｓ６）。
【００２４】
この位相合わせ処理では、モータ駆動部２によるモータＭの駆動を開始してロボットを往復移動させるとともに当該移動中に電流サンプリングを行う（ステップＳ３）。すなわち、モータＭの駆動開始により、例えば図７に示すように、モータＭが正回転し、所定時間をかけてロボットの移動速度を速度Ｖ０＋まで加速し、ステップＳ１で設定した移動距離に応じた時間だけ一定速度Ｖ０＋を維持した後、減速を開始してモータＭの正回転を停止させる。このように、モータＭを正回転させてロボットを移動させることを「往路移動」と称し、そのように移動させるためのモータＭの駆動パターンを「往路駆動パターン」と称するとともに、その往路駆動パターンにおいて一定速度Ｖ０＋が維持される領域を「定速度領域」と称する。また、往路移動中の定速度領域のほぼ中間位置において、モータＭの一回転中にモータ駆動部２の速度制御部２２から出力される電流指令信号を一定の時間間隔でサンプリングして回転角度毎の電流指令値を「正回転のサンプリングデータ」として電流サンプリングメモリ３２１に書き込む。
【００２５】
ロボットの往路移動が完了すると、モータＭは逆回転し、往路駆動パターンを反転させた駆動パターンでロボットを移動させる。つまり、ロボットの移動速度を速度Ｖ０−まで加速し、ステップＳ１で設定した移動距離に応じた時間だけ一定速度Ｖ０−を維持した後、減速を開始してモータＭの逆回転を停止させる。このようにモータＭを逆回転させてロボットを移動させることを「復路移動」と称し、そのように移動させるためのモータＭの駆動パターンを「復路駆動パターン」と称するとともに、その復路駆動パターンにおいて一定速度Ｖ０−が維持される領域についても「定速度領域」と称する。また、復路移動中の定速度領域のほぼ中間位置において、モータＭの一回転中にモータ駆動部２の速度制御部２２から出力される電流指令信号を一定の時間間隔でサンプリングして回転角度毎の電流指令値を「逆回転のサンプリングデータ」として電流サンプリングメモリ３２１に書き込む。
【００２６】
次のステップＳ４では、電流サンプリングメモリ３２１から正回転のサンプリングデータを読み出し、一回転分の電流指令値の平均値を計算する。そして、回転角度毎に電流指令値から上記平均値を引いて正回転電流リプルを求め、電流サンプリングメモリ３２１に上書きする。こうして往路移動中の電流指令値のＡＣ成分である正回転電流リプルが取得される（図８中の実線）。
【００２７】
また、逆回転側についても、正回転側と同様にして逆回転電流リプルを求める（ステップＳ５）。すなわち、電流サンプリングメモリ３２１から逆回転のサンプリングデータを読み出し、一回転分の電流指令値の平均値を計算し、回転角度毎に電流指令値から上記平均値を引いて正回転電流リプルを求め、電流サンプリングメモリ３２１に上書きする。こうして復路移動中の電流指令値のＡＣ成分である逆回転電流リプルが取得される（図８中の点線）。
【００２８】
正回転電流リプルおよび逆回転電流リプルが求まると、電流サンプリングメモリ３２１から回転角度毎に正回転の電流リプルおよび逆回転の電流リプルをそれぞれ読み出し、それらの値の平均値を計算する。そして、平均値（＝（正回転電流リプル＋逆回転電流リプル）／２）を平均電流リプルとしてメモリ３２２中の補正元テーブルに書き込む（ステップＳ６）。なお、図９において、上記のようにして取得された平均電流リプルの一例を図９の破線で示している。
【００２９】
上記した位相合わせ処理が完了する（図７中のタイミングＴ１）と、動作モードとして「相似比合わせ動作」を選択し（ステップＳ７）、以下に説明する相似比合わせ処理を実行する（ステップＳ８〜Ｓ１６）。この相似比合わせ処理では、ステップＳ８で各種初期設定を行う。本実施形態では、初期設定のひとつとして、一回転分の平均電流リプルの最大値から最小値を引いた値、つまり電流リプル振幅の最小値ＲＷｍｉｎをデフォルト値（この実施形態では、「１００００」）に設定するとともに、カウント値ｎの初期値として「１」を設定する。そして、次のステップＳ９で相似比を値（ｎ／２０）に設定する。例えばｎ＝１のとき、相似比は初期値（１／２０）に設定される。
【００３０】
相似比（ｎ／２０）の設定後、補正元テーブルメモリ３２２から平均電流リプルを読み出し、回転角度毎の平均電流リプルに相似比を掛け合わせた値を補正信号としてモータ駆動部２に出力する。そして、補正信号による補正を行いながら、モータ駆動部２によるモータＭの駆動を開始してロボットを往復移動させるとともに当該移動中に電流サンプリングを行う（ステップＳ１０）。なお、補正信号による補正を行っている点を除き、往復移動動作および電流サンプリング動作は位相合わせ処理時のそれら（ステップＳ３）と同一であり、一回転分の正回転のサンプリングデータと一回転分の逆回転のサンプリングデータとは電流サンプリングメモリ３２１に書き込まれる。例えばｎ＝１のとき、図７中のタイミングＴ１からタイミングＴ２までの間でモータＭを連続する往路駆動パターンおよび復路駆動パターンで駆動しながら、各定速度領域のほぼ中間の一回転分の電流サンプリングを行う。
【００３１】
電流サンプリングが完了すると、電流リプルの計算および相似比合わせメモリ３２３への書込を行う（ステップＳ１１）。すなわち、上記ステップＳ４と同様にして正回転電流リプルを算出し、上記ステップＳ５と同様にして逆回転電流リプルを算出し、さらに上記ステップＳ６と同様にして平均電流リプルを算出する。そして、相似比を（ｎ／２０）に設定した時の平均電流リプルを相似比合わせメモリ３２３に書き込む。
【００３２】
次のステップＳ１２では、相似比合わせメモリ３２３に書き込まれた一回転分の平均電流リプルより電流リプル振幅を求めた後、当該電流リプル振幅が最小値ＲＷmin未満であるか否かを判定する。そして、ステップＳ１２で「ＹＥＳ」と判定、つまりカウント値ｎでの電流リプル振幅が最小値ＲＷmin未満であると判定したとき、最小値ＲＷminを当該電流リプル振幅に更新するとともに当該カウント値ｎを最適値Ｋbestとして相似比合わせメモリ３２３に書き込んだ（ステップＳ１３）後で、ステップＳ１４に進む。なお、最適値Ｋbestの記憶先は相似比合わせメモリ３２３に限定されるものではなく、任意のメモリに書き込むことができる。一方、ステップＳ１２で「ＮＯ」と判定したときには、最小値ＲＷminおよび最適値Ｋbestの更新を行わず、そのままステップＳ１４に進む。
【００３３】
このステップＳ１４でカウント値ｎを「１」だけインクリメントした後、カウント値ｎが「２１」であるか否かを判定する（ステップＳ１５）。そして、ステップＳ１５で「ＮＯ」、つまりカウント値ｎが「２０」以下であると判定する間、ステップＳ９に戻って電流リプル振幅が最小となる相似比の導出処理（ステップＳ９〜Ｓ１５）を繰り返す。つまり、本実施形態では、相似比の候補として（１／２０）、（２／２０）、…、（２０／２０）を準備しておき、相似比の候補毎に相似比の導出処理を行った上で最適値Ｋbestを決定している。
【００３４】
一方、ステップＳ１５で「ＹＥＳ」と判定したときには、相似比合わせメモリ３２３から最適値Ｋbestを読み出し、電流リプル振幅が最も小さくなる最適相似比（＝Ｋbest／２０）を決定する。そして、補正元テーブルメモリ３２２から平均電流リプルを読み出し、回転角度毎の平均電流リプルに最適相似比を掛け合わせた値を相似比合わせ済データとして補正テーブルメモリ３２４に書き込む（ステップＳ１６）。
【００３５】
このように最適相似比で平均電流リプルを調整することで静的実誤差（図１０中の点線）に近似した相似比合わせ済データ（図１０中の実線）が得られ、例えば図１０に示すように、相似比合わせ済データが静的実誤差からオフセットしており、しかも図１０の点線で示すように回転角度が０゜のときの静的実誤差はゼロであるため、本実施形態では、最後にオフセット合わせを行う（ステップＳ１７）。すなわち、回転角度毎の相似比合わせ済データに対して回転角度ゼロの相似比合わせ済データを差し引き、このオフセット合わせ済データを最終的な補正データ（例えば図１１中の実線）として補正テーブルメモリ３２４に上書きする。これによって、より高精度な補正データが得られる。
【００３６】
以上のように、本実施形態によれば、上記した「Ａ．レゾルバの位置検出誤差と電流指令との相似関係」の項で説明した知見に基づきモータ制御装置１で使用する補正データを作成しているため、補正データを高精度に作成することができ、モータＭの制御精度を向上させることが可能である。
【００３７】
また、補正データを作成する方法として、基準位置検出器を取り付けて当該基準位置検出器で計測した位置との誤差を補正データとするものが従来より提案されているが、この場合、補正データを作成するための補正設備が別途必要となる。これに対し、上記実施形態では、当該補正設備を一切用いることなく、モータ制御装置１の独自の機能によって補正データを作成することができ、自らの性能を改善することができる。つまり、上記実施形態にかかるモータ制御装置１は自己補正機能を有している。また、ロボットにモータＭを取り付けた状態で補正データを作成することができる。したがって、ロボットを設置した工場などでモータＭを交換したり、修理した時にも、その場で交換・修理後に補正データを作成することができる。
【００３８】
また、上記実施形態では、速度指令信号を速度制御部２２で増幅した後の電流指令信号を利用して補正データを作成しており、分解能を十分に高く取れ、補正後の位置精度を従来技術よりも上げることができる。ここで、電流指令信号の代わりに、電流検出信号を用いて補正データを作成してもよく、上記実施形態と同様の作用効果が得られる。
【００３９】
このように本実施形態では、レゾルバＲｅが本発明の「センサ」の一例に相当している。また、「正回転電流リプル」が本発明の「正回転時指令情報」の一例に相当し、「逆回転電流リプル」が本発明の「逆回転時指令情報」の一例に相当している。また、ステップＳ６で求められた平均電流リプルが本発明の「位相合わせ情報」に相当している。また、１つの往路移動中に実行される電流指令信号のサンプリングが本発明の「正回転時のサンプリング」の一例に相当し、１つの復路移動中に実行される電流指令信号のサンプリングが本発明の「逆回転時のサンプリング」の一例に相当し、これらを連続して行う動作が本発明の「一対のサンプリング動作」の一例に相当しており、本実施形態では当該一対のサンプリング動作を（ｎ＋１）回繰り返して補正データを作成している。なお、本実施形態では、図７に示すように、相似比合わせ処理中に相似比の候補を切り替えながら一対のサンプリング動作を２０回繰り返しているが、当該繰り返し数（相似比の候補数）はこれに限定されるものではなく、任意である。
【００４０】
Ｃ．その他
なお、本発明は上記実施形態に限定されるものではなく、その趣旨を逸脱しない限りにおいて上述したものに対して種々の変更を加えることが可能である。例えば、上記実施形態では、レゾルバＲｅから出力される信号を用いてモータＭを制御するモータ制御装置１に本発明を適用しているが、レゾルバＲｅ以外の位置検出センサ、例えばエンコーダなどを本発明の「センサ」として用いるモータ制御装置にも本発明を適用可能である。
【００４１】
また、上記実施形態では、電流指令信号のサンプリング期間はモータＭの一回転分であるが、一回転を超えてサンプリングしてもよい。例えば、ｍ回転分の電流指令信号をサンプリングした場合には回転角度毎にｍ個のサンプリングデータを平均化して「正回転電流リプル」や「逆回転電流リプル」を導出してもよい。
【００４２】
また、上記実施形態では、正回転電流リプルと逆回転電流リプルとを平均化することで平均電流リプルを求めているが、正回転時のサンプリングデータと逆回転時のサンプリングデータとを平均化して平均電流リプルを求めてもよい。つまり、直流成分を取り除く工程を省略し、両サンプリングデータから位相合わせ情報を求めてもよく、これによって信号処理を簡素化することができる。
【００４３】
また、上記実施形態では、位相合わせ処理および相似比合わせ処理では、同一の駆動パターンでモータを駆動しながら電流サンプリングを行っているが、駆動パターンを一致させることは必須事項ではない。位相合わせ処理においては、モータの回転軸に連結される減速機（図示省略）の回転摩擦の影響が小さく、レゾルバの位置検出誤差との相似性が高い速度で電流サンプリングを行うのが望ましい。これに対し、相似比合わせ処理においては、上記回転摩擦の影響がなく、補正による効果が大きく表れる速度で電流サンプリングを行うのが望ましい。そこで、このような要望を満足するためには、位相合わせ処理における定速度領域の速度Ｖ０＋、Ｖ０−の絶対値が相似比合わせ処理でのそれよりも大きくなるように駆動パターンを設定するのが好適である。
【００４４】
さらに、上記実施形態では、モータＭをロボットの駆動源として用いる場合について説明したが、本発明の適用対象はロボットに取り付けられたモータを制御する技術に限定されるものではない。つまり、モータにより可動部が駆動される装置、例えば表面実装機、部品検査装置、半導体製造装置などの産業機器に取り付けられたモータを制御するモータ制御装置にも本発明を適用することができる。
【産業上の利用可能性】
【００４５】
この発明は、モータの回転軸に接続されるセンサから出力される信号を補正するための補正データを作成する補正データ作成技術および当該補正データを用いてモータを制御するモータ制御技術全般に適用可能である。
【符号の説明】
【００４６】
１…モータ制御装置
３…補正データ作成部
３１…演算処理部
Ｍ…モータ
Ｒｅ…レゾルバ
【図１】
2015159709.tif 000003
【図２】
2015159709.tif 000004
【図３】
2015159709.tif 000005
【図４】
2015159709.tif 000006
【図５】
2015159709.tif 000007
【図６】
2015159709.tif 000008
【図７】
2015159709.tif 000009
【図８】
2015159709.tif 000010
【図９】
2015159709.tif 000011
【図１０】
2015159709.tif 000012
【図１１】
2015159709.tif 000013
【図１２】
2015159709.tif 000014