JP2009098965A - 移動体制御方法及び移動体制御装置 - Google Patents

移動体制御方法及び移動体制御装置 Download PDF

Info

Publication number
JP2009098965A
JP2009098965A JP2007270500A JP2007270500A JP2009098965A JP 2009098965 A JP2009098965 A JP 2009098965A JP 2007270500 A JP2007270500 A JP 2007270500A JP 2007270500 A JP2007270500 A JP 2007270500A JP 2009098965 A JP2009098965 A JP 2009098965A
Authority
JP
Japan
Prior art keywords
moving body
pattern
command value
jerk pattern
jerk
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.)
Granted
Application number
JP2007270500A
Other languages
English (en)
Other versions
JP4469388B2 (ja
Inventor
Daisuke Sako
大助 迫
Mokoto Kagihiro
誠 鎰廣
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Sumitomo Heavy Industries Ltd
Original Assignee
Sumitomo Heavy Industries Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Sumitomo Heavy Industries Ltd filed Critical Sumitomo Heavy Industries Ltd
Priority to JP2007270500A priority Critical patent/JP4469388B2/ja
Publication of JP2009098965A publication Critical patent/JP2009098965A/ja
Application granted granted Critical
Publication of JP4469388B2 publication Critical patent/JP4469388B2/ja
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Feedback Control In General (AREA)
  • Control Of Position Or Direction (AREA)

Abstract

【課題】移動体の制振性能及び位置決め性能の低下を抑制する。
【解決手段】コントローラ5は、所定の駆動パターンで移動体の駆動を制御するためのものであって、移動体の位置又は速度に関する命令値に基づいて移動体のジャークパターンを生成する生成部6と、ジャークパターンを通過させて移動体の位置指令値を出力するフィルタ部7と、を備えている。ここで、コントローラ5では、ジャークパターンをフィルタ部7に通過させて位置指令値を得ることから、位置指令値において共振周波数成分等の振動を励振する周波数成分を低減させることができる。また、コントローラ5では、フィルタ部7の伝達関数から求められた遅れ時間だけジャークパターンを圧縮するように調整して、調整ジャークパターンを生成する。よって、命令値と位置指令値とを時間的に互いに一致させることができる。
【選択図】図2

Description

本発明は、所定の駆動パターンで移動体の駆動を制御するための移動体制御方法及び移動体制御装置に関する。
所定の駆動パターンで移動体を駆動する装置においては、機械的な振動要素を有する場合、振動が移動体の駆動パターン等によって励振され、固有振動(機械共振)してしまうことがある。かかる振動は、移動体の制振性能に著しい悪影響を及ぼすおそれがある。そこで、従来の移動体制御方法として、移動体の位置又は速度に関する命令値(位置信号)をフィルタ部(ノッチフィルタ)に通過させて、移動体の位置指令値(精密位置決め用の信号)を生成する工程を含むものが知られている(例えば、特許文献1参照)。このような移動体制御方法では、移動体の制振性能の低下を抑制することが図られている。
特開平4−38777号公報
しかしながら、上記の移動体制御方法では、前述したように、命令値をフィルタ部に通過させて位置指令値を生成することから、フィルタ部の影響で命令値と位置指令値とが時間的に互いに不一致となり、移動体の位置決め性能が低下してしまうおそれがある。
そこで、本発明は、移動体の制振性能及び位置決め性能の低下を抑制することができる移動体制御方法及び移動体制御装置を提供することを課題とする。
上記課題を解決するため、本発明に係る移動体制御方法は、所定の駆動パターンで移動体の駆動を制御するための移動体制御方法であって、移動体の位置又は速度に関する命令値に基づいて移動体のジャークパターンを生成し、ジャークパターンをフィルタ部に通過させて移動体の位置指令値を生成する工程を含み、位置指令値を生成する工程においては、フィルタ部の伝達関数に基づいて、命令値に対する位置指令値の遅れ時間を求め、この遅れ時間だけジャークパターンを圧縮するように調整して調整ジャークパターンを生成し、調整ジャークパターンをフィルタ部に通過させること、を特徴とする。
また、本発明に係る移動体制御装置は、所定の駆動パターンで移動体の駆動を制御するための移動体制御装置であって、移動体の位置又は速度に関する命令値に基づいて移動体のジャークパターンを生成する生成部と、ジャークパターンを通過させて移動体の位置指令値を出力するフィルタ部と、を備え、生成部は、フィルタ部の伝達関数に基づいて、命令値に対する位置指令値の遅れ時間を求め、この遅れ時間だけジャークパターンを圧縮するように調整して調整ジャークパターンを生成すること、を特徴とする。
本発明では、ジャークパターンをフィルタ部に通過させて位置指令値を得るため、位置指令値において共振周波数成分等の振動を励振する周波数成分を低減させることができる。よって、機械的な振動要素を励振させずに移動体を駆動することが可能となる。また、フィルタ部の伝達関数から求められた遅れ時間だけジャークパターンを圧縮するように調整して調整ジャークパターンを生成する。よって、命令値と位置指令値とを時間的に互いに一致させることが可能となる。従って、本発明によれば、移動体の制振性能及び位置決め性能の低下を抑制することができ、その結果、移動体の整定時間の短縮化が可能となる。
また、フィルタ部は、ジャークパターンが通過する複数のフィルタを含んで構成され、位置指令値を生成する工程においては、複数のフィルタの複数の伝達関数のそれぞれに基づいて、複数の遅れ時間をそれぞれ求め、複数の遅れ時間の合計だけジャークパターンを圧縮するように調整して調整ジャークパターンを生成することが好ましい。また、フィルタ部は、ジャークパターンが通過する複数のフィルタを含んで構成され、生成部は、複数のフィルタの複数の伝達関数のそれぞれに基づいて、複数の遅れ時間をそれぞれ求め、複数の遅れ時間の合計だけジャークパターンを圧縮するように調整して調整ジャークパターンを生成することが好ましい。これらの場合、振動を励振する周波数が複数存在しても、これらの周波数成分を位置指令値において低減させることができる。
また、伝達関数は、具体的には、移動体の移動による当該移動体の振動を測定することにより決定される場合がある。
本発明によれば、移動体の制振性能及び位置決め性能の低下を抑制することができる。その結果、移動体の整定時間の短縮化が可能となる。
以下、添付図面を参照して、本発明の好適な実施形態について詳細に説明する。なお、以下の説明において同一又は相当要素には同一符号を付し、重複する説明は省略する。
図1は本発明の実施形態を含むステージ装置を示す概略図、図2は図1のステージ装置のコントローラを示す概略図である。図1に示すように、ステージ装置(装置)1は、例えば半導体や液晶の検査用又は製造用装置として用いられるものである。このステージ装置1は、定盤2、移動体3、アクチュエータ4及びコントローラ(移動体制御装置)5を備えており、所定の駆動パターンで移動体3を駆動する。
定盤2は、床16にバネ等の除振手段17を介して支持されている。移動体3は、定盤2上に設けられており、エアベアリング等の案内手段(不図示)により、水平方向に移動可能に構成されている。アクチュエータ4は、移動体3を駆動するための駆動手段であり、定盤2に設けられ例えば永久磁石からなる固定子4aと、移動体3に設けられ例えば電磁コイルからなる可動子4bとを含んで構成されている。この可動子4bには、コントローラ5が接続されている。
コントローラ5は、アクチュエータ4の駆動を制御して移動体3の駆動を制御するものであり、生成部6とフィルタ部7とを有している。このコントローラ5は、例えばユーザにより入力された移動体3の位置又は速度に関する命令値(以下、単に「命令値」という)に基づいて、移動体3のジャークパターンを生成する。そして、このジャークパターンをフィルタ部7に通過させて移動体3の位置指令値を生成する(詳しくは、後述)。
生成部6は、命令値に基づいて移動体3のジャークパターンを生成する。フィルタ部7は、ノッチフィルタを含む5次のフィルタであり、具体的には、ノッチフィルタ8及び積分器9を含んでいる。
ノッチフィルタ8は、ジャークパターンにおいて共振周波数成分等の振動を励振する成分を減衰(低減)させる。ここでは、ノッチフィルタ8として、下記(1)式に示す伝達関数H1の2次ノッチフィルタが採用されている。
H1(s)=(s+ω)/(s+2ζωs+ω)…(1)
但し、sは変数、ωは周波数、ζはノッチフィルタ係数である。
積分器9は、ノッチフィルタ8を通過した後のジャークパターンを積分し、位置指令値を出力する。ここでは、積分器9として、例えば、下記(2)式に示す伝達関数H2の積分器が採用されている。
H2(s)=1/s…(2)
次に、説明したステージ装置1のコントローラ5による移動体3の駆動制御について、図3を参照しつつ説明する。
まず、ノッチフィルタ8の設定を行なう(S1)。具体的には、移動体3を駆動することで生じる移動体3の振動を予め測定し、この測定結果に基づいて、ノッチフィルタ8の伝達関数を設定する。なお、この伝達関数は、ユーザの入力により設定される場合もある。
続いて、生成部6にて、ノッチフィルタ8の伝達関数に基づいて命令値に対する位置指令値の遅れ時間Tを求める(S2)。ここでの遅れ時間Tは、伝達関数の位相遅れに相当するものとしている。
続いて、移動体3のジャークパターンを生成する(S3)。具体的には、入力された命令値に基づいて、遅れ時間Tだけ圧縮するようにジャークパターンを調整して調整ジャークパターンを生成する。
図4は生成された調整ジャークパターンの一例を示す線図である。図中において、横軸は時間成分を示し、縦軸はジャーク成分を示す。また、図中において、実線J1は、移動時間Pから遅れ時間Tだけ時間成分が圧縮するように調整された本実施形態の調整ジャークパターンを示し、破線J2は、時間成分が圧縮されていない従来のジャークパターンを示す。
図4に示すように、調整ジャークパターンJ1は、波形全体が均等に圧縮するように調整されている。また、この調整ジャークパターンJ1は、ジャークパターンJ2による移動体3の移動量に対し同等の移動量を確保すべく、波形と時間軸とで囲まれた面積が一定に保持されるように圧縮されている。具体的には、調整ジャークパターンJ1は、その波形と時間軸とで囲まれた面積が維持されるように、時間成分が遅れ時間Tだけ縮小されると共にジャーク成分が拡大されている。なお、ここでの遅れ時間Tは、調整ジャークパターンJ1を圧縮し過ぎない程度の時間量に設定されている。これは、ジャークパターンが圧縮され過ぎると、最大ジャーク値が大きくなり、移動体3の加速度が増大して振動が大きくなるという問題が生じるためである。
続いて、生成した調整ジャークパターンJ1をフィルタ部7に通過させ(S4)、移動体3の位置指令値を生成する(S5)。そして、位置指令値を、アクチュエータ4の駆動制御値として当該アクチュエータ4へ出力し、これにより、アクチュエータ4の駆動が制御されることになる。
以上、本実施形態では、調整ジャークパターンJ1をノッチフィルタ8に通過させて位置指令値が得られるため、位置指令値において共振周波数成分等の振動を励振する周波数成分を低減させることができる。その結果、機械共振を抑制することができると共に、機械的な振動要素を励振させずに移動体3を駆動することが可能となる。ここで、上述したように、この調整ジャークパターンJ1にあっては、ノッチフィルタ8の伝達関数から求められた遅れ時間Tだけ圧縮されるように調整されている。よって、命令値と位置指令値とを時間的に互いに一致させることが可能となる。従って、本実施形態によれば、移動体3の制振性能及び位置決め性能の低下を抑制することができ、その結果、移動体3の整定時間の短縮化が可能となる。
つまり、本実施形態は、ジャークパターンを生成する段階で位置決め性能が担保されるものであり、ノッチフィルタ8による励振制御性能を維持しつつ、制振パターン(制振軌道)を移動体3の駆動パターンとして自動的に生成するものといえる。なお、本実施形態のコントローラ5を、既存の装置のコントローラに搭載させることも勿論可能である。
以上、本発明の好適な実施形態について説明したが、本発明は上記実施形態に限定されるものではない。
例えば、上記実施形態では、コントローラ5をステージ装置に適用したが、射出成形機、レーザ加工装置、ボンダ装置等に適用してもよい。要は、所定の駆動パターンで移動体を駆動する装置であれば、その移動体の駆動を制御するものとして適用することができる。
また、上記実施形態では、ジャークパターンJ1を、1つのノッチフィルタ8に通過させたが、複数のノッチフィルタに通過させてもよい。つまり、フィルタ部は、ジャークパターンが通過する複数のフィルタを含んで構成されてもよい。この場合、複数のフィルタの複数の伝達関数のそれぞれに基づいて複数の遅れ時間をそれぞれ求め、これら複数の遅れ時間の合計だけ圧縮するようにジャークパターンを調整して、調整ジャークパターンを生成する。これにより、振動を励振する周波数が複数存在しても、これらの周波数成分を位置指令値において低減させることが可能となる。
本発明の実施形態を含むステージ装置を示す概略図である。 図1のステージ装置のコントローラを示す概略図である。 図1のステージ装置のコントローラによる処理手順を示すフローチャートである。 生成された調整ジャークパターンの一例を示す線図である。
符号の説明
1…ステージ装置(装置)、3…移動体、5…コントローラ(移動体制御装置)、6…生成部、7…フィルタ部、J1…調整ジャークパターン。

Claims (5)

  1. 所定の駆動パターンで移動体の駆動を制御するための移動体制御方法であって、
    前記移動体の位置又は速度に関する命令値に基づいて前記移動体のジャークパターンを生成し、前記ジャークパターンをフィルタ部に通過させて前記移動体の位置指令値を生成する工程を含み、
    前記位置指令値を生成する工程においては、
    前記フィルタ部の伝達関数に基づいて、前記命令値に対する前記位置指令値の遅れ時間を求め、この遅れ時間だけ前記ジャークパターンを圧縮するように調整して調整ジャークパターンを生成し、前記調整ジャークパターンを前記フィルタ部に通過させること、を特徴とする移動体制御方法。
  2. 前記フィルタ部は、前記ジャークパターンが通過する複数のフィルタを含んで構成され、
    前記位置指令値を生成する工程においては、
    複数の前記フィルタの複数の前記伝達関数のそれぞれに基づいて、複数の前記遅れ時間をそれぞれ求め、複数の前記遅れ時間の合計だけ前記ジャークパターンを圧縮するように調整して前記調整ジャークパターンを生成すること、を特徴とする請求項1記載の移動体制御方法。
  3. 前記伝達関数は、前記移動体を駆動することで生じる当該移動体の振動を測定することにより決定されること、を特徴とする請求項1又は2記載の移動体制御方法。
  4. 所定の駆動パターンで移動体の駆動を制御するための移動体制御装置であって、
    前記移動体の位置又は速度に関する命令値に基づいて前記移動体のジャークパターンを生成する生成部と、
    前記ジャークパターンを通過させて前記移動体の位置指令値を出力するフィルタ部と、を備え、
    前記生成部は、
    前記フィルタ部の伝達関数に基づいて、前記命令値に対する前記位置指令値の遅れ時間を求め、この遅れ時間だけ前記ジャークパターンを圧縮するように調整して調整ジャークパターンを生成すること、を特徴とする移動体制御装置。
  5. 前記フィルタ部は、前記ジャークパターンが通過する複数のフィルタを含んで構成され、
    前記生成部は、
    複数の前記フィルタの複数の前記伝達関数のそれぞれに基づいて、複数の前記遅れ時間をそれぞれ求め、複数の前記遅れ時間の合計だけ前記ジャークパターンを圧縮するように調整して前記調整ジャークパターンを生成すること、を特徴とする請求項4記載の移動体制御装置。


JP2007270500A 2007-10-17 2007-10-17 移動体制御方法及び移動体制御装置 Expired - Fee Related JP4469388B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2007270500A JP4469388B2 (ja) 2007-10-17 2007-10-17 移動体制御方法及び移動体制御装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2007270500A JP4469388B2 (ja) 2007-10-17 2007-10-17 移動体制御方法及び移動体制御装置

Publications (2)

Publication Number Publication Date
JP2009098965A true JP2009098965A (ja) 2009-05-07
JP4469388B2 JP4469388B2 (ja) 2010-05-26

Family

ID=40701902

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2007270500A Expired - Fee Related JP4469388B2 (ja) 2007-10-17 2007-10-17 移動体制御方法及び移動体制御装置

Country Status (1)

Country Link
JP (1) JP4469388B2 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2022526529A (ja) * 2019-03-27 2022-05-25 ヴィテスコ テクノロジーズ ジャーマニー ゲー・エム・ベー・ハー ドッグクラッチを制御する方法

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2022526529A (ja) * 2019-03-27 2022-05-25 ヴィテスコ テクノロジーズ ジャーマニー ゲー・エム・ベー・ハー ドッグクラッチを制御する方法
JP7288077B2 (ja) 2019-03-27 2023-06-06 ヴィテスコ テクノロジーズ ジャーマニー ゲー・エム・ベー・ハー ドッグクラッチを制御する方法
US11885412B2 (en) 2019-03-27 2024-01-30 Vitesco Technologies GmbH Method of controlling a dog clutch

Also Published As

Publication number Publication date
JP4469388B2 (ja) 2010-05-26

Similar Documents

Publication Publication Date Title
JP6667220B2 (ja) 振動型アクチュエータの制御装置とその制御方法、駆動装置、撮像装置、及び自動ステージ
JP5524535B2 (ja) アクチュエータの駆動装置
US10114296B2 (en) Driving system and driving method, and exposure apparatus and exposure method
CN105490592B (zh) 线性电机相位同步控制系统及其控制方法
JP2006350792A (ja) 機械位置制御装置
JP2012055852A (ja) アクチュエータの駆動装置
CN103916068A (zh) 马达控制装置、马达控制方法及机械系统
JP2016020904A (ja) Memsジャイロ・モータ・ループ・フィルタ
JP4469388B2 (ja) 移動体制御方法及び移動体制御装置
JP5882798B2 (ja) 振動抑制装置および振動抑制方法
JP6910156B2 (ja) マイクロマシニング技術によるアクチュエータを、特にマイクロミラーのマイクロマシニング技術によるアクチュエータを、制御するコントローラ、制御システム、マイクロミラーシステム、及び、マイクロマシニング技術によるアクチュエータの制御方法
JP2008303997A (ja) アクティブ除振装置及びそれに用いられる制振装置
JP2008015610A (ja) 制御装置
US20150062684A1 (en) Controller for actuating a micromechanical actuator, actuating system for actuating a micromechanical actuator, micro-mirror system and method for actuating a micromechanical actuator
JP2005016730A (ja) 能動的ダイナミックビータ及びその使用方法
JPH10311364A (ja) 能動的除振制振装置
Mirtchev et al. Optimizing the feedback control of Galvo scanners for laser manufacturing systems
JP6792961B2 (ja) 制振装置
JP2008256109A (ja) 制振装置及び制振装置の制御方法
US11921923B2 (en) Oscillation reduction in haptic vibrators by minimization of feedback acceleration
JP2010093961A (ja) モータ制御装置
KR102410575B1 (ko) 리니어 모터 스테이지의 제어 방법 및 제어 장치
JP2005039929A (ja) サーボ制御装置の振動抑制方法
JP4211303B2 (ja) 楕円振動装置の制御装置、楕円振動装置
JP3890672B2 (ja) 自励振動型振動装置

Legal Events

Date Code Title Description
A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20100218

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: 20100223

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20100226

R150 Certificate of patent or registration of utility model

Ref document number: 4469388

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130305

Year of fee payment: 3

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130305

Year of fee payment: 3

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20140305

Year of fee payment: 4

LAPS Cancellation because of no payment of annual fees