JP6020537B2 - モータ制御装置及びモータ制御方法 - Google Patents

Description

開示の実施形態は、モータ制御装置及びモータ制御方法に関する。

特許文献１には、位置偏差を零に近づけるために、位置制御器で比例制御（Ｐ制御）を、速度制御器で比例積分制御（ＰＩ制御ないしＩ−Ｐ制御）をそれぞれ行い、加えて速度フィードフォワード制御も行うサーボ制御装置が開示されている。

ＷＯ２００６／０１１５１９号公報

しかし、このように位置制御器と速度制御器のいずれか一方だけに積分制御（Ｉ制御）を行う場合には、少なくともモータの加減速制御時（もしくはモータ速度定常時も含めて）に位置偏差が大きく残ってしまう。このため、上記のモータ制御は、位置偏差低減の観点で改善する余地があった。

本発明はこのような問題点に鑑みてなされたものであり、位置偏差の低減が可能なモータ制御装置及びモータ制御方法を提供することを目的とする。

上記課題を解決するため、本発明の一の観点によれば、モータを制御するためのモータ制御装置であって、位置指令とモータ位置の位置偏差に基づいて速度指令を生成するように構成された位置制御部と、前記速度指令とモータ速度の速度偏差に基づいて前記モータに入力するトルク指令を生成するように構成された速度制御部と、前記位置偏差に加算するための当該位置偏差の積分値を不完全積分で算出するように構成された第１積分部と、前記速度偏差に加算するための当該速度偏差の積分値を完全積分で算出するように構成された第２積分部と、を備えるモータ制御装置が適用される。

また、本発明の別の観点によれば、モータを制御するためのモータ制御方法であって、位置指令とモータ位置の位置偏差に基づいて速度指令を生成することと、前記速度指令とモータ速度の速度偏差に基づいて前記モータに入力するトルク指令を生成することと、前記位置偏差に加算するための当該位置偏差の積分値を不完全積分で算出することと、前記速度偏差に加算するための当該速度偏差の積分値を完全積分で算出することと、を実行するモータ制御方法が適用される。

また、本発明の別の観点によれば、モータを制御するためのモータ制御装置であって、
位置指令とモータ位置の位置偏差に基づいて速度指令を生成するように構成された位置制御部と、前記速度指令とモータ速度の速度偏差に基づいて前記モータに入力するトルク指令を生成するように構成された速度制御部と、前記位置偏差に加算するための当該位置偏差の積分値を算出する手段と、前記速度制御部は、前記速度偏差に加算するための当該速度偏差の積分値を算出する手段と、前記位置指令の一階微分値に速度フィードフォワードゲインを乗算して速度フィードフォワード指令を生成し、これを前記速度指令に加算する手段と、を備えるモータ制御装置が適用される。

また、本発明の別の観点によれば、モータを制御するためのモータ制御装置であって、位置指令とモータ位置の位置偏差に基づいて速度指令を生成するように構成された位置制御部と、前記速度指令とモータ速度の速度偏差に基づいて前記モータに入力するトルク指令を生成するように構成された速度制御部と、前記位置偏差に加算するための当該位置偏差の積分値を算出するように構成された第１積分部と、前記速度偏差に加算するための当該速度偏差の積分値を算出するように構成された第２積分部と、を備えており、前記第１積分部は、前記位置偏差の積分値に不完全積分ゲインを乗算して当該第１積分部の入力に負帰還するように構成された不完全積分部であるモータ制御装置が適用される。

また、本発明の別の観点によれば、モータを制御するためのモータ制御方法であって、位置指令とモータ位置の位置偏差に基づいて速度指令を生成するステップと、前記速度指令とモータ速度の速度偏差に基づいて前記モータに入力するトルク指令を生成するステップと、前記位置偏差に加算するための当該位置偏差の積分値を算出するステップと、前記速度偏差に加算するための当該速度偏差の積分値を算出するステップと、を実行するモータ制御方法が適用される。

また、本発明の別の観点によれば、前記位置偏差の積分値を当該位置偏差に加算するステップでは、前記位置偏差の積分値に不完全積分ゲインを乗算して当該積分値を生成する前の前記位置偏差の入力に負帰還するモータ制御方法が適用される。

また、本発明の別の観点によれば、前記速度指令を生成するステップでは、前記位置偏差の積分値を当該位置偏差に加算した後に位置制御ゲインを乗算して前記速度指令を生成し、前記トルク指令を生成するステップでは、前記速度偏差の積分値を当該速度偏差に加算した後に速度制御ゲインを乗算して前記トルク指令を生成するモータ制御方法が適用される。

また、本発明の別の観点によれば、前記位置制御ゲインと前記速度制御ゲインは略比例関係となり、前記位置偏差を積分する際の第１時定数は前記位置制御ゲインと略反比例関係となり、前記速度偏差を積分する際の第２時定数は前記速度制御ゲインと略反比例関係となるよう設定されているモータ制御方法が適用される。

また、本発明の別の観点によれば、前記位置指令の二階微分値に前記モータの制御対象の総慣性モーメントを乗算した値に対し、前記位置指令の一階微分値に前記制御対象の粘性摩擦補償係数を乗算した値を加算してトルクフィードフォワード指令を生成し、これを前記トルク指令に加算するステップを実行するモータ制御方法が適用される。

本発明によれば、位置偏差を低減できる。

実施形態のモータ制御装置全体のシステム構成を表すブロック図である。 各種制御構成に対応した偏差比較図である。 二重積分構成でのステップ応答を示す図である。 二重積分構成でのボード線図である。 図３、図４のシミュレーションにあたって比較例と実施形態の各構成に対応して設定したパラメータ値を示す図である。 位置積分部によるオーバーシュートを説明する図である。 位置積分部に不完全積分を適用した場合のステップ応答を示す図である。 位置積分部に不完全積分を適用した場合のボード線図である。 粘性摩擦分を考慮したトルク線図である。 速度制御ゲインに２π×４０を代入した場合のゲイン安定性を示す係数図である。 速度制御ゲインに２π×２００を代入した場合のゲイン安定性を示す係数図である。 本実施形態の応答シミュレーションに適用した制御対象のボード線図である。 比較例の出力位置のシミュレーション結果を示す図である。 本実施形態の出力位置のシミュレーション結果を示す図である。 比較例の出力速度のシミュレーション結果を示す図である。 本実施形態の出力速度のシミュレーション結果を示す図である。 比較例の位置偏差のシミュレーション結果を示す図である。 本実施形態の位置偏差のシミュレーション結果を示す図である。 比較例のトルク指令のシミュレーション結果を示す図である。 本実施形態のトルク指令のシミュレーション結果を示す図である。 図１３〜図２０のシミュレーションにあたって比較例と実施形態の各構成に対応して設定したパラメータ値を示す図である。

以下、一実施の形態について図面を参照しつつ説明する。

＜モータ制御装置の概略構成＞
まず、図１を用いて、本実施形態に係るモータ制御装置の概略的な構成について説明する。図１に示すように、モータ制御装置１００は、特に図示しない上位制御装置から入力される位置指令に基づいて、モータＭの回転位置（回転角度；図中ではモータ位置と記載）を制御する。なお、ここでは各部位間の関係のみを概略的に説明するものとし、各部位の内部構成についてはそれぞれ後に詳述する。また、以下における図示及び説明は全て伝達関数形式での説明とする。図１において、本実施形態のモータ制御装置１００は、位置制御部１と、速度制御部２と、速度フィードフォワード制御部４と、トルクフィードフォワード制御部５とを有している。

位置制御部１は、入力された上記位置指令と、後述のモータＭの回転位置との差である位置偏差（上記図１中のＡ参照）に基づき、この位置偏差を少なくするように速度指令（上記図１中のＢ参照）を出力する。そして本実施形態では、この位置制御部１が、上記位置偏差に加算するための当該位置偏差の積分値を算出するように構成された位置積分部１１（第１積分部、不完全積分部）と、この位置積分部１１の出力に位置偏差を加算した後に乗算する位置制御ゲインＫｐとを備えたいわゆるＰＩ制御を行うよう構成されている。

速度制御部２は、上記位置制御部１からの速度指令と、後述のモータＭの回転速度（図中ではモータ速度と記載）との差である速度偏差（上記図１中のＣ参照）に基づき、この速度偏差を少なくするようにトルク指令（上記図１中のＥ参照）を出力する。そして本実施形態では、この速度制御部２が、上記速度偏差に加算するための当該速度偏差の積分値を算出するように構成された速度積分部１２（第２積分部）と、この速度積分部１２の出力に速度偏差を加算した後に乗算する速度制御ゲインＫｖ（及び総慣性モーメントＪｏ）とを備えたいわゆるＰＩ制御を行うよう構成されている。

速度フィードフォワード制御部４は、上記位置指令に基づいて上記位置偏差を少なくするための速度フィードフォワード指令を生成し、これを上記速度指令に加算する。

トルクフィードフォワード制御部５は、上記位置指令に基づいて上記位置偏差を少なくするためのトルクフィードフォワード指令を生成し、これを上記トルク指令に加算する。

モータＭは、トルク指令に対応した駆動電流によりトルクを発生し、特に図示しない負荷機械を駆動する。

以上の構成の本実施形態のモータ制御装置１００は、位置制御系のフィードバックループと、速度制御系のフィードバックループの２重ループ構成となっている。つまり、図示しない上位制御装置から位置指令が入力されてから、位置制御部１、速度制御部２、モータＭの順で制御信号が伝達されて、モータ位置の検出信号をフィードバックする位置制御系のフィードバックループ（以下、位置制御系ループという）を備えている。また、速度制御部２、モータＭの順で制御信号が伝達されて、モータ速度の検出信号をフィードバックする速度制御系のフィードバックループ（以下、速度制御系ループという）も備えている。なお本実施形態では、トルク指令に基づいて例えばＰＷＭ制御による駆動電流をモータＭに出力する電流制御部とその内部に備えられる電流制御系のフィードバックループについては説明を簡略化するために省略している。

＜本実施形態の特徴＞
近年では、上述したような位置制御系ループを備えるモータ制御装置１００の応答性能を向上させるために、位置指令とモータ位置の位置偏差を常時できるだけ０に抑える偏差レス制御の実現が要望されている。ここで位置偏差について詳細に説明すると、図２の最上方に示すタイムチャートのように、経時的に変化する位置指令速度（位置指令を一階時間微分した速度相当値）に対して実際に出力されるモータ差分位置（制御サンプリング周期毎のモータ位置変化量で検出される速度相当値）との差が位置偏差であり、そのうちモータ速度が一定速度である定常域における位置偏差を定常偏差といい、モータ速度が加減速している間の加減速域における位置偏差を加減速時偏差という。

一般的には、上記２重フィードバックループの構成において、位置制御部１と速度制御部２のいずれか一方に比例器（Ｐ）や積分器（Ｉ）を設けていわゆるＰＩ制御（もしくはＩ−Ｐ制御）を行わせたり、さらに速度フィードフォワード制御を併用することで偏差レス制御に近づける手法がある。

例えば、図示する構成例１のように、位置制御部１に比例器を備え、速度制御部２に比例器と積分器を備えたいわゆる位置Ｐ−速度ＰＩ制御を行わせる手法がある。この場合には、速度偏差を０に近づけることはできても、位置偏差に対しては加減速時偏差及び定常偏差のいずれも大きく生じさせてしまう。

また例えば、図示する構成例２のように、位置制御部１に比例器と積分器を備え、速度制御部２に比例器を備えたいわゆる位置ＰＩ−速度Ｐ制御を行わせる手法がある。この場合には、定常偏差を０に近づけることはできても、加減速時偏差をまだ大きく残してしまう。

また例えば、図示する構成例３のように、位置制御部１に比例器を備え、速度制御部２に比例器と積分器を備えたいわゆる位置Ｐ−速度ＰＩ制御を行わせ、さらに速度フィードフォワードゲインＶｆｆを１（＝１００％）とした速度フィードフォワード制御も併せて行わせる手法がある。この場合には、近似的には構成例２のような偏差になるが、外乱の影響で偏差が大きくなりやすい。

以上のような位置偏差の発生を低減させるために、本実施形態では、位置制御部１と速度制御部２の両方で積分部を備えたいわゆる二重積分の構成としていることを特徴としている。また、特にモータ動作の終了時における振動を抑制するために、位置制御部１が備える積分器を不完全積分部で構成している。また、二重積分とした場合の振動の発生を抑制するための各ゲインのバランス調整についても検討している。また、さらなる位置偏差の低減を実現するためにモータＭの粘性摩擦を考慮したトルクフィードフォワード制御も行う。これら本実施形態の特徴とその実現構成について、以下に順に説明する。

＜二重積分についての解析的検討＞
ここで、上記構成例３のように位置Ｐ−速度ＰＩ制御の場合には、定常偏差（ＰｏｓＥｒｒ）は公知の最終値の定理より次式（１）で記述することができる。

この式（１）より、速度フィードフォワード係数Ｖｆｆ＝１００％とすれば、位置偏差は０に漸近する。しかし、あくまでも「漸近」であり、厳密に０とはならない。

最も簡易な２重ループの構成で位置偏差を厳密に０にするためには位置制御系ループに位置積分部１１を導入すればよい。たとえば、上記構成例２のような位置ＰＩ−速度Ｐ制御の構成においては、位置指令から位置偏差までの伝達関数は次式（２）となる。

入力する位置指令としてランプ指令を仮定し、最終値の定理を適用すると次のようになる。

この式（３）よりわかるように位置制御系ループに位置積分部１１をＰＩ制御の形で導入することで、定常偏差を厳密に０にすることができる。

次に、過渡状態における最大位置偏差を検討する。図３のＬ１およびＬ２の各線は、位置ＰＩ−速度Ｐ制御の２重ループ構成とした比較例（上記構成例２に相当）に対してステップ状の位置指令を入力した場合の位置偏差をプロットした波形である。その際の各線に対応するゲイン設定値は図５に示す。

上記の式（２）よりわかるように位置制御系ループにＰＩ制御部を持つ場合、位置指令から位置偏差までの伝達関数にはゼロ点が存在するためオーバーシュートしやすい特性を持つ。実際、図３のＬ１およびＬ２の各線でもオーバーシュートが観測できる。しかし、機械制御の観点ではオーバーシュート量は極力低減させることが望ましい。

これに対し本実施形態では、オーバーシュートの低減手段の１つとして、さらに速度制御系ループにも速度積分部１２を導入している。つまり本実施形態では、位置制御系ループと速度制御系ループの二重積分とし、速度積分部１２の応答周波数を位置積分部１１の応答周波数よりも十分に高くすることで、位置偏差よりも速度偏差を大きくできる。

本実施形態と同様の位置ＰＩ−速度ＰＩ制御の２重ループ構成に対してステップ状の位置指令を入力した場合の位置偏差を図３のＬ３とＬ４の各線に示す。その際の各線に対応するゲイン設定値は図５に示す。図３より速度積分部１２が追加されたほうが、若干とはいえオーバーシュートが低減していることがわかる。

図４に図３の条件における位置指令から位置偏差までのボード線図を示す。Ｌ１〜Ｌ４の各線は図３のものに対応する。図４より速度積分を追加することでＫｖ＝４０Ｈｚにおいては１０〜３０Ｈｚの位相が、Ｋｖ＝２００Ｈｚにおいては６０〜２００Ｈｚの位相が進んでおり、この特性がオーバーシュート低減に寄与している。

以上の検討を踏まえ、本実施形態のモータ制御装置１００においては、位置制御部１が備える位置積分部１１は時定数Ｔｐｉを有する積分器（１／Ｔｐｉ・ｓ）で位置偏差の積分値を求め、これを当該位置偏差に加算するよう構成されている。また、速度制御部２が備える速度積分部１２は、時定数Ｔｉを有する積分器（１／Ｔｉ・ｓ）で速度偏差の積分値を求め、これを当該速度偏差に加算するよう構成されている。なお、位置積分部１１の時定数Ｔｐｉが各請求項記載の第１時定数に相当し、速度積分部１２の時定数Ｔｉが各請求項記載の第２時定数に相当する。

＜位置制御器における不完全積分の適用について＞
また、さらなるオーバーシュートの低減手段も検討する。前述のとおり、オーバーシュートの原因は位置制御系ループにゼロ点を持つ積分器を追加したことが原因である。逆に言えば、ゼロ点の原因である積分器をなくせばオーバーシュートは発生しないといえる。具体的には、位置制御部１に積分制御を行わせた場合で、図６に示すように、位置指令の入力終了時、特にモータＭの減速を終了して停止させる際に、モータ位置が指令停止位置よりオーバーシュートして振動しやすくなり、この振動中に位置偏差が発生してしまう。これは、積分部自体の応答が遅いためであり、その入力値が０となった後もしばらくは積分部に出力値が残存してしまうためである。

以上の点を踏まえて、本実施形態では、位置積分部１１が不完全積分機能を備えている。不完全積分とは、積分部の出力に係数を乗算して当該積分部の入力に負帰還することで、結果的に出力される積分値を徐々に減少させる手法のことである。具体的に本実施形態では、位置積分部１１が備える積分器（１／Ｔｐｉ・ｓ）の出力（位置偏差の積分値）に不完全積分ゲインＤｐを乗算して当該積分器の入力に負帰還させた不完全積分部として構成している（上記図１参照）。

図７のＬ５およびＬ６の各線は、本実施形態と同等の位置ＰＩ−速度ＰＩ制御における位置積分部１１に対して不完全積分率９０％を設定した場合に、ステップ状の位置指令を入力した場合の位置偏差をプロットした波形である。不完全積分ゲインＤｐ以外のゲイン設定値は図５のＬ３及びＬ４と同一である。また、図７のＬ３およびＬ４の各線は、図３のＬ３およびＬ４の各線と対応している。なお、不完全積分率９０％とは、積分器からの出力の９０％を積分値から引くということを意味している。図７よりわかるように不完全積分によって位置偏差低減中の減衰曲線はほぼ同じであるが、オーバーシュートは低減している。

図８に図７の条件における位置指令から位置偏差までのボード線図を示す。各線は図７と同じである。図８より不完全積分を追加することで低周波帯域のゲインおよび位相に変化が現れており、周波数が低下するほど位置積分の効果がなくなっていることがわかる。

＜フィードフォワード制御について＞
本実施形態におけるフィードフォワード制御としては、単純に位置指令の１階微分値に基づく速度フィードフォワード制御と２階微分値に基づくトルク（加速度）フィードフォワード制御を行う。まず、速度フィードフォワード制御については、上記図１に示すように、位置指令を１階微分した速度相当値にフィードフォワードゲインＶｆｆを乗じて速度指令に加算する構成のままとしている。

次にトルクフィードフォワード制御については、基本的には位置指令を２階微分したトルク相当値に総慣性モーメントＪｏとトルクフィードフォワードゲインＴｆｆを乗じてトルク指令に加算する。なお、特に図示しないが、機械的なガタや静止摩擦の影響を低減するために、正転方向と逆転方向でトルクフィードフォワードゲインＴｆｆを個別に設定できるようにしたほうが望ましい。

また本実施形態では、粘性摩擦の影響を低減するために、上記図１に示すように、位置指令に基づく速度相当値（１階微分値）に粘性摩擦補償係数Ｄｃｏｍｐを乗じてトルクフィードフォワード指令に加算している。これは、上述したように、比例器の比例制御によって低減できずに積分器の積分制御によって低減させる位置偏差の成分が、主に制御対象であるモータＭ固有の粘性摩擦などによる外乱トルクの影響が大きいことに対する対策である。例えば図９に示すように、実際にモータ位置を位置指令に追従させるためには、位置指令に基づくトルク指令よりも常に粘性摩擦を起因とした外乱トルク分だけ高いトルク指令を入力すべきである。この粘性摩擦分の外乱トルクは、モータ速度に当該モータＭ固有の粘性摩擦係数Ｄを乗算した値と同等である。

そこで本実施形態では、トルクフィードフォワード制御部５が、位置指令を二階微分したトルク相当値にモータＭの総慣性モーメントＪ_０を乗算した値に対し、位置指令を一階微分値した速度相当値にモータＭの粘性摩擦補償係数Ｄｃｏｍｐを乗算した値（上記の外乱トルク分に相当）を加算し、さらにこれにトルクフィードフォワードゲインＴｆｆを乗算してトルクフィードフォワード指令を生成し、これをトルク指令に加算するトルクフィードフォワード制御を行う。

＜ゲインバランスについて＞
次に図１に示した本実施形態のモータ制御装置１００におけるフィードバックゲインのゲインバランスについて検討し、検討したゲイン設定値に対する安定性を確認する。ゲインバランスの基本的な考え方は、速度ループゲインを基準とした２次系の減衰係数が１になるように定式化する。ただし、時定数Ｔｉのみは、速度積分部１２の導入経緯からできるだけ小さくなるように減衰係数が０．７程度になるようにする。

具体的には、次式（４）〜（６）とする。

次に上式に対する図１の制御ブロックの安定性を検討する。図１において簡単のため、モータＭが有する粘性摩擦係数Ｄ＝Ｄｃｏｍｐ＝０、モータＭの回転軸を含めた回転子モーメントＪ＝総慣性モーメントＪｏ＝１とした場合に、位置指令からモータ位置までの伝達関数は次式（７）のようになる。

ただし、

とする。

上記の式（４）〜式（６）に対してＫｖ＝２π×４０を代入した場合の式（７）の係数図を図１０に示す。また、Ｋｖ＝２π×２００を代入した場合の係数図を図１１に示す。このとき、不完全積分ゲインＤｐ＝１０％とした。これら図１０および図１１より、公知のＬｉｐａｔｏｖの安定判別を適用するといずれも安定十分条件を満足していることがわかる。なお、位置制御ゲインＫｐと速度制御ゲインＫｖが略比例する関係と、位置積分部１１の時定数Ｔｐｉが位置制御ゲインＫｐと略反比例する関係と、速度積分部１２の時定数Ｔｉが速度制御ゲインＫｖと略反比例する関係を同時に満たすよう各パラメータを設定するだけでも、オーバーシュートの低減効果を得ることができる。

＜シミュレーションによる効果確認＞
ここで、本実施形態のモータ制御装置１００による応答をシミュレーションにより確認する。また、比較のために上記構成例３の位置Ｐ−速度ＰＩ制御＋速度フィードフォワード制御（Ｖｆｆ＝１００％）の場合のシミュレーション結果も示す。なお、このシミュレーションで使用した制御対象モデルの周波数特性を図１２に示す。この図１２に示す周波数特性の制御対象モデルに対して構成例３を適用した場合の応答を図１３、図１５、図１７、図１９に示し、本実施形態のモータ制御装置１００を適用した場合の応答を図１４、図１６、図１８、図２０に示す。なお、図１３及び図１４は位置指令とモータ位置を示し、図１５及び図１６は速度指令値とモータ速度を示し、図１７及び図１８は位置偏差を示し、図１９及び図２０はトルク指令を示している。また、各構成に適用したパラメータを図２１に示す。

図１７と比較して図１８は最大位置偏差が低減していることがわかる。また、図１７と同様に図１８でも、位置指令の払い出し完了時点（位置指令の入力終了時）で位置偏差のオーバーシュートがなくなっている。このことから、目標とした性能を得ることができていると判断できる。

＜本実施形態の効果＞
以上説明した実施形態によれば、次のような効果を得る。すなわち、本実施形態のモータ制御装置１００では、位置制御部１に積分器としての位置積分部１１を備え、速度制御部２に積分器としての速度積分部１２を備え、つまり位置制御部１と速度制御部２の両方にそれぞれ積分部を備えている。このように２重フィードバックループの位置制御部１と速度制御部２の両方で２重の積分制御を行わせることで、外乱トルク等の影響があっても速度偏差とともに位置偏差を高い精度で０に近づけることができる。この結果、位置偏差の低減が可能なモータ制御装置１００を実現できる。特に本実施形態では、フィードバック系に重きをおいた制御系の構成となっているため、機械の経年変化や個体差の影響を受けにくいという利点がある。

また、本実施形態では特に、位置制御部１が備える位置積分部１１が、位置偏差の積分値に不完全積分ゲインＤｃｏｍｐ（＜１）を乗算して当該位置積分部１１の入力に負帰還するように構成された不完全積分部としている。これにより、位置指令の入力が終了して上記入力値（この場合は位置偏差）が一旦０に近づいた後には、不完全積分部の出力値が時間経過とともに自発的に漸減し、上記オーバーシュートによる振動を低減させて位置偏差を抑えることができる。

なお、このように位置制御部１の位置積分部１１を不完全積分部で構成した場合でも、速度制御部２の速度積分部１２が加減速時の速度偏差を０に近づけるため、２重フィードバックループ構成の全体で見れば応答特性を劣化させることはない。つまり、位置制御部１に不完全積分部を備え、速度制御部２に完全積分部を備える組み合わせは、２重フィードバックループ構成における偏差レス制御の実現に対し機能上特に好適な組み合わせであると言える。

また、本実施形態では特に、位置制御部１は、位置積分部１１の出力を位置偏差に加算した後に位置制御ゲインＫｐを乗算して速度指令を生成するように構成され、速度制御部２は、速度積分部１２の出力を速度偏差に加算した後に速度制御ゲインＫｖを乗算してトルク指令を生成するように構成されている。このように、位置制御部１と速度制御部２の両方に比例器と積分器を備えた位置ＰＩ−速度ＰＩ制御とすることで、さらに位置偏差を低減させることができ、高い精度での偏差レス制御を実現できる。

また、本実施形態では特に、位置制御ゲインＫｐと速度制御ゲインＫｖは略比例関係となり、位置積分部１１の時定数Ｔｐｉは位置制御ゲインＫｐと略反比例関係となり、速度積分部１２の時定数Ｔｉは速度制御ゲインＫｖと略反比例関係となるよう設定されている。これまで２重フィードバックループ構成において位置制御部１と速度制御部２の両方に積分器を備えた場合には、それらの相互バランスが均衡せず結果的にオーバーシュートによる振動が生じやすくなり、それを低減させるための各ゲインの調整が複雑なため困難とされていた。しかし今回、発明者の検討によれば、以上のような関係を同時に満たすよう位置制御ゲインＫｐ、速度制御ゲインＫｖ、時定数Ｔｐｉ、及び時定数Ｔｉを設定することで、上記オーバーシュートの発生を低減できることがあらたに知見された。これにより、位置制御部１と速度制御部２の２重積分制御による偏差レス制御の実現が容易となる。

また、本実施形態では特に、位置制御ゲインＫｐ、速度制御ゲインＫｖ、第１時定数Ｔｐｉ、第２時定数Ｔｉについて具体的に
Ｋｐ≒Ｋｖ／２π
Ｔｐｉ≒４／Ｋｐ
Ｔｉ≒２／Ｋｖ
の関係を満たすようそれぞれ設定されている（上記式（４）、式（５）、式（６）参照）。これにより、位置制御部１と速度制御部２の２重積分制御による高精度な偏差レス制御が具体的に可能となる。

また、本実施形態では特に、トルクフィードフォワード制御部５が、位置指令を二階微分したトルク相当値にモータＭの制御対象の総慣性モーメントＪ_０を乗算した値に対し、位置指令を一階微分した速度相当値に制御対象の粘性摩擦補償係数Ｄｃｏｍｐを乗算した値を加算してトルクフィードフォワード指令を生成し、これをトルク指令に加算するトルクフィードフォワード制御を行う。これにより、各積分器における積分制御の負担を低減させて精度の高い安定した偏差レス制御を実現できる。なお、このトルクフィードフォワード制御部５は、単純な指令微分によるフィードフォワード補償器をベースとしており、その一方で２重フィードバックループ自体に偏差レス特性を持たせているので、フィードフォワード制御器は補助的な位置づけ（加減速時の偏差量の低減）としてよい。

また、以上既に述べた以外にも、上記実施形態や各変形例による手法を適宜組み合わせて利用しても良い。

その他、一々例示はしないが、上記実施形態や各変形例は、その趣旨を逸脱しない範囲内において、種々の変更が加えられて実施されるものである。

１ 位置制御部
２ 速度制御部
４ 速度フィードフォワード制御部
５ トルクフィードフォワード制御部
１１ 位置積分部（第１積分部）
２１ 速度積分部（第２積分部）
１００ モータ制御装置
Ｍ モータ
Ｄ モータの粘性摩擦係数
Ｄｃｏｍｐ 粘性摩擦補償係数
Ｄｐ 不完全積分ゲイン
Ｋｐ 位置制御ゲイン
Ｋｖ 速度制御ゲイン
Ｔｐｉ 位置積分部の時定数（第１時定数）
Ｔｉ 速度積分部の時定数（第２時定数）
Ｖｆｆ 速度フィードフォワードゲイン
Ｔｆｆ トルクフィードフォワードゲイン

Claims (6)

1. モータを制御するためのモータ制御装置であって、
   位置指令とモータ位置の位置偏差に基づいて速度指令を生成するように構成された位置制御部と、
   前記速度指令とモータ速度の速度偏差に基づいて前記モータに入力するトルク指令を生成するように構成された速度制御部と、
   前記位置偏差に加算するための当該位置偏差の積分値を不完全積分で算出するように構成された第１積分部と、
   前記速度偏差に加算するための当該速度偏差の積分値を完全積分で算出するように構成された第２積分部と、
   を備えていることを特徴とするモータ制御装置。
2. 前記第１積分部は、
   前記位置偏差の積分値に不完全積分ゲインを乗算して当該第１積分部の入力に負帰還するように構成された不完全積分部であることを特徴とする請求項１記載のモータ制御装置。
3. 前記位置制御部は、前記第１積分部の出力を前記位置偏差に加算した後に位置制御ゲインを乗算して前記速度指令を生成するように構成され、
   前記速度制御部は、前記第２積分部の出力を前記速度偏差に加算した後に速度制御ゲインを乗算して前記トルク指令を生成するように構成されていることを特徴とする請求項１又は２記載のモータ制御装置。
4. 前記位置制御ゲインと前記速度制御ゲインは略比例関係となり、
   前記第１積分部の第１時定数は前記位置制御ゲインと略反比例関係となり、
   前記第２積分部の第２時定数は前記速度制御ゲインと略反比例関係となるよう設定されていることを特徴とする請求項３記載のモータ制御装置。
5. 前記位置指令の二階微分値に前記モータの制御対象の総慣性モーメントを乗算した値に対し、前記位置指令の一階微分値に前記制御対象の粘性摩擦補償係数を乗算した値を加算してトルクフィードフォワード指令を生成し、これを前記トルク指令に加算するよう構成されたトルクフィードフォワード制御部を有することを特徴とする請求項１乃至４のいずれか１項に記載のモータ制御装置。
6. モータを制御するためのモータ制御方法であって、
   位置指令とモータ位置の位置偏差に基づいて速度指令を生成することと、
   前記速度指令とモータ速度の速度偏差に基づいて前記モータに入力するトルク指令を生成することと、
   前記位置偏差に加算するための当該位置偏差の積分値を不完全積分で算出することと、
   前記速度偏差に加算するための当該速度偏差の積分値を完全積分で算出することと、
   を実行することを特徴とするモータ制御方法。
   

Images