JP3550657B2 - モータ制御装置 - Google Patents
モータ制御装置 Download PDFInfo
- Publication number
- JP3550657B2 JP3550657B2 JP2000209152A JP2000209152A JP3550657B2 JP 3550657 B2 JP3550657 B2 JP 3550657B2 JP 2000209152 A JP2000209152 A JP 2000209152A JP 2000209152 A JP2000209152 A JP 2000209152A JP 3550657 B2 JP3550657 B2 JP 3550657B2
- Authority
- JP
- Japan
- Prior art keywords
- motor
- torque
- current
- gain
- unit
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Images
Landscapes
- Control Of Position Or Direction (AREA)
- Control Of Electric Motors In General (AREA)
- Feedback Control In General (AREA)
Description
【０００１】
【発明の属する技術分野】
本発明は、モータ、ロボット及び工作機械等のモータ制御装置に関するものであり、特に制御パラメータのチューニング方法に関する。
【０００２】
【従来の技術】
制御ゲインをチューニングする装置として、例えば、特開平１０−７６４４４号公報に開示されたものがある。そこに開示されている装置は、負荷イナーシャの大きさを測定して制御ゲインを自動的に決定するオートチューニング部と、決定したゲインを格納するゲイン記憶部と、指令値と出力により決定されるゲインを読み出すゲイン読み出し部と、フィードバックループで構成されるコントローラを備えており、初期的にチューニング作業をしておくことによって、実用的に負荷の変動に応じてリアルタイムなゲイン変更を安価に実現することができる。
【０００３】
【発明が解決しようとする課題】
ところが前記従来例では、実際の運転に入る前に、実動作をいくつかのパターンに分けて指令に対する操作量と出力からゲインを決定し、ゲイン修正量をコントローラに与えるサイクルを繰り返すという手順によって制御ゲインをチューニングしている。しかし、この方法によると、複数個ある制御ゲインのどれをどのくらい変更すれば良いかということは、熟練者の経験に頼らなければならず、チューニングする技術者によっては、最適なゲインを得るまでに多大な時間を要すばかりでなく、振動を誘発する恐れがあるという問題がある。そこで本発明は、かかる問題に鑑みてなされたものであり、複数個ある制御パラメータを１つパラメータで自動的にチューニングするモータ制御装置を提供することを目的とする。
【０００４】
【課題を解決するための手段】
上記問題点を解決するために、請求項１に記載の本発明は、位置指令とモータ位置を入力し、前記位置指令に前記モータ位置が一致するようにトルク指令を決定する位置制御部と、前記トルク指令を入力しフィルタを通して新たなトルク指令を決定するトルクフィルタ部と、前記トルクフィルタ部の出力である前記トルク指令を入力し電流指令に変換してモータ電流が電流指令に一致するように電流制御を行いモータを駆動する電流制御部とを備え、負荷となるメカ部と位置を検出する検出器が連結されたモータを駆動するモータ制御装置において、制御パラメータ選定信号を受けると前記位置制御部と前記トルクフィルタ部と前記電流制御部に制御パラメータを出力して調節するワンパラメータチューニング部が設けられていると共に、前記位置制御部は、前記位置指令と前記モータ位置の差にメインパラメータkgの２乗をかけて補助ゲインkp倍した値を出力する第１トルク指令発生手段と、前記位置指令と前記モータ位置の差を積分してメインパラメータkgの３乗をかけて補助ゲインki倍した値を出力する第２トルク指令発生手段と、前記位置指令と前記モータ位置の差を微分して時定数tvのローパスフィルタを通した後メインパラメータkgをかけて補助ゲインkd倍した値を出力する第３トルク指令発生手段と，前記第１トルク指令発生手段から前記第３トルク指令発生手段までのトルク指令を加算し，前記トルクフィルタ部に出力する加算手段とを備えており、前記ワンパラメータチューニング部が前記メインパラメータkgと、前記補助ゲインkp、ki、kd、トルクフィルタ部の時定数tf、前記時定数tv、前記電流制御部内の電流ループゲインka、電流積分時定数taを自動的に決定することを特徴としている。
請求項２に記載の発明は、前記ワンパラメータチューニング部は、目標応答周波数から決定する手段と、負荷イナーシャ値と目標応答周波数から決定する手段と、メカ特性と目標応答周波数から決定する手段と、これら３つの手段を選択する判定器を備えたことを特徴としている。
請求項３に記載の発明は、前記目標応答周波数から決定する手段は、目標応答周波数ωfを入力すると、前記メインパラメータkgをkg=ωf、前記補助ゲインkpをkp=3、前記補助ゲインkdをkd=3、前記補助ゲインkiをki=1、前記トルクフィルタ定数tfをtf=1/(ωf*4)、前記電流ループゲインkaをka=ωf*4、前記電流積分時定数taをta=1/ωf、前記時定数tvのローパスフィルタをtv=20.5/(ωf*4)、と設定されることを特徴としている。
請求項４に記載の発明は、前記負荷イナーシャ値と目標応答周波数から決定する手段は、前記負荷イナーシャ値JLと前記目標応答周波数ωfを入力すると、モータイナーシャJMとの比から求めたイナーシャ補正ゲインJCOM=((JL+JM)/JM)0.5 を用いて、前記メインパラメータkgをkg=ωf/JCOM、前記補助ゲインkpをkp=3、前記補助ゲインkdをkd=3、前記補助ゲインkiをki=1、前記トルクフィルタ定数tfをtf=1/(ωf*4)*JCOM、前記電流ループゲインkaをka=ωf*4/JCOM，前記電流積分時定数taをta=1/ωf*JCOM、前記時定数tvのローパスフィルタをtv=20.5/(ωf*4)*JCOM、と設定されることを特徴としている。
請求項５に記載の発明は、前記メカ特性と目標応答周波数から決定する手段は、前記メカの共振周波数ωH及び反共振周波数ωLと前記目標応答周波数ωfを入力すると、モータ側イナーシャJ1をJ1-=(JM+JL)*(ωL/ωH)２/JMと表し、前記メインパラメータkgをkg=ωf/J1、前記補助ゲインkpをkp=3、前記補助ゲインkdをkd=3、前記補助ゲインkiをki=1、前記トルクフィルタ定数tfをtf=1/(ωf*4)*J1、前記電流ループゲインkaをka=ωf*4/J1、前記電流積分時定数taをta=1/ωf*J1、前記時定数tvのローパスフィルタをtv=20.5/(ωf*4)*J1、と設定されることを特徴としている。
【０００５】
【発明の実施の形態】
以下，本発明を具体的実施例に基づいて説明する。図１は本発明のモータ制御装置を適用したモータ制御システムのブロック図である。図において、１１は位置指令Prefを出力する指令発生部、１２は位置指令Prefと検出されたモータの位置信号Pfbを入力してトルク指令Trefを出力し、前記２つの入力信号が一致するようにモータ１４の位置制御をする位置制御部、１３はトルク指令Trefを受けてフィルタをかけるトルクフィルタ部、１４はトルクフィルタ部の出力であるトルク指令Trefを受けて電流指令Irに変換し、検出されたモータ電流Ifbが電流指令Trに一致するように電流制御を行いモータ１５に電流を供給する電流制御部、１６はモータ１５の回転軸に接続されて回転軸の回転位置を検出する検出器、１７はモータで駆動されるメカ部、１８は制御パラメータ選定信号を入力し、前記位置制御部１２とトルクフィルタ部１３と電流制御部１４に最適な制御パラメータを供給するワンパラメータチューニング部である。
【０００６】
次に、位置制御部１２とトルクフィルタ部１３と電流制御部１４とモータ１５と検出器１６の詳細について図２を用いて説明する。図中、２１は位置指令Prefからモータ位置Pfbを減じて位置偏差を出力する減算器、２２は前記位置偏差にメインパラメータkgの2乗をかける乗算器、２３は乗算器２２の出力に補助ゲインkpをかける乗算器、２４は前記位置偏差を積分する積分器、２５は積分器２４の出力にメインパラメータkgの3乗をかける乗算器、２６は乗算器２５の出力に補助ゲインkiをかける乗算器、２７は前記位置偏差に時定数tvのフィルタをかける速度フィルタ、２６は速度フィルタ２７の出力を微分する微分器、２９は微分器２８の出力にメインパラメータkgをかける乗算器、２ａは乗算器２９の出力に補助ゲインkdをかける乗算器、２ｂは前記乗算器２３、２６、２ａの出力を加える加算器である。２ｃは加算器２ｂの出力であるトルク指令に時定数tfのフィルタをかけるトルクフィルタ、２ｄはトルク指令を電流指令Irに変換する電流変換定数である。２ｅは電流指令Irとモータ電流Ifbを減じて電流偏差を出力する減算器、２ｆは電流ループゲインkaと電流積分時定数taで構成されるPI制御器であり電流をモータ１５に出力する。モータ２ｇは抵抗RとインダクタンスLとトルク定数ktと誘起電圧定数keでモデル化している。以上に示したように、モータモデルに表した抵抗R、インダクタンスL、トルク定数kt、誘起電圧定数ke、および電流変換定数ka以外の８つの制御パラメータはユーザが設定しなければならず、それぞれのパラメータの整合を取らなければ振動を誘発し、要求仕様を満たせない場合がある。本発明は、この点に鑑みてなされており、ワンパラメータで全ての制御パラメータを自動的に設定する方法を提案するものである。なお、抵抗RとインダクタンスL、トルク定数kt、誘起電圧定数keはモータ固有の値であり、チューニングする必要はない。
【０００７】
次に図３を用いてワンパラメータチューニング部１８の詳細を説明する。ワンパラメータチューニング部１８では制御パラメータ選定信号を入力し、判定器３１で、ユーザが希望する目標応答周波数ωfから決定する手段３２と、負荷イナーシャ値JLと目標応答周波数ωfから決定する手段３３と、メカ特性である共振周波数ωH及び反共振周波数ωLと目標応答周波数ωfから決定する手段３４の選択を行う。
【０００８】
ユーザが希望する目標応答周波数ωfから決定する手段が選ばれた場合は、前記目標応答周波数ωfを入力し、前記メインパラメータkgをkg=ωf、前記補助ゲインkpをkp=3、前記補助ゲインkdをkd=3、前記補助ゲインkiをki=1、前記トルクフィルタ定数tfをtf=1/(ωf*4)、前記電流ループゲインkaをka=ωf*4、前記電流積分時定数taをta=1/ωf、前記時定数tvのローパスフィルタをtv=20.5/(ωf*4)、と設定し、上記演算により算出された制御パラメータを出力する。
【０００９】
負荷イナーシャ値JLと目標応答周波数ωfから決定する手段が選ばれた場合は、モータイナーシャJMとの比から求めたイナーシャ補正ゲインJCOM=((JL+JM)/JM)0.5 を用いて、前記メインパラメータkgをkg=ωf/JCOM、前記補助ゲインkpをkp=3、前記補助ゲインkdをkd=3、前記補助ゲインkiをki=1、前記トルクフィルタ定数tfをtf=1/(ωf*4)*JCOM、前記電流ループゲインkaをka=ωf*4/JCOM、前記電流積分時定数taをta=1/ωf*JCOM、前記時定数tvのローパスフィルタをtv=20.5/(ωf*4)*JCOM、と設定し、上記演算により算出された制御パラメータを出力する。
【００１０】
メカ特性である共振周波数ωH及び反共振周波数ωLと目標応答周波数ωfから決定する手段が選ばれた場合は、前記メカの共振周波数ωH及び反共振周波数ωLと前記目標応答周波数ωfを入力し、モータ側イナーシャJ1をJ1-=(JM+JL)*(ωL/ωH)２/JMと表し、前記メインパラメータkgをkg=ωf/J1、前記補助ゲインkpをkp=3、前記補助ゲインkdをkd=3、前記補助ゲインkiをki=1、前記トルクフィルタ定数tfをtf=1/(ωf*4)*J1、前記電流ループゲインkaをka=ωf*4/J1、前記電流積分時定数taをta=1/ωf*J1、前記時定数tvのローパスフィルタをtv=20.5/(ωf*4)*J1、と設定し、上記演算により算出された制御パラメータを出力する。
【００１１】
以上の制御パラメータは安定条件と実験を繰り返すことにより決定される。例えば、メインパラメータと補助ゲインkp、ki、kdは、速度フィルタとトルクフィルタを適用せず、電流制御部とモータを１/JS２とおき、位置指令からモータ位置までの伝達関数の分母を３重根条件で解いて決定される。なお、本発明ではそれぞれの制御パラメータの整合を重根条件で解かれているが、安定条件を満たす範囲で解いて制御パラメータを設定すれば良い。また、本発明は、１つのパラメータで８つの制御パラメータを自動的に決定できることに加えて、負荷のイナーシャの大きさや、メカ特性である反共振周波数と共振周波数を用いて、制御パラメータの設定指針を自動的に変更し、最適な制御パラメータを得る事ができる．
【００１２】
【発明の効果】
以上、説明したように、本発明によれば、位置制御部、電流制御部、トルクフィルタ部などの制御パラメータを１つのパラメータで振動することなく自動的に決定することができ、さらに、負荷イナーシャの大きさや、メカ特性を用いて、制御パラメータの設定指針を自動的に変更し、負荷イナーシャの大きさやメカ特性に応じた最適な制御パラメータを得る事ができる位置制御装置が実現できる。
【図面の簡単な説明】
【図１】本発明の方法を適用するモータ制御システムのブロック図
【図２】図１の詳細を示すブロック図
【図３】ワンパラメータチューニング部の詳細を示す図
【符号の説明】
１１ 指令発生器、 １２ 位置制御部、 １３ トルクフィルタ部、
１４ 電流制御部、 １５ モータ、１６ 検出器、
１７ メカ部、 １８ ワンパラメータチューニング部、
２１、２ｅ 減算器、 ２２、２３、２５、２６、２９、２ａ 乗算器、
２４ 積分器、 ２７ 速度フィルタ、 ２８ 微分器、
２ｃ トルクフィルタ、 ２ｄ 電流変換定数、 ２ｆ 電流PI制御器、
２ｇ モータモデル、 ３１ 判定器、
３２ 目標応答周波数から決定する手段、
３３ 負荷イナーシャ値と目標応答周波数から決定する手段、
３４ メカ特性と目標応答周波数から決定する手段
【発明の属する技術分野】
本発明は、モータ、ロボット及び工作機械等のモータ制御装置に関するものであり、特に制御パラメータのチューニング方法に関する。
【０００２】
【従来の技術】
制御ゲインをチューニングする装置として、例えば、特開平１０−７６４４４号公報に開示されたものがある。そこに開示されている装置は、負荷イナーシャの大きさを測定して制御ゲインを自動的に決定するオートチューニング部と、決定したゲインを格納するゲイン記憶部と、指令値と出力により決定されるゲインを読み出すゲイン読み出し部と、フィードバックループで構成されるコントローラを備えており、初期的にチューニング作業をしておくことによって、実用的に負荷の変動に応じてリアルタイムなゲイン変更を安価に実現することができる。
【０００３】
【発明が解決しようとする課題】
ところが前記従来例では、実際の運転に入る前に、実動作をいくつかのパターンに分けて指令に対する操作量と出力からゲインを決定し、ゲイン修正量をコントローラに与えるサイクルを繰り返すという手順によって制御ゲインをチューニングしている。しかし、この方法によると、複数個ある制御ゲインのどれをどのくらい変更すれば良いかということは、熟練者の経験に頼らなければならず、チューニングする技術者によっては、最適なゲインを得るまでに多大な時間を要すばかりでなく、振動を誘発する恐れがあるという問題がある。そこで本発明は、かかる問題に鑑みてなされたものであり、複数個ある制御パラメータを１つパラメータで自動的にチューニングするモータ制御装置を提供することを目的とする。
【０００４】
【課題を解決するための手段】
上記問題点を解決するために、請求項１に記載の本発明は、位置指令とモータ位置を入力し、前記位置指令に前記モータ位置が一致するようにトルク指令を決定する位置制御部と、前記トルク指令を入力しフィルタを通して新たなトルク指令を決定するトルクフィルタ部と、前記トルクフィルタ部の出力である前記トルク指令を入力し電流指令に変換してモータ電流が電流指令に一致するように電流制御を行いモータを駆動する電流制御部とを備え、負荷となるメカ部と位置を検出する検出器が連結されたモータを駆動するモータ制御装置において、制御パラメータ選定信号を受けると前記位置制御部と前記トルクフィルタ部と前記電流制御部に制御パラメータを出力して調節するワンパラメータチューニング部が設けられていると共に、前記位置制御部は、前記位置指令と前記モータ位置の差にメインパラメータkgの２乗をかけて補助ゲインkp倍した値を出力する第１トルク指令発生手段と、前記位置指令と前記モータ位置の差を積分してメインパラメータkgの３乗をかけて補助ゲインki倍した値を出力する第２トルク指令発生手段と、前記位置指令と前記モータ位置の差を微分して時定数tvのローパスフィルタを通した後メインパラメータkgをかけて補助ゲインkd倍した値を出力する第３トルク指令発生手段と，前記第１トルク指令発生手段から前記第３トルク指令発生手段までのトルク指令を加算し，前記トルクフィルタ部に出力する加算手段とを備えており、前記ワンパラメータチューニング部が前記メインパラメータkgと、前記補助ゲインkp、ki、kd、トルクフィルタ部の時定数tf、前記時定数tv、前記電流制御部内の電流ループゲインka、電流積分時定数taを自動的に決定することを特徴としている。
請求項２に記載の発明は、前記ワンパラメータチューニング部は、目標応答周波数から決定する手段と、負荷イナーシャ値と目標応答周波数から決定する手段と、メカ特性と目標応答周波数から決定する手段と、これら３つの手段を選択する判定器を備えたことを特徴としている。
請求項３に記載の発明は、前記目標応答周波数から決定する手段は、目標応答周波数ωfを入力すると、前記メインパラメータkgをkg=ωf、前記補助ゲインkpをkp=3、前記補助ゲインkdをkd=3、前記補助ゲインkiをki=1、前記トルクフィルタ定数tfをtf=1/(ωf*4)、前記電流ループゲインkaをka=ωf*4、前記電流積分時定数taをta=1/ωf、前記時定数tvのローパスフィルタをtv=20.5/(ωf*4)、と設定されることを特徴としている。
請求項４に記載の発明は、前記負荷イナーシャ値と目標応答周波数から決定する手段は、前記負荷イナーシャ値JLと前記目標応答周波数ωfを入力すると、モータイナーシャJMとの比から求めたイナーシャ補正ゲインJCOM=((JL+JM)/JM)0.5 を用いて、前記メインパラメータkgをkg=ωf/JCOM、前記補助ゲインkpをkp=3、前記補助ゲインkdをkd=3、前記補助ゲインkiをki=1、前記トルクフィルタ定数tfをtf=1/(ωf*4)*JCOM、前記電流ループゲインkaをka=ωf*4/JCOM，前記電流積分時定数taをta=1/ωf*JCOM、前記時定数tvのローパスフィルタをtv=20.5/(ωf*4)*JCOM、と設定されることを特徴としている。
請求項５に記載の発明は、前記メカ特性と目標応答周波数から決定する手段は、前記メカの共振周波数ωH及び反共振周波数ωLと前記目標応答周波数ωfを入力すると、モータ側イナーシャJ1をJ1-=(JM+JL)*(ωL/ωH)２/JMと表し、前記メインパラメータkgをkg=ωf/J1、前記補助ゲインkpをkp=3、前記補助ゲインkdをkd=3、前記補助ゲインkiをki=1、前記トルクフィルタ定数tfをtf=1/(ωf*4)*J1、前記電流ループゲインkaをka=ωf*4/J1、前記電流積分時定数taをta=1/ωf*J1、前記時定数tvのローパスフィルタをtv=20.5/(ωf*4)*J1、と設定されることを特徴としている。
【０００５】
【発明の実施の形態】
以下，本発明を具体的実施例に基づいて説明する。図１は本発明のモータ制御装置を適用したモータ制御システムのブロック図である。図において、１１は位置指令Prefを出力する指令発生部、１２は位置指令Prefと検出されたモータの位置信号Pfbを入力してトルク指令Trefを出力し、前記２つの入力信号が一致するようにモータ１４の位置制御をする位置制御部、１３はトルク指令Trefを受けてフィルタをかけるトルクフィルタ部、１４はトルクフィルタ部の出力であるトルク指令Trefを受けて電流指令Irに変換し、検出されたモータ電流Ifbが電流指令Trに一致するように電流制御を行いモータ１５に電流を供給する電流制御部、１６はモータ１５の回転軸に接続されて回転軸の回転位置を検出する検出器、１７はモータで駆動されるメカ部、１８は制御パラメータ選定信号を入力し、前記位置制御部１２とトルクフィルタ部１３と電流制御部１４に最適な制御パラメータを供給するワンパラメータチューニング部である。
【０００６】
次に、位置制御部１２とトルクフィルタ部１３と電流制御部１４とモータ１５と検出器１６の詳細について図２を用いて説明する。図中、２１は位置指令Prefからモータ位置Pfbを減じて位置偏差を出力する減算器、２２は前記位置偏差にメインパラメータkgの2乗をかける乗算器、２３は乗算器２２の出力に補助ゲインkpをかける乗算器、２４は前記位置偏差を積分する積分器、２５は積分器２４の出力にメインパラメータkgの3乗をかける乗算器、２６は乗算器２５の出力に補助ゲインkiをかける乗算器、２７は前記位置偏差に時定数tvのフィルタをかける速度フィルタ、２６は速度フィルタ２７の出力を微分する微分器、２９は微分器２８の出力にメインパラメータkgをかける乗算器、２ａは乗算器２９の出力に補助ゲインkdをかける乗算器、２ｂは前記乗算器２３、２６、２ａの出力を加える加算器である。２ｃは加算器２ｂの出力であるトルク指令に時定数tfのフィルタをかけるトルクフィルタ、２ｄはトルク指令を電流指令Irに変換する電流変換定数である。２ｅは電流指令Irとモータ電流Ifbを減じて電流偏差を出力する減算器、２ｆは電流ループゲインkaと電流積分時定数taで構成されるPI制御器であり電流をモータ１５に出力する。モータ２ｇは抵抗RとインダクタンスLとトルク定数ktと誘起電圧定数keでモデル化している。以上に示したように、モータモデルに表した抵抗R、インダクタンスL、トルク定数kt、誘起電圧定数ke、および電流変換定数ka以外の８つの制御パラメータはユーザが設定しなければならず、それぞれのパラメータの整合を取らなければ振動を誘発し、要求仕様を満たせない場合がある。本発明は、この点に鑑みてなされており、ワンパラメータで全ての制御パラメータを自動的に設定する方法を提案するものである。なお、抵抗RとインダクタンスL、トルク定数kt、誘起電圧定数keはモータ固有の値であり、チューニングする必要はない。
【０００７】
次に図３を用いてワンパラメータチューニング部１８の詳細を説明する。ワンパラメータチューニング部１８では制御パラメータ選定信号を入力し、判定器３１で、ユーザが希望する目標応答周波数ωfから決定する手段３２と、負荷イナーシャ値JLと目標応答周波数ωfから決定する手段３３と、メカ特性である共振周波数ωH及び反共振周波数ωLと目標応答周波数ωfから決定する手段３４の選択を行う。
【０００８】
ユーザが希望する目標応答周波数ωfから決定する手段が選ばれた場合は、前記目標応答周波数ωfを入力し、前記メインパラメータkgをkg=ωf、前記補助ゲインkpをkp=3、前記補助ゲインkdをkd=3、前記補助ゲインkiをki=1、前記トルクフィルタ定数tfをtf=1/(ωf*4)、前記電流ループゲインkaをka=ωf*4、前記電流積分時定数taをta=1/ωf、前記時定数tvのローパスフィルタをtv=20.5/(ωf*4)、と設定し、上記演算により算出された制御パラメータを出力する。
【０００９】
負荷イナーシャ値JLと目標応答周波数ωfから決定する手段が選ばれた場合は、モータイナーシャJMとの比から求めたイナーシャ補正ゲインJCOM=((JL+JM)/JM)0.5 を用いて、前記メインパラメータkgをkg=ωf/JCOM、前記補助ゲインkpをkp=3、前記補助ゲインkdをkd=3、前記補助ゲインkiをki=1、前記トルクフィルタ定数tfをtf=1/(ωf*4)*JCOM、前記電流ループゲインkaをka=ωf*4/JCOM、前記電流積分時定数taをta=1/ωf*JCOM、前記時定数tvのローパスフィルタをtv=20.5/(ωf*4)*JCOM、と設定し、上記演算により算出された制御パラメータを出力する。
【００１０】
メカ特性である共振周波数ωH及び反共振周波数ωLと目標応答周波数ωfから決定する手段が選ばれた場合は、前記メカの共振周波数ωH及び反共振周波数ωLと前記目標応答周波数ωfを入力し、モータ側イナーシャJ1をJ1-=(JM+JL)*(ωL/ωH)２/JMと表し、前記メインパラメータkgをkg=ωf/J1、前記補助ゲインkpをkp=3、前記補助ゲインkdをkd=3、前記補助ゲインkiをki=1、前記トルクフィルタ定数tfをtf=1/(ωf*4)*J1、前記電流ループゲインkaをka=ωf*4/J1、前記電流積分時定数taをta=1/ωf*J1、前記時定数tvのローパスフィルタをtv=20.5/(ωf*4)*J1、と設定し、上記演算により算出された制御パラメータを出力する。
【００１１】
以上の制御パラメータは安定条件と実験を繰り返すことにより決定される。例えば、メインパラメータと補助ゲインkp、ki、kdは、速度フィルタとトルクフィルタを適用せず、電流制御部とモータを１/JS２とおき、位置指令からモータ位置までの伝達関数の分母を３重根条件で解いて決定される。なお、本発明ではそれぞれの制御パラメータの整合を重根条件で解かれているが、安定条件を満たす範囲で解いて制御パラメータを設定すれば良い。また、本発明は、１つのパラメータで８つの制御パラメータを自動的に決定できることに加えて、負荷のイナーシャの大きさや、メカ特性である反共振周波数と共振周波数を用いて、制御パラメータの設定指針を自動的に変更し、最適な制御パラメータを得る事ができる．
【００１２】
【発明の効果】
以上、説明したように、本発明によれば、位置制御部、電流制御部、トルクフィルタ部などの制御パラメータを１つのパラメータで振動することなく自動的に決定することができ、さらに、負荷イナーシャの大きさや、メカ特性を用いて、制御パラメータの設定指針を自動的に変更し、負荷イナーシャの大きさやメカ特性に応じた最適な制御パラメータを得る事ができる位置制御装置が実現できる。
【図面の簡単な説明】
【図１】本発明の方法を適用するモータ制御システムのブロック図
【図２】図１の詳細を示すブロック図
【図３】ワンパラメータチューニング部の詳細を示す図
【符号の説明】
１１ 指令発生器、 １２ 位置制御部、 １３ トルクフィルタ部、
１４ 電流制御部、 １５ モータ、１６ 検出器、
１７ メカ部、 １８ ワンパラメータチューニング部、
２１、２ｅ 減算器、 ２２、２３、２５、２６、２９、２ａ 乗算器、
２４ 積分器、 ２７ 速度フィルタ、 ２８ 微分器、
２ｃ トルクフィルタ、 ２ｄ 電流変換定数、 ２ｆ 電流PI制御器、
２ｇ モータモデル、 ３１ 判定器、
３２ 目標応答周波数から決定する手段、
３３ 負荷イナーシャ値と目標応答周波数から決定する手段、
３４ メカ特性と目標応答周波数から決定する手段
Claims (5)
- 位置指令とモータ位置を入力し、前記位置指令に前記モータ位置が一致するようにトルク指令を決定する位置制御部と、前記トルク指令を入力しフィルタを通して新たなトルク指令を決定するトルクフィルタ部と、前記トルクフィルタ部の出力である前記トルク指令を入力し電流指令に変換してモータ電流が電流指令に一致するように電流制御を行いモータを駆動する電流制御部とを備え、負荷となるメカ部と位置を検出する検出器が連結されたモータを駆動するモータ制御装置において、
制御パラメータ選定信号を受けると前記位置制御部と前記トルクフィルタ部と前記電流制御部に制御パラメータを出力して調節するワンパラメータチューニング部が設けられていると共に、
前記位置制御部には、前記位置指令と前記モータ位置の差にメインパラメータkgの２乗をかけて補助ゲインkp倍した値を出力する第１トルク指令発生手段と、前記位置指令と前記モータ位置の差を積分してメインパラメータkgの３乗をかけて補助ゲインki倍した値を出力する第２トルク指令発生手段と、前記位置指令と前記モータ位置の差を微分して時定数tvのローパスフィルタを通した後メインパラメータkgをかけて補助ゲインkd倍した値を出力する第３トルク指令発生手段と，前記第１トルク指令発生手段から前記第３トルク指令発生手段までのトルク指令を加算し，前記トルクフィルタ部に出力する加算手段とを備えており、
前記ワンパラメータチューニング部が前記メインパラメータkgと、前記補助ゲインkp、ki、kd、トルクフィルタ部の時定数tf、前記時定数tv、前記電流制御部内の電流ループゲインka、電流積分時定数taを自動的に決定することを特徴とするモータ制御装置。 - 前記ワンパラメータチューニング部は、目標応答周波数から決定する手段と、負荷イナーシャ値と目標応答周波数から決定する手段と、メカ特性と目標応答周波数から決定する手段と、これら３つの手段を選択する判定器を備えたことを特徴とする請求項１記載のモータ制御装置。
- 前記目標応答周波数から決定する手段は、前記目標応答周波数ωfを入力すると、前記メインパラメータkgをkg=ωf、前記補助ゲインkpをkp=3、前記補助ゲインkdをkd=3、前記補助ゲインkiをki=1、前記トルクフィルタ定数tfをtf=1/(ωf*4)、前記電流ループゲインkaをka=ωf*4、前記電流積分時定数taをta=1/ωf、前記時定数tvのローパスフィルタをtv=20.5/(ωf*4)、と設定されることを特徴とする請求項２記載のモータ制御装置。
- 前記負荷イナーシャ値と目標応答周波数から決定する手段は、前記負荷イナーシャ値JLと前記目標応答周波数ωfを入力すると、モータイナーシャJMとの比から求めたイナーシャ補正ゲインJCOM=((JL+JM)/JM)0.5 を用いて、前記メインパラメータkgをkg=ωf/JCOM、前記補助ゲインkpをkp=3、前記補助ゲインkdをkd=3、前記補助ゲインkiをki=1、前記トルクフィルタ定数tfをtf=1/(ωf*4)*JCOM、前記電流ループゲインkaをka=ωf*4/JCOM，前記電流積分時定数taをta=1/ωf*JCOM、前記時定数tvのローパスフィルタをtv=20.5/(ωf*4)*JCOM、と設定されることを特徴とする請求項２記載のモータ制御装置。
- 前記メカ特性と目標応答周波数から決定する手段は、前記メカの共振周波数ωH及び反共振周波数ωLと前記目標応答周波数ωfを入力すると、モータ側イナーシャJ1をJ1-=(JM+JL)*(ωL/ωH)２/JMと表し、前記メインパラメータkgをkg=ωf/J1、前記補助ゲインkpをkp=3、前記補助ゲインkdをkd=3、前記補助ゲインkiをki=1、前記トルクフィルタ定数tfをtf=1/(ωf*4)*J1、前記電流ループゲインkaをka=ωf*4/J1、前記電流積分時定数taをta=1/ωf*J1、前記時定数tvのローパスフィルタをtv=20.5/(ωf*4)*J1、と設定されることを特徴とする請求項２記載のモータ制御装置。
Priority Applications (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2000209152A JP3550657B2 (ja) | 2000-07-11 | 2000-07-11 | モータ制御装置 |
| PCT/JP2001/004712 WO2002005414A1 (en) | 2000-07-11 | 2001-06-04 | Motor control device |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2000209152A JP3550657B2 (ja) | 2000-07-11 | 2000-07-11 | モータ制御装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2002027784A JP2002027784A (ja) | 2002-01-25 |
| JP3550657B2 true JP3550657B2 (ja) | 2004-08-04 |
Family
ID=18705603
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2000209152A Expired - Fee Related JP3550657B2 (ja) | 2000-07-11 | 2000-07-11 | モータ制御装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3550657B2 (ja) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN110649855A (zh) * | 2019-09-27 | 2020-01-03 | 华中科技大学 | Pmsm伺服系统电流环系统 |
Families Citing this family (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP4696406B2 (ja) * | 2001-06-15 | 2011-06-08 | 株式会社安川電機 | 制御ゲイン探索機能を備えたモータ制御装置 |
| CN100424981C (zh) * | 2004-03-26 | 2008-10-08 | 株式会社安川电机 | 电机控制装置 |
| TWI295529B (en) * | 2004-12-03 | 2008-04-01 | Mitsubishi Electric Corp | Motor controller |
| JP4687418B2 (ja) * | 2004-12-03 | 2011-05-25 | 三菱電機株式会社 | モータ制御装置 |
| JP4712063B2 (ja) * | 2008-03-26 | 2011-06-29 | 三菱電機株式会社 | 位置制御装置 |
Family Cites Families (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH0816205A (ja) * | 1994-06-30 | 1996-01-19 | Fujitsu Ltd | サーボ制御システム及びそのチューニング方法 |
| JPH08221132A (ja) * | 1995-02-10 | 1996-08-30 | Fanuc Ltd | サーボパラメータの自動調整方法及び自動調整装置 |
| JP3434123B2 (ja) * | 1996-05-29 | 2003-08-04 | シャープ株式会社 | 画像形成装置 |
| JP3274070B2 (ja) * | 1996-08-08 | 2002-04-15 | 三菱電機株式会社 | 電動機制御方法及び電動機制御装置 |
-
2000
- 2000-07-11 JP JP2000209152A patent/JP3550657B2/ja not_active Expired - Fee Related
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN110649855A (zh) * | 2019-09-27 | 2020-01-03 | 华中科技大学 | Pmsm伺服系统电流环系统 |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2002027784A (ja) | 2002-01-25 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| KR100437178B1 (ko) | 위치 제어 장치 | |
| JP3561911B2 (ja) | モータ制御装置 | |
| JP3550657B2 (ja) | モータ制御装置 | |
| CN103580574A (zh) | 电动机控制装置 | |
| CN109861609B (zh) | 五桥臂两永磁电机系统优化模型预测控制装置和方法 | |
| US5196778A (en) | Control apparatus suitable for use in induction motor | |
| CN108818541A (zh) | 一种柔性关节机器人的自适应神经网络跟踪控制方法 | |
| JP2009237916A (ja) | サーボ制御装置 | |
| Szczepanski et al. | Comparison of Constraint-handling Techniques Used in Artificial Bee Colony Algorithm for Auto-Tuning of State Feedback Speed Controller for PMSM. | |
| WO2008072426A1 (ja) | プレス機械とその制御装置及び制御方法 | |
| US6914404B2 (en) | Motor controller | |
| JP4696406B2 (ja) | 制御ゲイン探索機能を備えたモータ制御装置 | |
| WO2002005414A1 (en) | Motor control device | |
| CN112761851B (zh) | 一种直驱式波浪能发电装置最大功率捕获控制方法 | |
| JP4752298B2 (ja) | モータ制御装置およびその制御方法 | |
| JP4254181B2 (ja) | モータ制御装置 | |
| Bellini et al. | A PLL-based filter for speed noise reduction in drives using a resolver transducer | |
| Salem et al. | PD controller structures: comparison and selection for an electromechanical system | |
| WO2007122904A1 (ja) | モータ制御装置および制御パラメータ調整方法 | |
| JP7443933B2 (ja) | モータ制御装置 | |
| JPH06348305A (ja) | Ｐｉｄ調節器のパラメータ調整装置 | |
| JP3834815B2 (ja) | 最適指令作成装置 | |
| JP2002335686A (ja) | モータ制御装置 | |
| Ersalı et al. | Real time PID controlled speed regulation of a DC motor using LabVIEW | |
| Caux et al. | Velocity sensorless control of a PMSM actuator directly driven an uncertain two-mass system using RKF tuned with an evolutionary algorithm |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20040326 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20040408 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090514 Year of fee payment: 5 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100514 Year of fee payment: 6 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100514 Year of fee payment: 6 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110514 Year of fee payment: 7 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130514 Year of fee payment: 9 |
|
| LAPS | Cancellation because of no payment of annual fees |