(57)【要約】【課題】制御システムにおいて、システムの制御性能を高度化するために、共振，非周期外乱，周期外乱をすべて抑制する。【解決手段】指令値ｒ*と、制御対象システムの検出値ｙと、制御対象システムの位相情報θと、に基づいて、制御対象システムの操作量ｕを決定するフィードバック制御器１を備えた制御システムであって、フィードバック制御器１は、検出値ｙと位相情報θとに基づいて、周期外乱補償信号ｒpd*を出力する周期外乱抑制制御器４と、指令値ｒ*と周期外乱補償信号ｒpd*とを加算した補正指令値ｒと、検出値ｙと、に基づいて、操作量ｕを算出する共振・外乱抑制制御器３と、を有する。周期外乱抑制制御器４は一般化周期外乱オブザーバを用いる。【選択図】図２
2018005259.tif 000002
【特許請求の範囲】
【請求項１】
指令値と、制御対象システムの検出値と、制御対象システムの位相情報と、に基づいて、制御対象システムの操作量を決定するフィードバック制御器を備えた制御システムであって、
前記フィードバック制御器は、
前記検出値と前記位相情報とに基づいて、周期外乱補償信号を出力する周期外乱抑制制御器と、
前記指令値と前記周期外乱補償信号とを加算した補正指令値と、前記検出値と、に基づいて、前記操作量を算出する共振・外乱抑制制御器と、を有し、
前記周期外乱抑制制御器は一般化周期外乱オブザーバを用いることを特徴とする制御システム。
【請求項２】
前記共振・外乱抑制制御器は、
前記指令値がμ設計制御器の前記指令値から前記操作量までの伝達特性を介した出力と、前記検出値がμ設計制御器の前記検出値から前記操作量までの伝達特性を介した出力と、を加算して、前記操作量を出力するμ設計制御器を有し、
前記周期外乱抑制制御器は、
前記位相情報に抑制対象次数ｎを乗じたｎ次回転位相を用いて、前記検出値から周波数成分を抽出し、ｄnｑn回転座標に変換した周期外乱のｎ次周波数成分ベクトルを出力する周波数成分抽出器と、
前記ｎ次回転位相を微分してｎ次回転周波数を算出する速度変換器と、
前記周期外乱のｎ次周波数成分ベクトルに、前記ｎ次回転周波数に同期した単一の周波数ベクトルが適用された逆モデルを乗じて、操作量推定値のｎ次周波数成分ベクトルを求める逆モデル乗算部と、
前記操作量推定値のｎ次周波数成分ベクトルから、周期外乱補償値のｎ次周波数成分ベクトルが低域通過フィルタを介した値を減算して周期外乱推定値のｎ次周波数成分ベクトルを出力する第１減算器と、
周期外乱指令値のｎ次周波数成分ベクトルから、前記周期外乱推定値のｎ次周波数成分ベクトルを減算して、周期外乱補償値のｎ次周波数成分ベクトルを出力する第２減算器と、
前記周期外乱補償値のｎ次周波数成分ベクトルを、前記ｎ次回転位相に基づいて、周期外乱に同期したｄnｑn回転座標系から元の時間波形に復元し、前記周期外乱補償信号を出力する補償信号合成部と、
を備えたことを特徴とする請求項１記載の制御システム。
【請求項３】
前記周波数成分抽出器に使用する前記検出値は、高域通過フィルタを通過させた値であることを特徴とする請求項２記載の制御システム。
【請求項４】
前記共振・外乱抑制制御器は、
前記指令値がμ設計制御器の前記指令値から前記操作量までの伝達特性を介した出力と、前記検出値が設計制御器の前記検出値から前記操作量までの伝達特性を介した出力と、を加算して、前記操作量を出力するμ設計制御器を有し、
前記周期外乱抑制制御器は、
前記位相情報に抑制対象次数ｎを乗じたｎ次回転位相を用いて、前記指令値から前記検出値を減算した偏差から周波数成分を抽出し、ｄnｑn回転座標に変換した周期外乱のｎ次周波数成分ベクトルを出力する周波数成分抽出器と、
前記ｎ次回転位相を微分してｎ次回転周波数を算出する速度変換器と、
周期外乱のｎ次周波数成分ベクトルに、前記ｎ次回転周波数に同期した単一の周波数ベクトルが適用された逆モデルを乗じて、操作量推定値のｎ次周波数成分ベクトルを求める逆モデル乗算部と、
前記操作量推定値のｎ次周波数成分ベクトルと、周期外乱補償値のｎ次周波数成分ベクトルが低域通過フィルタを介した値と、を加算して周期外乱補償値のｎ次周波数成分ベクトルを出力する加算器と、
前記周期外乱補償値のｎ次周波数成分ベクトルを、前記ｎ次回転位相に基づいて、周期外乱に同期したｄnｑn回転座標系から元の時間波形に復元し、前記周期外乱補償信号を出力する補償信号合成部と、
を備えたことを特徴とする請求項１記載の制御システム。
【請求項５】
前記共振・外乱抑制制御器は、
前記指令値がμ設計制御器の前記指令値から前記操作量までの伝達特性を介した出力と、前記検出値がμ設計制御器の前記検出値から前記操作量までの伝達特性を介した出力と、を加算して、前記操作量を出力するμ設計制御器を有し、
前記周期外乱抑制制御器は、
前記位相情報に抑制対象次数ｎを乗じたｎ次回転位相を用いて、前記指令値から前記検出値を減算した偏差を、ｄnｑn回転座標に変換した周期外乱のｎ次周波数成分ベクトルを出力する周波数成分変換器と、
前記ｎ次回転位相を微分してｎ次回転周波数を算出する速度変換器と、
前記周期外乱のｎ次周波数成分ベクトルに、前記ｎ次回転周波数に同期した単一の周波数ベクトルが適用された逆モデルを乗じて、操作量推定値のｎ次周波数成分ベクトルを求める逆モデル乗算部と、
前記操作量推定値のｎ次周波数成分ベクトルを積分し、周期外乱補償値のｎ次周波数成分ベクトルを出力する積分器と、
前記周期外乱補償値のｎ次周波数成分ベクトルを、前記ｎ次回転位相に基づいて、周期外乱に同期したｄnｑn回転座標系から元の時間波形に復元し、前記周期外乱補償信号を出力する補償信号合成部と、
を備えたことを特徴とする請求項１記載の制御システム。
【請求項６】
前記指令値と前記検出値に基づいて、直流トルク成分指令値を出力する低域トルク制御器を有し、
前記直流トルク成分指令値と前記周期外乱補償信号を加算した値を前記補正指令値とし、
前記低域トルク制御器は、
ＰＩ制御器と、低域通過フィルタと、を備えたことを特徴とする請求項１〜５のうち何れか１項に記載の制御システム。
【請求項７】
抑制対象次数の異なる前記周期外乱抑制制御器を複数台有し、各々の前記周期外乱抑制制御器の出力を合算した値を周期外乱補償信号とすることを特徴とする請求項１〜６のうち何れか１項に記載の制御システム。
【請求項８】
トルク指令値と、トルク検出値と、インバータによって駆動されるモータの位相情報と、に基づいて、前記インバータのインバータトルク指令値を演算するトルク制御器を備えた制御システムであって、
前記トルク制御器は、
前記トルク検出値と前記位相情報とに基づいて、周期外乱補償信号を出力する周期外乱抑制制御器と、
前記トルク指令値と前記周期外乱補償信号とを加算した補正トルク指令値と、前記トルク検出値と、に基づいて、前記インバータトルク指令値を算出する共振・外乱抑制制御器と、を有し、
前記周期外乱抑制制御器は一般化周期外乱オブザーバを用いることを特徴とする制御システム。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、システムの共振・外乱を抑制しながら、周期的な外乱も同時に抑制する制御方式に関する。
【背景技術】
【０００２】
特許文献１は、周期的な外乱を抑制する制御方式に関するものである。この特許文献１では、「周期外乱オブザーバ方式」によって、周期外乱である電動機のトルクリプルを抑制する手法が開示されている。
【０００３】
特許文献２，３は、μ設計法によるロバスト制御で、共振や外乱を抑制し、制御の安定化・高速化を実現するものである。特に、ダイナモメータ（エンジンベンチシステム）の動力計測装置の構成について記載されている。
【０００４】
本願発明は、システムの共振抑制と周期的な外乱抑制を同時に実現するものである。以下からは、ダイナモメータシステムのような多慣性系のモータドライブシステムを事例に挙げて説明するが、用途例はこれに限るものではない。例えば、電力系統システムならば、系統共振抑制と高調波抑制を同時に実現するなども該当する。
【０００５】
制御システムにおいて発生する共振や外乱は、制御性能を劣化させるのみでなく、システムを不安定化させる要因となる。構造・仕様・コスト等の制約があるため、システム共振や外乱を構造的対策によって十分に低減できない場合、共振抑制制御や外乱抑制制御が古くから行われている。
【０００６】
外乱には、ホワイトノイズのように全周波数帯域で発生する「非周期外乱」と、特定の周波数成分で周期的に発生する「周期外乱」がある。例えば、モータであればトルクリプル、電力系統であれば高調波などが周期外乱に相当する。特に、周期外乱については特定周波数成分で繰り返し発生するため、システムの共振周波数と一致した場合、非常に大きな外乱として増幅され、システムの故障や不安定化に多大な影響を与える。
【０００７】
外乱を抑制する一般的な手法として、外乱オブザーバが広く用いられている。外乱オブザーバは、指令値および制御対象モデルの逆特性から外乱を推定し、その推定外乱を指令値から差し引くことで外乱を除去する。
【先行技術文献】
【特許文献】
【０００８】
【特許文献１】特許５０８８４１４号
【特許文献２】特開２００３−１２１３０８号公報
【特許文献３】特開２００３−１４９０８５号公報
【発明の概要】
【発明が解決しようとする課題】
【０００９】
しかしながら、制御対象モデルの逆特性は一般に微分要素を持つため、高周波帯域のゲイン増幅を防止して擬似微分とするためのローパスフィルタが用いられる。このローパスフィルタが存在するために、周波数帯域の外乱を推定・除去することができない問題を有する。
【００１０】
例えば、３相モータのトルクリプルは、回転数に同期して発生する周期外乱であり、主に回転数の６×ｎ倍で発生することが知られている。回転数が高くなるほどトルクリプルの周波数成分は高くなり、外乱オブザーバでは十分に抑制できない制御帯域となる。さらには、高周波数帯域にシステムの共振周波数がある場合は周期外乱が増幅し、非常に大きな振動・騒音が発生する。
【００１１】
特許文献１では、周期外乱の周期性に着目し、トルクリプル周波数に同期した回転座標系で外乱オブザーバを一般化した「周期外乱オブザーバ方式」が開示されている。
【００１２】
この方式は、特定周波数成分の周期外乱のみに寄与する制御系であり、制御対象の逆特性に微分特性を含まないため、高周波数帯域であっても周期外乱を抑制することができる。しかしながら、特定周波数成分以外の非周期外乱を抑制することはできない。したがって、例えばシステムの共振周波数と一致する非周期外乱が存在する場合は、その影響を除去できないため、非周期外乱を抑制する別の方策を併用する必要がある。
【００１３】
特許文献２，３では、共振／外乱抑制手法の一例として、μ設計法によるロバスト制御が用いられている。こうしたロバスト制御においては、システムの共振や外乱を包括的に抑制し、所望の指令値応答や外乱応答を実現するコントローラの設計を行う。
【００１４】
しかし、広範な周波数帯域で各種パラメータの摂動を考慮した場合、保守的な設計となりやすい。また、ボードの定理に従い、指令値応答や外乱応答の速応性と共振抑圧性能にはトレードオフがある。そのため、共振周波数付近の外乱応答特性が０ｄＢを超えてしまい、そこに大きな周期外乱が含まれると十分に共振を抑制できないことがある。
【００１５】
以上示したように、制御システムにおいて、システムの制御性能を高度化するために、共振，非周期外乱，周期外乱をすべて抑制することが課題となる。
【課題を解決するための手段】
【００１６】
本発明は、前記従来の問題に鑑み、案出されたもので、その一態様は、指令値と、制御対象システムの検出値と、制御対象システムの位相情報と、に基づいて、制御対象システムの操作量を決定するフィードバック制御器を備えた制御システムであって、前記フィードバック制御器は、前記検出値と前記位相情報とに基づいて、周期外乱補償信号を出力する周期外乱抑制制御器と、前記指令値と前記周期外乱補償信号とを加算した補正指令値と、前記検出値と、に基づいて、前記操作量を算出する共振・外乱抑制制御器と、を有し、前記周期外乱抑制制御器は一般化周期外乱オブザーバを用いることを特徴とする。
【００１７】
また、その一態様として、前記共振・外乱抑制制御器は、前記指令値がμ設計制御器の前記指令値から前記操作量までの伝達特性を介した出力と、前記検出値がμ設計制御器の前記検出値から前記操作量までの伝達特性を介した出力と、を加算して、前記操作量を出力するμ設計制御器を有し、前記周期外乱抑制制御器は、前記位相情報に抑制対象次数ｎを乗じたｎ次回転位相を用いて、前記検出値から周波数成分を抽出し、ｄnｑn回転座標に変換した周期外乱のｎ次周波数成分ベクトルを出力する周波数成分抽出器と、前記ｎ次回転位相を微分してｎ次回転周波数を算出する速度変換器と、前記周期外乱のｎ次周波数成分ベクトルに、前記ｎ次回転周波数に同期した単一の周波数ベクトルが適用された逆モデルを乗じて、操作量推定値のｎ次周波数成分ベクトルを求める逆モデル乗算部と、前記操作量推定値のｎ次周波数成分ベクトルから、周期外乱補償値のｎ次周波数成分ベクトルが低域通過フィルタを介した値を減算して周期外乱推定値のｎ次周波数成分ベクトルを出力する第１減算器と、周期外乱指令値のｎ次周波数成分ベクトルから、前記周期外乱推定値のｎ次周波数成分ベクトルを減算して、周期外乱補償値のｎ次周波数成分ベクトルを出力する第２減算器と、前記周期外乱補償値のｎ次周波数成分ベクトルを、前記ｎ次回転位相に基づいて、周期外乱に同期したｄnｑn回転座標系から元の時間波形に復元し、前記周期外乱補償信号を出力する補償信号合成部と、を備えたことを特徴とする。
【００１８】
また、その一態様として、前記周波数成分抽出器に使用する前記検出値は、高域通過フィルタを通過させた値であることを特徴とする。
【００１９】
また、その一態様として、前記共振・外乱抑制制御器は、前記指令値がμ設計制御器の前記指令値から前記操作量までの伝達特性を介した出力と、前記検出値が設計制御器の前記検出値から前記操作量までの伝達特性を介した出力と、を加算して、前記操作量を出力するμ設計制御器を有し、前記周期外乱抑制制御器は、前記位相情報に抑制対象次数ｎを乗じたｎ次回転位相を用いて、前記指令値から前記検出値を減算した偏差から周波数成分を抽出し、ｄnｑn回転座標に変換した周期外乱のｎ次周波数成分ベクトルを出力する周波数成分抽出器と、前記ｎ次回転位相を微分してｎ次回転周波数を算出する速度変換器と、周期外乱のｎ次周波数成分ベクトルに、前記ｎ次回転周波数に同期した単一の周波数ベクトルが適用された逆モデルを乗じて、操作量推定値のｎ次周波数成分ベクトルを求める逆モデル乗算部と、前記操作量推定値のｎ次周波数成分ベクトルと、周期外乱補償値のｎ次周波数成分ベクトルが低域通過フィルタを介した値と、を加算して周期外乱補償値のｎ次周波数成分ベクトルを出力する加算器と、前記周期外乱補償値のｎ次周波数成分ベクトルを、前記ｎ次回転位相に基づいて、周期外乱に同期したｄnｑn回転座標系から元の時間波形に復元し、前記周期外乱補償信号を出力する補償信号合成部と、を備えたことを特徴とする。
【００２０】
また、その一態様として、前記共振・外乱抑制制御器は、前記指令値がμ設計制御器の前記指令値から前記操作量までの伝達特性を介した出力と、前記検出値がμ設計制御器の前記検出値から前記操作量までの伝達特性を介した出力と、を加算して、前記操作量を出力するμ設計制御器を有し、前記周期外乱抑制制御器は、前記位相情報に抑制対象次数ｎを乗じたｎ次回転位相を用いて、前記指令値から前記検出値を減算した偏差を、ｄnｑn回転座標に変換した周期外乱のｎ次周波数成分ベクトルを出力する周波数成分変換器と、前記ｎ次回転位相を微分してｎ次回転周波数を算出する速度変換器と、前記周期外乱のｎ次周波数成分ベクトルに、前記ｎ次回転周波数に同期した単一の周波数ベクトルが適用された逆モデルを乗じて、操作量推定値のｎ次周波数成分ベクトルを求める逆モデル乗算部と、前記操作量推定値のｎ次周波数成分ベクトルを積分し、周期外乱補償値のｎ次周波数成分ベクトルを出力する積分器と、前記周期外乱補償値のｎ次周波数成分ベクトルを、前記ｎ次回転位相に基づいて、周期外乱に同期したｄnｑn回転座標系から元の時間波形に復元し、前記周期外乱補償信号を出力する補償信号合成部と、を備えたことを特徴とする。
【００２１】
また、その一態様として、前記指令値と前記検出値に基づいて、直流トルク成分指令値を出力する低域トルク制御器を有し、前記直流トルク成分指令値と前記周期外乱補償信号を加算した値を前記補正指令値とし、前記低域トルク制御器は、ＰＩ制御器と、低域通過フィルタと、を備えたことを特徴とする。
【００２２】
また、その一態様として、抑制対象次数の異なる前記周期外乱抑制制御器を複数台有し、各々の前記周期外乱抑制制御器の出力を合算した値を周期外乱補償信号とすることを特徴とする。
【００２３】
また、他の態様として、トルク指令値と、トルク検出値と、インバータによって駆動されるモータの位相情報と、に基づいて、前記インバータのインバータトルク指令値を演算するトルク制御器を備えた制御システムであって、前記トルク制御器は、前記トルク検出値と前記位相情報とに基づいて、周期外乱補償信号を出力する周期外乱抑制制御器と、前記トルク指令値と前記周期外乱補償信号とを加算した補正トルク指令値と、前記トルク検出値と、に基づいて、前記インバータトルク指令値を算出する共振・外乱抑制制御器と、を有し、前記周期外乱抑制制御器は一般化周期外乱オブザーバを用いることを特徴とする。
【発明の効果】
【００２４】
本発明によれば、制御システムにおいて、システムの制御性能を高度化するために、共振，非周期外乱，周期外乱をすべて抑制することが可能となる。
【図面の簡単な説明】
【００２５】
【図１】フィードバック制御システムの基本構成図。
【図２】フィードバック制御器の基本構成図。
【図３】一般化周期外乱オブザーバを示す図。
【図４】特定周波数成分の複素ベクトル表現。
【図５】トルクフィードバック制御システム一例を示す構成図。
【図６】システム伝達特性の例を示す図（トルク制御なし）。
【図７】トルク波形の一例を示す図（トルクフィードバック制御なし）。
【図８】トルク制御器の構成例を示す図。
【図９】一般化プラントの構成例を示す図。
【図１０】μ設計コントローラの特性を示す図。
【図１１】μ設計制御器の構成例を示す図。
【図１２】共振および非周期外乱抑制制御のみを機能させた場合の閉ループ伝達特性を示す図。
【図１３】共振および非周期外乱抑制制御のみを機能させた場合のトルク波形を示す図。
【図１４】周期外乱抑制制御器の構成図。
【図１５】トルク波形を示す図（共振・非周期外乱・周期外乱を同時に抑制した場合）
【図１６】周期外乱抑制制御器の構成図（ハイパスフィルタ利用）。
【図１７】トルク偏差に対して周期外乱抑制制御器を用いる場合の構成図。
【図１８】トルク偏差に対する一般化周期外乱オブザーバの構成図。
【図１９】１次ローパスフィルタ適用時の等価な制御構成図。
【図２０】実施形態５のフィードバック制御器を示す図。
【図２１】低減トルク制御器の構成例を示す図。
【図２２】実施形態５の一般化プラントを示す図。
【図２３】周期外乱オブザーバから見たマイナーループの閉ループ伝達特性を示す図。
【図２４】実施形態５のトルク波形を示す図。
【発明を実施するための形態】
【００２６】
本明細書では、Ｈ∞的制御やμ設計法のように共振と非周期外乱を抑制する手法と、周期外乱オブザーバを用いた周期外乱抑制手法を併用する手段を説明する。
【００２７】
本明細書では、共振抑制制御手法の一例としてμ設計法を用いて説明するが、共振比制御・H∞制御など、共振抑制手法を限定するものではなく、共振抑制後の閉ループ伝達特性が把握できれば、どのような方式にも対応できるものである。
【００２８】
本願発明は、さまざまなシステムに適用可能な制御方式であるため、図１に示す一般的なフィードバック制御システムが基本構成図となる。指令値ｒ*、検出値ｙ、および、システムで問題となっている周期外乱を制御するために位相情報θをフィードバック制御器１に入力する。フィードバック制御器１で演算された操作量ｕは、制御対象システム２に入力される。
【００２９】
実際の制御対象システム２では共振特性を有する場合があり、操作量ｕや検出値ｙには外乱が含まれる。また、外乱の中でもシステム特性に起因して周期的に発生する周期外乱は、制御性能や安定性に影響を与えやすい。
【００３０】
こうした周期外乱は、制御対象システム２の動作に伴って周期的に発生するものであるから、その周期性を検出するための位相情報θをフィードバック制御器１に返す。
【００３１】
図２は、フィードバック制御器１の構成例である。共振・外乱抑制制御器３では後述する補正指令値ｒと検出値ｙに基づいてフィードバック制御を実施する。本願発明では、制御対象システム２に共振特性が含まれている場合を考慮し、共振抑制制御や外乱抑制制御も実施する。
【００３２】
例えば、ＰＩＤ制御器に外乱オブザーバ等を組み合わせたもの，共振比制御，H∞制御やμ設計等のロバスト制御などを想定しているが、これら共振抑制手法は限定されず、共振・外乱を抑制する任意の手法を用いれば良い。本願発明で重要となるのは、共振抑制した結果得られる指令値から検出値までの閉ループの周波数伝達特性となる。
【００３３】
この共振抑制された閉ループ伝達特性を、後述する一般化周期外乱オブザーバのモデルに適用することが本願発明の主たる目的となる。
【００３４】
周期外乱抑制制御器４では、位相情報θを用いて検出値ｙに含まれる周期外乱を抽出し、その周期外乱を抑制するように周波数成分毎に制御する。その手法として、特許文献１等で提案されている一般化周期外乱オブザーバを用いる。仮に、特許文献１の手法のみを共振系システムに適用した場合、周期外乱は抑制できるが共振抑制や非周期的な外乱の抑制はできない。
【００３５】
したがって、本願発明では共振抑制制御・非周期外乱抑制制御・周期外乱抑制制御を同時に実現する。周期外乱抑制制御器４で得られた周期外乱補償信号ｒpd*は、指令値ｒ*に加算し、補正指令値ｒとして共振・外乱抑制制御器３に入力する。
【００３６】
ここで、一般化周期外乱オブザーバについて簡単に説明する。図３は、一般化周期外乱オブザーバの基本構成例である。
【００３７】
周期外乱は特定の周波数で発生する外乱であるため、その周波数成分を抽出して抑制制御系を構築する。ここで、ｎ次周波数の周期外乱に同期したｄnｑn回転座標系を定義すると、図４に示すように、システム伝達特性Ｐnの入力信号（操作量）ｕn、出力信号（検出値）ｙnとその間のシステム伝達特性Ｐnは１次元複素ベクトルで表現できる。（実部をｄn軸，虚部をｑn軸とする。）
システム伝達特性Ｐnは（１）式で示され、操作量ｕから検出値ｙまでのｎ次周波数成分の伝達特性を示している。したがって、例えばアクチュエータや負荷，センサ，無駄時間等の伝達特性をすべて包含した周波数伝達特性となり、ｎ次周波数成分に限定すればシステム伝達特性Ｐnは１次元複素ベクトルで一般化できることを意味する。
【００３８】
【数１】
2018005259.tif 000003
【００３９】
このように、特定周波数成分で一般化されたシステム上で制御を行うために、検出値ｙからｄnｑn回転座標系に同期した成分を抽出する。検出値ｙが単相信号の場合は、（２）式に基づいて抽出し、三相信号の場合は（３）式に基づいて抽出する。
【００４０】
【数２】
2018005259.tif 000004
【００４１】
【数３】
2018005259.tif 000005
【００４２】
ＧF（ｓ）は、（２）式または（３）式でｄnｑn回転座標変換した後に、ｄn軸・ｑn軸成分を直流値として抽出するための低域通過フィルタであり、実部・虚部すなわちｄn軸とｑn軸それぞれに寄与する。例えば、フィルタ次数を１とした場合は、（４）式となる。
【００４３】
【数４】
2018005259.tif 000006
【００４４】
ωｆ：ローパスフィルタのカットオフ周波数
こうして抽出された検出値ｙnに対し、（５）式に示すシステムの伝達特性Ｐnの逆モデルＱn＾を用いて、（６）式のように操作量ｕnの操作量推定値ｕn＾を推定する。
【００４５】
【数５】
2018005259.tif 000007
【００４６】
【数６】
2018005259.tif 000008
【００４７】
実際のシステムに入力される操作量ｕnは、周期外乱ｄnを含んでいるため、（７）式に示すとおり（６）式の操作量推定値ｕn＾から低域通過フィルタＧF（ｓ）を介した操作量指令値ｕn*を差し引くことで、周期外乱推定値ｄn＾を推定する。
【００４８】
【数７】
2018005259.tif 000009
【００４９】
周期外乱指令値ｄn*（周期外乱を抑制する場合は０）から（７）式の周期外乱推定値ｄn＾を差し引くことで、周期外乱ｄnを打ち消すことができる。以上、図３に基づいて一般化周期外乱オブザーバの動作を説明した。
【００５０】
ところで、（５）式で示した逆モデルＱn＾は、特定周波数についての単一の逆モデルであるため、複数の周波数成分で動作させる場合は、それぞれの周波数における逆モデルを用意しておく必要がある。例えば、動作周波数が可変なシステムでは、周期外乱の周波数も動作周波数のｎ倍で発生するため、抽出すべき周波数成分も可変となる。このような場合は、動作周波数の変化に応じて適用する逆モデルも変える必要がある。
【００５１】
例えば、周期外乱が取り得る周波数範囲を１〜１０００Ｈｚと設定し、１Ｈｚ毎に逆モデルＱn＾を用意する場合は、Ｑdn，Ｑqnをそれぞれ１０００個実装しておき、動作周波数のｎ倍に同期した周波数成分を読み出すことで、変化する動作周波数にも対応できる。
【００５２】
しかしながら、システム伝達特性Ｐnが共振系システムの場合は、逆モデルＱn＾も共振特性を含むため、動作周波数の変化に対して急峻なモデルの変化を引き起こす。特に、共振周波数が交差する際は、その位相特性が反転する場合がある。直ちに正確な逆モデルＱn＾を読み出すことができれば問題とはならないが、実際のコントローラはデジタル制御に伴う演算無駄時間や位相検出遅れがある。
【００５３】
また、一般化周期外乱オブザーバは低域通過フィルタＧF（ｓ）によって決定づけられる閉ループ特性による応答遅れが生じ、モデル化誤差によって共振周波数のズレがあると最悪の場合、逆位相で補償する状態に陥り、制御が不安定となる恐れがある。したがって、周波数変化に対して逆モデルが急峻な特性変化を持つ場合は、不安定化を防止する対策が必須である。
【００５４】
本願発明では、この逆モデルＱn＾の急峻な変化を抑えるために、共振抑制制御をマイナーループで実施した上で、共振抑制制御特性を含んだシステムの閉ループ伝達特性で逆モデルＱn＾を生成し、それを一般化周期外乱オブザーバに適用するものである。さらには、共振と非周期的な外乱をも抑制した上で、周期的な外乱を抑制するため、特許文献１〜３にはなかった「共振」，「非周期外乱」，「周期外乱」のすべての課題を同時に改善することが可能となる。
【００５５】
以下、実施形態のひとつとして、モータドライブ用途の２慣性共振系システムにおけるトルクフィードバック制御を例に挙げて説明する。
【００５６】
なお、３慣性系以上の多慣性系や、モータドライブシステム以外の共振系システムの用途であっても、本願発明の手法が適用可能である。また、トルク制御以外（例えば、速度制御，位置制御，加速度制御，電流制御など）であっても同様の制御構成で実現可能であり、フィードバック制御システムにおける指令値と検出値の種目を限定するものではない。
【００５７】
図５に、本願発明の効果を説明するための代表例として、２慣性共振系のモータドライブシステムでトルク制御を実現するための構成図を示す。
【００５８】
装置構成の一例として、モータＭと負荷Ｌによる２慣性系システムを想定する。結合軸にはトルクメータ６を設置し、トルク検出値τdetをトルク制御器５にフィードバックする。モータＭを駆動するインバータＩＮＶでは，回転位置センサ２１あるいはセンサレス制御等で得られたモータＭの位相情報θないし回転速度情報などを取得し、トルク制御器５にその情報を渡す。
【００５９】
トルク制御器５はトルク指令値τ*，位相情報θ，トルク検出値τdetに基づいて、インバータトルク指令値τinv*を演算する。インバータＩＮＶはインバータトルク指令値τinv*に基づいて所望の電圧をモータＭへ印加することでモータＭを制御し、モータＭは負荷Ｌを駆動する。
【００６０】
位相情報θや回転速度情報は、後述する周期外乱抑制制御（本例ではトルクリプル抑制制御に相当）のために用いられる。
【００６１】
トルク検出値τdetを、速度検出・位置検出・電流検出などに置き換えて、各々に合わせて指令値を変更しても、同様のフィードバック制御システムが成り立つ。
【００６２】
また、本願発明を説明するにあたり、数値例として本構成のシステム伝達特性を図６に示す。図６は、トルク制御を実施しない場合のシステムの開ループ伝達特性であり、インバータトルク指令値τinv*からトルク検出値τdetまでの周波数特性を示している。低周波数帯域ではトルク誤差（指令値から検出値のゲイン（振幅）特性が０ｄＢとならない）があり、高域では２慣性共振系による共振点が存在する。また、図６の周波数特性は外乱を含んでいないが、実際のトルク検出値τdetには、例えばトルクリプルのような周期外乱や、ホワイトノイズ等の非周期外乱が含まれることにも留意する。こうした外乱は，特に図６に示した共振点で増幅し、トルク検出値τdetに顕著にその影響が現れる。
【００６３】
図７は、図６の特性においてトルクフィードバック制御を行わない場合の回転数とトルクの波形例である。図７では、０．５ｓｅｃｏｎｄｓ以降のトルク指令値τ*は一定値（５［Ｎｍ］）である。
【００６４】
図７に示すように、トルク誤差や外乱が発生しており、回転数上昇中にトルクリプル周波数とシステムの共振周波数が一致したとき、特に大きな共振現象が発生していることが分かる。
【００６５】
本願発明は、図６における低域のゲイン特性を０ｄＢとしてトルク誤差をなくし、かつ、高域の共振を抑制して非周期外乱と周期外乱をも同時に抑制することを目的とする。
【００６６】
［実施形態１］
図８に本実施形態１の制御システムとしてトルク制御器を示す。
【００６７】
〔第１の機能：共振および非周期外乱抑制制御器７〕
共振および非周期外乱抑制制御器７は図２の共振・外乱抑制制御器３に対応する。
【００６８】
本実施形態１では、構造化特異値μを用いたμ設計による共振抑制および非周期外乱抑制を実装する例で説明する。H∞制御，共振比制御など，そのほかの共振抑制手法を用いても同様に実現できることを示唆しておく。
【００６９】
図９は、μ設計で用いる一般化プラントの構成例である。機械系パラメータ等の摂動を個別に考慮しても良いが、実用上は物理モデル（バネ・マス要素）を明示的に同定することを省略し、トルク入出力の周波数伝達特性から簡易的に同定することが多い。したがって、ここではインバータから入力される定常トルク誤差（トルク偏差）Δτを摂動項として見積もり、ロバスト制御性能を担保する手法を用いる。
【００７０】
図９の符号は以下の通りである。
Ｊ１：モータの慣性モーメント，Ｊ２：負荷の慣性モーメント，Ｋ１２：軸ねじれ剛性，ｓ：ラプラス演算子，Δτ：定常トルク誤差（トルク偏差），Ｇtm（ｓ）：トルクメータ等の検出応答伝達関数，Ｇinv：インバータ応答伝達関数，ｄ１：外乱（周期外乱を含む），ｄ２およびｒ：μ設計制御器入力，ｄ３：トルク検出ノイズ，ｚ：定常トルク誤差の評価出力，ｗ：定常トルク誤差による外乱入力，ｕ：μ設計制御器出力（操作量），ｙ：観測出力（検出値），ｅ１：インバータトルク指令の評価出力，ｅ２：トルク偏差の評価出力，Ｗn（ｓ）：外乱ｄ１に対する重み関数，Ｗu（ｓ）：インバータトルク指令に対する重み関数，Ｗe（ｓ）：トルク偏差に対する重み関数。
【００７１】
トルク偏差に対する重み関数Ｗe（ｓ）は、低域の定常偏差をなくすように重みづけをしている。インバータトルク指令に対する重み関数Ｗu（ｓ）は、インバータトルクの高周波特性を低減するように設定している。外乱ｄ１に対する重み関数Ｗn（ｓ）は、周期外乱や非周期的外乱の抑圧性能を向上するように重み付けしている。
【００７２】
図９のように構成した一般化プラントにおいて、Ｄ−Ｋイテレーションを実施して得られたμ設計制御器の特性を図１０に示す。上段はゲイン線図，下段は位相線図を示している。左側はμ設計制御器の指令値ｒから操作量ｕの伝達特性Ｃｒｅｆ（ｓ），右側はμ設計制御器の検出値ｙから操作量ｕの伝達特性Ｃｔｍ（ｓ）を示している。
【００７３】
上記で設計された伝達特性Ｃｒｅｆ（ｓ）と伝達特性Ｃｔｍ（ｓ）を持つμ設計制御器は、図８の共振および非周期外乱抑制制御器７に実装され、図１１に示すように構成される。補正トルク指令値τr*が伝達特性Ｃｒｅｆ（ｓ）を介した出力と、トルク検出値τdetが伝達特性Ｃｔｍ（ｓ）を介した出力と、を加算してインバータトルク指令値τinv*を生成する。
【００７４】
共振および非周期外乱抑制制御器７のみを機能させた場合の閉ループ伝達特性を図１２に示す。また、そのときのトルク波形例を図１３に示す。図１２の上段はゲイン線図，下段は位相線図を示している。左側はトルク指令値τ*からトルク検出値τdetまでの閉ループ特性（指令値応答），右側は外乱ｄ１からトルク検出値τdetまでの閉ループ特性（外乱応答）を示している。
【００７５】
図７の制御なしの場合のトルク波形と比較すると、図１３のトルク波形は共振および非周期外乱抑制制御器７の効果により、共振現象を大幅に低減できていることが分かる。しかしながら、図１２の外乱特性を見て分かるように、共振周波数付近の外乱に対する閉ループ伝達特性は０ｄＢを超えているため、周期的な外乱に対してはリプルが残留し、十分に除去できているとは言えない。本実施形態１で用いたμ設計手法に関わらず、全周波数帯域で制御設計するコントローラは、ボードの定理に従って、どこかの周波数帯域を低減すれば、そのほかの周波数帯域が増幅される。
【００７６】
したがって、設計の善し悪しに関わらず、指令値応答と外乱抑圧に関する速応性と抑圧振幅にはトレードオフが発生する。
【００７７】
そこで、本実施形態１では、上述のような共振および非周期外乱抑制制御器７に加えて、第２の機能として特定の周波数成分のみに寄与する周期外乱オブザーバによる周期外乱抑制制御器８を組み合わせる。
【００７８】
〔第２の機能：周期外乱抑制制御器８〕
図１４は、図８の周期外乱抑制制御器８の構成図である。図３で前述した一般化周期外乱オブザーバを用いている。図１４の符号は以下の通りである。
Ｔn：周期外乱（トルクリプル）のｎ次周波数成分ベクトル，Ｕn＾：操作量推定値のｎ次周波数成分ベクトル（周期外乱を含む推定値），Ｄn*：周期外乱指令値のｎ次周波数成分ベクトル（抑制する場合は通常ゼロ），Ｄn＾：周期外乱推定値のｎ次周波数成分ベクトル，ＴPDn*：周期外乱補償値のｎ次周波数成分ベクトル。
【００７９】
まず、周波数成分抽出器９では、位相情報θに対して周期外乱（トルクリプル）の抑制対象次数ｎを乗じたｎ次回転位相ｎθを用いて、トルク検出値τdetから周波数成分を抽出し、トルクリプルに同期したｄnｑn回転座標系の周期外乱（トルクリプル）のｎ次周波数成分ベクトルＴnに変換する。周期外乱のｎ次周波数成分ベクトルＴnの変換式は（２）式に基づき以下の（８）式となる。
【００８０】
【数８】
2018005259.tif 000010
【００８１】
速度変換器１０では、ｎ次回転位相ｎθを微分してｎ次回転周波数ｎ・ωmを算出する。次に、逆モデル乗算部１５において、（８）式で算出した周期外乱のｎ次周波数成分ベクトルＴnに、逆モデルＱn＾を乗じて操作量推定値のｎ次周波数成分ベクトルＵn＾を求める。なお、（５）式に逆モデルＱn＾の算出式がある。この際、逆モデルＱn＾にはｎ次回転周波数ｎ・ωmに同期した単一の周波数成分ベクトルが適用される。前述したとおり、逆モデルＱn＾には、第１の機能である「共振および非周期外乱抑制制御器７」の閉ループ伝達特性（すなわち、図１２の指令値応答：トルク指令値からトルク検出までの周波数伝達特性）をマイナーループ特性として適用するため、図６のような共振特性は含まれず、動作周波数の変化、すなわち可変速運転に対して比較的ロバストな制御系を構築することができる。
【００８２】
操作量推定値のｎ次周波数成分ベクトルＵn＾には周期外乱が含まれているため、操作量推定値のｎ次周波数成分ベクトルＵn＾から、周期外乱補償値のｎ次周波数成分ベクトルＴpDn*が低域通過フィルタＧF（ｓ）を通った値を差し引き、周期外乱推定値のｎ次周波数成分ベクトルＤn＾を推定する。なお、低域通過フィルタＧF（ｓ）を介するのは、周波数成分抽出器９に含まれる低域通過フィルタＧF（ｓ）の応答と合わせるためである。周期外乱指令値のｎ次周波数成分ベクトルＤn*から推定した周期外乱推定値のｎ次周波数成分ベクトルＤn＾を減算し、周期外乱補償値のｎ次周波数成分ベクトルＴpDn*を算出することで、周期外乱を抑制できる。なお、フィルタ次数を１とした場合の低域通過フィルタＧF（ｓ）は（４）式となる。
【００８３】
こうして生成した周期外乱補償値のｎ次周波数成分ベクトルＴpDn*は、補償信号合成部１１において、（９）式に基づいて周期外乱に同期したｄnｑn回転座標系から元の時間波形に復元する。なお、ｎに複数の次数を設定して並列に構成することも可能であり、これら各次数の周波数成分を合算することにより、周期外乱補償信号τpd*が合成できる。
【００８４】
【数９】
2018005259.tif 000011
【００８５】
以上より周期外乱抑制制御器４を構成し、その出力である周期外乱補償信号τpd*を図８におけるトルク指令値τ*に加算することで、共振および非周期外乱抑制制御器７の新たな入力となる補正トルク指令値τr*を生成する。これにより、第１の機能である共振および非周期外乱抑制制御に加え、周期外乱抑制を同時に実現することができる。
【００８６】
図１５に、図８の構成で共振・非周期外乱・周期外乱を同時に抑制した場合のトルク波形例を示す。
【００８７】
共振と非周期外乱のみを抑制した場合の図１３と比較し、残留していた周期外乱の影響も除去され、トルクリプルや共振現象がさらに低減できていることが分かる。したがって、数値演算からも本実施形態１の効果が確認できる。
【００８８】
本実施形態１では、共振と非周期外乱と周期外乱を同時に抑制することができる。また本制御方法をモータドライブシステムのトルク制御に適用した場合、トルク制御の精度を向上させることができる。
【００８９】
［実施形態２］
実施形態１において（８）式によってトルク検出値τdetから周期外乱成分を抽出する際、トルク検出値τdetに含まれるＴdnｃｏｓｎｑ＋Ｔqnｓｉｎｎｑに着目すると、その周波数成分においては（１０）式のように展開される。
【００９０】
【数１０】
2018005259.tif 000012
【００９１】
（１０）式におけるＴdnｃｏｓ２ｎθ＋Ｔqnｓｉｎ２ｎθ、Ｔqnｃｏｓ２ｎθ＋Ｔdnｓｉｎ２ｎθで発生している２ｎ倍の周波数成分を、低域通過フィルタＧF（ｓ）によって除去することにより、ｄnｑn回転座標系で使用するｎ次周波数成分のＴdnおよびＴqnを抽出できる。
【００９２】
一方、トルク検出値τdetに直流トルク成分Ｔｄｃが含まれる場合は、以下の（１１）式のように展開される。
【００９３】
【数１１】
2018005259.tif 000013
【００９４】
（１１）式のＴdnｃｏｓ２ｎθ＋Ｔqnｓｉｎ２ｎθ＋２Ｔdcｃｏｓｎθ、Ｔqnｃｏｓ２ｎθ＋Ｔdnｓｉｎ２ｎθ＋２Ｔdcｓｉｎｎθを（１０）式と比較すると、（１０）式で発生していた２ｎ倍周波数成分に加えて、直流トルク成分Ｔｄｃに関する１ｎ倍成分が発生することが分かる。同様に、低域通過フィルタＧF（ｓ）で除去しても良いが、２ｎ倍成分のみの場合に比べて、１ｎ倍成分は低周波数となり、低域通過フィルタＧF（ｓ）で除去するためにはカットオフ周波数をより低く設計する必要がある。
【００９５】
低域通過フィルタＧF（ｓ）のカットオフ周波数は、周期外乱オブザーバの過渡応答性に直結するため、カットオフ周波数を可能な限り高くすることが望ましいが、前述のＴdnｃｏｓ２ｎθ＋Ｔqnｓｉｎ２ｎθ＋２Ｔdcｃｏｓｎθ、Ｔqnｃｏｓ２ｎθ＋Ｔdnｓｉｎ２ｎθ＋２Ｔdcｓｉｎｎθの影響を十分に除去することとのトレードオフの関係にある。
【００９６】
カットオフ周波数が高すぎると、他の周波数成分の影響がｄnｑn回転座標系に現れ、周期外乱オブザーバの安定性を損なう。一方で、カットオフ周波数が低すぎると、周期外乱オブザーバの安定性は向上するが、周期外乱抑圧の速応性が劣化し、可変速運転等の用途では特に問題となる。
【００９７】
（１０）式では、２ｎ倍成分と直流成分を切り分けるカットオフ周波数を設定すれば良いが、直流トルク成分Ｔｄｃに重畳された周期外乱を抽出する（１１）式の場合は１ｎ倍成分も発生するため、１ｎ倍成分と直流トルク成分Ｔｄｃを切り分ける必要がある。
【００９８】
そのため、直流トルク成分Ｔｄｃが含まれない（１０）式と比べて、カットオフ周波数の設定範囲が厳しくなり、速応性と安定性の両面で性能が劣化する可能性がある。
【００９９】
そこで、本実施形態２では、図１６に示すように、直流トルク成分Ｔｄｃを含むトルク検出値τdetに対して、高域通過フィルタ（ハイパスフィルタ）１２を介した後に、周波数成分抽出器９に入力し、（１０）式と等価の変換を行う。このハイパスフィルタ１２は、直流トルク成分Ｔｄｃを除去し、２ｎ倍には影響しない程度のカットオフ周波数に設定すれば良い。
【０１００】
以上示したように、本実施形態２によれば、実施形態１と同様の作用効果を奏する。直流トルク成分Ｔｄｃに重畳された周期外乱成分を一般化周期外乱オブザーバで抑制する際に、速応性と安定性の劣化を防止することができる。
【０１０１】
［実施形態３］
本実施形態３では、指令値と検出値の偏差に対して一般化周期外乱オブザーバを適用し、偏差に含まれる周期外乱を抑制する手法を説明する。図１７は、トルク誤差に対して周期外乱抑制制御を実施する場合の制御構成図である。
【０１０２】
なお、このときの周期外乱抑制制御器８は、図１４のトルク検出値τdetをトルク偏差Δτに置き換えて用いれば良い。また、周期外乱指令値のｎ次周波数成分ベクトルＤn*は、トルク偏差をなくすことが目的であるから、ゼロに設定する。
【０１０３】
したがって、図１４の制御ブロックを等価変換すると、周期外乱抑制制御器８は図１８のように構成できる。図１８に示すように、図１６の減算器１６，１７が省略され、操作量推定値のｎ次周波数成分ベクトルＵn＾と周期外乱補償値のｎ次周波数成分ベクトルＴpDn*を低域通過フィルタＧF（ｓ）に通した値と、を加算する加算器１９が設けられている。また、加算器１９の出力が周期外乱補償値のｎ次周波数成分ベクトルＴpDn*となる。
【０１０４】
図１８の周期外乱のｎ次周波数成分ベクトルＴnは、（８）式のトルク検出値τdetにΔτを代入して求める。
【０１０５】
以上示したように、本実施形態３によれば、実施形態１と同様の作用効果を奏する。また、実施形態２で説明したように、直流トルク成分Ｔｄｃに周期外乱が重畳された場合であっても、トルク偏差Δτを用いることで直流トルク成分Ｔｄｃが予め除去された状態で周期外乱オブザーバを動作させることが可能となる。
【０１０６】
すなわち、実施形態２で構成したようなハイパスフィルタは不要でありながら、実施形態２と同等の効果が得られ、図１８のように、より簡素化された制御構成で実現できる利点がある。
【０１０７】
［実施形態４］
実施形態３の図１８の構成において、一般化周期外乱オブザーバの周波数成分抽出に用いる低域通過フィルタＧF（ｓ）を（１２）式に示す１次のローパスフィルタに設定した場合、図１８は図１９のように制御ブロック図に等価変換できる。
【０１０８】
【数１２】
2018005259.tif 000014
【０１０９】
図１９は、図１８の周波数成分抽出器９を周波数成分変換器２０に変更し、低域通過フィルタＧF（ｓ）を積分器１３に変更している。すなわち、図１８の周波数成分抽出器９の内部にある低域通過フィルタＧF（ｓ）を外に出す。そして、積分器１３は、周波数成分抽出器９の内部にある低域通過フィルタＧF（ｓ）と後段の低域通過フィルタＧF（ｓ）と合成した結果で得られ、カットオフ周波数ωｆと逆モデルをゲインとした単純な積分器１３となる。このように図１８は図１９に等価変換できる。ただし、図１９の周波数成分変換器２０は、（８）式の代わりに以下の（１３）式を用いる。
【０１１０】
【数１３】
2018005259.tif 000015
【０１１１】
（１３）式には低域通過フィルタＧF（ｓ）がないため、トルク偏差Δτに含まれる周期外乱の周波数成分を明示的に抽出することをせずに、直接、周期外乱補償値のｎ次周波数成分ベクトルＴpDn*を生成することになる。
【０１１２】
以上より、本実施形態４によれば、実施形態１と同様の作用効果を奏する。また、低域通過フィルタＧF（ｓ）を１次に限定した場合、トルク偏差Δτに対する一般化周期外乱オブザーバは、ゲインと積分器という非常に簡単な構成で実現できるため、制御に係る演算量を低減できる。
【０１１３】
［実施形態５］
これまでの実施形態１〜４では、共振および非周期外乱抑制制御器７において、定常トルクを含む低周波数域のトルク制御も実施するコントローラを設計していた。つまり、高周波数域にある共振抑制も含めて、全周波数帯域でのコントローラとなるが、一般にμ設計等のロバスト制御で全周波数帯域をカバーする制御器を設計した場合、制御性能が保守的になったり、コントローラの次数が高くなる傾向がある。
【０１１４】
そこで、本実施形態５では、図２０に示すように共振および非周期外乱抑制制御器７において、高周波数領域にある共振抑制と非周期外乱抑制に注力し、定常トルク制御を含む低域トルク制御器１４により一般的なＰＩ制御器で実現し、それらをマイナーループに含んだ周期外乱抑制制御器８を付加する手法を説明する。
【０１１５】
図２１は、トルク制御の例における制御の基本構成図となる。なお、本実施形態５における周期外乱抑制制御器８は、実施形態３のトルク偏差に対する一般化周期外乱オブザーバの構成を基に説明するが、もちろん実施形態１やそのほかの構成を採っても良い。
【０１１６】
まず、低域トルク制御器１４の機能について説明する。
【０１１７】
２慣性共振系において、機械系の定常トルク（直流トルク）の特性はモータと負荷の慣性モーメントの比で決定づけられる。モータの慣性モーメントをＪ１，負荷の慣性モーメントＪ２とした場合、定常トルクτdet(dc)は（１４）式で示される。なお、（ｄｃ）は直流成分を意味する。
【０１１８】
【数１４】
2018005259.tif 000016
【０１１９】
このように、簡易的に慣性比が分かれば、予めそのトルク誤差をある程度補正することも可能であるが、実際にはインバータのトルク誤差や慣性モーメントの設計値からの誤差，粘性摩擦損失等も含まれるため、トルクフィードバック制御によって定常トルクを制御する必要がある。
【０１２０】
一方で、図６に示したように高周波数領域では２慣性系によるシステム共振点があるため、一般的なＰＩＤ制御等の構成で全周波数帯域に亘るトルクフィードバック制御を実施した場合、制御が不安定となりやすく、周波数領域での共振抑制を実施することは難しい。
【０１２１】
そこで、本実施形態５では、定常トルクを含む低周波数領域のトルク誤差をなくすためだけに寄与するＰＩ制御器を構成する。一例として、図２１に低域トルク制御器１４の構成例を示す。
【０１２２】
図２１では、一例として比例先行型Ｉ−Ｐ制御器を基本とし、その出力に低域通過フィルタＧF（ｓ）を介して直流トルク成分指令値τdc*を出力する構成を用いている。低域通過フィルタＧF（ｓ）は、高域にあるシステム共振特性の影響を除去するためのフィルタであり、このフィルタの通過帯域、すなわち、低周波数領域においてＰＩ制御器が機能する構造を持つ。これにより、高周波帯域でＰＩ制御器が不安定とならないように設計している。低域通過フィルタＧF（ｓ）の設計は任意であるが、例えば二項係数標凖形の２次ローパスフィルタで共振周波数の０．１倍程度のカットオフ周波数に設計する。
【０１２３】
低域通過フィルタＧF（ｓ）を用いることにより、本制御器が制御対象とするシステム特性は等価的に２次系ローパスフィルタ特性に近似されるため、本制御器の閉ループ特性は３次系となる。３次系の閉ループ特性を例えば二項係数標準形の参照モデルにマッチングさせることにより、（１５）式のようにＫｐ，Ｋｉが求められる。
【０１２４】
ここで、ωｃは、所望する任意の閉ループ応答周波数である。ωlpfは２次ローパスフィルタのカットオフ周波数、ｋは２次ローパスフィルタの係数（二項係数標準型は２，バターワース型は１．４など、フィルタ形式に従って指定する係数），ａ２およびａ１は３次系参照モデルの係数（二項係数標準形ならばａ１＝ａ２＝３，バターワース型ならばａ１＝ａ２＝２など）である。
【０１２５】
【数１５】
2018005259.tif 000017
【０１２６】
この低域トルク制御器１４によって、定常トルクを含む低周波領域のトルク誤差をなくし、安定的に制御することができる。ただし、低域トルク制御器１４のみでは高周波数領域の共振を抑制することはできないので、前述の共振および非周期外乱抑制制御器７を用いて抑制する。
【０１２７】
低周波数領域のトルク追従制御は低域トルク制御器１４で実現するため、高周波数領域の共振および非周期外乱抑制制御器７では、低周波数領域におけるコントローラゲインを低くした設計を行う。例えば、μ設計制御器を用いる場合、一般化プラントを図２２のように構成し、μ設計制御器入力（補正指令値）ｒからμ設計制御器出力（操作量）ｕのゲインに対して、重み関数Ｗe（ｓ）を介してμ設計制御器ゲインの評価出力を設定する。Ｗe（ｓ）では、前述の低域トルク制御器１４との制御干渉を防ぐために、低域に対する重み付けをする。図２２の符号は以下の通りである。
Ｊ１：モータの慣性モーメント，Ｊ２：負荷の慣性モーメント，Ｋ１２：軸ねじれ剛性，ｓ：ラプラス演算子，Δτ：定常トルク誤差，Ｇtm（ｓ）：トルクメータ等の検出応答伝達関数，Ｇinv（ｓ）：インバータ応答伝達関数，ｄ１：外乱（周期外乱を含む），ｄ２およびｒ：μ設計制御器入力，ｄ３：トルク検出ノイズ
ｚ：定常トルク誤差の評価出力，ｗ：定常トルク誤差による外乱入力，ｕ：μ設計制御器出力（操作量），ｙ：観測出力（検出値），ｅ１：トルク検出値の評価出力，ｅ２：インバータトルク指令の評価出力，ｅ３：μ設計制御器ゲインの評価出力，Ｗn（ｓ）：外乱ｄ１に対する重み関数，Ｗu（ｓ）：インバータトルク指令Ｕに対する重み関数，Ｗe（ｓ）：μ設計制御器ゲインに対する重み関数。
【０１２８】
実施形態１と同様に、伝達特性Ｃｒｅｆ（ｓ）と伝達特性Ｃｔｍ（ｓ）をもつμ設計制御器を設計し、図１１に示す構成で、図２０の共振および非周期外乱抑制制御器７の部分に実装する。さらに、低域トルク制御器１４が出力する直流トルク成分指令値τdc*と周期外乱抑制制御器８が出力する周期外乱抑制制御器出力τpd*を加算して、補正トルク指令値τr*を生成して共振および非周期外乱抑制制御器７に入力する。
【０１２９】
上述で得られた共振および非周期外乱抑制制御器７および低域トルク制御器１４を実装し、周期外乱抑制制御器８のみは動作させない状態において、周期外乱抑制制御器出力τpd*からトルク検出値τdetまでの閉ループ周波数伝達特性を図２３に示す。この周波数伝達特性を利用し、一般化周期外乱オブザーバの逆モデルＱn＾を設定する。このようにして、周期外乱抑制制御器８から見たマイナーループのモデルを設定し、周期外乱オブザーバを安定に動作させるとともに、共振・非周期外乱・周期外乱を同時に抑制する。
【０１３０】
本実施形態５によるトルク制御の結果を図２４に示す。共振・非周期外乱・周期外乱を良好に抑制できていることが確認できる。
【０１３１】
本実施形態５によれば、実施形態１と同様の作用効果を奏する。また、以下の効果が期待できる。
【０１３２】
低域と高域の制御器を分離することで、低域ではＰＩＤ制御等の従来的手法で制御調整が容易となる。
【０１３３】
また、高域の共振抑制制御を実施するμ設計等のロバスト制御器では、低域のトルク追従性能を考慮する必要がなくなるため、共振抑圧性能や即応性向上を目指した設計が容易となる。
【０１３４】
［実施形態６］
実施形態１〜５に関わる「一般化周期外乱オブザーバ」は、特定周波数成分のみに寄与する周期外乱抑制制御器ではあるが、本実施形態６では、抑制したい次数を別個指定し、それらの一般化周期外乱オブザーバを並列化し、補償信号合成部において、並列化した周期外乱補償値を合算することで、複数の周波数成分の周期外乱を同時に抑制することができる。
【０１３５】
以上、本発明において、記載された具体例に対してのみ詳細に説明したが、本発明の技術思想の範囲で多彩な変形および修正が可能であることは、当業者にとって明白なことであり、このような変形および修正が特許請求の範囲に属することは当然のことである。
【符号の説明】
【０１３６】
１…フィードバック制御器
２…制御対象システム
３…共振・外乱抑制制御器
４…周期外乱抑制制御器
５…トルク制御器
６…トルクメータ
７…共振および非周期外乱抑制制御器
８…周期外乱抑制制御器
９…周波数成分抽出器
１０…速度変換器
１１…補償信号合成部
１２…高域通過フィルタ
１３…積分器
１４…低域トルク制御器
１５…逆モデル乗算器
２０…周波数成分変換器
【図１】
2018005259.tif 000018
【図２】
2018005259.tif 000019
【図３】
2018005259.tif 000020
【図４】
2018005259.tif 000021
【図５】
2018005259.tif 000022
【図６】
2018005259.tif 000023
【図７】
2018005259.tif 000024
【図８】
2018005259.tif 000025
【図９】
2018005259.tif 000026
【図１０】
2018005259.tif 000027
【図１１】
2018005259.tif 000028
【図１２】
2018005259.tif 000029
【図１３】
2018005259.tif 000030
【図１４】
2018005259.tif 000031
【図１５】
2018005259.tif 000032
【図１６】
2018005259.tif 000033
【図１７】
2018005259.tif 000034
【図１８】
2018005259.tif 000035
【図１９】
2018005259.tif 000036
【図２０】
2018005259.tif 000037
【図２１】
2018005259.tif 000038
【図２２】
2018005259.tif 000039
【図２３】
2018005259.tif 000040
【図２４】
2018005259.tif 000041
【手続補正書】
【提出日】平成29年6月26日(2017.6.26)
【手続補正１】
【補正対象書類名】特許請求の範囲
【補正対象項目名】全文
【補正方法】変更
【補正の内容】
【特許請求の範囲】
【請求項１】
指令値と、制御対象システムの検出値と、制御対象システムの位相情報と、に基づいて、制御対象システムの操作量を決定するフィードバック制御器を備えた制御システムであって、
前記フィードバック制御器は、
前記検出値と前記位相情報とに基づいて、周期外乱補償信号を出力する周期外乱抑制制御器と、
前記指令値と前記周期外乱補償信号とを加算した補正指令値と、前記検出値と、に基づいて、前記操作量を算出する共振・外乱抑制制御器と、を有し、
前記周期外乱抑制制御器は一般化周期外乱オブザーバを用い、
前記共振・外乱抑制制御器は、
前記指令値がμ設計制御器の前記指令値から前記操作量までの伝達特性を介した出力と、前記検出値がμ設計制御器の前記検出値から前記操作量までの伝達特性を介した出力と、を加算して、前記操作量を出力するμ設計制御器を有し、
前記周期外乱抑制制御器は、
前記位相情報に抑制対象次数ｎを乗じたｎ次回転位相を用いて、前記検出値から周波数成分を抽出し、ｄnｑn回転座標に変換した周期外乱のｎ次周波数成分ベクトルを出力する周波数成分抽出器と、
前記ｎ次回転位相を微分してｎ次回転周波数を算出する速度変換器と、
前記周期外乱のｎ次周波数成分ベクトルに、前記ｎ次回転周波数に同期した単一の周波数ベクトルが適用された逆モデルを乗じて、操作量推定値のｎ次周波数成分ベクトルを求める逆モデル乗算部と、
前記操作量推定値のｎ次周波数成分ベクトルから、周期外乱補償値のｎ次周波数成分ベクトルが低域通過フィルタを介した値を減算して周期外乱推定値のｎ次周波数成分ベクトルを出力する第１減算器と、
周期外乱指令値のｎ次周波数成分ベクトルから、前記周期外乱推定値のｎ次周波数成分ベクトルを減算して、周期外乱補償値のｎ次周波数成分ベクトルを出力する第２減算器と、
前記周期外乱補償値のｎ次周波数成分ベクトルを、前記ｎ次回転位相に基づいて、周期外乱に同期したｄnｑn回転座標系から元の時間波形に復元し、前記周期外乱補償信号を出力する補償信号合成部と、
を備えたことを特徴とする制御システム。
【請求項２】
前記周波数成分抽出器に使用する前記検出値は、高域通過フィルタを通過させた値であることを特徴とする請求項１記載の制御システム。
【請求項３】
指令値と、制御対象システムの検出値と、制御対象システムの位相情報と、に基づいて、制御対象システムの操作量を決定するフィードバック制御器を備えた制御システムであって、
前記フィードバック制御器は、
前記検出値と前記位相情報とに基づいて、周期外乱補償信号を出力する周期外乱抑制制御器と、
前記指令値と前記周期外乱補償信号とを加算した補正指令値と、前記検出値と、に基づいて、前記操作量を算出する共振・外乱抑制制御器と、を有し、
前記周期外乱抑制制御器は一般化周期外乱オブザーバを用い、
前記共振・外乱抑制制御器は、
前記指令値がμ設計制御器の前記指令値から前記操作量までの伝達特性を介した出力と、前記検出値が設計制御器の前記検出値から前記操作量までの伝達特性を介した出力と、を加算して、前記操作量を出力するμ設計制御器を有し、
前記周期外乱抑制制御器は、
前記位相情報に抑制対象次数ｎを乗じたｎ次回転位相を用いて、前記指令値から前記検出値を減算した偏差から周波数成分を抽出し、ｄnｑn回転座標に変換した周期外乱のｎ次周波数成分ベクトルを出力する周波数成分抽出器と、
前記ｎ次回転位相を微分してｎ次回転周波数を算出する速度変換器と、
周期外乱のｎ次周波数成分ベクトルに、前記ｎ次回転周波数に同期した単一の周波数ベクトルが適用された逆モデルを乗じて、操作量推定値のｎ次周波数成分ベクトルを求める逆モデル乗算部と、
前記操作量推定値のｎ次周波数成分ベクトルと、周期外乱補償値のｎ次周波数成分ベクトルが低域通過フィルタを介した値と、を加算して周期外乱補償値のｎ次周波数成分ベクトルを出力する加算器と、
前記周期外乱補償値のｎ次周波数成分ベクトルを、前記ｎ次回転位相に基づいて、周期外乱に同期したｄnｑn回転座標系から元の時間波形に復元し、前記周期外乱補償信号を出力する補償信号合成部と、
を備えたことを特徴とする制御システム。
【請求項４】
指令値と、制御対象システムの検出値と、制御対象システムの位相情報と、に基づいて、制御対象システムの操作量を決定するフィードバック制御器を備えた制御システムであって、
前記フィードバック制御器は、
前記検出値と前記位相情報とに基づいて、周期外乱補償信号を出力する周期外乱抑制制御器と、
前記指令値と前記周期外乱補償信号とを加算した補正指令値と、前記検出値と、に基づいて、前記操作量を算出する共振・外乱抑制制御器と、を有し、
前記周期外乱抑制制御器は一般化周期外乱オブザーバを用い、
前記共振・外乱抑制制御器は、
前記指令値がμ設計制御器の前記指令値から前記操作量までの伝達特性を介した出力と、前記検出値がμ設計制御器の前記検出値から前記操作量までの伝達特性を介した出力と、を加算して、前記操作量を出力するμ設計制御器を有し、
前記周期外乱抑制制御器は、
前記位相情報に抑制対象次数ｎを乗じたｎ次回転位相を用いて、前記指令値から前記検出値を減算した偏差を、ｄnｑn回転座標に変換した周期外乱のｎ次周波数成分ベクトルを出力する周波数成分変換器と、
前記ｎ次回転位相を微分してｎ次回転周波数を算出する速度変換器と、
前記周期外乱のｎ次周波数成分ベクトルに、前記ｎ次回転周波数に同期した単一の周波数ベクトルが適用された逆モデルを乗じて、操作量推定値のｎ次周波数成分ベクトルを求める逆モデル乗算部と、
前記操作量推定値のｎ次周波数成分ベクトルを積分し、周期外乱補償値のｎ次周波数成分ベクトルを出力する積分器と、
前記周期外乱補償値のｎ次周波数成分ベクトルを、前記ｎ次回転位相に基づいて、周期外乱に同期したｄnｑn回転座標系から元の時間波形に復元し、前記周期外乱補償信号を出力する補償信号合成部と、
を備えたことを特徴とする制御システム。
【請求項５】
前記指令値と前記検出値に基づいて、直流トルク成分指令値を出力する低域トルク制御器を有し、
前記直流トルク成分指令値と前記周期外乱補償信号を加算した値を前記補正指令値とし、
前記低域トルク制御器は、
ＰＩ制御器と、低域通過フィルタと、を備えたことを特徴とする請求項１〜４のうち何れか１項に記載の制御システム。
【請求項６】
抑制対象次数の異なる前記周期外乱抑制制御器を複数台有し、各々の前記周期外乱抑制制御器の出力を合算した値を周期外乱補償信号とすることを特徴とする請求項１〜５のうち何れか１項に記載の制御システム。