JP5434264B2 - サーボ制御装置 - Google Patents
サーボ制御装置 Download PDFInfo
- Publication number
- JP5434264B2 JP5434264B2 JP2009123966A JP2009123966A JP5434264B2 JP 5434264 B2 JP5434264 B2 JP 5434264B2 JP 2009123966 A JP2009123966 A JP 2009123966A JP 2009123966 A JP2009123966 A JP 2009123966A JP 5434264 B2 JP5434264 B2 JP 5434264B2
- Authority
- JP
- Japan
- Prior art keywords
- speed
- frequency
- torque
- gain
- phase
- 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.)
- Active
Links
- YGSDEFSMJLZEOE-UHFFFAOYSA-M salicylate Chemical compound OC1=CC=CC=C1C([O-])=O YGSDEFSMJLZEOE-UHFFFAOYSA-M 0.000 claims 2
- 229960001860 salicylate Drugs 0.000 claims 2
- 230000010354 integration Effects 0.000 description 18
- 238000005259 measurement Methods 0.000 description 16
- 238000012545 processing Methods 0.000 description 12
- 238000012546 transfer Methods 0.000 description 9
- UOCLXMDMGBRAIB-UHFFFAOYSA-N 1,1,1-trichloroethane Chemical compound CC(Cl)(Cl)Cl UOCLXMDMGBRAIB-UHFFFAOYSA-N 0.000 description 8
- 238000010586 diagram Methods 0.000 description 8
- 230000001133 acceleration Effects 0.000 description 2
- 238000000034 method Methods 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000001771 impaired effect Effects 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 230000006641 stabilisation Effects 0.000 description 1
- 238000011105 stabilization Methods 0.000 description 1
Images
Landscapes
- Control Of Electric Motors In General (AREA)
Description
本発明は、サーボアンプ、サーボモータ等を組み合わせた速度制御系に対して、負荷イナーシャの設定値と実際値との誤差が大きい場合や負荷変動が発生した場合に安定性を向上させるサーボ制御装置に関する。
一般に、サーボ制御装置の速度制御には、電動機の速度をフィードバックして制御を行うため、電動機の回転子を含む機械系全体のイナーシャを正確に知る必要がある。そこで、負荷イナーシャを推定して各制御パラメータを調整する方法が知られている（例えば、特許文献1参照）。
図５は、負荷イナーシャを推定して制御パラメータを調整する方法を表すブロック図である。この図５において、速度指令値Ｎｒが減算器１に入力され、この減算器１で速度実際値Ｎとの偏差ΔＮが演算され、この偏差ΔＮが速度調節器２に入力される。この速度調節器２では、ＰＩ（比例積分）演算が行われてトルク指令値ｕ(n)が出力される。このトルク指令値ｕ(n)はトルク制限部６に供給されて、その最大値が後述するトルク制限値演算部１０から入力されるトルク制限値Ｔｍａｘに制限される。そして、最大値が制限されたトルク指令値ｕ(n)′がトルク制御部４に供給される。このトルク制御部４では、トルク指令値ｕ(n)′に基づいてサーボモータ等の機械系５が出力するトルクの制御を行う。
図５は、負荷イナーシャを推定して制御パラメータを調整する方法を表すブロック図である。この図５において、速度指令値Ｎｒが減算器１に入力され、この減算器１で速度実際値Ｎとの偏差ΔＮが演算され、この偏差ΔＮが速度調節器２に入力される。この速度調節器２では、ＰＩ（比例積分）演算が行われてトルク指令値ｕ(n)が出力される。このトルク指令値ｕ(n)はトルク制限部６に供給されて、その最大値が後述するトルク制限値演算部１０から入力されるトルク制限値Ｔｍａｘに制限される。そして、最大値が制限されたトルク指令値ｕ(n)′がトルク制御部４に供給される。このトルク制御部４では、トルク指令値ｕ(n)′に基づいてサーボモータ等の機械系５が出力するトルクの制御を行う。
また、速度調節器２の伝達関数はＫｖ（１＋１／Ｔｉ・ｓ）、トルク制御部４の伝達関数は１＋１／Ｔａｃｒ・ｓ、機械系５の伝達関数は１／Ｊｓで表される。ここで、ｓはラプラス演算子、Ｋｖは速度調節器２のゲイン、Ｔｉは速度調節器の積分時間、Ｔａｃｒはトルク制御部４の等価時定数、Ｊは負荷イナーシャである。
そして、速度調節器２から出力されるトルク指令値ｕ(n)はトルク平均値演算部９にも供給され、このトルク平均値演算部９でトルク指令値ｕ(n)の加減速時の発生トルクの平均値Ｔｍｉｎを演算し、演算したトルク平均値Ｔｍｉｎとトルク制限設定値Ｔｍ０とをトルク制限値演算部１０に供給する。
そして、速度調節器２から出力されるトルク指令値ｕ(n)はトルク平均値演算部９にも供給され、このトルク平均値演算部９でトルク指令値ｕ(n)の加減速時の発生トルクの平均値Ｔｍｉｎを演算し、演算したトルク平均値Ｔｍｉｎとトルク制限設定値Ｔｍ０とをトルク制限値演算部１０に供給する。
このトルク制限値演算部１０では、トルク平均値Ｔｍｉｎがトルク制限設定値Ｔｍ０よりも小さい場合には、トルク制限値Ｔｍａｘをトルク平均値Ｔｍｉｎよりも小さいトルク制限値Ｔｍａｘを設定し、その他の場合にはトルク制限設定値Ｔｍ０をトルク制限値Ｔｍａｘとして設定し、設定したトルク制限値Ｔｍａｘを出力する。このトルク制限値Ｔｍａｘは、トルク制限部６に入力されると共に、負荷イナーシャ推定部７に入力される。
ここで、トルク制限値Ｔｍａｘ、速度変化率Ｎ′、負荷イナーシャＪとの間には、
Ｊ＝Ｔｍａｘ／ΔＮ ・・・（１）
という関係があることに着目して、負荷イナーシャ推定部７は、負荷イナーシャＪを推定演算する。なお、速度変化率Ｎ′は、
Ｎ′＝（Ｎ(n+1)−Ｎ(n)）／ｔｓ ・・・（２）
により算出する。ここで、ｔｓはサンプリング時間である。
Ｊ＝Ｔｍａｘ／ΔＮ ・・・（１）
という関係があることに着目して、負荷イナーシャ推定部７は、負荷イナーシャＪを推定演算する。なお、速度変化率Ｎ′は、
Ｎ′＝（Ｎ(n+1)−Ｎ(n)）／ｔｓ ・・・（２）
により算出する。ここで、ｔｓはサンプリング時間である。
上述のようにして演算された負荷イナーシャ推定値Ｊｈは速度調節器ゲイン演算部８に入力され、この速度調節器ゲイン演算部８で、トルク制御部４の等価時定数Ｔａｃｒを用いて速度調節器ゲインＫｖが次式により演算される。
Ｋｖ＝Ｊｈ／（ｇｖ・Ｔａｃｒ） ・・・（３）
ここで、ｇｖは設定定数である。
Ｋｖ＝Ｊｈ／（ｇｖ・Ｔａｃｒ） ・・・（３）
ここで、ｇｖは設定定数である。
また、積分時間演算部１１で、前記速度調節器ゲインＫｖと負荷イナーシャ推定値Ｊｈ、さらには設定定数ｇｉを用いて次式により速度調節器２の積分時間Ｔｉを演算する。
Ｔｉ＝Ｋｖ／（ｇｉ・Ｊｈ） ・・・（４）
すなわち、１／ＴｉがＫｖ／Ｊｈ以下になるように積分時間演算手段が積分時間Ｔｉを自動的に決定する。
Ｔｉ＝Ｋｖ／（ｇｉ・Ｊｈ） ・・・（４）
すなわち、１／ＴｉがＫｖ／Ｊｈ以下になるように積分時間演算手段が積分時間Ｔｉを自動的に決定する。
しかしながら、上記特許文献１に記載の従来例にあっては、サーボアンプ、サーボモータ等を組み合わせた速度制御系で、未知パラメータである負荷イナーシャＪの値を推定し、その推定値Ｊｈに対して各制御パラメータの自動調整を行っている。そのため、負荷イナーシャの推定値と実際値との間の誤差が大きい場合や負荷変動が生じた場合には、安定性が損なわれるという未解決の課題がある。
そこで、本発明は、上記従来例の未解決の課題に着目してなされたものであり、負荷イナーシャの推定値と実際値との誤差が大きい場合や負荷変動が生じた場合においても安定性を向上させることができるサーボ制御装置を提供することを目的としている。
上記目的を達成するために、一の形態に係るサーボ制御装置は、速度指令値と帰還速度の偏差が入力される速度調節器と、該速度調節器から出力されるトルク指令値に基づいて機械系の出力トルクを制御するトルク制御部とを少なくとも備えたサーボ制御装置であって、前記速度調節器とトルク制御部との間に位相進み補償器をカスケード接続し、該位相進み補償器は、自己のゲインが零となる周波数が一つのみ存在する場合に、当該周波数を前記速度調節器のカットオフ周波数と一致させるようにパラメータを自動調整することを特徴としている。
この構成によると、推定した負荷イナーシャの推定値と実際値と一致している場合に位相進み補償器を接続していない場合と同等の応答を得ることができる。
また、他の形態に係るサーボ制御装置は、速度指令値と帰還速度の偏差が入力される速度調節器と、該速度調節器から出力されるトルク指令値に基づいて機械系の出力トルクを制御するトルク制御部とを少なくとも備えたサーボ制御装置であって、前記速度調節器とトルク制御部との間に位相進み補償器をカスケード接続し、該位相進み補償器は、自己のゲインが零となる周波数が複数存在する場合に、ゲインが零で且つ位相補償量が最も大きくなる周波数を前記速度調節器のカットオフ周波数と一致させるようにパラメータを自動調整することを特徴としている。
この構成によると、推定した負荷イナーシャの値と実際の値とで誤差が大きい場合でも、位相余裕を大きくすることで安定性を増すことができる。
この構成によると、推定した負荷イナーシャの値と実際の値とで誤差が大きい場合でも、位相余裕を大きくすることで安定性を増すことができる。
また、他の形態に係るサーボ制御装置は、速度指令値と帰還速度の偏差が入力される速度調節器と、該速度調節器から出力されるトルク指令値に基づいて機械系の出力トルクを制御するトルク制御部とを少なくとも備えたサーボ制御装置であって、前記速度調節器とトルク制御部との間に位相進み補償器をカスケード接続し、該位相進み補償器は、前記位相進み補償器は、自己のゲインが零となる周波数が存在しない場合に、ゲインが零に最も近く、且つ位相補償量が最も大きくなる周波数を前記速度調節器のカットオフ周波数と一致させるようにパラメータを自動調整することを特徴としている。
この構成によると、推定した負荷イナーシャの値と実際の値とで誤差が大きい場合でも、位相余裕を大きくすることで安定性を増すことができる。
この構成によると、推定した負荷イナーシャの値と実際の値とで誤差が大きい場合でも、位相余裕を大きくすることで安定性を増すことができる。
本発明によれば、位相進み補償器のパラメータを速度調節器のカットオフ周波数近傍に自動調整することにより、推定した負荷イナーシャの値と実際の値とで誤差が大きい場合でも、位相余裕を大きくすることで安定性を増すことができる。このため、帰還速度の速度変動や位置偏差を小さくすることが可能となるという効果が得られる。
また、位相進み補償器のゲインが零となる周波数を速度調節器のカットオフ周波数に一致させることにより、負荷イナーシャの推定値と実査位置とが一致している場合において、位相進み補償器を接続する前とあとでカットオフ周波数の変化がないため、位相進み補償器を接続していない状態と同等の応答を得ることができる。
また、位相進み補償器のゲインが零となる周波数を速度調節器のカットオフ周波数に一致させることにより、負荷イナーシャの推定値と実査位置とが一致している場合において、位相進み補償器を接続する前とあとでカットオフ周波数の変化がないため、位相進み補償器を接続していない状態と同等の応答を得ることができる。
以下、本発明の実施の形態を図面に基づいて説明する。
図１は本発明のサーボ制御装置の一実施形態を示すブロック図であり、図中、１は速度指令値Ｎｒから実際の速度Ｎを減算して偏差ΔＮを算出する減算器である。この減算器１から出力される偏差ΔＮは速度調節器２に入力される。
この速度調節器２は、図２に示すにように、偏差ΔＮが入力される伝達関数が“１”に設定された演算部２ａと、偏差ΔＮが入力される積分演算部２ｂと、演算部２ａ及び積分演算部２ｂの出力を加算する加算器２ｃと、この加算器２ｃの出力が入力される比例演算部２ｄとで構成されている。
図１は本発明のサーボ制御装置の一実施形態を示すブロック図であり、図中、１は速度指令値Ｎｒから実際の速度Ｎを減算して偏差ΔＮを算出する減算器である。この減算器１から出力される偏差ΔＮは速度調節器２に入力される。
この速度調節器２は、図２に示すにように、偏差ΔＮが入力される伝達関数が“１”に設定された演算部２ａと、偏差ΔＮが入力される積分演算部２ｂと、演算部２ａ及び積分演算部２ｂの出力を加算する加算器２ｃと、この加算器２ｃの出力が入力される比例演算部２ｄとで構成されている。
ここで、積分演算部２ｂの伝達関数Ｇｉは積分時間をＴｉとしたときにＧｉ＝１／（Ｔｉ・ｓ）で表され、比例演算部２ｄの伝達関数Ｇｐは比例ゲインをＫｖとしたときにＧｐ＝Ｋｖで表される。このため、速度調節器２の伝達関数Ｇｖは下記（５）式で表される。
Ｇｖ＝Ｋｖ｛１＋１／（Ｔｉ・ｓ）｝ ・・・（５）
そして、速度調節器２の可変パラメータとなる積分時間Ｔｉ及び比例ゲインＫｖが前述した従来例と同様に負荷イナーシャＪを推定することにより演算される。すなわち、トルク平均値演算部９で速度調節器２から出力されるトルク指令値ｕ(n)の加減速時の発生トルクの平均値Ｔｍｉｎを算出し、算出したトルク平均値Ｔｍｉｎと予め設定されたトルク制限値Ｔｍ０とをトルク制限値演算部１０に供給してトルク制限値Ｔｍａｘを算出する。
Ｇｖ＝Ｋｖ｛１＋１／（Ｔｉ・ｓ）｝ ・・・（５）
そして、速度調節器２の可変パラメータとなる積分時間Ｔｉ及び比例ゲインＫｖが前述した従来例と同様に負荷イナーシャＪを推定することにより演算される。すなわち、トルク平均値演算部９で速度調節器２から出力されるトルク指令値ｕ(n)の加減速時の発生トルクの平均値Ｔｍｉｎを算出し、算出したトルク平均値Ｔｍｉｎと予め設定されたトルク制限値Ｔｍ０とをトルク制限値演算部１０に供給してトルク制限値Ｔｍａｘを算出する。
また、速度実際値Ｎの速度変化率Ｎ′とトルク制限値Ｔｍａｘとを負荷イナーシャ推定部７に供給して負荷イナーシャ推定値Ｊｈ（＝Ｔｍａｘ／Ｎ′）を演算し、演算した負荷イナーシャ推定値Ｊｈを速度調節器ゲイン演算部８に供給して前記（３）式に従って速度調節器ゲインＫｖを算出する。
さらに、負荷イナーシャ推定値Ｊｈと速度調節器ゲインＫｖとを積分時間演算部１１に供給して前記（４）式に従って積分時間Ｔｉを演算する。
さらに、負荷イナーシャ推定値Ｊｈと速度調節器ゲインＫｖとを積分時間演算部１１に供給して前記（４）式に従って積分時間Ｔｉを演算する。
演算された積分時間Ｔｉ及び速度調節器ゲインＫｖを速度調節器２の比例演算部２ｄ及び積分演算部２ｂに供給することにより、速度調節器２のパラメータを自動的に決定する。
そして、速度調節器２から出力されるトルク指令値ｕ(n)がカスケード接続された位相進み補償器３に入力される。この位相進み補償器３は高周波領域で一巡伝達関数の位相を進めることにより安定化を図る補償を行うもので、伝達関数Ｇｃ(s)が下記（６）式で表される。
Ｇｃ(s)＝ＫC｛（１＋αＴCｓ）／（１＋ＴCｓ）｝ ・・・（６）
ここで、ＫCはゲイン、ＴCは時定数、αは係数、ｓはラプラス演算子であって、ゲインＫC、時定数ＴC及び係数αが可変パラメータとなる。
この位相進み補償器３のボード線図は、周波数ω［ｌｏｇ］に対するゲインが、図３（ａ）に示すように、０［ｄＢ］から折点周波数１／αＴCから一定の増加率で増加し、２０ｌｏｇ10α［ｄＢ］まで増加した折点周波数１／ＴCで一定値となるように設定されている。
Ｇｃ(s)＝ＫC｛（１＋αＴCｓ）／（１＋ＴCｓ）｝ ・・・（６）
ここで、ＫCはゲイン、ＴCは時定数、αは係数、ｓはラプラス演算子であって、ゲインＫC、時定数ＴC及び係数αが可変パラメータとなる。
この位相進み補償器３のボード線図は、周波数ω［ｌｏｇ］に対するゲインが、図３（ａ）に示すように、０［ｄＢ］から折点周波数１／αＴCから一定の増加率で増加し、２０ｌｏｇ10α［ｄＢ］まで増加した折点周波数１／ＴCで一定値となるように設定されている。
また、周波数ω［ｌｏｇ］に対する位相が、図３（ｂ）に示すように、折点周波数１／αＴC及び１／ＴC間の中間の周波数ωm（＝１／ＴC√α）で最大位相φmとなり、この中間周波数ωmから折点周波数１／αＴC及び１／ＴCに近づくにつれて位相が低下するように設定されている。また、位相進みの最大値ｓｉｎφmはｓｉｎφm＝（α−１）／（α＋１）で表される。
そして、パラメータとしてのゲインＫCは設計仕様によって決定され、係数αは速度調節器２から出力されるトルク指令値ｕ(n)に対する位相余裕をどの程度持たせるかによって決定され、時定数ＴCは折点周波数１／ＴC又は１／αＴCをどのような周波数に設定するかによって決定される。
ここで、時定数ＴCの設定は、基本的には速度調節器２のカットオフ周波数と位相進み補償器３のゲインが零となる折線周波数１／αＴCが一致するように自動的に設定する。
ここで、時定数ＴCの設定は、基本的には速度調節器２のカットオフ周波数と位相進み補償器３のゲインが零となる折線周波数１／αＴCが一致するように自動的に設定する。
すなわち、位相進み補償器３のゲインが零となる周波数が１つだけ存在する場合には、位相進み補償器３のゲインが零となる折線周波数１／αＴCを速度調節器２のカットオフ周波数と一致するように時定数ＴCを自動的に設定する。
また、位相進み補償器３のゲインが零となる周波数が複数存在する場合には、位相進み補償器３のゲインの最小値が零であれば、折線周波数１／αＴCを速度調節器２のカットオフ周波数と一致するように時定数ＴCを設定し、位相進み補償器３のゲインの最大値が零である場合には、折線周波数１／ＴCが速度調節器２のカットオフ周波数に一致するように時定数ＴCを自動的に設定する。
また、位相進み補償器３のゲインが零となる周波数が複数存在する場合には、位相進み補償器３のゲインの最小値が零であれば、折線周波数１／αＴCを速度調節器２のカットオフ周波数と一致するように時定数ＴCを設定し、位相進み補償器３のゲインの最大値が零である場合には、折線周波数１／ＴCが速度調節器２のカットオフ周波数に一致するように時定数ＴCを自動的に設定する。
さらに、位相進み補償器３のゲインが零となる周波数が存在しない場合すなわち位相進み補償器３のゲインが常に零より小さい場合には、折線周波数１／ＴCが速度調節器２のカットオフ周波数に一致するように時定数ＴCを設定し、位相進み補償器３のゲインが常に零より大きい場合には、折線周波数１／αＴCが速度調節器２のカットオフ周波数に一致するように時定数ＴCを自動的に設定する。
このように、パラメータを自動設定するには、位相進み補償器３の出力側に、ゲイン測定装置２０を設ける。このゲイン測定装置２０は、図４に示すように、機械系５の電動機の駆動に影響を与えることがない所定周波数（例えば２０００Ｈｚ程度）の正弦波を測定用信号として予め設定した設定時間が経過する毎に０．０１秒〜０．０５秒間程度の短時間発生させる正弦波発生部２１と、この正弦波発生部２１で発生された測定用信号を位相進み補償器３の出力側に加える加算部２２と、加算部２２の出力側及び入力側の信号Ｓａ１及びＳａ２が入力されてゲインを測定するゲイン測定部２３とを備えている。
ゲイン測定部２３は、信号Ｓａ１が入力される信号処理部２４Ａと、信号Ｓａ２が入力される信号処理部２４Ｂと、信号処理部２４Ａで信号処理した信号Ｓｂ１を信号処理部２４Ｂで信号処理した信号Ｓｂ１で除算して閉ループゲインＫを算出する除算器２５とを備えている。
信号処理部２４Ａ及び２４Ｂは、正弦波発生部２１で発生した測定用信号を抽出するバンドパスフィルタ２６ａ及び２６ｂと、このバンドパスフィルタ２６ａ及び２６ｂの出力が入力される絶対値演算部２７ａ及び２７ｂと、絶対値演算部２７ａ及び２７ｂから出力される絶対値を積分する積分演算部２８ａ及び２８ｂとを備えている。そして、信号処理部２４Ａ及び２４Ｂは正弦波発生部２１で測定用信号を発生している期間だけ作動状態に制御される。
信号処理部２４Ａ及び２４Ｂは、正弦波発生部２１で発生した測定用信号を抽出するバンドパスフィルタ２６ａ及び２６ｂと、このバンドパスフィルタ２６ａ及び２６ｂの出力が入力される絶対値演算部２７ａ及び２７ｂと、絶対値演算部２７ａ及び２７ｂから出力される絶対値を積分する積分演算部２８ａ及び２８ｂとを備えている。そして、信号処理部２４Ａ及び２４Ｂは正弦波発生部２１で測定用信号を発生している期間だけ作動状態に制御される。
また、除算器２５から出力されるゲインＫが位相進み補償器３に入力され、この位相進み補償器３で入力されるゲインＫに基づいて前述したパラメータの自動設定を行う。
次に、上記実施形態の動作を説明する。
今、速度指令信号Ｎｒが減算器１に入力されて、この減算器１から速度偏差ΔＮが速度調節器２に供給され、この速度調節器２でＰＩ演算処理してトルク指令値ｕ(n)を算出し、これが位相進み補償器３で位相進み補償されてトルク制御部４に供給され、このトルク制御部４で、機械系に含まれる電動機を駆動制御するフィードバック制御が行われているものとする。
次に、上記実施形態の動作を説明する。
今、速度指令信号Ｎｒが減算器１に入力されて、この減算器１から速度偏差ΔＮが速度調節器２に供給され、この速度調節器２でＰＩ演算処理してトルク指令値ｕ(n)を算出し、これが位相進み補償器３で位相進み補償されてトルク制御部４に供給され、このトルク制御部４で、機械系に含まれる電動機を駆動制御するフィードバック制御が行われているものとする。
このとき、位相進み補償器３では、所定時間毎にゲイン測定装置２０から入力される閉ループゲインＫに基づいてパラメータを自動設定する。ゲイン測定装置２０では、所定時間毎に短時間の正弦波でなる測定用信号Ｓａを発生し、この測定用信号を加算部２２で位相進み補償器３の出力信号に重畳する。
このとき、信号処理部２４Ａ及び２４Ｂも作動状態となり、信号処理部２４Ａによって加算部２２で測定用信号が重畳された信号をバンドパスフィルタ２６ａに供給して、このバンドパスフィルタ２６ａで測定用信号を抽出し、抽出した測定用信号を絶対値演算部２７ａで絶対値化し、積分演算部２８ａで積分して、その積分出力を除算器２５に供給する。
このとき、信号処理部２４Ａ及び２４Ｂも作動状態となり、信号処理部２４Ａによって加算部２２で測定用信号が重畳された信号をバンドパスフィルタ２６ａに供給して、このバンドパスフィルタ２６ａで測定用信号を抽出し、抽出した測定用信号を絶対値演算部２７ａで絶対値化し、積分演算部２８ａで積分して、その積分出力を除算器２５に供給する。
一方、フィードバック制御系を一巡して位相進み補償器３から出力される一巡信号が信号処理部２４Ｂのバンドパスフィルタ２６ｂに入力され、このバンドパスフィルタ２６ｂで一巡後測定信号を抽出し、抽出した一巡後測定信号を絶対値演算部２７ｂで絶対値化し、積分演算部２８ｂで積分して、その積分出力を除算器２５に供給する。
このため、除算器２５で、測定信号の積分出力を一巡後測定信号の積分出力で除算することにより、閉ループゲインＫを算出し、算出した閉ループゲインＫを位相進み補償器３に供給する。
このため、除算器２５で、測定信号の積分出力を一巡後測定信号の積分出力で除算することにより、閉ループゲインＫを算出し、算出した閉ループゲインＫを位相進み補償器３に供給する。
このため、位相進み補償器３で、閉ループゲインＫに基づいて、０［ｄＢ］の周波数が存在するか否かを判定し、０［ｄＢ］の周波数が１つだけ存在する場合には、折線周波数１／αＴCを速度調節器２のカットオフ周波数と一致するように時定数ＴCを自動的に設定する。Ｏ［ｄＢ］の周波数が複数存在する場合には、ゲインＫの最小値が０［ｄＢ］であれば、折線周波数１／αＴCを速度調節器２のカットオフ周波数と一致するように時定数ＴCを設定し、ゲインＫの最大値が零である場合には、折線周波数１／ＴCが速度調節器２のカットオフ周波数に一致するように時定数ＴCを自動的に設定する。
さらに、ゲインＫが零となる周波数が存在しない場合には、ゲインＫが０［ｄＢ］に最も近く、位相補償量が最も大きくなる点の周波数を自動調整する。すなわちゲインＫが常に零より小さい場合には、折線周波数１／ＴCが速度調節器２のカットオフ周波数に一致するように時定数ＴCを設定し、ゲインＫが常に零より大きい場合には、折線周波数１／αＴCが速度調節器２のカットオフ周波数に一致するように時定数ＴCを自動的に設定する。
このように、位相進み補償器３のパラメータをゲインＫが零となる周波数を速度調節器２のカットオフ周波数に一致するように自動的に設定することにより、負荷イナーシャの推定値Ｊｈと実際の負荷イナーシャＪとが一致している場合においては、カットオフ周波数が同一であるため、従来例と略同等の応答が得られる。
また、負荷イナーシャＪが負荷イナーシャ推定値Ｊｈに対して大きい場合には、ゲインが全体的に下がり、カットオフ周波数が下がる。このときは、位相進み補償器３によって、従来の構成よりも位相余裕を大きくすることができ、安定性を向上させて帰還速度の速度変動や位置偏差を小さくできる。
また、負荷イナーシャＪが負荷イナーシャ推定値Ｊｈに対して大きい場合には、ゲインが全体的に下がり、カットオフ周波数が下がる。このときは、位相進み補償器３によって、従来の構成よりも位相余裕を大きくすることができ、安定性を向上させて帰還速度の速度変動や位置偏差を小さくできる。
また、負荷イナーシャＪが負荷イナーシャ推定値Ｊｈに対して小さい場合においては、ゲインが全体的に上がり、カットオフ周波数が上がる。このときは、位相進み補償器３を設置している場合には、設置していない場合に比較して、位相進み補償器３のゲイン特性により高周波数帯域のゲインが上がっているため、カットオフ周波数が上がるが、位相進み補償器３のパラメータを調整することで位相進み補償器３が無い場合と略同等の応答を得ることができる。
１…加算器、２…速度調節器、３…位相進み補償器、４…トルク制御部、５…機械系、７…負荷イナーシャ推定部、８…速度調節器ゲイン演算部、９…トルク平均値演算部、１０…トルク制限値演算部、１１…積分時間演算部、２０…ゲイン測定装置、２１…正弦波発生部、２２…加算部、２３…ゲイン測定部、２４Ａ，２４Ｂ…信号処理部、２５…除算器、２６ａ，２６ｂ…バンドパスフィルタ、２７ａ，２７ｂ…絶対値演算部、２８ａ，２８ｂ…積分演算部
Claims (3)
- 速度指令値と帰還速度の偏差が入力される速度調節器と、該速度調節器から出力されるトルク指令値に基づいて機械系の出力トルクを制御するトルク制御部とを少なくとも備えたサーボ制御装置であって、
前記速度調節器とトルク制御部との間に位相進み補償器をカスケード接続し、該位相進み補償器は、自己のゲインが零となる周波数が一つのみ存在する場合に、当該周波数を前記速度調節器のカットオフ周波数と一致させるようにパラメータを自動調整することを特徴とするサーボ制御装置。 - 速度指令値と帰還速度の偏差が入力される速度調節器と、該速度調節器から出力されるトルク指令値に基づいて機械系の出力トルクを制御するトルク制御部とを少なくとも備えたサーボ制御装置であって、
前記速度調節器とトルク制御部との間に位相進み補償器をカスケード接続し、該位相進み補償器は、自己のゲインが零となる周波数が複数存在する場合に、ゲインが零で且つ位相補償量が最も大きくなる周波数を前記速度調節器のカットオフ周波数と一致させるようにパラメータを自動調整することを特徴とするサーボ制御装置。 - 速度指令値と帰還速度の偏差が入力される速度調節器と、該速度調節器から出力されるトルク指令値に基づいて機械系の出力トルクを制御するトルク制御部とを少なくとも備えたサーボ制御装置であって、
前記速度調節器とトルク制御部との間に位相進み補償器をカスケード接続し、該位相進み補償器は、前記位相進み補償器は、自己のゲインが零となる周波数が存在しない場合に、ゲインが零に最も近く、且つ位相補償量が最も大きくなる周波数を前記速度調節器のカットオフ周波数と一致させるようにパラメータを自動調整することを特徴とするサーボ制御装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2009123966A JP5434264B2 (ja) | 2009-05-22 | 2009-05-22 | サーボ制御装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2009123966A JP5434264B2 (ja) | 2009-05-22 | 2009-05-22 | サーボ制御装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2010273468A JP2010273468A (ja) | 2010-12-02 |
| JP5434264B2 true JP5434264B2 (ja) | 2014-03-05 |
Family
ID=43421043
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2009123966A Active JP5434264B2 (ja) | 2009-05-22 | 2009-05-22 | サーボ制御装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP5434264B2 (ja) |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP6022117B2 (ja) * | 2014-04-21 | 2016-11-09 | 三菱電機株式会社 | 電動パワーステアリング装置 |
Family Cites Families (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2000078874A (ja) * | 1998-09-02 | 2000-03-14 | Fuji Electric Co Ltd | 速度制御系におけるパラメータの自動調整装置 |
| JP4189716B2 (ja) * | 2000-02-10 | 2008-12-03 | 富士電機システムズ株式会社 | モータ速度制御装置 |
| JP3835528B2 (ja) * | 2001-07-19 | 2006-10-18 | 株式会社安川電機 | 速度制御装置 |
| JP2008289218A (ja) * | 2007-05-15 | 2008-11-27 | Yaskawa Electric Corp | モータ制御装置とその制御方法 |
-
2009
- 2009-05-22 JP JP2009123966A patent/JP5434264B2/ja active Active
Also Published As
| Publication number | Publication date |
|---|---|
| JP2010273468A (ja) | 2010-12-02 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP5541314B2 (ja) | ダイナモメータシステムの制御装置 | |
| JP6584658B2 (ja) | 電動パワーステアリング装置 | |
| JP3892823B2 (ja) | モータの速度制御装置 | |
| WO2010024195A1 (ja) | 電動機の外乱抑圧装置および外乱抑圧方法 | |
| JP4134158B2 (ja) | 電動パワーステアリング制御装置 | |
| CN104993766B (zh) | 一种二质量系统谐振抑制方法 | |
| CN105874196A (zh) | 功率斜变的桨距前馈 | |
| WO2008075558A1 (ja) | 位置制御装置 | |
| JP6519650B2 (ja) | モータ制御装置及びそれを搭載した電動パワーステアリング装置 | |
| WO2012067229A1 (ja) | 電動機の位置制御装置 | |
| JP4294344B2 (ja) | 電動機の制御方法及び制御装置 | |
| CN111038576B (zh) | 电动助力转向系统中的抖动噪声管理 | |
| JP5488044B2 (ja) | 回転電気機械のトルクリプル抑制制御装置および制御方法 | |
| JP5434264B2 (ja) | サーボ制御装置 | |
| JP5362339B2 (ja) | モータ制御装置 | |
| JP2018529165A (ja) | 負荷側に測定手段を追加することなしに負荷振動を減衰させる方法および装置 | |
| JP6703338B2 (ja) | 電動パワーステアリング装置 | |
| JP5017984B2 (ja) | サーボ制御装置とその速度追従制御方法 | |
| JP2009048462A (ja) | 機械的共振周波数補償装置 | |
| JP7156184B2 (ja) | パラメータ調整方法 | |
| JP2014136509A (ja) | 自動操舵装置 | |
| WO2019123573A1 (ja) | 電動機の制御装置 | |
| JP2009018808A (ja) | 電動パワーステアリング装置 | |
| JP5702055B2 (ja) | 電力動揺抑制装置、電力動揺抑制方法および電力動揺制御プログラム | |
| JP2019213309A (ja) | 巻線界磁型同期モータの制御方法、及び、制御装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A711 | Notification of change in applicant |
Free format text: JAPANESE INTERMEDIATE CODE: A712 Effective date: 20110422 |
|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20120416 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20130814 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20130917 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20131017 |
|
| 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: 20131112 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20131125 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 5434264 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |