JP3815545B2 - 振動抑制位置決め制御装置 - Google Patents
振動抑制位置決め制御装置 Download PDFInfo
- Publication number
- JP3815545B2 JP3815545B2 JP2001030290A JP2001030290A JP3815545B2 JP 3815545 B2 JP3815545 B2 JP 3815545B2 JP 2001030290 A JP2001030290 A JP 2001030290A JP 2001030290 A JP2001030290 A JP 2001030290A JP 3815545 B2 JP3815545 B2 JP 3815545B2
- Authority
- JP
- Japan
- Prior art keywords
- position command
- command
- zero
- output
- target position
- 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
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D3/00—Control of position or direction
- G05D3/12—Control of position or direction using feedback
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B5/00—Anti-hunting arrangements
- G05B5/01—Anti-hunting arrangements electric
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Control Of Position Or Direction (AREA)
- Feedback Control In General (AREA)
- Control Of Electric Motors In General (AREA)
Description
【０００１】
【発明の属する技術分野】
本発明は、モータで負荷を駆動して位置決めする位置決め制御装置に関し、とくに、負荷又は負荷が置かれる機台に存在する低周波数の振動を抑制する技術に関する。
【０００２】
【従来の技術】
近年の産業用機械は、軽量化や小型化の要求から、モータと負荷を接続する軸や駆動機構が置かれる機台の剛性が低下しつつあり、負荷系や機台の固有周波数が低下する傾向にある。またこれと並行してサーボ制御系の性能が高められ、駆動系の応答も高められる傾向にある。このような状況にあるサーボ制御系については、負荷や機台が振動しやすくなるという問題が顕在化しつつある。
従来、このような振動を抑制するため、図３に示すような「電気学会研究会資料」IIC-96-17, pp.75-84に記載されたサーボ制御装置が提案されている。図において、３１はＳ字位置指令発生器、３２は準安定型プレフィルタ、３３はセミクローズドフィードバック位置制御系であり、３３aはフィードバック制御系の位置指令からモータ位置までの伝達関数、３３bはモータ位置から負荷位置までの伝達関数である。このフィードバック制御系における負荷の固有振動角周波数はωａであり、Ｓ字位置指令θ* Ｍの速度パターンが図５に示すような加速時間と減速時間が等しい台形となっている場合を例示している。なお、ｔＡは加減速時間、（ｔＤ-ｔＡ）は等速時間である。
このような制御系をしている場合、フィードバック位置制御系３３の振動極ωａは、図３からわかるように、準安定型プレフィルタ３２の伝達関数
【数３】
が持つ零点によってキャンセルされ、また、ωａｎを（４）式のいずれかを満足するように設定することによって、制振制御が実現される。
【数４】
【０００３】
【発明が解決しようとする課題】
ところが、前記の従来の技術によると、
（１）目標位置指令θ* Ｍの加減速時間および等速時間が短い場合、フィードバック系の位置指令θ** Ｍが急峻になる。（図６参照。詳細な説明は後述）
（２）（４）式は厳密に満たされる必要があり、満たされないと持続振動が発生する。例えば、目標位置指令θ* Ｍの加減速時間がわずか５％変動すると、後述の図７に示すようにフィードバック系の位置指令θ** Ｍが持続的に振動する。
（３）従来の準安定型プレフィルタをＣＰＵ等の演算手段で実現しようとすると、離散時間化による誤差で、準安定型プレフィルタの臨界安定極が不安定な極となるため、準安定型プレフィルタが不安定となる。たとえば、サンプル時間がわずか１００μｓであっても、図８に示すようにフィードバック系の位置指令θ** Ｍが不安定（振動しながら発散）なものとなる。
などの問題があった。
従来の準安定型プレフィルタの問題を考察すると、問題の本質がすべてフィルタの分母の減衰項がゼロであることに帰着する。通常は、減衰項が入ったフィルタを単純に適用することを考えるが、この場合、フィルタの遅れ時間が大きくなり、位置決め時間が伸びてしまう。従来例はこの遅れ時間をなくすために、減衰項をゼロにしているものと考えられる。したがって、従来の考え方の延長では、「安定性が高くかつ位置決め時間が短い」プレフィルタは構成できなかった。本発明は、この根本的な問題を解決するために、フィードバック制御系の位置指令が目標指令と一致したときにプレフィルタの出力をゼロとすることにより、フィードバック制御系の位置指令を目標位置に定着させて、短時間に安定な位置決めをすることができる振動抑制位置決め制御装置を提供することを目的とする。
【０００４】
【課題を解決するための手段】
請求項１の発明の振動抑制位置決め制御装置は、所定のパターンで変化する目標位置指令の微分値を与えると、位置指令を生成し、その位置指令をフィードバック制御系に入力して負荷を前記位置指令に追従させる位置決め制御装置において、前記目標位置指令の微分値を積分する積分器と、前記積分器の出力と前記位置指令を差し引いて位置指令偏差を出力する減算器と、式（５）の伝達関数をもち前記目標位置指令の微分値を入力する安定型プレフィルタと、前記安定型プレフィルタの出力と前記位置指令偏差を入力し、前記目標位置指令の微分値が零から非零になれば指令開始と判断し、前記目標位置指令の微分値が非零から零になれば指令終了と判断するとともに、指令終了の後、前記位置指令偏差が０になってから次の指令開始までは０を出力し、それ以外は前記安定型プレフィルタの出力をそのまま出力する指令定着部と、前記指令定着部の出力を積分して前記位置指令を出力する第２の積分器と、を備えることを特徴としている。
【数５】
請求項２の発明の振動抑制位置決め制御装置は、所定のパターンで変化する目標位置指令を与えると、位置指令を生成し、その位置指令をフィードバック制御系に入力して負荷を前記位置指令に追従させる位置決め制御装置において、前記目標位置指令を微分する微分器と、前記目標位置指令と前記位置指令を差し引いて位置指令偏差を出力する減算器と、式（６）の伝達関数をもち前記微分器の出力を入力する安定型プレフィルタと、前記安定型プレフィルタの出力と前記位置指令偏差を入力し、前記目標位置指令の微分値が零から非零になれば指令開始と判断し、前記目標位置指令の微分値が非零から零になれば指令終了と判断するとともに、指令終了の後、前記位置指令偏差が０になってから次の指令開始までは０を出力し、それ以外は前記安定型プレフィルタの出力をそのまま出力する指令定着部と、前記指令定着部の出力を積分して前記位置指令を出力する第２の積分器と、を備えることを特徴としている。
【数６】
以上のようになっているため、負荷又は負荷が置かれる機台に低周波数の振動が存在することがあっても、短時間に安定な位置決めをすることができるのである。
【０００５】
【発明の実施の形態】
以下、本発明の実施の形態について、図を用いて説明する。図１と図２はそれぞれ本発明の実施例１と実施例２を示すブロック図であり、図４は本発明を適用したシステムの構成図である。
まず図４から説明すると、４１はモータ、４３は負荷、４２はモータ４１と負荷４３を連結して回転力を伝える力伝達機構であり、４４はこれらを搭載する機台、４５は機台４４を支える支持足である。モータ４１が力伝達機構４２を介して負荷４３を駆動するとき、機台４４がモータ４１の駆動力の反力を受ける。支持足４５の剛性が低い場合は機台４４が振動しやすく、また、モータが高加減速度で負荷を駆動する場合で、特に駆動力の周期が機台４４の固有振動周期に近いときは機台４４が振動しやすい。
このような機台４４の振動を抑制するため、本発明の実施例１と実施例２の制御系はそれぞれ図１と図２のように構成されている。これらの図において、５はフィードバック制御系、５aはフィードバック制御系５の位置指令ｘ***から機台変位ｙまでの伝達関数の安定項、５bは同じくその伝達関数の不安定項である。なお、ω０は機台４４の固有振動周波数である。
図１において、目標位置指令の微分値ｖ*が与えられると、積分器６では目標位置指令の微分値ｖ*が積分されて目標位置指令ｘ*が得られる。
図２において、目標位置指令ｘ*が与えられると、微分器８では目標位置指令ｘ*が微分されて目標位置指令の微分値ｖ*が得られる。
図１および図２において、まず、減算器７では、目標位置指令ｘ*からフィードバック制御系５の位置指令ｘ***が減算されて位置指令偏差ｅｒが得られる。目標位置指令の微分値ｖ*が式（７）の伝達関数を持つ安定型プレフィルタ１に入力される。
【数７】
こうして得られた信号ｖ**と、位置指令偏差ｅｒと、目標位置指令の微分値ｖ*は指令定着部２に入力される。
次に、指令定着部２では、目標位置指令の微分値ｖ*に基づいて目標指令の開始と終了が判断される。ｖ*が零から非零になるときは、指令開始と判断され、ｖ*が非零から零になるときは、指令終了と判断される。また、指令終了の後、位置指令偏差ｅｒが０になってから次の指令開始までは切替スイッチをＢ側に倒して０が出力され、それ以外の場合には、Ａ側に倒してｖ**が出力される。すなわち、フィードバック制御系の位置指令が目標位置に達する前は、安定型プレフィルタ１通過後の信号ｖ**を出力し、フィードバック制御系の位置指令が目標位置に達した後は、０を出力する、という動作がとられるのである。なお、図５のパターンを繰り返す連続送りの場合では、フィードバック制御系の位置指令が目標位置に達してから次の送りの始まりまで、安定型プレフィルタ１の全状態量をゼロにクリアする処理を追加する。これにより、安定型プレフィルタ１が常に初期状態で起動するので、連続する図５のパターンの間隔が短い場合でも、安定型プレフィルタ１が正常に動作する効果がある。
最後に、指令定着部２の出力ｖ***が積分器４で積分演算されて位置指令ｘ***が得られると、位置指令としてフィードバック制御系５に入力される。
以上述べたように、目標位置指令の微分値を安定型プレフィルタ１に通させることにより、目標位置指令の微分値に含まれる機台の固有振動周波数ω０成分が除去されるので、安定型プレフィルタ１通過後の指令信号は安定かつなだらかで、機台の振動を励起しないものとなる。また、安定型プレフィルタ１通過後の指令信号を指令定着部２に通過させることにより、フィードバック制御系に加わる最終の指令信号をすばやく目標位置に到達させることができるのである。こうして、機台の振動を励起させることなく、指令定着時間が短い安定な位置決め指令を得ることができる。
次に、この実施例における発明の効果について、次の３つのケースについてシミュレーションしたので説明する。
ケース１） ｔＡが一定で、従来の準安定型プレフィルタおよび本発明の安定型プレフィルタを連続系で実現する。
ケース２） ｔＡが５％下がり、従来の準安定型プレフィルタおよび本発明の安定型プレフィルタを連続系で実現する。
ケース３） ｔＡが一定で、従来の準安定型プレフィルタおよび本発明の安定型プレフィルタを離散系で実現する（サンプル周期Ts=１００μｓ）。
シミュレーションに用いる共通する条件は、目標位置指令ｘ*がＱＭ *と同じ、図５に示したパターンで、ｔＡ＝18.8ms、ｔＤ＝27.2msであり、機台の固有振動周波数はω０＝12Hzである。
従来の技術については、準安定型プレフィルタＦ１（ｓ）のパラメータをωａ＝ω０、ωａｎ＝２π／ｔＡとして上記３つのケースについてシミュレーションし、その結果、得られた位置指令の時間関数をそれぞれ図６、図７および図８に示す。
本発明を適用した場合については、安定型プレフィルタＦ２（ｓ）のパラメータをω２＝2ω０、ζ２＝0.４として上記３つのケースについてシミュレーションし、その結果、得られた位置指令の時間関数をそれぞれ図９、図１０および図１１に示す。
図６〜８を図９〜１１と比較してわかるように、従来技術のフィードバック系の位置指令ＱＭ **は
１） 波形が急峻である。
２） ｔＡを少し（５％）下げるだけでも、持続的に振動する。
３） 準安定型プレフィルタを離散系で実現すると、不安定になる。
となっているのに対して、本発明のフィードバック制御系の位置指令Ｘ***は
１） なだらかである。
２） ｔＡを少し（５％）下げても、波形がほぼ変わらない。
３） 安定型プレフィルタを離散系で実現しても、波形が全然変わらない。
となっており、従来技術にくらべて時間応答が大幅に改善されていることがわかる。
なお、安定型プレフィルタＦ２（ｓ）通過後の位置指令ｘ**はオーバーシュートしているが、指令定着部２の出力であるフィードバック制御系の位置指令ｘ***はオーバーシュートしていないため、指令定着時間が非常に短かくなっている。
【０００６】
【発明の効果】
以上のべたように本発明によれば、目標指令信号を安定型プレフィルタに通しているので、目標指令信号に含まれる機械の固有振動周波数成分が除去され、しかも安定型プレフィルタ通過後の指令信号が安定かつなだらかなものとなっている。また、安定型プレフィルタ通過後の指令信号を指令定着部に通しているので、フィードバック制御系に加わる最終の指令信号がすばやく目標位置に到達するようになっている。従って、機械の振動を励起させることなく、指令定着時間が短い安定な位置決め指令を得ることができるという大きな効果がある。
【図面の簡単な説明】
【図１】本発明の実施例１を示すブロック図
【図２】本発明の実施例２を示すブロック図
【図３】従来の振動抑制位置決め制御装置の構成を示すブロック図
【図４】本発明の実施例のシステム構成図
【図５】Ｓ字位置指令および指令の速度パターンの時間関数を示す図
【図６】ｔＡが一定で、準安定型プレフィルタを連続系で実現する場合の従来技術の位置指令の時間関数を示す図
【図７】ｔＡが５％下がり、準安定型プレフィルタを連続系で実現する場合の従来技術の位置指令の時間関数を示す図
【図８】ｔＡが一定で、準安定型プレフィルタを離散系で実現する場合の従来技術の位置指令の時間関数を示す図
【図９】ｔＡが一定で、安定型プレフィルタを連続系で実現する場合の本発明の位置指令の時間関数を示す図
【図１０】ｔＡが５％下がり、安定型プレフィルタを連続系で実現する場合の本発明の位置指令の時間関数を示す図
【図１１】ｔＡが一定で、安定型プレフィルタを離散系で実現する場合の本発明の位置指令の時間関数を示す図
【符号の説明】
１ 安定型プレフィルタ
２ 指令定着部
２a 切替判別部
２b 切替スイッチ
２c 定数０
３、４、６ 積分器
５ フィードバック制御系
５a フィードバック制御系の位置指令から機台変位までの伝達関数の安定項
５b フィードバック制御系の位置指令から機台変位までの伝達関数の不安定項
７ 減算器
８ 微分器
３１ Ｓ字位置指令発生器
３２ 準安定型プレフィルタ
３３ セミクローズドフィードバック制御系
３３a フィードバック制御系の位置指令からモータ位置までの伝達関数
３３b フィードバック制御系のモータ位置から負荷位置までの伝達関数
４１ モータ
４２ 力伝達機構
４３ 負荷
４４ 機台
４５ 支持足
【発明の属する技術分野】
本発明は、モータで負荷を駆動して位置決めする位置決め制御装置に関し、とくに、負荷又は負荷が置かれる機台に存在する低周波数の振動を抑制する技術に関する。
【０００２】
【従来の技術】
近年の産業用機械は、軽量化や小型化の要求から、モータと負荷を接続する軸や駆動機構が置かれる機台の剛性が低下しつつあり、負荷系や機台の固有周波数が低下する傾向にある。またこれと並行してサーボ制御系の性能が高められ、駆動系の応答も高められる傾向にある。このような状況にあるサーボ制御系については、負荷や機台が振動しやすくなるという問題が顕在化しつつある。
従来、このような振動を抑制するため、図３に示すような「電気学会研究会資料」IIC-96-17, pp.75-84に記載されたサーボ制御装置が提案されている。図において、３１はＳ字位置指令発生器、３２は準安定型プレフィルタ、３３はセミクローズドフィードバック位置制御系であり、３３aはフィードバック制御系の位置指令からモータ位置までの伝達関数、３３bはモータ位置から負荷位置までの伝達関数である。このフィードバック制御系における負荷の固有振動角周波数はωａであり、Ｓ字位置指令θ* Ｍの速度パターンが図５に示すような加速時間と減速時間が等しい台形となっている場合を例示している。なお、ｔＡは加減速時間、（ｔＤ-ｔＡ）は等速時間である。
このような制御系をしている場合、フィードバック位置制御系３３の振動極ωａは、図３からわかるように、準安定型プレフィルタ３２の伝達関数
【数３】
【数４】
【発明が解決しようとする課題】
ところが、前記の従来の技術によると、
（１）目標位置指令θ* Ｍの加減速時間および等速時間が短い場合、フィードバック系の位置指令θ** Ｍが急峻になる。（図６参照。詳細な説明は後述）
（２）（４）式は厳密に満たされる必要があり、満たされないと持続振動が発生する。例えば、目標位置指令θ* Ｍの加減速時間がわずか５％変動すると、後述の図７に示すようにフィードバック系の位置指令θ** Ｍが持続的に振動する。
（３）従来の準安定型プレフィルタをＣＰＵ等の演算手段で実現しようとすると、離散時間化による誤差で、準安定型プレフィルタの臨界安定極が不安定な極となるため、準安定型プレフィルタが不安定となる。たとえば、サンプル時間がわずか１００μｓであっても、図８に示すようにフィードバック系の位置指令θ** Ｍが不安定（振動しながら発散）なものとなる。
などの問題があった。
従来の準安定型プレフィルタの問題を考察すると、問題の本質がすべてフィルタの分母の減衰項がゼロであることに帰着する。通常は、減衰項が入ったフィルタを単純に適用することを考えるが、この場合、フィルタの遅れ時間が大きくなり、位置決め時間が伸びてしまう。従来例はこの遅れ時間をなくすために、減衰項をゼロにしているものと考えられる。したがって、従来の考え方の延長では、「安定性が高くかつ位置決め時間が短い」プレフィルタは構成できなかった。本発明は、この根本的な問題を解決するために、フィードバック制御系の位置指令が目標指令と一致したときにプレフィルタの出力をゼロとすることにより、フィードバック制御系の位置指令を目標位置に定着させて、短時間に安定な位置決めをすることができる振動抑制位置決め制御装置を提供することを目的とする。
【０００４】
【課題を解決するための手段】
請求項１の発明の振動抑制位置決め制御装置は、所定のパターンで変化する目標位置指令の微分値を与えると、位置指令を生成し、その位置指令をフィードバック制御系に入力して負荷を前記位置指令に追従させる位置決め制御装置において、前記目標位置指令の微分値を積分する積分器と、前記積分器の出力と前記位置指令を差し引いて位置指令偏差を出力する減算器と、式（５）の伝達関数をもち前記目標位置指令の微分値を入力する安定型プレフィルタと、前記安定型プレフィルタの出力と前記位置指令偏差を入力し、前記目標位置指令の微分値が零から非零になれば指令開始と判断し、前記目標位置指令の微分値が非零から零になれば指令終了と判断するとともに、指令終了の後、前記位置指令偏差が０になってから次の指令開始までは０を出力し、それ以外は前記安定型プレフィルタの出力をそのまま出力する指令定着部と、前記指令定着部の出力を積分して前記位置指令を出力する第２の積分器と、を備えることを特徴としている。
【数５】
【数６】
【０００５】
【発明の実施の形態】
以下、本発明の実施の形態について、図を用いて説明する。図１と図２はそれぞれ本発明の実施例１と実施例２を示すブロック図であり、図４は本発明を適用したシステムの構成図である。
まず図４から説明すると、４１はモータ、４３は負荷、４２はモータ４１と負荷４３を連結して回転力を伝える力伝達機構であり、４４はこれらを搭載する機台、４５は機台４４を支える支持足である。モータ４１が力伝達機構４２を介して負荷４３を駆動するとき、機台４４がモータ４１の駆動力の反力を受ける。支持足４５の剛性が低い場合は機台４４が振動しやすく、また、モータが高加減速度で負荷を駆動する場合で、特に駆動力の周期が機台４４の固有振動周期に近いときは機台４４が振動しやすい。
このような機台４４の振動を抑制するため、本発明の実施例１と実施例２の制御系はそれぞれ図１と図２のように構成されている。これらの図において、５はフィードバック制御系、５aはフィードバック制御系５の位置指令ｘ***から機台変位ｙまでの伝達関数の安定項、５bは同じくその伝達関数の不安定項である。なお、ω０は機台４４の固有振動周波数である。
図１において、目標位置指令の微分値ｖ*が与えられると、積分器６では目標位置指令の微分値ｖ*が積分されて目標位置指令ｘ*が得られる。
図２において、目標位置指令ｘ*が与えられると、微分器８では目標位置指令ｘ*が微分されて目標位置指令の微分値ｖ*が得られる。
図１および図２において、まず、減算器７では、目標位置指令ｘ*からフィードバック制御系５の位置指令ｘ***が減算されて位置指令偏差ｅｒが得られる。目標位置指令の微分値ｖ*が式（７）の伝達関数を持つ安定型プレフィルタ１に入力される。
【数７】
次に、指令定着部２では、目標位置指令の微分値ｖ*に基づいて目標指令の開始と終了が判断される。ｖ*が零から非零になるときは、指令開始と判断され、ｖ*が非零から零になるときは、指令終了と判断される。また、指令終了の後、位置指令偏差ｅｒが０になってから次の指令開始までは切替スイッチをＢ側に倒して０が出力され、それ以外の場合には、Ａ側に倒してｖ**が出力される。すなわち、フィードバック制御系の位置指令が目標位置に達する前は、安定型プレフィルタ１通過後の信号ｖ**を出力し、フィードバック制御系の位置指令が目標位置に達した後は、０を出力する、という動作がとられるのである。なお、図５のパターンを繰り返す連続送りの場合では、フィードバック制御系の位置指令が目標位置に達してから次の送りの始まりまで、安定型プレフィルタ１の全状態量をゼロにクリアする処理を追加する。これにより、安定型プレフィルタ１が常に初期状態で起動するので、連続する図５のパターンの間隔が短い場合でも、安定型プレフィルタ１が正常に動作する効果がある。
最後に、指令定着部２の出力ｖ***が積分器４で積分演算されて位置指令ｘ***が得られると、位置指令としてフィードバック制御系５に入力される。
以上述べたように、目標位置指令の微分値を安定型プレフィルタ１に通させることにより、目標位置指令の微分値に含まれる機台の固有振動周波数ω０成分が除去されるので、安定型プレフィルタ１通過後の指令信号は安定かつなだらかで、機台の振動を励起しないものとなる。また、安定型プレフィルタ１通過後の指令信号を指令定着部２に通過させることにより、フィードバック制御系に加わる最終の指令信号をすばやく目標位置に到達させることができるのである。こうして、機台の振動を励起させることなく、指令定着時間が短い安定な位置決め指令を得ることができる。
次に、この実施例における発明の効果について、次の３つのケースについてシミュレーションしたので説明する。
ケース１） ｔＡが一定で、従来の準安定型プレフィルタおよび本発明の安定型プレフィルタを連続系で実現する。
ケース２） ｔＡが５％下がり、従来の準安定型プレフィルタおよび本発明の安定型プレフィルタを連続系で実現する。
ケース３） ｔＡが一定で、従来の準安定型プレフィルタおよび本発明の安定型プレフィルタを離散系で実現する（サンプル周期Ts=１００μｓ）。
シミュレーションに用いる共通する条件は、目標位置指令ｘ*がＱＭ *と同じ、図５に示したパターンで、ｔＡ＝18.8ms、ｔＤ＝27.2msであり、機台の固有振動周波数はω０＝12Hzである。
従来の技術については、準安定型プレフィルタＦ１（ｓ）のパラメータをωａ＝ω０、ωａｎ＝２π／ｔＡとして上記３つのケースについてシミュレーションし、その結果、得られた位置指令の時間関数をそれぞれ図６、図７および図８に示す。
本発明を適用した場合については、安定型プレフィルタＦ２（ｓ）のパラメータをω２＝2ω０、ζ２＝0.４として上記３つのケースについてシミュレーションし、その結果、得られた位置指令の時間関数をそれぞれ図９、図１０および図１１に示す。
図６〜８を図９〜１１と比較してわかるように、従来技術のフィードバック系の位置指令ＱＭ **は
１） 波形が急峻である。
２） ｔＡを少し（５％）下げるだけでも、持続的に振動する。
３） 準安定型プレフィルタを離散系で実現すると、不安定になる。
となっているのに対して、本発明のフィードバック制御系の位置指令Ｘ***は
１） なだらかである。
２） ｔＡを少し（５％）下げても、波形がほぼ変わらない。
３） 安定型プレフィルタを離散系で実現しても、波形が全然変わらない。
となっており、従来技術にくらべて時間応答が大幅に改善されていることがわかる。
なお、安定型プレフィルタＦ２（ｓ）通過後の位置指令ｘ**はオーバーシュートしているが、指令定着部２の出力であるフィードバック制御系の位置指令ｘ***はオーバーシュートしていないため、指令定着時間が非常に短かくなっている。
【０００６】
【発明の効果】
以上のべたように本発明によれば、目標指令信号を安定型プレフィルタに通しているので、目標指令信号に含まれる機械の固有振動周波数成分が除去され、しかも安定型プレフィルタ通過後の指令信号が安定かつなだらかなものとなっている。また、安定型プレフィルタ通過後の指令信号を指令定着部に通しているので、フィードバック制御系に加わる最終の指令信号がすばやく目標位置に到達するようになっている。従って、機械の振動を励起させることなく、指令定着時間が短い安定な位置決め指令を得ることができるという大きな効果がある。
【図面の簡単な説明】
【図１】本発明の実施例１を示すブロック図
【図２】本発明の実施例２を示すブロック図
【図３】従来の振動抑制位置決め制御装置の構成を示すブロック図
【図４】本発明の実施例のシステム構成図
【図５】Ｓ字位置指令および指令の速度パターンの時間関数を示す図
【図６】ｔＡが一定で、準安定型プレフィルタを連続系で実現する場合の従来技術の位置指令の時間関数を示す図
【図７】ｔＡが５％下がり、準安定型プレフィルタを連続系で実現する場合の従来技術の位置指令の時間関数を示す図
【図８】ｔＡが一定で、準安定型プレフィルタを離散系で実現する場合の従来技術の位置指令の時間関数を示す図
【図９】ｔＡが一定で、安定型プレフィルタを連続系で実現する場合の本発明の位置指令の時間関数を示す図
【図１０】ｔＡが５％下がり、安定型プレフィルタを連続系で実現する場合の本発明の位置指令の時間関数を示す図
【図１１】ｔＡが一定で、安定型プレフィルタを離散系で実現する場合の本発明の位置指令の時間関数を示す図
【符号の説明】
１ 安定型プレフィルタ
２ 指令定着部
２a 切替判別部
２b 切替スイッチ
２c 定数０
３、４、６ 積分器
５ フィードバック制御系
５a フィードバック制御系の位置指令から機台変位までの伝達関数の安定項
５b フィードバック制御系の位置指令から機台変位までの伝達関数の不安定項
７ 減算器
８ 微分器
３１ Ｓ字位置指令発生器
３２ 準安定型プレフィルタ
３３ セミクローズドフィードバック制御系
３３a フィードバック制御系の位置指令からモータ位置までの伝達関数
３３b フィードバック制御系のモータ位置から負荷位置までの伝達関数
４１ モータ
４２ 力伝達機構
４３ 負荷
４４ 機台
４５ 支持足
Claims (2)
- 所定のパターンで変化する目標位置指令の微分値を与えると、位置指令を生成し、その位置指令をフィードバック制御系に入力して負荷を前記位置指令に追従させる位置決め制御装置において、
前記目標位置指令の微分値を積分する積分器と、
前記積分器の出力と前記位置指令を差し引いて位置指令偏差を出力する減算器と、
式（１）の伝達関数をもち前記目標位置指令の微分値を入力する安定型プレフィルタと、
前記指令定着部の出力を積分して前記位置指令を出力する第２の積分器と、
を備えることを特徴とする振動抑制位置決め制御装置。 - 所定のパターンで変化する目標位置指令を与えると、位置指令を生成し、その位置指令をフィードバック制御系に入力して負荷を前記位置指令に追従させる位置決め制御装置において、
前記目標位置指令を微分する微分器と、
前記目標位置指令と前記位置指令を差し引いて位置指令偏差を出力する減算器と、
式（２）の伝達関数をもち前記微分器の出力を入力する安定型プレフィルタと、
前記指令定着部の出力を積分して前記位置指令を出力する第２の積分器と、
を備えることを特徴とする振動抑制位置決め制御装置。
Priority Applications (7)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2001030290A JP3815545B2 (ja) | 2001-02-07 | 2001-02-07 | 振動抑制位置決め制御装置 |
| KR1020037010392A KR100664468B1 (ko) | 2001-02-07 | 2002-01-24 | 진동 억제 위치 결정 제어 장치 |
| DE60228819T DE60228819D1 (de) | 2001-02-07 | 2002-01-24 | Vibrationsunterdrückende positionsregelung |
| US10/467,086 US6801010B2 (en) | 2001-02-07 | 2002-01-24 | Vibration suppression positioning controller |
| EP02716376A EP1359480B1 (en) | 2001-02-07 | 2002-01-24 | Vibration suppression positioning controller |
| PCT/JP2002/000531 WO2002063401A1 (fr) | 2001-02-07 | 2002-01-24 | Unite de commande de localisation et de suppression de vibrations |
| TW091101791A TW513627B (en) | 2001-02-07 | 2002-02-01 | Positioning control device for suppressing vibration |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2001030290A JP3815545B2 (ja) | 2001-02-07 | 2001-02-07 | 振動抑制位置決め制御装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2002229602A JP2002229602A (ja) | 2002-08-16 |
| JP3815545B2 true JP3815545B2 (ja) | 2006-08-30 |
Family
ID=18894526
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2001030290A Expired - Fee Related JP3815545B2 (ja) | 2001-02-07 | 2001-02-07 | 振動抑制位置決め制御装置 |
Country Status (7)
| Country | Link |
|---|---|
| US (1) | US6801010B2 (ja) |
| EP (1) | EP1359480B1 (ja) |
| JP (1) | JP3815545B2 (ja) |
| KR (1) | KR100664468B1 (ja) |
| DE (1) | DE60228819D1 (ja) |
| TW (1) | TW513627B (ja) |
| WO (1) | WO2002063401A1 (ja) |
Families Citing this family (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP3946046B2 (ja) * | 2002-01-15 | 2007-07-18 | 富士機械製造株式会社 | 機械の制振制御方法および制振制御型機械 |
| AU2003218101A1 (en) * | 2002-03-13 | 2003-09-29 | Georgia Tech Research Corporation | Shaping and smooth baseline function command generator |
| JP4228389B2 (ja) * | 2003-06-30 | 2009-02-25 | 株式会社安川電機 | 位置決め制御装置 |
| JP4541218B2 (ja) * | 2005-04-08 | 2010-09-08 | 三菱電機株式会社 | 指令生成装置 |
| JP4926559B2 (ja) * | 2006-06-26 | 2012-05-09 | 国立大学法人長岡技術科学大学 | 位置制御装置、位置制御方法、ロボット制御装置およびロボット制御方法 |
| US8235351B1 (en) * | 2009-08-27 | 2012-08-07 | Lockheed Martin Corporation | Shock load isolation mounting |
| JP6818523B2 (ja) * | 2016-11-17 | 2021-01-20 | キヤノン株式会社 | インプリント装置及び物品の製造方法 |
| JP6863818B2 (ja) * | 2017-05-01 | 2021-04-21 | 芝浦機械株式会社 | 位置制御装置 |
| JP7013836B2 (ja) * | 2017-12-15 | 2022-02-01 | オムロン株式会社 | 制御装置 |
Family Cites Families (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP3448991B2 (ja) * | 1994-11-29 | 2003-09-22 | 株式会社ニコン | ステージ移動制御装置、投影型露光装置およびステージ駆動方法ならびに露光方法。 |
| JP3815809B2 (ja) * | 1995-08-07 | 2006-08-30 | 富士通株式会社 | 光学的記憶装置 |
| US6128552A (en) * | 1996-11-08 | 2000-10-03 | Canon Kabushiki Kaisha | Anti-vibration apparatus and method |
| US5721477A (en) * | 1997-02-11 | 1998-02-24 | The University Of Manitoba | Nonlinear proportional integral controller |
| KR100237306B1 (ko) * | 1997-03-25 | 2000-01-15 | 윤종용 | 2관성 공진계의 진동 억제방법 및 장치 |
| JP4109747B2 (ja) * | 1998-05-07 | 2008-07-02 | キヤノン株式会社 | アクティブ除振装置および露光装置 |
| GB9814306D0 (en) * | 1998-07-01 | 1998-09-02 | Eastman Kodak Co | Photographic high contrast silver halide material and method of processing |
| JP2000274482A (ja) * | 1999-01-18 | 2000-10-03 | Canon Inc | 能動的除振装置、露光装置及び方法並びにデバイス製造方法 |
| JP2000284805A (ja) * | 1999-03-31 | 2000-10-13 | Shibaura Mechatronics Corp | フィードバック制御装置 |
| JP3430967B2 (ja) | 1999-04-22 | 2003-07-28 | 三菱電機株式会社 | サーボ制御装置 |
| US6140791A (en) * | 1999-06-10 | 2000-10-31 | Samsung Information Systems America | Method and apparatus for controlling the acceleration trajectory of positioning a high-velocity transducer and for reducing the harmonic content thereof |
-
2001
- 2001-02-07 JP JP2001030290A patent/JP3815545B2/ja not_active Expired - Fee Related
-
2002
- 2002-01-24 US US10/467,086 patent/US6801010B2/en not_active Expired - Lifetime
- 2002-01-24 KR KR1020037010392A patent/KR100664468B1/ko not_active IP Right Cessation
- 2002-01-24 DE DE60228819T patent/DE60228819D1/de not_active Expired - Lifetime
- 2002-01-24 WO PCT/JP2002/000531 patent/WO2002063401A1/ja active IP Right Grant
- 2002-01-24 EP EP02716376A patent/EP1359480B1/en not_active Expired - Lifetime
- 2002-02-01 TW TW091101791A patent/TW513627B/zh not_active IP Right Cessation
Also Published As
| Publication number | Publication date |
|---|---|
| US20040061609A1 (en) | 2004-04-01 |
| US6801010B2 (en) | 2004-10-05 |
| EP1359480B1 (en) | 2008-09-10 |
| DE60228819D1 (de) | 2008-10-23 |
| KR100664468B1 (ko) | 2007-01-04 |
| KR20030075181A (ko) | 2003-09-22 |
| EP1359480A1 (en) | 2003-11-05 |
| JP2002229602A (ja) | 2002-08-16 |
| WO2002063401A1 (fr) | 2002-08-15 |
| TW513627B (en) | 2002-12-11 |
| EP1359480A4 (en) | 2006-03-08 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US9075400B2 (en) | Motor control device | |
| JP3815545B2 (ja) | 振動抑制位置決め制御装置 | |
| JP2004005469A (ja) | 電動機の制御方法及び制御装置 | |
| CN113557479A (zh) | 电动机控制装置、陷波滤波器调整装置、陷波滤波器调整方法 | |
| JP4367411B2 (ja) | モータの制御装置 | |
| JP5127767B2 (ja) | 駆動制御装置 | |
| JP5092831B2 (ja) | 位置決め制御装置 | |
| JPH07257830A (ja) | エレベーターの振動抑制制御装置 | |
| JPH0993971A (ja) | モータ制御装置 | |
| JP3132757B2 (ja) | クレーン制御方法 | |
| JP4660012B2 (ja) | 数値制御装置 | |
| JP2004246495A (ja) | 振動抑制指令生成装置 | |
| JP3742707B2 (ja) | 時変振動機構に用いる制振起動方法 | |
| JP4340846B2 (ja) | 位置決め制御装置 | |
| WO2015177912A1 (ja) | 指令生成装置および方法 | |
| JP3627092B2 (ja) | 加振装置 | |
| JP3890672B2 (ja) | 自励振動型振動装置 | |
| JPH01170396A (ja) | モータ速度制御装置 | |
| WO2023171122A1 (ja) | モータ制御装置、およびその自動調整方法 | |
| JP3265793B2 (ja) | 能動型振動制御装置及び車両用能動型振動制御装置 | |
| JP3890673B2 (ja) | 自励振動型振動装置 | |
| JP2762789B2 (ja) | 多関節ロボットの加減速制御方法 | |
| KR100676835B1 (ko) | 모터의 제어장치 | |
| JP4114208B2 (ja) | 電磁サスペンションの制御方法及び装置 | |
| JP2023183279A (ja) | ダイナモメータシステム |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20060117 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20060316 |
|
| 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: 20060517 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20060530 |
|
| 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: 20100616 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110616 Year of fee payment: 5 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120616 Year of fee payment: 6 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130616 Year of fee payment: 7 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140616 Year of fee payment: 8 |
|
| LAPS | Cancellation because of no payment of annual fees |