(57)【特許請求の範囲】
【請求項１】
動作対象物を動作させるモータと、前記モータを制御するモータ制御装置とを備えるモータシステムにおいて、
前記モータの回転位置指令を入力とし前記モータの回転位置を出力とする閉ループ系をブロック線図で表わすと、前記閉ループ系は、伝達要素として、比例ゲイン要素と、積分フィルタ要素と、モータゲイン要素と、モータ要素と、微分フィルタ要素とを備えるとともに、前記閉ループ系の入力部から出力部へ向かう前向き経路と、前記閉ループ系の出力部から入力側に向かう第１帰還経路および第２帰還経路とを備え、
前記前向き経路では、信号の伝達方向において、前記回転位置指令が入力される第１の加え合わせ点と、前記比例ゲイン要素と、第２の加え合わせ点と、前記積分フィルタ要素と、前記モータゲイン要素と、前記モータ要素とがこの順番に配置され、
前記第１帰還経路は、前記第１の加え合わせ点に負帰還接続され、
前記第２帰還経路は、前記第２の加え合わせ点に負帰還接続されるとともに、前記微分フィルタ要素は、前記第２帰還経路の中に配置され、
前記モータに電力を供給するアンプの固定ゲインと前記モータのトルク定数とを含む固定値を前記動作対象物および前記モータのイナーシャで割った値であるゲインをＫとし、前記動作対象物および前記モータの粘性に関わる項を前記動作対象物および前記モータのイナーシャで割った値であるゲインをｐとし、ラプラス演算子をｓとすると、
前記動作対象物に応じて前記モータを適切に制御するための前記閉ループ系の希望特性を有する伝達関数である希望伝達関数は、
ｍ０／（ｓ２＋ｍ１ｓ＋ｍ０）
で規定され、
前記比例ゲイン要素は、ｍ０であり、
前記積分フィルタ要素は、（ｓ２＋ｑ１ｓ＋ｑ０）／（ｓ２＋ａ１ｓ）で表わされる伝達関数であり、
前記モータゲイン要素は、１／Ｋであり、
前記モータ要素は、Ｋ／（ｓ２＋ｐｓ）で表わされる伝達関数であり、
前記微分フィルタ要素は、（ｂ２ｓ２＋ｂ１ｓ）／（ｓ２＋ｑ１ｓ＋ｑ０）で表わされる伝達関数であり、
ａ１、ｂ１、ｂ２が以下の関係を満足することで、前記閉ループ系の特性が前記希望伝達関数に一致し、
ａ１＝ｑ１＋ｍ１−ｐ
ｂ１＝ｑ０ｍ１
ｂ２＝（ｑ１−ｐ）（ｍ１−ｐ）＋ｑ０
前記モータ制御装置は、前記動作対象物および前記モータのイナーシャを検出するイナーシャ検出手段を備え、前記イナーシャ検出手段での検出結果に基づいて、ｑ０およびｑ１を調整することによって、前記希望伝達関数の特性を損なうことなく、前記動作対象物および前記モータのイナーシャに応じて変化する外乱応答特性を補正することを特徴とするモータシステム。
【請求項２】
前記イナーシャ検出手段は、前記モータ要素への入力と前記モータ要素からの出力とに基づいて、前記動作対象物および前記モータのイナーシャを推定する適応同定手段であることを特徴とする請求項１記載のモータシステム。
【請求項３】
前記モータ制御装置には、前記動作対象物および前記モータのイナーシャと、ｑ０およびｑ１とが対応付けられたテーブルが記憶され、
前記モータ制御装置は、前記イナーシャ検出手段での検出結果と前記テーブルとに基づいてｑ０およびｑ１を調整することを特徴とする請求項１または２記載のモータシステム。
【請求項４】
前記モータ制御装置は、前記イナーシャ検出手段によって検出された前記動作対象物および前記モータのイナーシャに基づいて、所定の演算を行ってｑ０およびｑ１を算出し、ｑ０およびｑ１を調整することを特徴とする請求項１または２記載のモータシステム。
【請求項５】
動作対象物を動作させるモータと、前記モータを制御するモータ制御装置とを備えるモータシステムにおいて、
前記モータの回転位置指令を入力とし前記モータの回転位置を出力とする閉ループ系をブロック線図で表わすと、前記閉ループ系は、伝達要素として、比例ゲイン要素と、積分フィルタ要素と、モータゲイン要素と、モータ要素と、微分フィルタ要素とを備えるとともに、前記閉ループ系の入力部から出力部へ向かう前向き経路と、前記閉ループ系の出力部から入力側に向かう第１帰還経路および第２帰還経路とを備え、
前記前向き経路では、信号の伝達方向において、前記回転位置指令が入力される第１の加え合わせ点と、前記比例ゲイン要素と、第２の加え合わせ点と、前記積分フィルタ要素と、前記モータゲイン要素と、前記モータ要素とがこの順番に配置され、
前記第１帰還経路は、前記第１の加え合わせ点に負帰還接続され、
前記第２帰還経路は、前記第２の加え合わせ点に負帰還接続されるとともに、前記微分フィルタ要素は、前記第２帰還経路の中に配置され、
前記モータに電力を供給するアンプの固定ゲインと前記モータのトルク定数とを含む固定値を前記動作対象物および前記モータのイナーシャで割った値であるゲインをＫとし、前記動作対象物および前記モータの粘性に関わる項を前記動作対象物および前記モータのイナーシャで割った値であるゲインをｐとし、ラプラス演算子をｓとすると、
前記動作対象物に応じて前記モータを適切に制御するための前記閉ループ系の希望特性を有する伝達関数である希望伝達関数は、
ｍ０／（ｓ２＋ｍ１ｓ＋ｍ０）
で規定され、
前記比例ゲイン要素は、ｍ０であり、
前記積分フィルタ要素は、（ｓ２＋ｑ１ｓ＋ｑ０）／（ｓ２＋ａ１ｓ）で表わされる伝達関数であり、
前記モータゲイン要素は、１／Ｋであり、
前記モータ要素は、Ｋ／（ｓ２＋ｐｓ）で表わされる伝達関数であり、
前記微分フィルタ要素は、（ｂ２ｓ２＋ｂ１ｓ）／（ｓ２＋ｑ１ｓ＋ｑ０）で表わされる伝達関数であり、
ａ１、ｂ１、ｂ２が以下の関係を満足することで、前記閉ループ系の特性が前記希望伝達関数に一致し、
ａ１＝ｑ１＋ｍ１−ｐ
ｂ１＝ｑ０ｍ１
ｂ２＝（ｑ１−ｐ）（ｍ１−ｐ）＋ｑ０
前記モータ制御装置は、前記動作対象物および／または前記モータの振動の大きさを検出する振動検出手段を備え、前記振動検出手段での検出結果に基づいて、ｑ０およびｑ１を調整することによって、前記希望伝達関数の特性を損なうことなく、前記動作対象物および／または前記モータの振動を抑制することを特徴とするモータシステム。
【請求項６】
前記モータ制御装置には、前記動作対象物および／または前記モータの振動の大きさと、ｑ０およびｑ１とが対応付けられたテーブルが記憶され、
前記モータ制御装置は、前記振動検出手段での検出結果と前記テーブルとに基づいてｑ０およびｑ１を調整することを特徴とする請求項５記載のモータシステム。
【請求項７】
前記モータ制御装置は、前記振動検出手段によって検出された前記動作対象物および／または前記モータの振動の大きさに基づいて、所定の演算を行ってｑ０およびｑ１を算出し、ｑ０およびｑ１を調整することを特徴とする請求項５記載のモータシステム。
【請求項８】
前記微分フィルタ要素の特性多項式ｓ２＋ｑ１ｓ＋ｑ０の根は、重根となっていることを特徴とする請求項１から７のいずれかに記載のモータシステム。
【請求項９】
前記モータ制御装置は、前記モータ要素への入力と前記モータ要素からの出力とに基づいて前記ゲインＫを推定する適応同定手段を備え、前記適応同定手段で推定された前記ゲインＫに基づいて前記モータゲイン要素を更新することを特徴とする請求項１から８のいずれかに記載のモータシステム。
【請求項１０】
前記適応同定手段は、前記ゲインＫの推定を所定時間間隔で逐次実行し、
前記モータ制御装置は、前記適応同定手段で推定された前記ゲインＫに基づいて前記モータゲイン要素を所定時間間隔で逐次更新することを特徴とする請求項９記載のモータシステム。
【請求項１１】
前記適応同定手段は、前記モータ要素への入力と前記モータ要素からの出力とに基づいて、前記ゲインｐを推定することを特徴とする請求項９または１０記載のモータシステム。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、動作対象物を動作させるモータと、モータを制御するモータ制御装置とを備えるモータシステムに関する。
【背景技術】
【０００２】
従来、ロボットを動作させるモータの制御装置として、Ｐ−ＰＩ制御（比例・比例積分制御）でモータを制御するモータ制御装置が知られている（たとえば、特許文献１参照）。Ｐ−ＰＩ制御を行うモータ制御装置では、モータの回転位置と回転速度とがフィードバックされるとともに、回転位置の偏差に対して比例制御が行われ、回転速度の偏差に対して比例積分制御（ＰＩ制御）が行われている。
【０００３】
Ｐ−ＰＩ制御を行うモータ制御装置と、このモータ制御装置によって制御されるモータとを備えるモータシステムにおいて、モータの回転位置指令を入力としモータの回転位置を出力とする閉ループ系をブロック線図で表わすと、たとえば、図５のようになる。図５において、Ｋｐは、位置ループゲインであり、Ｋｖは、速度ループゲインであり、Ｋｉは、積分ゲインである。また、Ｋは、モータに電力を供給するアンプの固定ゲインとモータのトルク定数とを含む固定値をロボットおよびモータのイナーシャで割った値であるゲインであり、ｐは、ロボットおよびモータの粘性に関わる項をロボットおよびモータのイナーシャで割った値であるゲインであり、ｓは、ラプラス演算子である。さらに、ωＦは、フィルタのカットオフ周波数であり、フィルタによって回転位置が回転速度に変換されている。
【先行技術文献】
【特許文献】
【０００４】
【特許文献１】特開２００６−２４４３００号公報
【発明の概要】
【発明が解決しようとする課題】
【０００５】
図５に示す閉ループ系において、ロボットやモータのイナーシャが大きくなっても（すなわち、Ｋが小さくなっても）、速度ループゲインＫｖをそれに合わせて大きくすれば、ロボットやモータのイナーシャの大きさに関係なく、閉ループ系の特性を一定に保つことが可能である。しかしながら、大きくなったロボットやモータのイナーシャに合わせて速度ループゲインＫｖを大きくすると、外乱に対するモータの応答感度が上がる。外乱に対するモータの応答感度が上がると、機械誤差やガタによりモータやロボットに振動が生じやすくなる。
【０００６】
ここで、図５に示す閉ループ系において、積分ゲインＫｉを小さくすることで外乱応答感度を下げて、モータやロボットに生じる振動を抑制することは可能である。しかしながら、積分ゲインＫｉのみを小さくすると、位置ループゲインＫｐと速度ループゲインＫｖと積分ゲインＫｉとのバランスが崩れて、図５に示す閉ループ系の特性（すなわち、回転位置指令に対するモータの応答特性）が変動する。また、閉ループ系の特性が変動すると、モータを安定させた状態で適切に制御することが困難になる場合がある。
【０００７】
そこで、本発明の課題は、動作対象物やモータのイナーシャが大きくなったときに動作対象物やモータに振動が生じても、動作対象物やモータの振動を抑制しつつ、モータの回転位置指令を入力としモータの回転位置を出力とする閉ループ系の特性を一定に保つことが可能なモータシステムを提供することにある。
【課題を解決するための手段】
【０００８】
上記の課題を解決するため、本発明のモータシステムは、動作対象物を動作させるモータと、モータを制御するモータ制御装置とを備えるモータシステムにおいて、モータの回転位置指令を入力としモータの回転位置を出力とする閉ループ系をブロック線図で表わすと、閉ループ系は、伝達要素として、比例ゲイン要素と、積分フィルタ要素と、モータゲイン要素と、モータ要素と、微分フィルタ要素とを備えるとともに、閉ループ系の入力部から出力部へ向かう前向き経路と、閉ループ系の出力部から入力側に向かう第１帰還経路および第２帰還経路とを備え、前向き経路では、信号の伝達方向において、回転位置指令が入力される第１の加え合わせ点と、比例ゲイン要素と、第２の加え合わせ点と、積分フィルタ要素と、モータゲイン要素と、モータ要素とがこの順番に配置され、第１帰還経路は、第１の加え合わせ点に負帰還接続され、第２帰還経路は、第２の加え合わせ点に負帰還接続されるとともに、微分フィルタ要素は、第２帰還経路の中に配置され、モータに電力を供給するアンプの固定ゲインとモータのトルク定数とを含む固定値を動作対象物およびモータのイナーシャで割った値であるゲインをＫとし、動作対象物およびモータの粘性に関わる項を動作対象物およびモータのイナーシャで割った値であるゲインをｐとし、ラプラス演算子をｓとすると、動作対象物に応じてモータを適切に制御するための閉ループ系の希望特性を有する伝達関数である希望伝達関数は、ｍ０／（ｓ２＋ｍ１ｓ＋ｍ０）で規定され、比例ゲイン要素は、ｍ０であり、積分フィルタ要素は、（ｓ２＋ｑ１ｓ＋ｑ０）／（ｓ２＋ａ１ｓ）で表わされる伝達関数であり、モータゲイン要素は、１／Ｋであり、モータ要素は、Ｋ／（ｓ２＋ｐｓ）で表わされる伝達関数であり、微分フィルタ要素は、（ｂ２ｓ２＋ｂ１ｓ）／（ｓ２＋ｑ１ｓ＋ｑ０）で表わされる伝達関数であり、ａ１、ｂ１、ｂ２が以下の関係を満足することで、閉ループ系の特性が希望伝達関数に一致し、
ａ１＝ｑ１＋ｍ１−ｐ
ｂ１＝ｑ０ｍ１
ｂ２＝（ｑ１−ｐ）（ｍ１−ｐ）＋ｑ０
モータ制御装置は、動作対象物およびモータのイナーシャを検出するイナーシャ検出手段を備え、イナーシャ検出手段での検出結果に基づいて、ｑ０およびｑ１を調整することによって、希望伝達関数の特性を損なうことなく、動作対象物およびモータのイナーシャに応じて変化する外乱応答特性を補正することを特徴とする。
【０００９】
本発明において、イナーシャ検出手段は、たとえば、モータ要素への入力とモータ要素からの出力とに基づいて、動作対象物およびモータのイナーシャを推定する適応同定手段である。
【００１０】
また、上記の課題を解決するため、本発明のモータシステムは、動作対象物を動作させるモータと、モータを制御するモータ制御装置とを備えるモータシステムにおいて、モータの回転位置指令を入力としモータの回転位置を出力とする閉ループ系をブロック線図で表わすと、閉ループ系は、伝達要素として、比例ゲイン要素と、積分フィルタ要素と、モータゲイン要素と、モータ要素と、微分フィルタ要素とを備えるとともに、閉ループ系の入力部から出力部へ向かう前向き経路と、閉ループ系の出力部から入力側に向かう第１帰還経路および第２帰還経路とを備え、前向き経路では、信号の伝達方向において、回転位置指令が入力される第１の加え合わせ点と、比例ゲイン要素と、第２の加え合わせ点と、積分フィルタ要素と、モータゲイン要素と、モータ要素とがこの順番に配置され、第１帰還経路は、第１の加え合わせ点に負帰還接続され、第２帰還経路は、第２の加え合わせ点に負帰還接続されるとともに、微分フィルタ要素は、第２帰還経路の中に配置され、モータに電力を供給するアンプの固定ゲインとモータのトルク定数とを含む固定値を動作対象物およびモータのイナーシャで割った値であるゲインをＫとし、動作対象物およびモータの粘性に関わる項を動作対象物およびモータのイナーシャで割った値であるゲインをｐとし、ラプラス演算子をｓとすると、動作対象物に応じてモータを適切に制御するための閉ループ系の希望特性を有する伝達関数である希望伝達関数は、ｍ０／（ｓ２＋ｍ１ｓ＋ｍ０）で規定され、比例ゲイン要素は、ｍ０であり、積分フィルタ要素は、（ｓ２＋ｑ１ｓ＋ｑ０）／（ｓ２＋ａ１ｓ）で表わされる伝達関数であり、モータゲイン要素は、１／Ｋであり、モータ要素は、Ｋ／（ｓ２＋ｐｓ）で表わされる伝達関数であり、微分フィルタ要素は、（ｂ２ｓ２＋ｂ１ｓ）／（ｓ２＋ｑ１ｓ＋ｑ０）で表わされる伝達関数であり、ａ１、ｂ１、ｂ２が以下の関係を満足することで、閉ループ系の特性が希望伝達関数に一致し、
ａ１＝ｑ１＋ｍ１−ｐ
ｂ１＝ｑ０ｍ１
ｂ２＝（ｑ１−ｐ）（ｍ１−ｐ）＋ｑ０
モータ制御装置は、動作対象物および／またはモータの振動の大きさを検出する振動検出手段を備え、振動検出手段での検出結果に基づいて、ｑ０およびｑ１を調整することによって、希望伝達関数の特性を損なうことなく、動作対象物および／またはモータの振動を抑制することを特徴とする。
【００１１】
本発明のモータシステムでは、モータの回転位置指令を入力としモータの回転位置を出力とする閉ループ系をブロック線図で表わすと、閉ループ系は、上述のように構成されている。また、本発明では、モータ制御装置は、動作対象物およびモータのイナーシャを検出するイナーシャ検出手段を備え、イナーシャ検出手段での検出結果に基づいて、ｑ０およびｑ１を調整している。ｑ０およびｑ１の調整により積分フィルタ要素のゲインを調整することになるが（すなわち、外乱応答感度を調整することになるが）、本発明では、上述のように構成されているため、動作対象物やモータのイナーシャが大きくなったときに動作対象物やモータに振動が生じても、動作対象物やモータの振動を抑制することが可能になる。あるいは、本発明のモータシステムでは、モータ制御装置は、動作対象物および／またはモータの振動の大きさを検出する振動検出手段を備え、振動検出手段での検出結果に基づいて、ｑ０およびｑ１を調整している。そのため、本発明では、動作対象物やモータのイナーシャが大きくなったときに動作対象物やモータに振動が生じても、上記と同様に、動作対象物やモータの振動を抑制することが可能になる。また、その他の要因で動作対象物やモータに振動が生じても、動作対象物やモータの振動を抑制することが可能になる。
【００１２】
また、本発明では、閉ループ系が上述のように構成されているため、動作対象物やモータのイナーシャが大きくなって、ｑ０およびｑ１が調整されても、これに対応してａ１、ｂ１およびｂ２も自動的に調整することで、閉ループ系の伝達関数を変化させることなく、希望伝達関数に一致させることが可能になる。したがって、本発明では、動作対象物やモータのイナーシャが大きくなった場合、外乱応答感度が高くなり、振動に対する検知感度も高くなるが、ｑ０およびｑ１が調整されるとともに、それらに対応してａ１、ｂ１およびｂ２も自動的に調整されることで閉ループ系の特性を一定に保つことが可能になる。以上より、本発明では、動作対象物やモータのイナーシャが大きくなったときに動作対象物やモータに振動が生じても、動作対象物やモータの振動を抑制しつつ、閉ループ系の特性を一定に保つことが可能になる。
【００１３】
本発明において、モータ制御装置には、動作対象物およびモータのイナーシャと、ｑ０およびｑ１とが対応付けられたテーブルが記憶され、モータ制御装置は、イナーシャ検出手段での検出結果とテーブルとに基づいてｑ０およびｑ１を調整することが好ましい。また、本発明において、モータ制御装置には、動作対象物および／またはモータの振動の大きさと、ｑ０およびｑ１とが対応付けられたテーブルが記憶され、モータ制御装置は、振動検出手段での検出結果とテーブルとに基づいてｑ０およびｑ１を調整することが好ましい。このように構成すると、モータ制御装置に記憶されたテーブルに基づいてｑ０およびｑ１を調整することが可能になるため、動作対象物およびモータのイナーシャに応じたｑ０およびｑ１の調整の再現性や、動作対象物および／またはモータの振動の大きさに応じたｑ０およびｑ１の調整の再現性を高めることが可能になる。したがって、ｑ０およびｑ１の安定した調整が可能になる。
【００１４】
また、本発明において、モータ制御装置は、イナーシャ検出手段によって検出された動作対象物およびモータのイナーシャに基づいて、所定の演算を行ってｑ０およびｑ１を算出し、ｑ０およびｑ１を調整しても良い。また、本発明において、モータ制御装置は、振動検出手段によって検出された動作対象物および／またはモータの振動の大きさに基づいて、所定の演算を行ってｑ０およびｑ１を算出し、ｑ０およびｑ１を調整しても良い。
【００１５】
本発明において、たとえば、微分フィルタ要素の特性多項式ｓ２＋ｑ１ｓ＋ｑ０の根を重根とすれば、特性多項式ｓ２＋ｑ１ｓ＋ｑ０の根が２つである場合と比較して、ｑ０およびｑ１の調整が容易になる。
【００１６】
本発明において、モータ制御装置は、モータ要素への入力とモータ要素からの出力とに基づいてゲインＫを推定する適応同定手段を備え、適応同定手段で推定されたゲインＫに基づいてモータゲイン要素を更新することが好ましい。この場合には、たとえば、適応同定手段は、ゲインＫの推定を所定時間間隔で逐次実行し、モータ制御装置は、適応同定手段で推定されたゲインＫに基づいてモータゲイン要素を所定時間間隔で逐次更新する。このように構成すると、動作対象物やモータのイナーシャが大きくなったときに、閉ループ系の伝達関数を希望伝達関数に自動的に一致させることが可能になる。したがって、動作対象物やモータのイナーシャが大きくなっても、閉ループ系の特性を自動で一定に保つことが可能になる。
【００１７】
本発明において、適応同定手段は、モータ要素への入力とモータ要素からの出力とに基づいて、ゲインｐを推定することが好ましい。このように構成すると、ゲインｐの値が大きくても、推定されたゲインｐに基づいて、積分フィルタ要素および微分フィルタ要素を適切な伝達関数とすることが可能になる。
【発明の効果】
【００１８】
以上のように、本発明のモータシステムでは、動作対象物やモータのイナーシャが大きくなったときに動作対象物やモータに振動が生じても、動作対象物やモータの振動を抑制しつつ、モータの回転位置指令を入力としモータの回転位置を出力とする閉ループ系の特性を一定に保つことが可能になる。
【図面の簡単な説明】
【００１９】
【図１】本発明の実施の形態にかかるモータシステムの概略構成を示すブロック図である。
【図２】図１に示すモータシステムにおいてモータの回転位置指令を入力としモータの回転位置を出力としたときの閉ループ系のブロック線図である。
【図３】図２に示す閉ループ系の伝達関数が、閉ループ系の希望特性を有する伝達関数である希望伝達関数と等しくなることを説明するための図である。
【図４】本発明の他の実施の形態にかかる微分フィルタ要素を示すブロック線図である。
【図５】従来技術にかかるモータシステムにおいてモータの回転位置指令を入力としモータの回転位置を出力としたときの閉ループ系のブロック線図である。
【発明を実施するための形態】
【００２０】
以下、図面を参照しながら、本発明の実施の形態を説明する。
【００２１】
（モータシステムの構成）
図１は、本発明の実施の形態にかかるモータシステム１の概略構成を示すブロック図である。図２は、図１に示すモータシステム１においてモータ３の回転位置指令を入力としモータ３の回転位置を出力としたときの閉ループ系８のブロック線図である。
【００２２】
本形態のモータシステム１は、動作対象物２を動作させるモータ３と、モータ３を制御するモータ制御装置４とを備えている。モータ３は、ＡＣサーボモータまたはＤＣサーボモータであり、たとえば、動作対象物２である産業用ロボットのアームを動作させる。また、モータ３は、モータ３の回転位置を検出するための検出機構（エンコーダ）５を備えている。検出機構５の出力信号は、モータ制御装置４に入力されている。モータシステム１において、モータ３の回転位置指令を入力としモータ３の回転位置を出力とする閉ループ系８をブロック線図で表すと、図２のようになる。なお、本形態では、モータ制御装置４のモータ制御回路は、アナログ回路（連続時間系の回路）であるが、モータ制御回路は、デジタル回路（離散時間系の回路）であっても良いし、ソフトウエアによって構成されても良い。
【００２３】
図２に示すように、閉ループ系８は、伝達要素として、比例ゲイン要素９と、積分フィルタ要素１０と、モータゲイン要素１１と、モータ要素１２と、微分フィルタ要素１３とを備えている。また、閉ループ系８は、閉ループ系８の入力部から出力部へ向かう前向き経路１５と、閉ループ系８の出力部から入力側に向かう第１帰還経路（第１フィードバック経路）１６および第２帰還経路（第２フィードバック経路）１７とによって構成されている。
【００２４】
前向き経路１５では、信号の伝達方向において、回転位置指令が入力される第１の加え合わせ点１８と、比例ゲイン要素９と、第２の加え合わせ点１９と、積分フィルタ要素１０と、モータゲイン要素１１と、モータ要素１２とがこの順番に配置されている。第１帰還経路１６は、第１の加え合わせ点１８に負帰還接続されている。第２帰還経路１７は、第２の加え合わせ点１９に負帰還接続されている。また、微分フィルタ要素１３は、第２帰還経路１７の中に配置されている。
【００２５】
ラプラス演算子をｓとすると、動作対象物２に応じてモータ３を適切に制御するための閉ループ系８の希望特性を有する伝達関数である希望伝達関数は、ｍ０／（ｓ２＋ｍ１ｓ＋ｍ０）で規定される。この希望伝達関数は、たとえば、下記のように変形することができる。
ｍ０／（ｓ２＋ｍ１ｓ＋ｍ０）＝ω１ω２／（ｓ＋ω１）（ｓ＋ω２）
ここで、ω１、ω２は、希望伝達関数の遮断周波数（カットオフ周波数）であり、以下の関係が成立する。
ｍ０＝ω１ω２、ｍ１＝ω１＋ω２
なお、動作対象物２およびモータ３の特性に応じてω１、ω２を設定することで、所望の制御応答特性を得ることができる。
【００２６】
また、モータ３に電力を供給するアンプ（図示省略）の固定ゲインとモータ３のトルク定数とを含む固定値を動作対象物２およびモータ３のイナーシャで割った値であるゲインをＫとし、動作対象物２およびモータ３の粘性に関わる項を動作対象物２およびモータ３のイナーシャで割った値であるゲインをｐとすると、比例ゲイン要素９は、ｍ０であり、積分フィルタ要素１０は、（ｓ２＋ｑ１ｓ＋ｑ０）／（ｓ２＋ａ１ｓ）で表わされる伝達関数であり、モータゲイン要素１１は、１／Ｋであり、モータ要素１２は、Ｋ／（ｓ２＋ｐｓ）で表わされる伝達関数であり、微分フィルタ要素１３は、（ｂ２ｓ２＋ｂ１ｓ）／（ｓ２＋ｑ１ｓ＋ｑ０）で表わされる伝達関数である。また、ａ１、ｂ１、ｂ２は以下の関係を満足する。
ａ１＝ｑ１＋ｍ１−ｐ・・・式（１）
ｂ１＝ｑ０ｍ１・・・式（２）
ｂ２＝（ｑ１−ｐ）（ｍ１−ｐ）＋ｑ０・・・式（３）
【００２７】
なお、ｑ０、ｑ１は、動作対象物２およびモータ３を適切に制御するために任意に設定される値である。また、微分フィルタ要素１３の特性多項式（ｓ２＋ｑ１ｓ＋ｑ０）および積分フィルタ要素１０の分子多項式（ｓ２＋ｑ１ｓ＋ｑ０）は、たとえば、下記のように変形することができる。
ｓ２＋ｑ１ｓ＋ｑ０＝（ｓ＋ωｑ１）（ｓ＋ωｑ２）
ここで、ωｑ１、ωｑ２は、遮断周波数であり、以下の関係が成立する。
ｑ０＝ωｑ１ωｑ２、ｑ１＝ωｑ１＋ωｑ２
本形態では、ωｑ１とωｑ２とが等しくなっている。すなわち、微分フィルタ要素１３の特性多項式の根は重根となっている。ただし、ωｑ１とωｑ２とは等しくなくても良い。
【００２８】
モータ制御装置４は、モータ要素１２への入力とモータ要素１２からの出力とに基づいて、ゲインＫを推定する適応同定手段２１を備えている（図２参照）。適応同定手段２１は、最小二乗法等の同定法によってゲインＫを推定する。また、適応同定手段２１は、ゲインＫの推定を所定時間間隔で逐次実行する。モータ制御装置４は、適応同定手段２１で推定されたゲインＫに基づいて、モータゲイン要素１１を更新する。すなわち、モータ制御装置４は、適応同定手段２１によって所定時間間隔で逐次推定されたゲインＫに基づいて、モータゲイン要素１１を所定時間間隔で逐次更新する。
【００２９】
また、適応同定手段２１は、モータ要素１２への入力とモータ要素１２からの出力とに基づいて、動作対象物２およびモータ３のイナーシャを推定する。適応同定手段２１は、最小二乗法等の同定法によって動作対象物２およびモータ３のイナーシャを推定するとともに、このイナーシャの推定を所定時間間隔で逐次実行する。モータ制御装置４は、適応同定手段２１で推定されたイナーシャに基づいて、ｑ０およびｑ１を調整する。
【００３０】
具体的には、モータ制御装置４には、動作対象物２およびモータ３のイナーシャと、ｑ０およびｑ１とが対応付けられたテーブルが記憶されており、モータ制御装置４は、適応同定手段２１によって推定されたイナーシャとテーブルとに基づいて、ｑ０およびｑ１を調整する。また、モータ制御装置４は、適応同定手段２１によって推定されたイナーシャが大きくなると、外乱感度が高くなり、振動に対する検知感度も高くなるが、ｑ０およびｑ１を小さくすることで、閉ループ系８の特性を一定に保ちつつ、外乱感度を下げることが可能になる。本形態の適応同定手段２１は、動作対象物２およびモータ３のイナーシャを検出するイナーシャ検出手段であり、モータ制御装置４は、このイナーシャ検出手段（すなわち、適応同定手段２１）の検出結果に基づいて、ｑ０およびｑ１を調整する。また、モータ制御装置４は、ｑ０およびｑ１の値に応じて、上述の式（１）〜（３）にしたがってａ１、ｂ１およびｂ２も自動調整する。
【００３１】
なお、動作対象物２およびモータ３のイナーシャと、ｑ０およびｑ１とが対応付けられたテーブルが、モータ制御装置４に記憶されていなくても良い。この場合には、モータ制御装置４は、たとえば、適応同定手段２１によって推定されたイナーシャに基づいて、所定の演算を行ってｑ０およびｑ１を算出し、ｑ０およびｑ１を調整すれば良い。
【００３２】
さらに、適応同定手段２１は、モータ要素１２への入力とモータ要素１２からの出力とに基づいて、ゲインｐを推定する。適応同定手段２１は、最小二乗法等の同定法によってゲインｐを推定するとともに、ゲインｐの推定を所定時間間隔で逐次実行する。モータ制御装置４は、適応同定手段２１で推定されたゲインｐに基づいて、積分フィルタ要素１０および微分フィルタ要素１３を更新する。すなわち、モータ制御装置４は、適応同定手段２１によって所定時間間隔で逐次推定されたゲインｐに基づいて、積分フィルタ要素１０および微分フィルタ要素１３を所定時間間隔で逐次更新する。
【００３３】
（本形態の主な効果）
以上説明したように、本形態では、閉ループ系８をブロック線図で表わすと、閉ループ系８は、図２に示すように構成されている。また、本形態では、モータ制御装置４は、適応同定手段２１で推定されたイナーシャに基づいて、ｑ０およびｑ１を調整している。そのため、本形態では、動作対象物２やモータ３のイナーシャが大きくなったときに動作対象物２やモータ３に振動が生じても、動作対象物２やモータ３の振動を抑制することが可能になる。
【００３４】
また、本形態では、動作対象物２やモータ３のイナーシャが大きくなると、外乱感度が高くなり、振動に対する検知感度も高くなるが、適応同定手段２１で推定されたイナーシャに基づいてｑ０およびｑ１が調整されているため、また、閉ループ系８が図２に示すように構成されているため、さらに、ｑ０およびｑ１の値に応じて、上述の式（１）〜（３）にしたがってａ１、ｂ１およびｂ２も自動調整されているため、動作対象物２やモータ３の振動を抑制しつつ、閉ループ系８の伝達関数を希望伝達関数に一致させることが可能になる。したがって、本形態では、動作対象物２やモータ３のイナーシャが大きくなっても、閉ループ系８の特性を一定に保つことが可能になる。以上より、本形態では、動作対象物２やモータ３のイナーシャが大きくなったときに動作対象物２やモータ３に振動が生じても、動作対象物２やモータ３の振動を抑制しつつ、閉ループ系８の特性を一定に保つことが可能になる。
【００３５】
特に本形態では、モータ要素１２への入力とモータ要素１２からの出力とに基づいて、適応同定手段２１でゲインＫが推定されるとともに、適応同定手段２１で推定されたゲインＫに基づいてモータゲイン要素１１が更新されているため、動作対象物２やモータ３のイナーシャが大きくなった場合でも、閉ループ系８の伝達関数を希望伝達関数に自動的に一致させることができる。図３等を用いて具体的に説明すると、まず、図２に示す閉ループ系８は、図３（Ａ）〜（Ｄ）に示すように、順次、等価変換することができる。また、図３（Ｄ）の伝達関数の分母は、
ｓ４＋（ａ１＋ｐ）ｓ３＋（ａ１ｐ＋ｂ２）ｓ２＋ｂ１ｓ＋ｍ０（ｓ２＋ｑ１ｓ＋ｑ０）
と変形することができ、変形後の分母に上述の式（１）〜（３）を代入して整理すると、
ｓ２（ｓ２＋ｑ１ｓ＋ｑ０）＋ｍ１ｓ（ｓ２＋ｑ１ｓ＋ｑ０）＋ｍ０（ｓ２＋ｑ１ｓ＋ｑ０）
となり、共通因子である（ｓ２＋ｑ１ｓ＋ｑ０）が分母分子に存在するため、（ｓ２＋ｑ１ｓ＋ｑ０）を約分することで、図３（Ｄ）の伝達関数は、希望伝達関数ｍ０／（ｓ２＋ｍ１ｓ＋ｍ０）と一致することがわかる。
【００３６】
このように、本形態では、動作対象物２やモータ３のイナーシャが大きくなっても、閉ループ系８の伝達関数を希望伝達関数に自動的に一致させることができるため、動作対象物２やモータ３のイナーシャが大きくなっても、閉ループ系８の特性を自動的に一定に保つことが可能になる。また、本形態では、適応同定手段２１がゲインｐを推定しているため、ゲインｐの値が大きくても、推定されたゲインｐに基づいて、積分フィルタ要素１０および微分フィルタ要素１３を適切に調整することで、閉ループ系８の特性を自動的に一定に保つことが可能になる。
【００３７】
本形態では、モータ制御装置４に、動作対象物２およびモータ３のイナーシャと、ｑ０およびｑ１とが対応付けられたテーブルが記憶されており、モータ制御装置４は、適応同定手段２１によって推定されたイナーシャとテーブルとに基づいて、ｑ０およびｑ１を調整している。そのため、本形態では、動作対象物２およびモータ３のイナーシャに応じたｑ０およびｑ１の調整の再現性を高めることが可能になり、その結果、ｑ０およびｑ１の安定した調整が可能になる。また、本形態では、微分フィルタ要素１３の特性多項式の根が重根となっているため、ｑ０およびｑ１の調整が容易になる。
【００３８】
（他の実施の形態）
上述した形態は、本発明の好適な形態の一例ではあるが、これに限定されるものではなく本発明の要旨を変更しない範囲において種々変形実施が可能である。
【００３９】
上述した形態では、モータ制御装置４は、適応同定手段２１で推定されたイナーシャに基づいて、ｑ０およびｑ１を調整している。この他にもたとえば、モータ制御装置４は、動作対象物２および／またはモータ３の振動の大きさを検出する振動検出手段を備えるとともに、この振動検出手段での検出結果に基づいて、ｑ０およびｑ１を調整しても良い。この場合には、モータ制御装置４は、振動検出手段によって検出される振動の大きさが大きくなると、ｑ０およびｑ１を小さくする。
【００４０】
この場合であっても、動作対象物２やモータ３のイナーシャが大きくなったときに動作対象物２やモータ３に振動が生じても、動作対象物２やモータ３の振動を抑制することができる。また、上述した形態と同様に、ｑ０およびｑ１が調整されても、閉ループ系８の伝達関数を希望伝達関数に一致させることが可能になるため、閉ループ系８の特性を一定に保つことが可能になる。したがって、この場合であっても、上述した形態と同様の効果を得ることができる。
【００４１】
なお、この場合には、動作対象物２および／またはモータ３の振動の大きさと、ｑ０およびｑ１とが対応付けられたテーブルがモータ制御装置４に記憶され、モータ制御装置４は、振動検出手段での検出結果とこのテーブルとに基づいて、ｑ０およびｑ１を調整することが好ましい。ただし、モータ制御装置４は、たとえば、振動検出手段によって検出された振動の大きさに基づいて、所定の演算を行ってｑ０およびｑ１を算出し、ｑ０およびｑ１を調整しても良い。
【００４２】
また、モータ制御装置４は、適応同定手段２１によって推定されたイナーシャと、振動検出手段によって検出された振動の大きさとに基づいて、ｑ０およびｑ１を調整しても良い。
【００４３】
上述した形態では、微分フィルタ要素１３は、１個の伝達要素によって構成されているが、微分フィルタ要素１３は、２個以上の伝達要素によって構成されても良い。たとえば、微分フィルタ要素１３は、図４に示す２個の伝達要素１３ａ、１３ｂによって構成されても良い。同様に、上述した形態では、積分フィルタ要素１０は、１個の伝達要素によって構成されているが、積分フィルタ要素１０は、２個以上の伝達要素によって構成されても良い。
【００４４】
上述した形態では、適応同定手段２１は、ゲインｐを推定しているが、ゲインｐが小さい場合には、適応同定手段２１は、ゲインｐを推定しなくても良い。また、上述した形態では、モータ制御装置４は、適応同定手段２１で推定されたゲインＫに基づいて、モータゲイン要素１１を更新している。すなわち、上述した形態では、ゲインＫが自動的に更新されているが、ゲインＫが手動で更新されても良い。この場合であって、ゲインｐが小さく、かつ、動作対象物２および／またはモータ３の振動の大きさを検出する振動検出手段での検出結果に基づいてｑ０およびｑ１を調整する場合には、モータ制御装置４は、適応同定手段２１を備えていなくても良い。
【００４５】
上述した形態では、適応同定手段２１が、動作対象物２およびモータ３のイナーシャを検出するイナーシャ検出手段となっているが、モータ制御装置４は、適応同定手段２１に加えて、動作対象物２およびモータ３のイナーシャを検出するイナーシャ検出手段を備えていても良い。
【符号の説明】
【００４６】
１  モータシステム
２  動作対象物
３  モータ
４  モータ制御装置
８  閉ループ系
９  比例ゲイン要素
１０  積分フィルタ要素
１１  モータゲイン要素
１２  モータ要素
１３  微分フィルタ要素
１５  前向き経路
１６  第１帰還経路
１７  第２帰還経路
１８  第１の加え合わせ点
１９  第２の加え合わせ点
２１  適応同定手段（イナーシャ検出手段）
【図１】
0006353731.tif 000002
【図２】
0006353731.tif 000003
【図３】
0006353731.tif 000004
【図４】
0006353731.tif 000005
【図５】
0006353731.tif 000006