特許
J-GLOBAL ID:201103031777070041
制御ゲイン探索機能を備えたモータ制御装置
発明者:
,
出願人/特許権者:
代理人 (3件):
小栗 昌平
, 本多 弘徳
, 市川 利光
公報種別:特許公報
出願番号(国際出願番号):特願2001-182248
公開番号(公開出願番号):特開2003-009562
特許番号:特許第4696406号
出願日: 2001年06月15日
公開日(公表日): 2003年01月10日
請求項(抜粋):
【請求項1】 位置指令とモータ位置を入力し位置指令にモ-タ位置が一致するようにトルク指令Aを決定する位置制御部と、
前記トルク指令Aを入力しフィルタを通してトルク指令Bを決定するトルクフィルタ部と、
前記トルク指令Bを入力してノッチフィルタを通しトルク指令Cを出力するノッチフィルタ部と、
前記トルク指令Cを入力し電流指令に変換してモ-タ電流が電流指令に一致するように電流制御を行いモータを駆動する電流制御部と、
モータとモータの位置を検出する検出器と、
モータで駆動されるメカ部とを備え、
前記位置制御部内の制御ゲインを1つのパラメータkgに基づいて自動的に決定する制御ゲイン探索機能を備えたモータ制御装置において、
同じ位置指令パタンを繰り返し前記位置制御部に入力し、前記位置制御部内の位置偏差を変数とする所定の評価関数Eの値を試行ごとにモニタし、前記ノッチフィルタを使用しない状態で、試行ごとに前記パラメータkgを上げていき、現試行iでの評価関数Eiが1試行前の値Ei-1より大きくなった場合は1試行前のパラメータkgの値を基に前記位置制御部内の制御ゲインを決定する第1ステップと、
第1ステップで決定された制御ゲインを用いて、ノッチフィルタを使用する状態で試行ごとにノッチフィルタのノッチ周波数fcを高周波から下げていき、現試行時の評価関数Eiが1試行前の値Ei-1より大きくなった場合は1試行前のノッチ周波数fcをノッチフィルタの設定値とし,再び第1ステップと同様に、評価関数を基に前記パラメータkgを決定することによりノッチ周波数fcと、前記パラメータkg値と、kg値を基に前記位置制御部内の制御ゲインを決定するする第2ステップと、
第2ステップで設定されたノッチフィルタを使用した状態で、前記ノッチフィルタの帯域幅を設定する変数Q値を現在のQ値よりも大きくすることにより帯域幅を狭くし、再び第1ステップと同様に評価関数を基に前記パラメータkgを上げ、現試行時の評価関数Eiが1試行前の値Ei-1より大きくなった場合は、前記変数Q値を現在のQ値よりもさらに大きくし、前記パラメータkgを上げることにより,評価関数Eiが最小でパラメータkgが最大となるような変数Qとパラメータkgを探すサイクルを繰り返すことにより、ノッチフィルタの変数Q値と、前記パラメータkg値と、kg値を基に前記位置制御部内の制御ゲインを決定する第3ステップと、
を備えることを特徴とする制御ゲイン探索機能を備えたモータ制御装置。
IPC (6件):
H02P 29/00 ( 200 6.01)
, G05B 11/36 ( 200 6.01)
, G05B 13/02 ( 200 6.01)
, G05B 13/04 ( 200 6.01)
, G05D 3/12 ( 200 6.01)
, B23Q 15/12 ( 200 6.01)
FI (7件):
H02P 5/00 K
, H02P 5/00 F
, G05B 11/36 503 C
, G05B 13/02 E
, G05B 13/04
, G05D 3/12 305 V
, B23Q 15/12 Z
引用特許: