(57)【要約】【課題】より制御性能の高い制御装置を提供する。【解決手段】制御装置１は、モータと負荷とを連結部材で連結してなる機械系２を模した２慣性系モデルに基づいて当該機械系２を制御する制御装置１である。制御装置１は、２慣性系モデルの逆モデルを用いて、負荷角度指令値θｒｅｆに応じた、モータに対するフィードフォワード値（ωＭ＿ＦＦ、τＦＦ）を出力するフィードフォワード制御部１１を備えている。フィードフォワード制御部１１は、非線形の伝達特性を有するモータの摩擦、負荷の摩擦、及び、連結部材のガタの伝達特性を含む２慣性系モデルの逆モデルを用いる。【選択図】図５
2018055603.tif 000002
【特許請求の範囲】
【請求項１】
モータと負荷とを連結部材で連結してなる機械系を模した２慣性系モデルに基づいて当該機械系を制御する制御装置であって、
前記２慣性系モデルの逆モデルを用いて、負荷角度の指令値に応じた、前記モータに対するフィードフォワード値を出力するフィードフォワード制御部を備え、
前記フィードフォワード制御部は、
非線形の伝達特性を有する前記モータの摩擦、前記負荷の摩擦、及び、前記連結部材のガタの伝達特性のうち少なくとも何れか一つを含む前記２慣性系モデルの逆モデルを用いる
制御装置。
【請求項２】
前記２慣性系モデルの逆モデルは、前記ガタの変位の時間微分特性を含み、
前記フィードフォワード制御部は、
前記ガタの変位の時間微分特性に基づいて前記モータに対するフィードフォワード値を演算する
請求項１に記載の制御装置。
【請求項３】
前記２慣性系モデルの逆モデルは、前記負荷の摩擦の時間微分特性を含み、
前記フィードフォワード制御部は、
前記負荷の摩擦の時間微分特性に基づいて前記モータに対するフィードフォワード値を演算する
請求項１又は請求項２に記載の制御装置。
【請求項４】
前記フィードフォワード制御部は、
前記２慣性系モデルの逆モデルを用いて、前記負荷角度の指令値に応じたモータ角速度フィードフォワード値、及び、トルクフィードフォワード値を出力する
請求項１から請求項３の何れか一項に記載の制御装置。
【請求項５】
請求項１から請求項４の何れか一項に記載の制御装置と、
前記機械系と、
を備える駆動システム。
【請求項６】
前記機械系の前記連結部材は、ボールねじである
請求項５に記載の駆動システム。
【請求項７】
前記機械系は、工作機械である
請求項６に記載の駆動システム。
【請求項８】
前記機械系は、射出成型機である
請求項６に記載の駆動システム。
【請求項９】
前記機械系の前記連結部材は、歯車である
請求項５に記載の駆動システム。
【請求項１０】
前記機械系は、段ボールカッターである
請求項９に記載の駆動システム。
【請求項１１】
前記機械系は、ロボットアームである
請求項９に記載の駆動システム。
【請求項１２】
モータと負荷とを連結部材で連結してなる機械系を模した２慣性系モデルに基づいて当該機械系を制御するための制御方法であって、
前記２慣性系モデルの逆モデルを用いて、負荷角度の指令値に応じた、前記モータに対するフィードフォワード値を出力するフィードフォワード制御ステップを有し、
前記フィードフォワード制御ステップにおいて、
非線形の伝達特性を有する前記モータの摩擦、前記負荷の摩擦、及び、前記連結部材のガタの伝達特性のうち少なくとも何れか一つを含む前記２慣性系モデルの逆モデルを用いる
制御方法。
【請求項１３】
モータと負荷とを連結部材で連結してなる機械系を模した２慣性系モデルに基づいて当該機械系を制御する制御装置のコンピュータを、
前記２慣性系モデルの逆モデルを用いて、負荷角度の指令値に応じた、前記モータに対するフィードフォワード値を出力するフィードフォワード制御部として機能させ、
前記フィードフォワード制御部は、
非線形の伝達特性を有する前記モータの摩擦、前記負荷の摩擦、及び、前記連結部材のガタの伝達特性のうち少なくとも何れか一つを含む前記２慣性系モデルの逆モデルを用いる
プログラム。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、制御装置、駆動システム、制御方法及びプログラムに関する。
【背景技術】
【０００２】
負荷を駆動させるモータの制御系（制御装置）の設計において制御性能を向上させるためにはフィードバック制御では限界があり、指令信号に対する応答特性が高いフィードフォワード制御を行う必要がある。また、フィードフォワード制御を実現するためには、制御装置側が、制御対象（即ち、モータ及び負荷を有する機械系）を模したモデルの逆モデルを持つ必要があるが、このフィードフォワード制御用のモデルと実際の制御対象の特性との間に誤差があると、制御性能の向上は図れない。
そのため、制御性能の高いフィードフォワード制御を実現するためには、制御対象を正確に模したモデルを得る必要がある。
【０００３】
特許文献１では、２慣性系モデル（２質点系モデル）の逆モデル特性に基づいてフィードフォワード制御を行う方法が開示されている。２慣性系モデルとは、例えば、モータと、負荷と、当該モータ及び負荷を連結する連結部材（ボールねじ、歯車等）とを有する機械系を模してなるモデルである。このような２慣性系モデルを構築することで、負荷とモータとを有する機械系の特性をより正確に模すことができる。
【先行技術文献】
【特許文献】
【０００４】
【特許文献１】特開２０１１−１３５６７７号公報
【発明の概要】
【発明が解決しようとする課題】
【０００５】
特許文献１に記載の２慣性系モデルは、慣性（イナーシャ）、粘性といった線形要素のみであり、モータ側の摩擦、負荷側の摩擦、連結部材に生じるガタ等の非線形要素は含んでいない。非線形要素に対しては別途、経験的な調整で対応している。
このような非線形要素を含まない２慣性系モデルは、モータと負荷とを有する機械系を正確に模しているとは言えない。
【０００６】
本発明の目的は、上記課題に鑑みてなされたものであって、より制御性能の高い制御装置、駆動システム、制御方法及びプログラムを提供することにある。
【課題を解決するための手段】
【０００７】
本発明の一態様は、モータと負荷とを連結部材で連結してなる機械系を模した２慣性系モデルに基づいて当該機械系を制御する制御装置であって、前記２慣性系モデルの逆モデルを用いて、負荷角度の指令値に応じた、前記モータに対するフィードフォワード値を出力するフィードフォワード制御部を備え、前記フィードフォワード制御部は、非線形の伝達特性を有する前記モータの摩擦、前記負荷の摩擦、及び、前記連結部材のガタの伝達特性のうち少なくとも何れか一つを含む前記２慣性系モデルの逆モデルを用いる制御装置である。
【０００８】
また、本発明の一態様によれば、前記２慣性系モデルの逆モデルは、前記ガタの変位の時間微分特性を含み、前記フィードフォワード制御部は、前記ガタの変位の時間微分特性に基づいて前記モータに対するフィードフォワード値を演算する。
【０００９】
また、本発明の一態様によれば、前記２慣性系モデルの逆モデルは、前記負荷の摩擦の時間微分特性を含み、前記フィードフォワード制御部は、前記負荷の摩擦の時間微分特性に基づいて前記モータに対するフィードフォワード値を演算する。
【００１０】
また、本発明の一態様によれば、前記フィードフォワード制御部は、前記２慣性系モデルの逆モデルを用いて、前記負荷角度の指令値に応じたモータ角速度フィードフォワード値、及び、トルクフィードフォワード値を出力する。
【００１１】
また、本発明の一態様は、上述の制御装置と、前記機械系と、を備える駆動システムである。
【００１２】
また、本発明の一態様によれば、前記機械系の前記連結部材は、ボールねじである。
【００１３】
また、本発明の一態様によれば、前記機械系は、工作機械である。
【００１４】
また、本発明の一態様によれば、前記機械系は、射出成型機である。
【００１５】
また、本発明の一態様によれば、前記機械系の前記連結部材は、歯車である。
【００１６】
また、本発明の一態様によれば、前記機械系は、段ボールカッターである。
【００１７】
また、本発明の一態様によれば、前記機械系は、ロボットアームである。
【００１８】
また、本発明の一態様は、モータと負荷とを連結部材で連結してなる機械系を模した２慣性系モデルに基づいて当該機械系を制御するための制御方法であって、前記２慣性系モデルの逆モデルを用いて、負荷角度の指令値に応じた、前記モータに対するフィードフォワード値を出力するフィードフォワード制御ステップを有し、前記フィードフォワード制御ステップにおいて、非線形の伝達特性を有する前記モータの摩擦、前記負荷の摩擦、及び、前記連結部材のガタの伝達特性のうち少なくとも何れか一つを含む前記２慣性系モデルの逆モデルを用いる制御方法である。
【００１９】
また、本発明の一態様は、モータと負荷とを連結部材で連結してなる機械系を模した２慣性系モデルに基づいて当該機械系を制御する制御装置のコンピュータを、前記２慣性系モデルの逆モデルを用いて、負荷角度の指令値に応じた、前記モータに対するフィードフォワード値を出力するフィードフォワード制御部として機能させ、前記フィードフォワード制御部は、非線形の伝達特性を有する前記モータの摩擦、前記負荷の摩擦、及び、前記連結部材のガタの伝達特性のうち少なくとも何れか一つを含む前記２慣性系モデルの逆モデルを用いるプログラムである。
【発明の効果】
【００２０】
上述の制御装置、駆動システム、制御方法及びプログラムによれば、より制御性能を高くすることができる。
【図面の簡単な説明】
【００２１】
【図１】第１の実施形態に係る駆動システムの全体構成を示す図である。
【図２】第１の実施形態に係る機械系の伝達特性を示すブロック線図である。
【図３】第１の実施形態に係る機械系のモータ側及び負荷側の摩擦特性を説明する図である。
【図４】第１の実施形態に係る機械系の連結部材における不感帯の特性を説明する図である。
【図５】第１の実施形態に係る駆動システムの機能構成を示す図である。
【図６】第１の実施形態に係るフィードフォワード制御部のブロック線図である。
【図７】第１の実施形態に係るフィードフォワード制御部の処理フローである。
【図８】第１の実施形態に係るフィードフォワード制御部の機能の詳細を示す図である。
【図９】第１の実施形態に係る機械系の構造を示す図である。
【図１０】第２の実施形態に係る機械系の構造を示す図である。
【図１１】第３の実施形態に係る機械系の構造を示す図である。
【図１２】第４の実施形態に係る機械系の構造を示す図である。
【発明を実施するための形態】
【００２２】
＜第１の実施形態＞
以下、第１の実施形態に係る駆動システムについて、図１〜図９を参照しながら詳細に説明する。
【００２３】
（駆動システムの全体構成）
図１は、第１の実施形態に係る駆動システムの全体構成を示す図である。
図１に示すように、第１の実施形態に係る駆動システム９は、制御装置１と機械系２とを備えている。
機械系２は、モータ２０と、負荷２１と、モータ２０及び負荷２１を機械的に連結する連結部材２２と、を有してなる。本実施形態に係る機械系２の具体的な態様については後述する。
【００２４】
図１に示すように、制御装置１は、図示しない上位機器から負荷２１の目標回転角度を示す負荷角度指令値θｒｅｆを受け付ける。そして、制御装置１は、受け付けた負荷角度指令値θｒｅｆに応じてモータ２０に発生すべきトルクτを演算し、当該トルクτを示すトルク指令値を出力する。モータ２０は、受け付けたトルク指令値に示されるトルクτで回転駆動し、トルクτがモータ２０側から負荷２１側へと連結部材２２を通じて伝達する。その結果、伝達されたトルクτ’に応じて負荷２１が回転駆動する。このようにして、制御装置１により、負荷２１の回転角度（以下、単に「角度」とも記載する。）が所望の目標角度（負荷角度指令値θｒｅｆ）に一致するような制御が実現される。
なお、本実施形態においては、説明の簡略化のため、モータ２０は、制御装置１からトルク指令値を受け付けた場合に、当該トルク指令値どおりのトルクτを出力することができるものとして説明する。
【００２５】
第１の実施形態に係る制御装置１は、いわゆるクローズドシステムであって、モータ２０の角度と、負荷２１の角度と、を示す検出値（実測データ）に基づいてフィードバック制御を行う。
ここで、機械系２を構成するモータ２０及び負荷２１には、それぞれ、図示しない回転検出器（エンコーダ）が設置されている。制御装置１は、当該回転検出器を通じて、モータ２０の角度、負荷２１の角度を検出する。また、制御装置１は、取得したモータ２０の角度の検出値を内部で時間微分することで、モータ２０の角速度を検出する。また、制御装置１は、取得した負荷２１の角度の検出値を内部で時間微分することで、負荷２１の角速度を検出する。
なお、以下の説明において、モータ２０の角速度の検出値を「モータ角速度ωＭ」とも記載し、モータ２０の角度の検出値を「モータ角度θＭ」とも記載する。また、負荷２１の角速度の検出値を「負荷角速度ωＬ」とも記載し、負荷２１の角度の検出値を「負荷角度θＬ」とも記載する。
【００２６】
また、制御装置１は、更に、機械系２を２慣性系と見なして模した２慣性系モデル（後述）を予め有しており、当該２慣性系モデルを用いてフィードフォワード制御を行う。
なお、機械系２における負荷２１が、回転系ではなく直動系の場合、負荷２１に対する制御対象パラメータは、厳密には“角度”、“角速度”ではなく、“位置”、“速度”となる。しかし、この場合、制御装置１は、２慣性系として、モータ２０の“角度”、“角速度”と同じ次元で取り扱うために、負荷の“位置”、“速度”を、モータ軸換算値としての“角度”、“角速度”に逐次変換して各種制御を行う。
【００２７】
機械系２を２慣性系と見なした場合において、機械系２固有の特性を表すパラメータ群は、モータ２０側の特性を示すパラメータ、負荷２１側の特性を示すパラメータ、及び、モータ２０と負荷２１とを機械的に連結して動力を伝達する連結部材２２の特性を示すパラメータに大別される。具体的には、モータ２０側の特性を示すパラメータとして、モータ側慣性モーメントＪＭ、モータ側粘性係数ＤＭ、モータ側摩擦トルクτｆＭ（モータの摩擦）がある。また、負荷２１側の特性を示すパラメータとして、負荷側慣性モーメントＪＬ、負荷側粘性係数ＤＬ、負荷側摩擦トルクτｆＬ（負荷の摩擦）がある。更に、連結部材２２の特性を示すパラメータとして、ねじれ剛性係数ＫＲ、ねじれ粘性係数ＤＲ、不感帯幅ＢＬがある。
【００２８】
（機械系の伝達特性）
図２は、第１の実施形態に係る機械系の伝達特性を示すブロック線図である。
本実施形態に係る機械系２（図１参照）をモータ２０、負荷２１及び連結部材２２からなる２慣性系の機械と見なすことで、当該機械系２における入力と出力との関係を、図２に示すような伝達関数を用いたブロック線図で表すことができる。
【００２９】
図２に示すように、モータ２０は、制御装置１（図１）から受け付けたトルク指令値に基づいて自身が発生させたトルクτを入力とし、モータ角度θＭを出力とする。モータ２０が発生させたトルクτは、モータ２０に生じる摩擦であるモータ側摩擦トルクτｆＭ、及び、連結部材２２を通じて負荷２１に伝達するトルクτ’が差し引かれた後、伝達要素１／（ＪＭｓ＋ＤＭ）を通じてモータ角速度ωＭに変換され、更に伝達要素１／ｓ（積分要素）を通じてモータ角度θＭに変換される。
ここで、モータ側摩擦トルクτｆＭは、モータ２０の速度反転時（モータ角速度ωＭの符号反転時）に符号のみが反転するクーロン摩擦成分だけでなく、モータ２０の速度反転後の変位（モータ角速度ωＭのゼロからの積分値）に依存して非線形に変化する非線形摩擦成分を含んでいる。モータ側摩擦トルクτｆＭは、この非線形摩擦成分をモデル化して規定し、モータ角速度ωＭを入力変数とするモータ側摩擦関数ＧＭを通じて得られる。モータ側摩擦関数ＧＭの詳細については後述する。
【００３０】
同様に、負荷２１は、モータ２０から連結部材２２を通じて伝達されたトルクτ’（＝（ＫＲ＋ＤＲｓ）（θＭ−θＬ−ＢＫＬＳ））を入力とし、負荷角度θＬを出力とする。負荷２１に入力されたトルクτ’は、負荷２１に生じる摩擦である負荷側摩擦トルクτｆＬが差し引かれた後、伝達要素１／（ＪＬｓ＋ＤＬ）を通じて負荷角速度ωＬに変換され、更に伝達要素１／ｓを通じて負荷角度θＬに変換される。
ここで、負荷側摩擦トルクτｆＬも同様に、負荷２１の速度反転後の変位（負荷角速度ωＬのゼロからの積分値）に依存して非線形に変化する非線形摩擦成分を含んでいる。負荷側摩擦トルクτｆＬは、この非線形摩擦成分をモデル化して規定し、負荷角速度ωＬを入力変数とする負荷側摩擦関数ＧＬを通じて得られる。負荷側摩擦関数ＧＬの詳細については後述する。
【００３１】
また、図２に示すように、連結部材２２は、モータ角度θＭと負荷角度θＬとの偏差（以下、「ねじれ角度（θＭ−θＬ）」とも記載する。）を入力とし、ねじれ角度（θＭ−θＬ）に応じたトルクτ’を出力とする伝達系である。入力されたねじれ角度（θＭ−θＬ）は、不感帯（以下、「ガタ」とも記載する。）における非線形性を表す不感帯特性関数Ｆ１と、伝達要素ＫＲ及び伝達要素ＤＲｓと、を通じて、モータ２０及び負荷２１に印加されるトルクτ’に変換される。
ここで、不感帯特性関数Ｆ１とは、不感帯幅ＢＬで規定される非線形関数である。不感帯特性関数Ｆ１は、連結部材２２のねじれ角度（θＭ−θＬ）を入力変数とし、当該ねじれ角度（θＭ−θＬ）からガタの変位（ガタ変位）ＢＫＬＳを差し引いた角度を出力する。不感帯特性関数Ｆ１の詳細については後述する。
また、ねじれ剛性係数ＫＲとは、連結部材２２のねじれ方向についての剛性の度合いを示すパラメータであって、連結部材２２のばね定数に相当する。即ち、ねじれ剛性係数ＫＲは、負荷２１に印加されるトルクτ’のうち、連結部材２２のねじれ角度（θＭ−θＬ）に比例する成分を与える。
また、ねじれ粘性係数ＤＲとは、連結部材２２のねばりの度合いを示すパラメータであって、負荷２１に印加されるトルクτ’のうち、連結部材２２におけるモータ角速度ωＭと負荷角速度ωＬとの偏差（以下、「ねじれ角速度（ωＭ−ωＬ）」とも記載する。）に比例する成分を与える。
【００３２】
以上の通り、制御装置１が制御対象とする機械系２は、複数のパラメータ群及び非線形関数によって、２慣性系モデルとして特徴づけられる。
ここで、モデルパラメータ群とは、上述したモータ側慣性モーメントＪＭ、モータ側粘性係数ＤＭ、負荷側慣性モーメントＪＬ、負荷側粘性係数ＤＬ、ねじれ剛性係数ＫＲ、ねじれ粘性係数ＤＲ、及び、不感帯幅ＢＬである。
また、非線形関数とは、モータ角速度ωＭに応じたモータ側摩擦トルクτｆＭを与えるモータ側摩擦関数ＧＭ、負荷角速度ωＬに応じた負荷側摩擦トルクτｆＬを与えるモータ側摩擦関数ＧＬ、及び、ねじれ角度（θＭ−θＬ）からガタ変位ＢＫＬＳを差し引いた角度を出力する不感帯特性関数Ｆ１である。
また、機械系２への入力であるトルクτは、トルク指令値から制御装置１自身が観測可能なパラメータである。機械系２からの出力（検出値）であるモータ角度θＭ及び負荷角度θＬは、上述の回転検出器を通じて、制御装置１が観測可能なパラメータである。
【００３３】
図３は、第１の実施形態に係る機械系のモータ側及び負荷側の摩擦特性を説明する図である。
図３（ａ）は、モータ側摩擦トルクτｆＭ及び負荷側摩擦トルクτｆＬの各々に生じる非線形摩擦特性を示すグラフである。
良く知られているクーロン摩擦は、物体の速度（モータ角速度ωＭ、負荷角速度ωＬ）の方向（正、負の符号）に依存してその方向（正、負の符号）のみが変化し、その量は、速度（ω）、変位（θ）に対しては変動しないものとして知られている。しかしながら、連結部材２２において、例えば、ボールねじ、ボールベアリング等の転がり要素が含まれる場合には、通常のクーロン摩擦とは特性が異なる“転がり摩擦”を考慮する必要がある。
ここで、転がり摩擦は、速度反転直後の転がり要素が転動しない“微動領域”においては、速度反転後の変位（モータ角速度ωＭ、負荷角速度ωＬのゼロからの積分値）によって見かけのばね定数が動的に変化する非線形ばね特性を有しており、図３（ａ）に示すようなヒステリシスカーブを描く。これは、転がり要素と軌道面の接触部における弾性変形やすべりによるものと考えられている。
また、転がり要素が有効に転動する“粗動領域”においては、クーロン摩擦により摩擦の速度に対する静的特性を示す。即ち、図３（ａ）に示すように、モータ２０の摩擦（モータ側摩擦トルクτｆＭ）は、速度反転後の変位が所定以上となった時点で、モータ側クーロン摩擦値τｆＭｃで飽和する。また、負荷２１の摩擦（負荷側摩擦トルクτｆＬ）は、速度反転後の変位が所定以上となった時点で、負荷側クーロン摩擦値τｆＬｃで飽和する。ここで、モータ側クーロン摩擦値τｆＭｃ及び負荷側クーロン摩擦値τｆＬｃは、モータ側摩擦特性関数ＧＭ及び負荷側摩擦特性関数ＧＬを規定するパラメータである。
【００３４】
本実施形態においては、モータ側摩擦特性関数ＧＭ及び負荷側摩擦特性関数ＧＬは、図３（ａ）に示す非線形摩擦特性を折れ線近似してなるＧＭＳ（Generalized Maxwell Slip）モデルに基づいて規定される。ここで、ＧＭＳモデルとは、Ｎ個の特性の異なるブロック（転がり要素）とばねとが並列に接続されている状態を模したものである。図３（ｂ）に示すグラフ（折れ線）を構成する複数の直線の各々が、Ｎ個のブロックのうちのいくつまでが転がりきっている（有効に転動している）状態か、を表現している。
図３（ｂ）に示すように、モータ側摩擦特性関数ＧＭは、変位０〜θ１、θ１〜θ２、θ２〜θ３、θ３〜θ４の各々において採用すべき直線の傾きＫ１、Ｋ２、Ｋ３、Ｋ４、及び、オフセット（変位０における切片）τｆＭ１（＝−τｆＭｃ）、τｆＭ２、τｆＭ３、τｆＭ４、τｆＭ５（＝τｆＭｃ）によって規定される。
なお、横軸の変位θは、モータ角速度ωＭの速度反転時（ωＭ＝０）からの積分値で与えられる。
なお、図示を省略するが、負荷側摩擦特性関数ＧＬも、図３（ｂ）に示すモータ側摩擦特性関数ＧＭと同様に規定される。
【００３５】
図４は、第１の実施形態に係る機械系の連結部材における不感帯の特性を説明する図である。
【００３６】
図４（ａ）に示す不感帯特性関数Ｆ１は、モータ２０と負荷２１との間に設けられた連結部材２２のガタ（不感帯）の幅を示す不感帯幅ＢＬに基づく伝達特性を表している。
不感帯特性関数Ｆ１は、不感帯幅ＢＬによって規定される非線形特性であって、連結部材２２のねじれ角度（θＭ−θＬ）を入力変数とする。図４（ａ）に示すように、連結部材２２のねじれ角度（θＭ−θＬ）の絶対値が不感帯幅ＢＬ以下の場合（−ＢＬ≦θＭ−θＬ≦＋ＢＬ）、ガタ出力はゼロとなる。即ち、この場合、モータ２０から負荷２１へトルクが伝達されない。他方、連結部材２２のねじれ角度（θＭ−θＬ）の絶対値が不感帯幅ＢＬよりも大きい場合（θＭ−θＬ＜−ＢＬ，θＭ−θＬ＞＋ＢＬ）、ガタ出力は、ねじれ角度（θＭ−θＬ）から不感帯幅ＢＬだけ小さい値（θＭ−θＬ＋ＢＬ（θＭ−θＬ＜−ＢＬ）、又は、θＭ−θＬ−ＢＬ（θＭ−θＬ＞＋ＢＬ））となる。
【００３７】
また、図４（ｂ）に示すガタ変位関数Ｆ１’は、ガタ変位ＢＫＬＳとねじれ角度（θＭ−θＬ）との関係をしている。
ガタ変位ＢＫＬＳは、不感帯幅ＢＬ（−ＢＬ〜＋ＢＬ）の幅を有する不感帯における変位量を示すパラメータであって、ねじれ角度（θＭ−θＬ）に対し、図４（ｂ）に示すような特性を有している。即ち、図４（ａ）に示すガタ出力は、ガタ変位ＢＫＬＳを用いて“θＭ−θＬ―ＢＫＬＳ”と表すことができる。
図４（ｂ）に示すように、ガタ変位ＢＫＬＳは、ねじれ角度（θＭ−θＬ）が不感帯の最小値（−ＢＬ）よりも小さい範囲では、ガタ変位ＢＫＬＳは最小値（−ＢＬ）をとり、ねじれ角度（θＭ−θＬ）が不感帯の最大値（＋ＢＬ）よりも大きい範囲では、ガタ変位ＢＫＬＳは最大値（＋ＢＬ）をとる。また、ねじれ角度（θＭ−θＬ）が不感帯の最小値（−ＢＬ）以上かつ最大値（＋ＢＬ）以下の範囲においては、ガタ変位ＢＫＬＳは、ねじれ角度（θＭ−θＬ）と同一の値を有する特性となる。
【００３８】
（駆動システムの機能構成）
図５は、第１の実施形態に係る駆動システムの機能構成を示す図である。
図５に示すように、第１の実施形態に係る制御装置１は、上位装置（図示せず）から負荷角度指令値θｒｅｆの入力を受け付けて、機械系２に対し、負荷角度指令値θｒｅｆに応じたトルクτを示すトルク指令値を出力する。
制御装置１は、フィードバック制御部１０と、フィードフォワード制御部１１と、を備えている。
【００３９】
フィードバック制御部１０は、負荷角度指令値θｒｅｆと、回転検出器を通じて検出される現在の負荷角度θＬとの偏差（θｒｅｆ−θＬ）に基づいて、当該偏差（θｒｅｆ−θＬ）をゼロに近づけるためのトルクフィードバック値τＦＢを出力する。
本実施形態に係るフィードバック制御部１０は、比例制御部１０ａと、比例積分制御部１０ｂと、を有している。
比例制御部１０ａは、負荷角度指令値θｒｅｆと負荷角度θＬとの偏差（θｒｅｆ−θＬ）に対し、所定の比例定数ＫＰＰで比例して増減するモータ角速度フィードバック値ωＭ＿ＦＢを出力する。
比例積分制御部１０ｂは、上述のモータ角速度フィードバック値ωＭ＿ＦＢにモータ角速度フィードフォワード値ωＭ＿ＦＦ（後述）を加算した値（ωＭ＿ＦＢ＋ωＭ＿ＦＦ）と、回転検出器を通じて観測されたモータ角度θＭを微分して得られる現在のモータ角速度ωＭとの偏差（ωＭ＿ＦＢ＋ωＭ＿ＦＦ−ωＭ）を入力する。ここで、加算値（ωＭ＿ＦＢ＋ωＭ＿ＦＦ）は、モータ２０に対するモータ角速度ωＭの指令値である。比例積分制御部１０ｂは、モータ角速度の指令値（ωＭ＿ＦＢ＋ωＭ＿ＦＦ）と検出値（ωＭ）との偏差（ωＭ＿ＦＢ＋ωＭ＿ＦＦ−ωＭ）に基づき、所定の比例定数ＫＶＰ及び積分定数（ＫＶＰ／ＴＶＩ）に基づくトルクフィードバック値τＦＢを出力する（ここで、ＴＶＩは、積分時間である）。
【００４０】
フィードフォワード制御部１１は、機械系２を模した２慣性系モデルの逆モデルを内部に有している。この２慣性系モデルの逆モデルは、機械系２の伝達特性を示す複数のモデルパラメータ（ＪＭ、ＤＭ、ＪＬ、ＤＬ、ＫＲ、ＤＲ、ＢＬ）、及び、非線形関数（ＧＭ、ＧＬ、Ｆ１）によって規定される（図２〜図４参照）。
本実施形態においては、フィードフォワード制御部１１は、機械系２の逆モデルを規定するパラメータ群（ＪＭ、ＤＭ、ＪＬ、ＤＬ、ＫＲ、ＢＬ）、及び、非線形関数（ＧＭ、ＧＬ、Ｆ１）を既に同定しているものとする。
フィードフォワード制御部１１は、負荷角度指令値θｒｅｆと、モータ角速度ωＭと、負荷角速度ωＬとを入力し、トルクフィードフォワード値τ＿ＦＦとモータ角速度フィードフォワード値ωＭ＿ＦＦを出力する。
モータ角速度フィードフォワード値ωＭ＿ＦＦは、モータ角速度フィードバック値ωＭ＿ＦＢに加算され、モータ角速度指令値として比例積分制御部１０ｂに入力される。また、トルクフィードフォワード値τ＿ＦＦは、トルクフィードバック値τＦＢに加算され、トルクτを示すトルク指令値として機械系２に出力される。
【００４１】
（フィードフォワード制御部の処理）
図６は、第１の実施形態に係るフィードフォワード制御部のブロック線図である。
また、図７は、第１の実施形態に係るフィードフォワード制御部の処理フローである。
また、図８は、第１の実施形態に係るフィードフォワード制御部の機能の詳細を示す図である。
以下、図６〜図８を参照しながら、本実施形態に係るフィードフォワード制御部１１の機能について詳細に説明する。
【００４２】
まず、フィードフォワード制御部１１が、機械系２を模した２慣性系モデルの逆モデルを用いて、モータ角速度フィードフォワード値ωＭ＿ＦＦ、及び、トルクフィードフォワード値τＦＦを演算する方法について説明する。
【００４３】
ここで、機械系２を模した２慣性系モデルの運動方程式は、図２に示すブロック線図に基づいて、式（１）及び式（２）のように表すことができる。式（１）は、モータ２０についての運動方程式であり、式（２）は、負荷２１についての運動方程式である。
【００４４】
【数１】
2018055603.tif 000003
【００４５】
【数２】
2018055603.tif 000004
【００４６】
式（１）、（２）において、“τｆＭ［ωＭ］”は、モータ側摩擦特性関数ＧＭ（図３（ｂ））に基づいてモータ角速度ωＭの変数として規定されるモータ側摩擦トルクτｆＭを示している。また、“τｆＬ［ωＬ］”は、負荷側摩擦特性関数ＧＬに基づいて負荷角速度ωＬの変数として規定される負荷側摩擦トルクτｆＬを示している。
また、“ＢＫＬＳ［θＭ−θＬ］”は、ガタ変位関数Ｆ１’（図４（ｂ））に基づいてねじれ角度（θＭ−θＬ）の変数として規定されるガタ変位ＢＫＬＳを示している。
【００４７】
なお、現実の機械系２において、連結部材２２のねじれ粘性係数ＤＲの影響は小さいものとして、式（１）、式（２）においては、ねじれ粘性係数ＤＲを無視している。
【００４８】
上位装置から負荷角度指令値θｒｅｆが入力された場合、フィードフォワード制御部１１は、式（１）及び式（２）で示される２慣性系モデルについて、負荷角度θＬを負荷角度指令値θｒｅｆと一致させ（θＬ＝θｒｅｆ）、負荷角速度ωＬを負荷角度指令値θｒｅｆの時間微分ωｒｅｆ（負荷角速度指令値）と一致させる（ωＬ＝ωｒｅｆ）必要がある。
そこで、式（２）の“θＬ”に“θｒｅｆ”を代入し、ωＬ”に“ωｒｅｆ”を代入することで、θＬ＝θｒｅｆ、ωＬ＝ωｒｅｆとなるモータ角度θＭを、式（３）のように求めることができる。
【００４９】
【数３】
2018055603.tif 000005
【００５０】
式（３）において、右辺第１項は、負荷角度指令値θｒｅｆそのものである。また、右辺第２項は、負荷慣性トルク、負荷粘性トルク、及び、負荷側摩擦トルク分のねじれ角度（θＭ−θＬ）を補償するために、負荷角度指令値θｒｅｆに加えて必要な成分である。右辺第３項は、ガタ変位ＢＫＬＳを補償するために、負荷角度指令値θｒｅｆに加えて必要な成分である。
【００５１】
式（３）で示されるモータ角度θＭを時間微分することで、式（４）のように、モータ速度フィードフォワード値ωＭ＿ＦＦを得ることができる。
【００５２】
【数４】
2018055603.tif 000006
【００５３】
式（４）は、モータ速度フィードフォワード値ωＭ＿ＦＦを得るための２慣性系モデル（機械系２）の逆モデルといえる。
式（４）の右辺第１項は、負荷角速度指令値ωｒｅｆそのものである。また、右辺第２項は、負荷慣性トルク、負荷粘性トルク、及び、負荷側摩擦トルク分のねじれ角度の時間微分特性である。右辺第２項には、負荷側摩擦トルクの時間微分特性（ｓ・τｆＬ［ωｒｅｆ］）が含まれる。また、右辺第３項は、ガタ変位ＢＫＬＳの時間微分特性（（ｄ／ｄｔ）・ＢＫＬＳ［θＭ−θＬ］）である。
【００５４】
また、式（１）、式（２）の“θＬ”に“θｒｅｆ”を代入し、ωＬ”に“ωｒｅｆ”を代入することで、θＬ＝θｒｅｆ、ωＬ＝ωｒｅｆとなるトルク（トルクフィードフォワード値τＦＦ）を、式（５）のように求めることができる。
【００５５】
【数５】
2018055603.tif 000007
【００５６】
式（５）は、トルクフィードフォワード値τＦＦを得るための２慣性系モデル（機械系２）の逆モデルといえる。
式（５）の右辺第１項は、全慣性トルクであり、右辺第２項は、全粘性トルクである。また、右辺第３項は、負荷慣性トルク及び負荷粘性トルク分のねじれ角度を生じさせるためのモータ慣性トルク及びモータ粘性トルクである。右辺第４項は、負荷側摩擦トルク分のねじれ角度を生じさせるためのモータ慣性トルク及びモータ粘性トルクである。右辺第４項には、負荷側摩擦トルクの時間微分特性（ｓ・τｆＬ［ωｒｅｆ］）が含まれる。右辺第５項は、ガタ分のモータ慣性トルク及びモータ粘性トルクである。右辺第５項には、ガタ変位ＢＫＬＳの時間微分特性（（ｄ／ｄｔ）・ＢＫＬＳ［θＭ−θＬ］）が含まれる。右辺第６項、第７項は、全摩擦トルクである。
フィードフォワード制御部１１は、式（４）、式（５）に示される２慣性系モデルの逆モデルを用いて、モータ角速度フィードフォワード値ωＭ＿ＦＦ、及び、トルクフィードフォワード値τＦＦを演算する。
【００５７】
次に、図６、図７を参照しながら、フィードフォワード制御部１１の具体的な処理手順について説明する。
図６に示すように、フィードフォワード制御部１１は、負荷側摩擦演算部１１０と、ガタ微分演算部１１１と、モータ角速度フィードフォワード値演算部１１２と、モータ側摩擦演算部１１３と、トルクフィードフォワード値演算部１１４とを備えている。
【００５８】
まず、フィードフォワード制御部１１は、上位装置から負荷角度指令値θｒｅｆの入力を受け付ける（図７、ステップＳ０１）。
【００５９】
負荷側摩擦演算部１１０は、負荷側摩擦トルクのフィードフォワード値τｆＬ＿ＦＦ、及び、負荷側摩擦トルクの時間微分特性のフィードフォワード値ｓ・τｆＬ＿ＦＦを演算する（図７、ステップＳ０２）。
具体的には、負荷側摩擦演算部１１０は、上位装置から受け付けた負荷角度指令値θｒｅｆを時間微分して得られる負荷角速度指令値ωｒｅｆを入力する。そして、負荷側摩擦演算部１１０は、負荷角速度指令値ωｒｅｆの速度反転時（ωｒｅｆ＝０）からの積分値（変位θ）を負荷側摩擦特性関数ＧＬに代入し、変位θに応じた負荷側摩擦トルクのフィードフォワード値τｆＬ＿ＦＦを出力する。なお、負荷側摩擦特性関数ＧＬは、図３（ｂ）に示すモータ側摩擦特性関数ＧＭと同様の非線形関数である。
【００６０】
また、負荷側摩擦演算部１１０は、以下に示す式（６）のように、負荷側摩擦トルクの時間微分特性のフィードフォワード値ｓ・τｆＬ＿ＦＦを演算する。
【００６１】
【数６】
2018055603.tif 000008
【００６２】
式（６）において、“ＦｉＬ［ωＬ］”は、負荷側摩擦トルクτｆＬ［ωＬ］のＧＭＳモデルを構成する各要素の摩擦トルクである。即ち、ＧＭＳモデルの要素ｉ（ｉ＝０、１、２・・）ごとに生じる摩擦トルクの時間微分（（ｄ／ｄｔ）・ＦｉＬ［ωＬ］）を合計することで、負荷側摩擦トルクの時間微分特性ｓ・τｆＬを求めることができる。負荷側摩擦トルクの時間微分特性ｓ・τｆＬのフィードフォワード値ｓ・τｆＬ＿ＦＦは、負荷側摩擦トルクτｆＬ［ωＬ］に負荷角速度指令値ωｒｅｆを代入する（τｆＬ［ωｒｅｆ］）ことで求めることができる。
【００６３】
次に、ガタ微分演算部１１１は、ガタ変位の時間微分特性のフィードフォワード値（ｄ／ｄｔ）・ＢＬＫＳを演算する（図７、ステップＳ０３）。
具体的には、ガタ微分演算部１１１は、図６に示すように、モータ角速度ωＭと、負荷角速度ωＬと、負荷側摩擦演算部１１０が出力する負荷側摩擦トルクのフィードフォワード値τｆＬ＿ＦＦとを入力する。
【００６４】
以下、図８を参照しながら、ガタ微分演算部１１１が行う処理について説明する。
ガタ変位ＢＫＬＳの時間微分特性（（ｄ／ｄｔ）・ＢＫＬＳ［θＭ−θＬ］）は、以下の式（７）のように求めることができる。
【００６５】
【数７】
2018055603.tif 000009
【００６６】
即ち、ガタ変位ＢＫＬＳの時間微分特性（（ｄ／ｄｔ）・ＢＫＬＳ［θＭ−θＬ］）は、式（７）のように、ガタ変位ＢＫＬＳ［θＭ−θＬ］をねじれ角度（θＭ−θＬ）で微分した特性（（ｄ／ｄ（θＭ−θＬ））・ＢＫＬＳ［θＭ−θＬ］）と、ねじれ角速度（ωＭ−ωＬ）との積で求められる。
ガタ変位ＢＫＬＳ［θＭ−θＬ］をねじれ角度（θＭ−θＬ）で微分した特性（（ｄ／ｄ（θＭ−θＬ））・ＢＫＬＳ［θＭ−θＬ］）とは、図４（ｂ）に示すガタ変位ＢＫＬＳのグラフの傾きで表される。したがって、ねじれ角度で微分した特性（ｄ／ｄ（θＭ−θＬ））・ＢＫＬＳ［θＭ−θＬ］は、ねじれ角度（θＭ−θＬ）が−ＢＬより小さい領域、及び、＋ＢＬより大きい領域では“０”となり、ねじれ角度（θＭ−θＬ）が−ＢＬ以上＋ＢＬ以下の領域では“１”となる。
【００６７】
式（７）によれば、ガタ変位ＢＫＬＳの時間微分特性（（ｄ／ｄｔ）・ＢＫＬＳ［θＭ−θＬ］）をフィードフォワード値として特定するためには、ねじれ角度（θＭ−θＬ）とねじれ角速度（ωＭ−ωＬ）とを特定する必要がある。ここで、本実施形態に係るガタ微分演算部１１１は、ねじれ角速度（ωＭ−ωＬ）は、ガタ移動中において一定とみなし、所定の比例定数Ｋ（Ｋ＝ωＭ−ωＬ）とする。
【００６８】
また、ねじれ角度（θＭ−θＬ）は、フィードフォワード値の精度を高めるため、機械系２からモータ角速度ωＭ及び負荷角速度ωＬを入力し、速度反転時（ωＭ＝０）からのねじれ角速度（ωＭ−ωＬ）の積分値によって特定する。
ただし、この場合、速度反転時からガタの移動を開始するまでに必要な一定のオフセットねじれ角度を考慮する必要がある。このオフセットねじれ角度は、負荷側摩擦トルクτｆＬに抗するために必要なねじれ角度である。そこで、ガタ微分演算部１１１は、ステップＳ０２で負荷側摩擦演算部１１０が算出した負荷側摩擦トルクのフィードフォワード値τｆＬ＿ＦＦを入力し、τｆＬ＿ＦＦ／ＫＲをオフセットねじれ角度とする。
【００６９】
以上より、ガタ微分演算部１１１は、反転後ねじれ角度の絶対値｜（θＭ−θＬ）｜が、速度反転時からオフセットねじれ角度（τｆＬ＿ＦＦ／ＫＲ）だけ進んだ後にガタの移動を開始し、更にガタ補償幅（不感帯幅ＢＬ×２）を進んだ後にガタの移動を完了するものと判断する（図８のブロック１１１ａ参照）。ガタ微分演算部１１１は、反転後ねじれ角度の絶対値｜（θＭ−θＬ）｜がオフセットねじれ角度τｆＬ＿ＦＦ／ＫＲから当該オフセットねじれ角度にガタ補償幅を加算した値（τｆＬ＿ＦＦ／ＫＲ＋２ＢＬ）の範囲内にある場合、一定の比例定数Ｋ（ねじれ角速度）を出力し、それ以外の範囲では“０”を出力する（図８のブロック１１１ａ、１１１ｂ参照）。
【００７０】
次に、モータ角速度フィードフォワード値演算部１１２は、モータ角速度のフィードフォワード値ωＭ＿ＦＦを演算する（図７、ステップＳ０４）。
具体的には、モータ角速度フィードフォワード値演算部１１２は、図６に示すように、負荷角速度指令値ωｒｅｆと、負荷角速度指令値ωｒｅｆの１回微分ｓ・ωｒｅｆ（負荷加速度指令値）と、負荷角速度指令値ωｒｅｆの２回微分ｓ２・ωｒｅｆと、負荷側摩擦トルクの時間微分特性のフィードフォワード値ｓ・τｆＬ＿ＦＦと、ガタ変位の時間微分特性のフィードフォワード値（ｄ／ｄｔ）・ＢＬＫＳとを入力する。
モータ角速度フィードフォワード値演算部１１２は、入力した各種値を、式（４）に代入し、モータ角速度フィードフォワード値ωＭ＿ＦＦを演算する。
【００７１】
次に、モータ側摩擦演算部１１３は、モータ側摩擦トルクのフィードフォワード値τｆＭ＿ＦＦを演算する（図７、ステップＳ０５）。
具体的には、モータ側摩擦演算部１１３は、図６に示すように、モータ角速度フィードフォワード値演算部１１２が出力するモータ角速度フィードフォワード値ωＭ＿ＦＦを入力する。そして、モータ側摩擦演算部１１３は、モータ角速度フィードフォワード値ωＭ＿ＦＦの速度反転時（ωＭ＿ＦＦ＝０）からの積分値（変位θ）をモータ側摩擦特性関数ＧＭ（図４（ｂ）参照）に代入し、変位θに応じたモータ側摩擦トルクのフィードフォワード値τｆＭ＿ＦＦを出力する。
【００７２】
次に、トルクフィードフォワード値演算部１１４は、トルクフィードフォワード値τＦＦを演算する（図７、ステップＳ０６）。
具体的には、トルクフィードフォワード値演算部１１４は、図６に示すように、負荷角速度指令値ωｒｅｆと、負荷角速度指令値ωｒｅｆの１回微分ｓ・ωｒｅｆ（負荷加速度指令値）と、負荷角速度指令値ωｒｅｆの２回微分ｓ２・ωｒｅｆと、負荷角速度指令値ωｒｅｆの３回微分ｓ３・ωｒｅｆと、負荷側摩擦トルクの時間微分特性のフィードフォワード値ｓ・τｆＬ＿ＦＦと、負荷側摩擦トルクのフィードフォワード値τｆＬ＿ＦＦと、ガタ変位の時間微分特性のフィードフォワード値（ｄ／ｄｔ）・ＢＬＫＳと、モータ側摩擦トルクのフィードフォワード値τｆＭ＿ＦＦと、を入力する。そして、トルクフィードフォワード値演算部１１４は、入力した各種値を、式（５）に代入し、トルクフィードフォワード値τＦＦを演算する。
【００７３】
（機械系の構造）
図９は、第１の実施形態に係る機械系の構造を示す図である。
本実施形態に係る機械系２は、図９に示すような工作機械２Ａである。
工作機械２Ａは、サーボモータ２０Ａと、テーブル２１Ａと、ボールねじ２２Ａとを備えている。
サーボモータ２０Ａは、モータ２０の一態様であって、内部に回転角度を検出する回転検出器を有し、精密な位置決めが可能なサーボモータである。
テーブル２１Ａは、負荷２１の一態様であって、工作対象物を乗せて動かすための台である。
ボールねじ２２Ａは、連結部材２２の一態様であって、ねじ部２２０Ａと、ナット部２２１Ａとを有している。ボールねじ２２Ａは、サーボモータ２０Ａの回動を直動に変換する駆動機構である。
サーボモータ２０Ａが回転すると、回転力がボールねじ２２Ａのねじ部２２０Ａに伝わり、ねじ部２２０Ａが回転する。回転支持ブラケット２２２Ａに支持されたねじ部２２０Ａが回転すると、ナット部２２１Ａがねじ部２２０Ａに沿い直線移動し、このナット部２２１Ａの直線移動に応じてテーブル２１Ａが直線移動する。これにより、サーボモータ２０Ａの回転運動がボールねじ２２Ａにより直線運動に変換される。
【００７４】
（作用・効果）
以上の通り、第１の実施形態に係る制御装置１は、モータ２０と負荷２１とを連結部材２２で連結してなる機械系２を模した２慣性系モデルに基づいて当該機械系２を制御する制御装置である。
制御装置１は、２慣性系モデルの逆モデル（式（４）、式（５））を用いて、負荷角度の指令値（負荷角度指令値θｒｅｆ）に応じた、モータ２０に対するフィードフォワード値（ωＭ＿ＦＦ、τＦＦ）を出力するフィードフォワード制御部１１を備えている。
そして、フィードフォワード制御部１１は、非線形の伝達特性を有するモータ２０の摩擦の伝達特性（モータ側摩擦特性関数ＧＭ）、負荷２１の摩擦の伝達特性（負荷側摩擦特性関数ＧＬ）、及び、連結部材２２のガタの伝達特性（不感帯特性関数Ｆ１）を含む２慣性系モデルの逆モデルを有する。
このようにすることで、モータ２０の摩擦の伝達特性、負荷２１の摩擦の伝達特性、及び、連結部材２２のガタの伝達特性をそのまま含む逆モデルに基づいてフィードフォワード制御を行うので、フィードフォワード値の精度を一層高めることができる。したがって、フィードフォワードの制御性能を高めることができる。
【００７５】
また、第１の実施形態に係る２慣性系モデルの逆モデルは、ガタ変位ＢＫＬＳの時間微分特性（（ｄ／ｄｔ）・ＢＫＬＳ）を含む。そして、フィードフォワード制御部１１は、ガタ変位の時間微分特性（（ｄ／ｄｔ）・ＢＫＬＳ）に基づいてモータ２０に対するフィードフォワード値（ωＭ＿ＦＦ、τＦＦ）を演算する。
このようにすることで、２慣性系モデルの逆モデルのうち、ガタの非線形特性（不感帯特性関数Ｆ１）に由来する成分をガタ変位の時間微分特性（（ｄ／ｄｔ）・ＢＫＬＳ）で補償することができる。
【００７６】
また、第１の実施形態に係る２慣性系モデルの逆モデルは、負荷２１の摩擦の時間微分特性（ｓ・τｆＬ）を含む。そして、フィードフォワード制御部１１は、負荷２１の摩擦の時間微分特性（ｓ・τｆＬ）に基づいてモータ２０に対するフィードフォワード値（ωＭ＿ＦＦ、τＦＦ）を演算する。
このようにすることで、２慣性系モデルの逆モデルのうち、負荷２１の摩擦の非線形特性（負荷側摩擦特性関数ＧＬ）に由来する成分を負荷２１の摩擦の時間微分特性（ｓ・τｆＬ）で補償することができる。
【００７７】
また、第１の実施形態に係るフィードフォワード制御部は、２慣性系モデルの逆モデルを用いて、負荷角度指令値θｒｅｆに応じたモータ角速度フィードフォワード値ωＭ＿ＦＦ、及び、トルクフィードフォワード値τＦＦを出力する。
このようにすることで、フィードバック制御部１０の出力であるモータ角速度フィードバック値ωＭ＿ＦＢと、トルクフィードバック値τＦＢとのそれぞれに対し、フィードフォワード値を補償することができる。
【００７８】
（変形例）
以上、第１の実施形態に係る制御装置１及び駆動システム９について詳細に説明したが、制御装置１及び駆動システム９の具体的な態様は、上述のものに限定されることはなく、要旨を逸脱しない範囲内において種々の設計変更等を加えることは可能である。
【００７９】
例えば、第１の実施形態に係るフィードフォワード制御部１１は、非線形の伝達特性を有するモータ２０の摩擦の伝達特性（モータ側摩擦特性関数ＧＭ）、負荷２１の摩擦の伝達特性（負荷側摩擦特性関数ＧＬ）、及び、連結部材２２のガタの伝達特性（不感帯特性関数Ｆ１）の全てを含む２慣性系モデルの逆モデルを有するものとして説明した。しかし、他の実施形態においてはこの態様に限定されない。
即ち、他の実施形態においては、フィードフォワード制御部１１は、非線形の伝達特性を有するモータ２０の摩擦の伝達特性、負荷２１の摩擦の伝達特性、及び、連結部材２２のガタの伝達特性のうち少なくとも何れか一つを含む２慣性系モデルの逆モデルを有するものとしてもよい。
このようにしても、フィードフォワード制御部１１は、何れかの非線形の伝達特性が考慮された逆モデルに基づいて、モータ２０に対するフィードフォワード値を算出するので、精度の高いフィードフォワード値を算出することができる。
【００８０】
また、第１の実施形態に係る連結部材２２のガタの伝達特性は、図４（ａ）、（ｂ）に示すような、傾きが不連続な折れ線によって規定されているが、他の実施形態においてはこの態様に限定されない。
例えば、他の実施形態に係る連結部材２２のガタの伝達特性は、図４（ａ）、（ｂ）に示す折れ線に準じるものであって、かつ、傾きが連続的に変化する曲線によって規定されているものであってもよい。
この場合、図８のブロック１１１ａに示す、ガタ変位のねじれ角度についての微分特性（（ｄ／ｄ（θＭ−θＬ））・ＢＫＬＳ）も、傾きが連続的に変化する曲線となる。
【００８１】
また、第１の実施形態に係るガタ微分演算部１１１は、機械系２からモータ角速度ωＭ及び負荷角速度ωＬを入力し、速度反転時（ωＭ＝０）からのねじれ角速度（ωＭ−ωＬ）の積分値によって特定するものとして説明したが、他の実施形態においてはこの態様に限定されない。
例えば、他の実施形態に係るガタ微分演算部１１１は、モータ角度θＭ及び負荷角度θＬを入力し、ねじれ角度（θＭ−θＬ）を直接特定してもよい。ただし、この場合は、モータ２０側で検出されるモータ角度θＭと、負荷２１側で検出される負荷角度θＬとの間にオフセット誤差が生じないようにするのが好ましい。
【００８２】
また、第１の実施形態に係るガタ微分演算部１１１は、ガタ移動中のねじれ角速度（ωＭ−ωＬ）を一定（所定の比例定数Ｋ）とみなすものとしたが、他の実施形態においてはこの態様に限定されない。
例えば、他の実施形態に係るガタ微分演算部１１１は、ねじれ角速度（ωＭ−ωＬ）を機械系２から入力されるモータ角速度ωＭ及び負荷角速度ωＬを用いて算出してもよい。
【００８３】
また、第１の実施形態に係るフィードフォワード制御部１１は、フィードバック制御部１０の比例制御部１０ａが出力するモータ角度フィードバック値ωＭ＿ＦＢを補償するためのモータ角度フィードフォワード値ωＭ＿ＦＦを出力するものとして説明した。また、第１の実施形態に係るフィードフォワード制御部１１は、フィードバック制御部１０の比例積分制御部１０ｂが出力するトルクフィードバック値τＦＢを補償するためのトルクフィードフォワード値τＦＦを出力するものとして説明した。しかし、他の実施形態においてはこの態様に限定されない。
例えば、他の実施形態に係るフィードフォワード制御部１１は、トルクフィードフォワード値τＦＦに相当するＰＩ制御前のモータ角速度成分をモータ角速度フィードフォワード値ωＭ＿ＦＦに上乗せし、モータ角速度フィードフォワード値ωＭ＿ＦＦのみを出力してもよい。
【００８４】
また、第１の実施形態に係る工作機械２Ａ（図９）は、連結部材２２として、ボールねじ２２Ａのみを有するものとして説明したが、他の実施形態においてはこの態様に限定されない。
即ち、他の実施形態に係る工作機械２Ａは、連結部材２２として、ボールねじ２２Ａに加え歯車を具備する態様であってもよい。この場合、連結部材２２に係るパラメータ（ねじれ剛性係数ＫＲ、ねじれ粘性係数ＤＲ、不感帯幅ＢＬ等）は、ボールねじ２２Ａ及び歯車を一体の連結部材２２とみなして各パラメータを同定してもよい。
【００８５】
＜第２の実施形態＞
次に、第２の実施形態に係る駆動システムについて、図１０を参照しながら詳細に説明する。
【００８６】
図１０は、第２の実施形態に係る機械系の構造を示す図である。
第２の実施形態に係る機械系２は、図１０に示すような段ボールカッター２Ｂである。
段ボールカッター２Ｂは、サーボモータ２０Ｂと、回転刃２１Ｂと、歯車２２Ｂとを備えている。
サーボモータ２０Ｂは、モータ２０の一態様であって、第１の実施形態と同様のサーボモータである。
回転刃２１Ｂは、負荷２１の一態様であって、段ボールＰの送出に合わせて回転することで段ボールＰを送出方向に対し垂直にカットする機構である。
歯車２２Ｂは、連結部材２２の一態様であって、サーボモータ２０Ｂの回転動力を回転刃２１Ｂに伝達する。
【００８７】
＜第３の実施形態＞
次に、第３の実施形態に係る駆動システムについて、図１１を参照しながら詳細に説明する。
【００８８】
図１１は、第３の実施形態に係る機械系の構造を示す図である。
第３の実施形態に係る機械系２は、図１１に示すような射出成型機２Ｃである。
射出成型機２Ｃは、サーボモータ２０Ｃと、射出成型機構２１Ｃと、ボールねじ２２Ｃとを備えている。
【００８９】
サーボモータ２０Ｃは、モータ２０の一態様であって、第１、第２の実施形態と同様のサーボモータである。２つのサーボモータ２０Ｃは、各々に対応する制御装置１からトルク指令値を受け付ける。サーボモータ２０Ｃは、ボールねじ２２Ｃを通じて、樹脂材料２１２Ｃ（成型材料）を圧力的に移送する射出スクリュー２１０Ｃを駆動する。
【００９０】
射出成型機構２１Ｃは、負荷２１の一態様であって、樹脂材料を金型に射出する機構である。射出成型機構２１Ｃは、射出スクリュー２１０Ｃを通じて樹脂材料２１２Ｃを射出して金型２１４Ｃの成型空間２１５Ｃに注入する。
具体的には、射出スクリュー２１０Ｃは、射出シリンダ２１１Ｃに挿入され、射出スクリュー２１０Ｃと射出シリンダ２１１Ｃとの間には、樹脂材料２１２Ｃが充填されている。樹脂材料２１２Ｃは、ノズル２１３Ｃを介して金型２１４Ｃに供給される。金型２１４Ｃの内部には成型空間２１５Ｃが設けられ、樹脂材料２１２Ｃは成型空間２１５Ｃに射出されて所望の形状に成型される。
【００９１】
ボールねじ２２Ｃは、連結部材２２の一態様であって、ねじ部２２０Ｃと、ナット部２２１Ｃとを有している。
サーボモータ２０Ｃがボールねじ軸を回転すると、ナット部２２１Ｃが直線運動をし、サーボモータ２０Ｃが生成する回転駆動力は、ボールねじにより直線運動の駆動力に変換される。その直線運動の駆動力は、射出スクリュー２１０Ｃに伝達され、射出スクリュー２１０Ｃと射出シリンダ２１１Ｃとの間に充填される樹脂材料２１２Ｃが金型２１４Ｃに射出される。
【００９２】
＜第４の実施形態＞
次に、第４の実施形態に係る駆動システムについて、図１２を参照しながら詳細に説明する。
【００９３】
図１２は、第４の実施形態に係る機械系の構造を示す図である。
第４の実施形態に係る機械系２は、図１２に示すようなロボットアーム２Ｄ（マニピュレータ）である。
ロボットアーム２Ｄは、サーボモータ２０Ｄと、アーム部２１Ｄと、歯車２２Ｄとを備えている。
サーボモータ２０Ｄは、モータ２０の一態様であって、第１〜第３の実施形態と同様のサーボモータである。
アーム部２１Ｄは、負荷２１の一態様であって、操作者の操作に応じて所望にグリップ動作等を行う。
歯車２２Ｄは、連結部材２２の一態様であって、サーボモータ２０Ｄの回転動力をアーム部２１Ｄに伝達する。
【００９４】
上述の各実施形態においては、制御装置１の機能を実現するためのプログラムをコンピュータ読み取り可能な記録媒体に記録して、この記録媒体に記録されたプログラムをコンピュータシステムに読み込ませ、実行することにより各手順を行うものとしている。ここで、上述した制御装置１の各処理の過程は、プログラムの形式でコンピュータ読み取り可能な記録媒体に記憶されており、このプログラムをコンピュータが読み出して実行することによって上記各種処理が行われる。ここで、コンピュータ読み取り可能な記録媒体とは、磁気ディスク、光磁気ディスク、ＣＤ−ＲＯＭ、ＤＶＤ−ＲＯＭ、半導体メモリ等をいう。また、このコンピュータプログラムを通信回線によってコンピュータに配信し、この配信を受けたコンピュータが当該プログラムを実行するようにしても良い。
また、制御装置１の機能が、ネットワークで接続される複数の装置に渡って具備される態様であってもよい。
【００９５】
以上、本発明のいくつかの実施形態を説明したが、これらの実施形態は、例として示したものであり、発明の範囲を限定することは意図していない。これら実施形態は、その他の様々な形態で実施されることが可能であり、発明の要旨を逸脱しない範囲で種々の省略、置き換え、変更を行うことができる。これら実施形態やその変形は、発明の範囲や要旨に含まれると同様に、特許請求の範囲に記載された発明とその均等の範囲に含まれるものとする。
【符号の説明】
【００９６】
１  制御装置
１０  フィードバック制御部
１０ａ  比例制御部
１０ｂ  比例積分制御部
１１  フィードフォワード制御部
１１０  負荷側摩擦演算部
１１１  ガタ微分演算部
１１２  モータ角速度フィードフォワード値演算部
１１３  モータ側摩擦演算部
１１４  トルクフィードフォワード値演算部
２  機械系
２０  モータ
２１  負荷
２２  連結部材
２Ａ  工作機械
２０Ａ  サーボモータ
２１Ａ  テーブル
２２Ａ  ボールねじ
２２０Ａ  ねじ部
２２１Ａ  ナット部
２Ｂ  段ボールカッター
２０Ｂ  サーボモータ
２１Ｂ  回転刃
２２Ｂ  歯車
Ｐ  段ボール
２Ｃ  射出成型機
２０Ｃ  サーボモータ
２１Ｃ  射出成型機構
２１０Ｃ  射出スクリュー
２１１Ｃ  射出シリンダ
２１２Ｃ  樹脂材料
２１３Ｃ  ノズル
２１４Ｃ  金型
２１５Ｃ  成型空間
２２Ｃ  ボールねじ
２２０Ｃ  ねじ部
２２１Ｃ  ナット部
２Ｄ  ロボットアーム
２０Ｄ  サーボモータ
２１Ｄ  アーム部
２２Ｄ  歯車
９  駆動システム
９ａ  上位装置
θｒｅｆ  負荷角度指令値
ωｒｅｆ  負荷角速度指令値
τ、τ’  トルク
τＦＦ  トルクフィードフォワード値
τＦＢ  トルクフィードバック値
θＭ  モータ角度
ωＭ  モータ角速度
ωＭ＿ＦＦ  モータ角速度フィードフォワード値
ωＭ＿ＦＢ  モータ角速度フィードバック値
ＪＭ  モータ側慣性モーメント
ＤＭ  モータ側粘性係数
τｆＭ  モータ側摩擦トルク
τｆＭｃ  モータ側クーロン摩擦値
θＬ  負荷角度
ωＬ  負荷角速度
ＪＬ  負荷側慣性モーメント
ＤＬ  負荷側粘性係数
τｆＬ  負荷側摩擦トルク
τｆＬｃ  負荷側クーロン摩擦値
ＫＲ  ねじれ剛性係数
ＤＲ  ねじれ粘性係数
ＢＬ  不感帯幅
Ｆ１  不感帯特性関数
Ｆ１’  ガタ変位関数
ＧＭ  モータ側摩擦特性関数
ＧＬ  負荷側摩擦特性関数
【図１】
2018055603.tif 000010
【図２】
2018055603.tif 000011
【図３】
2018055603.tif 000012
【図４】
2018055603.tif 000013
【図５】
2018055603.tif 000014
【図６】
2018055603.tif 000015
【図７】
2018055603.tif 000016
【図８】
2018055603.tif 000017
【図９】
2018055603.tif 000018
【図１０】
2018055603.tif 000019
【図１１】
2018055603.tif 000020
【図１２】
2018055603.tif 000021