JP2010250509A - 駆動制御装置 - Google Patents

Abstract

【課題】 駆動機械の過大慣性振動を検出し、この過大慣性振動を抑制して安定な制御系を実現する駆動制御装置を提供する。
【解決手段】 位置指令信号と位置信号を入力とし駆動機械１の速度指令信号を出力する位置制御手段５と、速度指令信号と速度信号を入力としトルク指令信号を出力する速度制御手段６と、駆動機械１を駆動するトルクがトルク指令信号に一致するよう制御するトルク制御手段２と、開ループ周波数応答のゲイン交差周波数が、周波数の増加に伴い開ループ周波数応答の位相が増加するときの位相交差周波数以下となる状態を検出することにより、慣性設定値に対する駆動機械の慣性が大きいことで制御系が不安定となり発生する過大慣性振動を検出する振動検出手段７と、過大慣性振動が検出された場合に速度制御手段６或いは位置制御手段５のゲインを変更することで振動を抑制する振動抑制手段８を備える。
【選択図】 図１

Description

本発明は、産業用ロボットや工作機械など各種産業機械を駆動する駆動制御装置に関するものであり、特に過大慣性振動を抑制し制御系を安定化させる駆動制御装置に関するものである。

この種の駆動制御装置では、駆動制御装置にて予め設定される慣性設定値に対し、駆動機械の慣性が非常に大きい（過大慣性である）場合、駆動機械と駆動制御装置からなる制御系全体の安定性が低下し、振幅が大きな振動（以下、過大慣性振動と記述する）が発生する問題がある。上記の過大慣性振動は、駆動機械が機械共振特性を有している場合に発生する数１００Ｈｚ〜数ｋＨｚの高い周波数の発振とは異なり、数Ｈｚ〜数１０Ｈｚ程度の低い周波数で発振する。

このような問題に対して、従来の駆動制御装置では、外部から入力される指令より生成した規範速度信号と、駆動機械の速度信号との偏差に補償ゲインを乗じて速度ずれ補償信号を生成し、速度ずれ補償信号を速度指令信号に加算することにより、駆動機械の過大慣性に起因して発生する過大慣性振動を抑制し、制御系の安定化を図るよう構成している。

また、位置指令信号と駆動機械の位置信号との偏差、速度指令信号と速度信号との偏差、あるいは規範速度信号と速度信号との偏差のいずれかを監視しておき、これら偏差が予め設定されたしきい値以下、または発振が発生するまで上記補償ゲインを大きくするよう構成されている（例えば、特許文献１参照）

特開２００７−３０６７７９号公報（図１）

従来の駆動制御装置では、過大慣性振動を抑制するためには、規範速度信号と速度信号との偏差に乗じる補償ゲインを事前に十分に大きくしておく必要がある。しかしながら、補償ゲインを大きく設定した状態で、比較的小さな慣性を有する駆動機械を駆動する場合、制御系全体のループゲインが大きくなるため、制御系の安定性が低下し、不安定となる問題がある。

また、位置指令信号と位置信号との偏差、速度指令信号と速度信号との偏差あるいは速度規範速度信号と速度信号との偏差のいずれかに基づいて補償ゲインを大きくする構成では、過大慣性により各偏差が大きくなると補償ゲインを大きくするので、過大慣性振動を抑制できる。また、慣性が小さい駆動機械を駆動する場合は偏差が小さくなるので、補償ゲインを大きくしない。よって、制御系は不安定とはならない。しかしながら、偏差を予め設定されたしきい値との比較しかしていないので、過大慣性以外の他の要因で発生する振動に対しても補償ゲインを大きくすることになる。そのため、本来であれば補償ゲインを大きくする必要がない、あるいは補償ゲインを大きくしても効果がない場合でも補償ゲインを大きくし、制御系を不安定にする問題がある。

また、駆動機械が機械共振特性を有している場合、補償ゲインを大きくしすぎると、機械共振特性に起因して発振する。発振が発生した場合、補償ゲインをそれ以上大きくできないため、過大慣性振動抑制を抑制することができない問題がある。

本発明は、上記に鑑みてなされたものであって、駆動機械が過大慣性振動していることを誤検出することなく検出し、過大慣性振動を抑制し、安定な制御系を実現する駆動機械制御装置を提供することを目的とする。

上述した課題を解決し、目的を達成するために、本発明の駆動制御装置は、駆動機械の位置の目標値である位置指令信号と駆動機械の位置の現在値を示す位置信号を入力として、位置比例ゲインを用いた比例演算により駆動機械の速度の目標値である速度指令信号を出力する位置制御手段と、速度指令信号と駆動機械の速度の現在値を示す速度信号を入力として、速度比例ゲインと速度積分ゲインを用いた比例積分演算により駆動機械を駆動するトルクの目標値であるトルク指令信号を出力する速度制御手段と、トルク指令信号を入力として、駆動機械を駆動するトルクがトルク指令信号に一致するよう制御するトルク制御手段と、開ループ周波数応答のゲイン交差周波数が、周波数の増加に伴い開ループ周波数応答の位相が増加するときの位相交差周波数以下となる状態を検出することにより、慣性設定値に対する駆動機械の慣性が大きいことで制御系が不安定となり発生する過大慣性振動を検出する第１の検出手段と、振動検出手段により振動が検出された場合に速度制御手段或いは位置制御手段のゲインを変更することで振動を抑制する振動抑制手段を備えることを特徴とする。

本発明の駆動制御装置によれば、トルク指令信号に現れる所定の値以下の周波数を検出することにより、駆動機械が過大慣性振動していることを検出でき、他の要因で振動している場合に誤検出することはない。また、速度比例ゲインと速度積分ゲインとの比率と、速度積分ゲインと位置比例ゲインとの比率の少なくとも片方を小さくするよう速度比例ゲイン、速度積分ゲイン、位置比例ゲインを変更することにより過大慣性振動を抑制することができる。駆動機械が機械共振を有している場合であっても、速度積分ゲインまたは位置比例ゲインのどちらかを小さくすることで、機械共振特性に起因した発振を発生させることなく、過大慣性振動を抑制することができるという効果を奏する。

図１は、この発明の実施の形態１の駆動制御装置のブロック図である。 図２は、駆動機械の構成を表すブロック図である。 図３は、トルク指令信号から駆動機械の位置信号までの周波数応答のグラフを示す図である。 図４は、外乱に対する駆動機械の位置信号の応答波形のグラフを示す図である。 図５は、この発明の実施の形態２の駆動制御装置のブロック図である。 図６は、この発明の実施の形態３の駆動制御装置のブロック図である。 図７は、この発明の実施の形態４の駆動制御装置のブロック図である。

以下に、本発明にかかる駆動制御装置の実施の形態を図面に基づいて詳細に説明する。なお、この実施の形態によりこの発明が限定されるものではない。

実施の形態１.
＜駆動制御装置の構成＞
図１は、本発明の実施の形態１による駆動制御装置を示すブロック図である。
駆動機械１は、図２に示すように、負荷機械１１と、負荷機械１１を駆動する電動機１２などから構成され、電動機１２はタイミングベルトやボールネジといったトルク伝達機構１３を介して負荷機械１１を駆動する。電動機１２のトルクＴ_ｍは、トルク制御手段２によりトルク指令信号Ｔ_ｒに一致するよう制御される。位置検出手段３は、駆動機械１の位置の現在値を検出して位置信号θ_ｍを出力する。速度演算手段４は、駆動機械１の位置信号θ_ｍを入力として、駆動機械１の速度の現在値を示す速度信号ω_ｍを出力する。

位置制御手段５は、駆動機械１の位置の目標値である位置指令信号θ_rと位置信号θmを入力として、駆動機械１の速度の現在値を示す速度信号ω_ｍを出力する。速度制御手段６は、速度指令信号ω_ｒと速度信号ω_ｍを入力として、トルク指令信号Ｔ_ｒを出力する。

振動検出手段（第１の検出手段）７は、トルク指令信号Ｔ_ｒを入力とし、駆動機械１が所定の値以下の周波数で振動していることを検出する。そして、特に振動検出手段７は、後で詳細に述べるが、慣性設定値に対する駆動機械１の慣性が大きいことを制御系が不安定となり振動する過大慣性振動が発生しているとき、この過大慣性振動を検出する。

振動抑制手段８は、振動検出手段７により駆動機械１が所定の周波数の値以下の周波数で振動していることを検出した場合に、位置制御手段５および速度制御手段６のゲインを変更する。

＜基本動作＞
次に、動作について説明する。
位置制御手段５は、位置指令信号θ_ｒと位置信号θ_ｍとの偏差に位置比例ゲインＫ_pを乗じた信号を速度指令信号ω_ｒとして出力する。すなわち、次式の演算を行う。

次に、速度演算手段４は次式で表されるように、位置信号θ_ｍを微分することにより、速度信号ω_ｍを出力する。

次に、速度制御手段６は、速度指令信号ω_rと速度信号ω_ｍを入力として、速度比例ゲインＫ_ｖと速度積分ゲインω_piとを用いて、次式に示すＰＩ（propotional-integral：比例−積分）制御演算によりトルク指令信号Ｔ_ｒを出力する。

速度比例ゲインＫ_vは、駆動機械１の慣性の設定値である慣性設定値Ｊ_ｎと、後述する速度応答設定値ω_scとを用いて、次式示す演算により設定されるものとする。

説明を容易にするため、以下の説明ではトルク制御手段２の伝達特性を１とし、トルク指令信号Ｔ_ｒから位置信号θ_ｍまでの伝達特性をＧ_ｐ（ｓ）が慣性Ｊの剛体特性、すなわちＧ_ｐ（ｓ）が次式のように表されるものとする。

このとき、トルク指令信号Ｔ_ｒの箇所で制御ループを切り開いたときの開ループ伝達関数Ｌ（ｓ）は、速度比例ゲインＫ_ｖ、速度積分ゲインω_pi、位置比例ゲインＫ_ｐおよび式（
５）を用いて、次式のように表される。

式（６）より、開ループ伝達関数Ｌ（ｓ）のゲイン特性が０dBと交差する周波数であるゲイン交差周波数ω_gcは、次式のように近似できる。

ゲイン交差周波数ω_gcは制御系の速応性や安定性の尺度として扱われ、ゲイン交差周波数ω_gcが大きいほど速応性を向上させることができ、ゲイン交差周波数ω_ｇｃにおける位相余裕が大きいほど制御系の安定性が向上する。式（４）中の速度応答設定値ω_scは、ゲイン交差周波数ω_gcの設計値で表しており、式（７）より、慣性設定値Ｊ_ｎが駆動機械１の慣性Ｊと等しい場合（Ｊ_ｎ＝Ｊ）、ゲイン交差周波数ω_gcは速度応答設定値ω_scと等しくなる（ω_sc＝ω_gc）。

一般的に、速度応答設定値ω_sc、すなわち速度比例ゲインＫ_ｖを大きくすることで、ゲイン交差周波数ω_gcが大きくなるよう調整される。実際の制御系は、演算時間や駆動機械１に内在するむだ時間などによる遅れ要素を含んでいるため、開ループ周波数応答の位相特性は、周波数が増加するに従い位相が減少するよう変化し、さらに周波数が増加すると−１８０度よりも小さくなる。そのため、速度比例ゲインＫ_ｖを大きくしすぎると、ゲイン交差周波数ω_gcにおける位相余裕が小さくなるため制御系の安定性が低下する。また、開ループ周波数応答の位相が−１８０度よりも小さく、位相遅れが大きい周波数領域に機械共振特性が存在すると、その共振ピークにより共振周波数付近のゲインが大きくなるため、速度比例ゲインＫ_ｖを大きくしすぎると、やはり制御系は不安定となる。

＜過大慣性振動が発生する条件＞
次に、過大慣性振動が発生する条件について説明する。
図４は、慣性設定値をＪ_ｎ＝１、速度応答設定値をω_sc＝１で固定とし、駆動機械１の慣性Ｊを変化させたときの開ループ伝達関数の周波数応答を表している。また、図５は、図４と同じ条件を使用したときの外乱に対する位置信号θ_ｍの応答波形を表す。図４および図５では、（ａ）慣性設定値Ｊ_ｎが駆動機械１の慣性Ｊと等しい条件（Ｊ＝Ｊ_ｎ）（細線）、（ｂ）慣性設定値Ｊ_ｎが駆動機械１の慣性Ｊより大きく，制御系が安定限界となる条件（太線）、（ｃ）慣性設定値Ｊ_ｎが条件（ｂ）よりもさらに大きく制御系が不安定となる条件（点線）における結果を示している。また，条件（ａ），（ｂ），（ｃ）における位相特性は同じであるため各線が一致している。また、図５中に示す一点鎖線は、位相遅れが０のときの位相特性を表しており、位相遅れが存在すると、太線が示すとおり、周波数が増加するに従い開ループ位相は減少し、位相遅れが増大する。

図５に示すとおり、慣性設定値Ｊ_ｎが駆動機械１の慣性Ｊと等しい場合は、外乱に対する位置信号θ_ｍは速やかに０に収束している。しかしながら、慣性設定値Ｊ_ｎに対し、駆動機械１の慣性Ｊが大きくなるに従い、開ループ伝達関数Ｌ（ｓ）のゲイン特性が全体的に小さくなり、ゲイン交差周波数ω_gcが低くなる。それに伴い、ゲイン交差周波数ω_gcにおける位相遅れが増大し、位相余裕が小さくなるため、位置信号θ_ｍの応答が振動的となる。条件（ｂ）は、制御系が安定限界となる条件であり、ゲイン交差周波数ω_gcにおける位相余裕は０となり、位置信号θ_ｍの応答波形には持続振動が発生する。条件（ｃ）のように、慣性設定値Ｊ_ｎに対し、駆動機械１の慣性Ｊがさらに大きくなると、ゲイン交差周波数ω_gcにおける位相余裕は負となり、制御系は不安定となる。このとき発生する振動周波数は、ほぼゲイン交差周波数ω_gcと等しくなる。

以上のことより、慣性設定値Ｊ_ｎに対する駆動機械１の慣性Ｊが大きくなることで制御系が不安定となり、過大慣性振動が発生する条件は、周波数が増加するに従い開ループ周波数応答の位相が増加するとき−１８０度と交差する周波数である位相交差周波数ω_pcを用いて、次式のように表すことができる。

＜振動検出手段の動作：過大慣性振動の検出＞
次に、振動検出手段７の動作について説明する。
慣性設定値Ｊ_ｎに対する駆動機械１の慣性Ｊが大きくなることで制御系が不安定となる条件は式（８）で表されるが、駆動機械１の慣性Ｊが未知である場合、実際のゲイン交差周波数ω_gcも未知である。しかしながら、式（８）より、慣性設定値Ｊ_ｎに対する駆動機械１の慣性Ｊが大きいことで制御系が不安定となるときに発生する振動周波数は、位相交差周波数ω_pcよりも低くなる。振動検出手段７では、トルク指令信号Ｔ_ｒを入力とし、位相交差周波数ω_pc以下の周波数の振動を検出することにより、駆動機械１が過大慣性振動していることを検出している。位相交差周波数ω_ｐｃは、速度積分ゲインω_piと位置比例ゲインＫ_ｐを用いて次式のように表すことができる。

よって、トルク指令信号Ｔ_ｒを入力とし、位置比例ゲインＫ_ｐと速度積分ゲインω_piを用いて演算される位相交差周波数ω_pc以下の周波数を振動検出することにより、駆動機械１が過大慣性振動していることを検出することができる。検出信号として使用するトルク指令信号Ｔ_ｒに過大慣性振動の周波数より高い周波数成分が含まれる場合は、式（９）で表される位相交差周波数ω_pcの数倍程度の遮断周波数をもつローパスフィルタをトルク指令信号Ｔ_ｒに作用させた信号を検出信号として使用することにより、過大慣性振動の周波数より高い周波数成分による影響を低減することができる。

また、Ｋ_ｐ＞ω_piのとき、式（９）は次式となる。

よって、Ｋ_p＞ω_piのときは、トルク指令信号Ｔ_ｒを入力とし、位置比例ゲインＫ_ｐ以下の周波数を振動検出することにより、式（９）に含まれる乗算や平方根の計算をすることなく簡単な比較計算で、駆動機械１が過大慣性振動していることを検出することができる。検出信号として使用するトルク指令信号Ｔ_ｒに過大慣性振動の周波数より高い周波数成分が含まれる場合は、式（１０）で表される位置比例ゲインＫ_ｐの数倍程度の遮断周波数をもつローパスフィルタをトルク指令信号Ｔｒに作用させた信号を検出信号として使用することにより、過大慣性振動の周波数より高い周波数成分による影響を低減することができる。

＜過大慣性振動の検出の他の方法＞
また、ω_pi＞Ｋ_ｐのとき、式（９）は次式となる。

よって、ω_pi＞Ｋ_pのときは、トルク指令信号Ｔ_ｒを入力とし、速度積分ゲインω_pi以下の周波数を振動検出することにより、式（９）に含まれる乗算や平方根の計算をすることなく簡単な比較計算で、駆動機械１が過大慣性振動していることを検出することができる。検出信号として使用するトルク指令信号Ｔ_ｒに過大慣性振動の周波数より高い周波数成分が含まれる場合は、式（１１）で表される速度積分ゲインω_piの数倍程度の遮断周波数をもつローパスフィルタをトルク指令信号Ｔ_ｒに作用させた信号を検出信号として使用することにより、過大慣性振動の周波数より高い周波数成分による影響を低減することができる。

＜過大慣性振動の検出のさらに他の方法＞
ここでは、トルク指令信号Ｔ_ｒに現れる過大慣性振動を検出するようにしたが、トルク指令信号Ｔｒの代わりに、次式に示すトルク指令信号Ｔ_ｒの比例成分に相当するＴ_rpを用いてもよい。

これにより、摩擦や重力負荷などの定常成分を除去することができ、過大慣性振動の検出が容易となる。

＜過大慣性振動の検出のさらに他の方法＞
また、過大慣性振動が発生する場合、トルク指令信号Ｔ_ｒだけでなく、駆動機械１の位置信号θ_mあるいは速度信号ω_mにも同様の過大慣性振動が発生する。よって、トルク指令信号Ｔ_ｒの代わりに、位置信号θ_mあるいは速度信号ω_mに現れる過大慣性振動を検出するようにしても良い。また、これまで述べた過大慣性振動の検出方法により検出された振動の振幅が所定のしきい値以上であるとき駆動機械１が過大振動していることを検出するようにしてもよい。

＜振動抑制手段の動作＞
次に、振動抑制手段８の動作について説明する。
駆動機械１が過大慣性振動を発生する条件である式（８）は、次式のように変形できる。

式（１３）より、速度比例ゲインＫ_ｖと速度積分ゲインω_piとの比率である第１の比率と、速度比例ゲインＫ_vと位置比例ゲインＫ_pとの比率である第２の比率の少なくとも片方が大きくなるように速度比例ゲインＫ_ｖを大きくする、あるいは速度積分ゲインω_piまたは位置比例ゲインＫ_ｐを小さくすることで、制御系の安定性は向上し、過大慣性振動を抑制することができる。

また、制御系の安定余裕が十分大きくない、あるいは駆動機械１が機械共振特性を有しおり速度比例ゲインＫ_ｖを大きくすると制御系が発振するような場合であっても、速度積分ゲインω_piあるいは位置比例ゲインＫ_ｐを小さくし、第１の比率または第２の比率を大きくすることで、制御系を発振させることなく、過大慣性振動を抑制することができる。
また、第１の比率と第２の比率を大きくする代わりに、第１の比率と第２の比率を大きくすることと同等の効果をもつ制御ループを追加してもよい。

実施の形態２．
＜過大慣性検出手段の追加＞
図３は、本発明の実施の形態２による駆動制御装置を示すブロック図である。図１と同一の部分については同一の符号を付して、説明を省略する。図３に示すブロック図において、実施の形態１と異なる部分は、加速度演算手段１４により位置信号θ_ｍを２回微分することにより駆動機械１の加速度の現在値を示す加速度信号ａ_ｍを演算し、トルク指令信号Ｔ_ｒと加速度信号ａ_ｍを入力として、トルク指令信号Ｔ_rの大きさと、加速度信号ａ_ｍの大きさとの比率と、慣性設定値Ｊ_ｎに所定のゲインＫを乗じたものを比較し、過大慣性検出手段９を追加し、振動検出手段７の出力と過大慣性検出手段９の出力に基づいて駆動機械１が過大慣性振動していることを検出するようにしたことである。

＜過大慣性検出手段の動作＞
過大慣性検出手段９の動作について説明する。
駆動機械１が慣性Ｊの剛体特性であるとした場合、駆動機械１に入力されるトルク指令信号Ｔ_ｒと加速度信号_ａｍとの関係は、駆動機械１の慣性Ｊを用いて次式のように表される。

駆動機械１の慣性Ｊが、慣性設定値Ｊ_ｎに比べて大きい場合、次式が成立する。

式（１５）に示す条件を所定のゲインＫを用いて次式のように表すと、駆動機械１の慣性Ｊが慣性設定値Ｊ_ｎのＫ倍になることを検出することができる

実際には、測定した信号の除算を行うのは演算量が大きくなる。そこで、式（１６）式を変形し、次式に示す条件式を用いて駆動機械１の慣性が慣性設定値Ｊ_ｎよりも過大、すなわち過大慣性であることを検出する。

＜過大慣性検出の他の方法＞
実際には、トルク指令信号Ｔｒおよび加速度信号ａ_ｍの符号を考慮する必要がある。そこで、式（１７）において、トルク指令信号Ｔｒの絶対値と加速度信号ａ_ｍの絶対値を用いて次式に示す条件式を用いることで、各変数の符号に対応することができる。

＜過大慣性検出の他の方法＞
また、トルク指令信号Ｔ_rおよび加速度信号ａ_mに、トルク指令信号Ｔ_ｒの符号を乗じたものを使用し、次式に示す条件式を用いてもよい。

次に、所定のゲインＫの設定について説明する。（１３）式に示す過大慣性振動が発生する条件式に（４）式を代入して変形すると、次式が得られる。

速度積分ゲインω_piおよび位置比例ゲインＫ_pは、速度応答設定値ω_scの数分の一程度に設定すると、良好な制御特性が得られることが知られている。ここでは、速度積分ゲインωpiおよび位置比例ゲインＫ_ｐは、速度応答設定値ω_scに対する比率であるＲ_pi，Ｒ_pを用いて次式のように設定されるものとする。

このとき、Ｋ＝（ω_ｓｃ／ω_pi）＋（ω_ｓｃ／_Ｋp）＝Ｒ_pi＋Ｒ_pと設定すると、過大慣性検出手段９は、駆動機械１の慣性Ｊが過大慣性振動が発生する大きさと等しくなるとき過大慣性を検出することになる。Ｋ＜（ω_ｓｃ／ω_pi）＋（ω_ｓｃ／Ｋ_p）＝Ｒ_pi＋Ｒ_pと設定すれば、制御系が不安定とならない条件においても過大慣性を検出することができる。

実施の形態１で説明した振動検出手段７の出力と過大慣性検出手段９の出力に基づいて、駆動機械１が過大慣性振動していることを検出するよう構成することで、駆動機械１が過大慣性以外の要因で振動している場合でも誤検出することなく、確実に過大慣性振動を検出でき、振動抑制手段８の動作により過大慣性振動を抑制することが可能となる。
例えば、第１の検出手段の出力と、第２の検出手段の出力の少なくとも片方、あるいは両方の出力が過大慣性振動を検出しているとき駆動機械１が過大慣性振動していることを検出するようにしてもよい。
また、第１の検出手段の出力により駆動機械１が過大慣性振動していることを検出し、第２の検出手段の出力により、過大慣性振動が抑制され、収束していることを判断するようにしてもよい。

実施の形態３．
図６は、本発明の実施の形態３による駆動制御装置を示すブロック図である。図１と同一の部分については同一の符号を付して、説明を省略する。図６に示すブロック図において実施の形態１と異なる部分は、加速度演算手段１４により位置信号θ_ｍを２回微分することで駆動機械１の加速度の現在値を示す加速度信号ａ_ｍを演算し、トルク指令信号Ｔ_ｒと加速度信号ａ_ｍに基づいて駆動機械１の慣性Ｊを推定演算し、推定演算された慣性推定値を慣性設定値Ｊ_ｎに設定する推定演算手段１５と、慣性設定値に基づいて速度制御手段６或いは位置制御手段５のゲインを変更するゲイン変更手段１６と、振動検出手段７により駆動機械１が過大慣性振動していることを検出したとき、慣性推定演算手段１５の推定演算を動作させる推定演算動作切替手段１７を備えたことである。

まず、図６において、振動検出手段７および推定演算切替手段１７がない場合の動作について説明する。慣性推定演算手段１５は、トルク指令信号Ｔ_ｒと加速度信号ａ_ｍを入力とし、最小二乗法などの逐次計算によりトルク指令信号Ｔ_ｒと加速度信号ａｍの比に相当する値を演算することにより駆動機械１の慣性Ｊの値を推定し、慣性推定値を慣性設定値Ｊｎとして設定する。式（４）に示すように、逐次計算される慣性設定値Ｊ_ｎに基づいて速度比例ゲインＫ_ｖが変更されるようゲイン変更手段１６が構成される場合を考えると、駆動機械１が過大慣性振動している場合であっても、慣性設定値Ｊ_ｎが駆動機械１の慣性Ｊに近づくよう慣性推定演算手段１５における推定演算が進展することにより過大慣性振動は抑制される。

しかしながら、この種の最小二乗法などの逐次計算を用いた駆動機械１の慣性推定演算では、駆動機械１を速度一定で長時間駆動するような場合、加速度変化が小さい状態が長く続くために、その後に速度が急に変化すると慣性推定値の更新が急激となり、推定動作へ悪影響を及ぼすことになる。また、慣性推定値に基づいて速度比例ゲインＫ_ｖを変更する場合、速度比例ゲインも急激に変化するため駆動機械１へ入力するトルクも急変することになる。そのため、加速度変化が小さい状態が長く続く場合には推定動作を停止させるよう構成されている。そのため、加速度変化が小さい状態が長く続く場合、あるいは指令が入力されない場合に過大慣性振動が発生すると、推定演算が動作しないため過大慣性振動が長く続くことになる。

これに対し、本実施の形態では、図６に示すように、振動検出手段７により駆動機械１が過大慣性振動していることを検出したとき、慣性推定動作切替手段１７により慣性推定演算手段１５の推定演算が動作するように切り替えるよう構成しているため、加速度変化が小さい状態が長く続く場合や指令が入力されない場合においても、推定演算を動作させることができ、過大慣性振動を抑制することができる。

実施の形態４．
図７は、本発明の実施の形態４による駆動制御装置を示すブロック図である。図６と同一の部分については同一の符号を付して、説明を省略する。図７に示すブロック図において、実施の形態３と異なる部分は、振動検出手段７により駆動機械１が過大慣性振動していることを検出したときのみ慣性推定演算手段１５の推定速度を増大させるよう構成したことである。

このように構成することで、駆動機械１が過大慣性振動している場合であっても、推定演算時間が短縮されるため、過大慣性振動を速やかに抑制することができる。
また、上述のとおり、完成推定演算手段１５の推定速度を増大すると推定動作に悪影響を及ぼすが、過大慣性振動を検出しているときのみ推定速度を増大させ、過大慣性振動が抑制された後、推定速度を通常の値に戻すことにより、定常的な推定動作に影響を及ぼさないようにできる。
実施の形態３、または実施の形態４では、慣性推定演算手段１５で演算される慣性推定値に従い、速度比例ゲインＫ_ｖを変更する場合について記載したが、完成推定値に基づき速度積分ゲインω_ｐｉ、または位置比例ゲインＫ_ｐを変更してもよい。
また、実施の形態３、または実施の形態４では、第１の検出手段７により過大振動を検出する場合について説明したが、第２の検出手段、または第１の検出手段の出力と第２の検出手段の出力により駆動機械１が過大慣性振動していることを検出してもよい。

実施の形態５．
＜ＰＩ制御演算、ＩＰ制御演算＞
実施の形態１および実施の形態２における速度制御手段６は、式（３）に示すＰＩ制御演算としたが、速度制御手段６は、次式に示す演算を行うＩＰ制御演算としてもよい。

このとき、実施の形態１および実施の形態２で示した振動検出手段７、過大慣性検出手段９の動作は同じである。

速度制御手段６をＩＰ制御演算にすることで、式（１３）に示す駆動機械１が過大慣性振動を発生する条件は、次式に示す条件となる。

式（２４）より、振動抑制手段８は、振動検出手段７、過大慣性検出手段９の出力に基づいて、駆動機械１が過大慣性振動していることを検出した場合、速度比例ゲインＫ_ｖと位置比例ゲインＫ_ｐの第２の比率を大きくすることで制御系を安定化させ、過大慣性振動を抑制することが可能となる。

以上のように、本発明にかかる駆動制御装置は、産業用ロボットや工作機械など各種産業機械を駆動する駆動制御装置に有用であり、特に、過大慣性振動を発生させる機械を制御する駆動制御装置に好適なものである。

１ 駆動機械
１１ 負荷機械
１２ 電動機
１３ トルク伝達機構
２ トルク制御手段
３ 位置検出手段
４ 速度演算手段
５ 位置制御手段
６ 速度制御手段
７ 振動検出手段（第１の検出手段）
８ 振動抑制手段
９ 振動検出手段（第２の検出手段）
１４ 加速度演算手段
１５ 慣性推定演算手段
１６ ゲイン変更手段
１７ 推定演算動作切替手段
１８ 慣性推定演算速度変更手段

Claims (7)

1. 駆動機械の位置の目標値である位置指令信号と前記駆動機械の位置の現在値を示す位置信号を入力として、位置比例ゲインを用いた比例演算により前記駆動機械の速度の目標値である速度指令信号を出力する位置制御手段と、
   前記速度指令信号と前記駆動機械の速度の現在値を示す速度信号を入力として、速度比例ゲインと速度積分ゲインを用いた比例積分演算により駆動機械を駆動するトルクの目標値であるトルク指令信号を出力する速度制御制御手段と、
   前記トルク指令信号を入力として、前記駆動機械を駆動するトルクが前記トルク指令信号に一致するよう制御するトルク制御手段と、
   開ループ周波数応答のゲイン交差周波数が、周波数の増加に伴い開ループ周波数応答の位相が増加するときの位相交差周波数以下となる状態を検出することにより、慣性設定値に対する駆動機械の慣性が大きいことで制御系が不安定となり発生する過大慣性振動を検出する第１の検出手段と、
   前記第１の検出手段により振動が検出された場合に前記速度制御手段或いは前記位置制御手段のゲインを変更することで前記振動を抑制する振動抑制手段を備える
   ことを特徴とする駆動制御装置。
2. 前記第１の検出手段は、前記トルク指令信号に基づいて、前記駆動機械が前記位置比例ゲインに基づいて決定される値以下の周波数で振動しているときを、ゲイン交差周波数が位相交差周波数以下となる状態として検出する
   ことを特徴とする請求項１に記載の駆動制御装置。
3. 前記第１の検出手段は、前記トルク指令信号に基づいて、前記駆動機械が前記速度積分ゲインに基づいて決定される値以下の周波数で振動しているときを、ゲイン交差周波数が位相交差周波数以下となる状態として検出する
   ことを特徴とする請求項１に記載の駆動制御装置。
4. 慣性設定値に対する駆動機械の慣性が大きいことで制御系が不安定となり発生する過大慣性振動を、前記駆動機械の加速度の現在値を示す加速度信号の大きさと前記トルク指令信号との比率と、前記駆動機械の慣性設定値に所定のゲインを乗じた値とを比較することにより検出する第２の検出手段をさらに備え、
   前記第１の検出手段の出力と前記第２の検出手段の出力に基づいて前記駆動機械が過大慣性振動していることを検出する
   ことを特徴とする請求項１から請求項３のいずれか１項に記載の駆動制御装置。
5. 前記振動抑制手段は、前記速度比例ゲインと前記速度積分ゲインとの比率である第１の比率と、前記速度比例ゲインと前記位置比例ゲインとの比率である第２の比率の少なくともいずれか一方を大きくすることにより前記過大慣性振動を抑制する
   ことを特徴とする請求項１から請求項４のいずれか１項に記載の駆動制御装置。
6. 前記トルク信号と前記加速度信号を入力として、前記駆動機械の慣性を推定演算し、前記慣性設定値とする慣性推定演算手段と、前記慣性設定値に基づいて前記速度制御手段或いは速度制御手段のゲインを変更するゲイン変更手段を備え、
   前記過大慣性振動を検出したとき前記推定演算手段の推定演算を動作させる
   ことを特徴とする請求項５に記載の駆動制御装置。
7. 前記トルク信号と前記加速度信号を入力として、前記駆動機械の慣性を推定演算し、前記慣性設定値とする慣性推定演算手段と、前記慣性設定値に基づいて前記速度制御手段或いは位置制御手段のゲインを変更するゲイン変更手段を備え、
   前記過大慣性振動を検出したとき前記推定演算手段の推定演算速度を増大させる
   ことを特徴とする請求項５に記載の駆動制御装置。

Images