JP4385142B2 - Position control method in walking drive - Google Patents
Position control method in walking drive Download PDFInfo
- Publication number
- JP4385142B2 JP4385142B2 JP2001150604A JP2001150604A JP4385142B2 JP 4385142 B2 JP4385142 B2 JP 4385142B2 JP 2001150604 A JP2001150604 A JP 2001150604A JP 2001150604 A JP2001150604 A JP 2001150604A JP 4385142 B2 JP4385142 B2 JP 4385142B2
- Authority
- JP
- Japan
- Prior art keywords
- group
- contact block
- drive
- speed
- stepping
- 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
- 238000000034 method Methods 0.000 title claims description 32
- 239000004575 stone Substances 0.000 claims description 163
- 230000033001 locomotion Effects 0.000 claims description 118
- 230000005291 magnetic effect Effects 0.000 claims description 11
- 230000005294 ferromagnetic effect Effects 0.000 claims description 10
- 239000000463 material Substances 0.000 claims description 3
- 230000035699 permeability Effects 0.000 claims description 2
- 238000006073 displacement reaction Methods 0.000 description 45
- 230000007246 mechanism Effects 0.000 description 22
- 230000008859 change Effects 0.000 description 17
- 230000002441 reversible effect Effects 0.000 description 11
- 230000032258 transport Effects 0.000 description 11
- 238000012840 feeding operation Methods 0.000 description 9
- 238000009826 distribution Methods 0.000 description 8
- 238000000926 separation method Methods 0.000 description 8
- 230000001360 synchronised effect Effects 0.000 description 8
- 230000001133 acceleration Effects 0.000 description 7
- 238000004364 calculation method Methods 0.000 description 5
- 230000000295 complement effect Effects 0.000 description 5
- 230000014509 gene expression Effects 0.000 description 5
- 238000005259 measurement Methods 0.000 description 5
- 239000004065 semiconductor Substances 0.000 description 5
- 241000282414 Homo sapiens Species 0.000 description 4
- 230000009471 action Effects 0.000 description 4
- 230000008901 benefit Effects 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 230000003287 optical effect Effects 0.000 description 4
- 230000036961 partial effect Effects 0.000 description 4
- 230000002093 peripheral effect Effects 0.000 description 4
- 230000002829 reductive effect Effects 0.000 description 4
- 238000004422 calculation algorithm Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 239000003302 ferromagnetic material Substances 0.000 description 3
- 230000003068 static effect Effects 0.000 description 3
- 238000005308 sum rule Methods 0.000 description 3
- 238000013519 translation Methods 0.000 description 3
- 241001465754 Metazoa Species 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 230000005389 magnetism Effects 0.000 description 2
- 238000011084 recovery Methods 0.000 description 2
- 239000007787 solid Substances 0.000 description 2
- 238000001179 sorption measurement Methods 0.000 description 2
- 238000004804 winding Methods 0.000 description 2
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 1
- QNRATNLHPGXHMA-XZHTYLCXSA-N (r)-(6-ethoxyquinolin-4-yl)-[(2s,4s,5r)-5-ethyl-1-azabicyclo[2.2.2]octan-2-yl]methanol;hydrochloride Chemical compound Cl.C([C@H]([C@H](C1)CC)C2)CN1[C@@H]2[C@H](O)C1=CC=NC2=CC=C(OCC)C=C21 QNRATNLHPGXHMA-XZHTYLCXSA-N 0.000 description 1
- 238000012935 Averaging Methods 0.000 description 1
- 241000605059 Bacteroidetes Species 0.000 description 1
- BGPVFRJUHWVFKM-UHFFFAOYSA-N N1=C2C=CC=CC2=[N+]([O-])C1(CC1)CCC21N=C1C=CC=CC1=[N+]2[O-] Chemical compound N1=C2C=CC=CC2=[N+]([O-])C1(CC1)CCC21N=C1C=CC=CC1=[N+]2[O-] BGPVFRJUHWVFKM-UHFFFAOYSA-N 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000008094 contradictory effect Effects 0.000 description 1
- 125000004122 cyclic group Chemical group 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 230000026058 directional locomotion Effects 0.000 description 1
- 230000005489 elastic deformation Effects 0.000 description 1
- 230000008713 feedback mechanism Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000005339 levitation Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000013011 mating Effects 0.000 description 1
- 230000000737 periodic effect Effects 0.000 description 1
- 238000000206 photolithography Methods 0.000 description 1
- 238000002360 preparation method Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 229910001285 shape-memory alloy Inorganic materials 0.000 description 1
- 230000002123 temporal effect Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
- 230000007723 transport mechanism Effects 0.000 description 1
Images
Landscapes
- Container, Conveyance, Adherence, Positioning, Of Wafer (AREA)
- Control Of Position Or Direction (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
- Automatic Assembly (AREA)
Description
【0001】
【発明の属する技術分野】
本発明はウォーキングドライブにおける位置制御方法に関する。ウォーキングドライブ(Walking Drive)という駆動形態は本発明者が創案したものである。一般に広く知られている駆動手段でない。名称だけでは技術分野がわからないので初めにこれを説明し併せて用語を定義する。
【0002】
ウォーキングドライブというのは複数組の有限長の駆動手段を相補的に運動させ対象物を搬送する機構である。人間の歩行に似ているから本発明者がウォーキングドライブと名付けた。有限長駆動手段として圧電素子を例えば用いることができる。
【0003】
圧電素子のストロークには限界があるが、同様に動物の足のストロークにも限界がある。しかし人間の歩行動作をみると、2本の足が往復運動を行いながらも胴体は無限に滑らかに、かつ平面内を自由に移動することができる。
【0004】
ウォーキングドライブは、これと同様に相補的な運動を行う二組の圧電素子を利用して、X、Yの方向、あるいはX、Y、θの方向に長ストロークの滑らかな駆動を行うこともできる。人間の歩行において歩幅が正確には一定でないように、一周期で移動する量が正確に一定にはならない。また、複数の接触面が正確な協調動作をしていない場合や、加減速時にすべりが生じることがある。このため、移動を継続すると設定した移動量と実際の移動量との差が累積して、テーブルの位置が分からなくなる。そこでテーブルの位置を見失わないために本発明が提案される。
【0005】
【従来の技術】
1次元或いは二次元の何らかの駆動手段を持つ移動装置があってその位置を求める、あるいは制御するようにした発明は数多く提案されている。
【0006】
(1)特開昭59−58825号「測長誤差を少なくする機能を備えた移動装置」はXY面で移動できる半導体デバイス製造用のXYステージの端面にレ−ザ光を当て反射光と元の光を干渉させて干渉縞から移動距離を求めている。0.6μm程度の波長の光の干渉を用いるから分解能は0.1μmと極めて高いが反面広い範囲で正確に位置決めができない。テーブル自体のストロークも数μmであって狭いものである。
【0007】
(2)特開昭60−7725号「電磁位置合わせ装置」はフォトリソグラフィのために半導体ウエハを保持し3方向(X、Y、θ)に移動できるステージは従来3つのモータを使っていたが、これを3つ或いは4つの電磁コイルによって置き換えたものを提案している。電磁コイルの電流モードを変えることによってX方向、Y方向、θ方向にステージを移動させることができる。センサの必要性は述べているが、どのようなセンサを用いるのかということを説明していない。
【0008】
(3)特開昭63−6487号「X・Y・Z微動テーブル」は露光装置において試料を載せるテーブルを与える。粗動テーブルの上に微動テーブルを搭載する、二重に重ねたテーブルである。細い縦軸の上に支持されたテーブルは四辺形の容器に囲まれており、その中で僅かに動くことができる。電磁石の磁力によってX方向、Y方向に力を受けると縦軸が撓むからテーブルがXY変位する。変位量のセンサは、センサ面とステージ端面の間の静電容量の変化によって求めるものである。微少な変位だから静電容量で測定できるが、0.1mmを越えるような距離の変化を測定できない。
【0009】
(4)特開平4−99989号「微小移動方法およびその装置」はこれまで述べた微小な半導体デバイスなどとはがらっと違って重量のある大きい物体を対象にする。地面に置かれた重量物は重力によって地面との間に静止摩擦力を生じている。衝撃力を瞬間的に加えて一瞬の変位をおこさせ姿勢制御したい。ばね、磁石などでは一方向にしか力を出せない。それで形状記憶合金バネと電磁プランジャを組み合わせて両方向に衝撃力を発生することができるようにしている。位置変化を検出するセンサについては述べていない。
【0010】
(5)特開昭61−109638号「微動上下機構」は半導体デバイス用の円盤状のステージを昇降可能にバネで弾性支持し、その下に電磁石を設けて電磁力でステージ(強磁性体)を吸引離脱して上下動させる機構を提案している。上下駆動機構の提案であって上下の変位量を求めるためのセンサについては述べていない。板ばねの変形を利用するものであるから上下のストロークも短いものである。
【0011】
(6)特開平8−197358号「XYステージ機構」はステッパなどの無接触ステージを提案している。接触部があり、摩擦があると摩耗物などがまわりこんで半導体ウエハを汚染するから非接触のステージを提案する。磁気によってステージを浮上させ磁力のバランスによってX方向、Y方向に微小変位できるようにしている。磁気浮上であるからストロークは小さい。隙間の検出には光学的センサを用いている。
【0012】
これまで述べたステージの駆動機構はステージと駆動機構の関係が固定的であり駆動機構の変位がステージの変位に等しい。だから駆動機構の変位を測定すればステージの位置も分かるような単純な関係にある。既存のセンサによって移動距離、変位は簡単に測定できる。しかしそのような駆動機構は当然にストロークが極めて短い。より長いストロークの機構が望まれる。そのために本発明者が提案した駆動方式がウォーキングドライブといわれるものである。これは
【0013】
(7)特開平7−285043号「送り装置」特許出願人社本英二、森脇俊道によって初めて提案されたものである。X方向、Y方向に微小変位する圧電素子によってテーブルを繰り返し繰り返し所望の方向へ運ぶものである。詳細は次に説明する。
【0014】
[1.ウォーキングドライブの概念と一方向駆動]
まず、予め決められた変位パターンを利用してテーブルを駆動する方法を模式的に図1〜3に示す。図1は駆動部の斜視図である。接触ブロックCは立方体のブロックであるが、これの上面がテーブル下面に接触しテーブルを移動させる接触部材である。縦方向(z方向とする)の圧電素子Sは接触ブロックCを上下に変位させる素子である。縦方向圧電素子Sを「支持用素子」と呼ぶ。支持用素子Sの下端はなんらかの固定部材に固定される。支持用素子Sを伸張するとテーブルの下面を支持するし、支持用素子Sを縮小するとテーブル下面から離隔する。
【0015】
接触ブロックCには横方向(x方向、y方向とする)に二つの圧電素子Y、Xが付いている。横方向の圧電素子X、Yの他端は固定部材に固定してある。圧電素子Xを伸張すると接触ブロックCはx方向へ移動し、圧電素子Xを縮小すると接触ブロックCは−x方向に移動する。圧電素子Yを伸張すると接触ブロックCはy方向へ移動し、圧電素子Yを縮小すると接触ブロックCは−y方向に移動する。横方向の圧電素子X、Yを送り用素子という。支持用素子S、送り用素子X、Y、接触ブロックCよりなる1単位を駆動部Dと呼ぶ。つまりD=S+X+Y+Cである。
【0016】
このような接触ブロックC、圧電素子S、X、Yよりなる駆動部Dはn個(3つ以上)が単位となったA群駆動部と、B群駆動部よりなる。つまり駆動部は2群あってそれぞれn個あるから、全部で駆動部は2n個ある。n個のA群駆動部は同時にテーブルの下面へ接触し離隔する。n個のB群駆動部も同時にテーブルの下面へ接触し離隔する。
【0017】
しかしA群駆動部とB群駆動部は相補的にテーブル下面に接触する。相補的にというのは時間的に相補的だということである。
【0018】
平面を支持するには3つ以上の支持点が必要だからnは3以上であるが、4、5或いはそれ以上のnを与えることもできる。
【0019】
簡略化するため以後の記述において、A群駆動部、B群駆動部はときにA群、B群と省略して表現することもある。またS、X、Y、C、Dなどの部材を区別する必要があるときはSB、XA、…というように添え字を付す。
【0020】
さて時間であるがA群、B群ともに、定まった周期Tをもって同期運動を繰り返す。1周期Tを位相で表現すると2π(360度)であるが、ウォーキングドライブはこれを6つの区間(60度ずつ)に等分割する。
【0021】
区間の名称を1区(0〜60度;τ1)、2区(60度〜120度;τ2)、3区(120度〜180度;τ3)、4区(180度〜240度;τ4)、5区(240度〜300度;τ5)、6区(300度〜360度;τ6)とする。1区の時間長さをτとする。6τ=Tである。
【0022】
A群駆動部、B群駆動部ともに支持用素子Sは同一の周期Tで同じ運動を繰り返す。しかしA群とB群では半周期(180度分)のズレがある。送り用素子X、Yの方もA群とB群では半周期のズレがある。しかし送り用素子の運動はA群内で同一とは限らないし、B群内でも同一とは限らない。非直線運動をする場合は同じ群内の駆動部でも送り用素子X、Yの運動は相違する。しかしそれは後述の速度U、Vの違いであってタイミングの配分は支持用素子と同様で確実に決まっている。
【0023】
ウォーキングドライブの運動は説明が難しいので、その運動が定型的で分かりやすい支持用素子Sの方から説明する。その方が理解しやすい。支持用素子Sが接触ブロックCを動かしテーブルに対して幾つかの作用を及ぼす。
【0024】
支持用素子Sが伸びて状態を維持し接触ブロックCはテーブルに触れ、これを運ぶ時もある。これを「触」と呼ぶ。
【0025】
支持用素子Sが縮んで接触ブロックがテーブルから離れてゆく時もある。これを「背」と呼ぶ。
【0026】
支持用素子Sが縮退した状態を保ち接触ブロックCがテーブルと離隔している時もある。これを「離」と呼ぶ。
【0027】
支持用素子Sが伸びてゆき接触ブロックがテーブルに触れるようになる時もある。これを「向」と呼ぶ。支持用素子Sによって接触ブロックはテーブルに対して1周期内で、「向触背離」の4相運動をする。支持用素子Sの運動速度(変位量/位相)、振幅は不変である。つまり向触背離の動きは常に不変であり、テーブル運動を変えるために支持用素子Sのパラメータを変化させる必要はない。
【0028】
同じタイミングで送り用素子X、Yも運動するがこれは2相の運動である。4相運動するものと2相運動するものが混在するのでウォーキングドライブの理解は難しい。
【0029】
これら4つの支持用素子Sの運動形態は区間と関係付けられている。「向」と「背」は支持用素子Sの前進後退運動であるがそれには1区ずつの時間(位相)が割り当てられる。「離」は支持用素子Sが縮退した状態であるがこれにも1区が割り当てられる。「触」は支持用素子Sが伸びきった状態であるがこれには3区が割り当てられる。これらの区間と1体対応するのは位相であり、時間ではない。しかし時間の方が理解しやすいから位相に代えて時間によって以後の説明をする。位相/時間の比は信号の角周波数であるが周波数を変化させることによって移動速度を自在に変えることができる。
【0030】
A群もB群も向触背離の運動を繰り返すがタイミングが半周期ずれている。A群では、向に1区、触に2、3、4区、背に5区、離に6区が割り当てられる。B群では向に4区、触に5、6、1区、背に2区、離に3区が対応する。
【0031】
つまり、支持用素子Sの運動は、A群、B群について
1区…A群=向、B群=触
2区…A群=触、B群=背
3区…A群=触、B群=離
4区…A群=触、B群=向
5区…A群=背、B群=触
6区…A群=離、B群=触
である。これは以後に出る2次元の場合でも維持される共通の性質である。ウォーキングドライブの基本だといって良い。
【0032】
図3は一次元運動の場合の支持用素子SA、SBと送り用素子XA、XBの1周期での運動を表している。1つ目のグラフがA群支持用素子SAの運動を、3つ目のグラフがB群支持用素子SBの運動を示す。横軸は時間(位相)である。▲1▼〜▲2▼が1区、▲2▼〜▲3▼が2区、…、▲6▼〜▲1▼が6区をそれぞれ表現している。縦軸は素子の伸長変位を示す。Sが0というのは縮退していることである。そのとき接触ブロックはテーブルから離れている。だから「離」になる。
【0033】
Sが増大するというのは接触ブロックがテーブルに接触しようとする運動を表現し「向」に該当する。Sが最大値をとるのは接触ブロックがテーブルに接触しテーブルを摩擦力によって保持したという状態で「触」に当たる。Sが減少するのは接触ブロックがテーブルから離れてゆく運動を表し「背」に当たる。離と触が2つの静的な状態であるが、遷移のための過程、背と向があるから4相の運動になる。
【0034】
触は3区間に渡っているから半周期ずつA群支持用素子、B群支持用素子がテーブルを支持する。A群は2区、3区、4区でテーブルを支持する。B群は5区、6区、1区でテーブルを支持する。時点▲2▼においてB群支持からA群支持に変わり、時点▲5▼においてA群支持からB群支持に切り替わる。
【0035】
図2はA群とB群の駆動部のテーブルに対する相対運動を示す。図2では、A群、B群の駆動部が一つしか書いてないがこれは代表である。実際にはテーブルを支えるため3つ以上の等価の駆動部が存在する。▲2▼、▲3▼、▲4▼、▲5▼でA群の支持用素子SAが上に伸びてテーブルを保持している事が分かる。▲5▼、▲6▼、▲1▼、▲2▼でB群の支持用素子SBが上に伸びテーブルを支持している。▲2▼、▲5▼は切り替わり時点だから、双方の接触ブロックがテーブル裏面に接触している。接触ブロックとテーブルの間では固体同士が接触して滑りのない状態で力が伝えられる。静止摩擦力が大きくて滑りはないという仮定がある。以上の機構に加えて水平方向に動く送りの機構がある。送り機構は2次元のものであるが、1次元の場合を先に説明する。一次元だからA群にはXAが、B群にはXBがあるとする。
【0036】
図2ではx方向の送り素子XA、XBの変位を反対向きに書いてあるから同じ送りに対してA群、B群の送り用素子の作用は反対になる。
図3に示すようにA群の送り用素子XAは1区から5区まで等速度Uで伸長を続ける。6区では後退し1区の最初の位置へ復帰する。速度Uで伸長するA群の接触ブロックCAは2区、3区、4区でテーブルと接触するのであるから、テーブルは送り用素子XAのためにU×3τだけ等速で進む。
【0037】
B群の送り用素子XBは4区、5区、6区、1区、2区で等速Uで縮退を続ける。5区、6区、1区ではB群の支持用素子がテーブルに接触し続ける。3区では伸長し4区の最初の位置へ復帰する。速度Uで縮退するB群の接触ブロックCBは5区、6区、1区でテーブルと接触するのであるから、テーブルは送り用素子XBのためにU×3τだけ等速で進む。
【0038】
つまり5区〜1区ではテーブルはB群によって3Uτだけx方向へ送られ、2区〜4区ではA群の駆動部によって3Uτだけx方向へ送られる。テーブルは結局6Uτ送られる事になるが、これはUTであるから周期Tにおいて等速度Uでテーブルがx方向へ送られている。
【0039】
送り用素子はテーブルを運ぶ遅い運動と、テーブルから離れて復帰する速い運動の二つがあるだけである。前者のテーブルを運ぶ運動を「搬」と呼ぶ。
【0040】
後者の元位置に復帰する運動を「復」と呼ぶ。送り用素子は搬復の2相動作を繰り返す。搬の速度はUであるが、復の平均速度は−5Uであって5倍速い。
【0041】
搬復搬復…と2相変化する送り用素子と、向触背離向触背離…と4相変化する支持用素子の時間的な対応関係が重要である。送り用素子の「復」が、支持用素子の「離」に同期している。
【0042】
つまり接触ブロックがテーブルから離れている間に接触ブロックは元位置へ復帰する。送り用素子の「搬」が、支持用素子の「向触背」に同期している。送り用素子の「搬」は5区よりなる長い動作であるが、支持用素子の「触」は3区だけの動作である。その前後の「向」、「背」を含む5区に、送り用素子の「搬」が同期する。
【0043】
つまり「搬」の初めと終わりでは駆動部はテーブルを搬送する作用はない。「向」の部分は接触ブロックCがテーブルと同じ速度になるための準備期間であり、「背」の部分は接触ブロックCがテーブルから離隔するときに速度変動を生じないための慣性運動である。線速度の差をなくし接触ブロックを滑らかにテーブルに接触離隔させるということである。支持用素子の向、背のような動作中にも、送り用素子は搬動作をさせるので、4相と2相の食い違いが出てくるのであるがこれがテーブルの搬送を円滑にしているのである。本発明者のウォーキングドライブにおいて重要な点の一つである。
【0044】
A群とB群によって交互にテーブルを運ぶのであるから継ぎ目において速度の不連続が発生してはいけない。速度不連続があると加速度が生じテーブル質量×加速度の力が発生するからテーブルが接触ブロックの上を空滑りする。だから時刻▲2▼、▲5▼においてA群、B群の送り用素子XA、XBの速度Uは同一でなければならない。速度変動を押さえ滑りを防ぐためにはその瞬間だけ速度が同一であれば良いのである。
【0045】
しかし本発明の方法はまことに念が入っており一方の駆動部が「向」であるとき、他方の駆動速度に等しいし、「背」であるときも他方の駆動速度に等しい。「搬」である駆動部からみれば、搬の5区のうち初めの2区と終わりの2区で他方の駆動部と同じ速度になっている。搬の5区のうち真ん中の1区だけ他方の駆動部と速度が異なる。このとき他方の駆動部は離の状態にある。1周期は6区よりなるが、そのうち2区だけ、二つの駆動部速度が違うが、4区においては速度が同一である。つまり
【0046】
UA=UB AまたはBが向または背 (1)
UA≠UB AまたはBが離 (2)
【0047】
という関係にある。時間的に表現すれば、1周期において、2/3は両駆動部は同じ速度で平行移動しており、1/3だけ復帰のため相違する運動をしている。
【0048】
両駆動部は同時にテーブルを支持するのは▲2▼、▲5▼の時点だけで一瞬である。常には一方だけでテーブルが支持され搬送されている。その場合でも離隔している方の駆動部は2/3の時間は、テーブルと同一の速度で動いているということである。
【0049】
しかしそれは一次元ウォーキングドライブが等速直線運動しかできないのだということではない。速度変更は簡単である。図3における横軸を時間ではなく位相として捉え、この位相を進める角速度を操作するだけでよい。すなわち、この位相を正の方向へ速く進めれば図2においてテーブルは速く右へ送られ、逆に負の方向へ遅く進めればテーブルは遅く左へ送られる。この速度の変更および方向の変更は、どの位相においても行うことができる。
図3に示す動作の関係を表1に示す。
【0050】
【表1】
【0051】
送り用素子のストローク(1回分の運動距離)をξとし、駆動部の駆動周波数をf(T=f−1)とすると、1周期において、A群は3ξ/5だけ、B群は3ξ/5だけテーブルを運ぶので6ξ/5だけテーブルはx方向へ進行する。
【0052】
表1は支持用素子と送り用素子の動作、速度の異同、主導権の推移を区間毎に述べている。この性質は以後のウォーキングドライブの運動を貫いて共通している。2次元の場合も全く同じである。今度は1周期内の区間ごとの送り用素子の速度について述べる。
【0053】
k区に於けるA群の送り用素子XAの速度をUAkとする。
k区に於けるB群の送り用素子XBの速度をUBkとする。
k区に於けるテーブルXTの速度をUTkとする。
【0054】
上の定義はXだけであるが、それは1次元問題を考えているからである。2次元問題の場合はXとYを考えればよいのである。1周期だけを考えているがどの周期でも同じことであるから1周期だけわかれば良いのである。テーブルの速度UTkは予め決定されているものとする。どうして既決であるのかは後で説明する。この場合にA群、B群の送り用素子速度UAk、UBkを区間毎に次のように決める。ここで、UA6、UB3は平均の速度である(以下も同じ)。
【0055】
1区 UA1=UB1=UT1 (3)
2区 UA2=UB2=UT2 (4)
【数1】
4区 UA4=UB4=UT4 (6)
5区 UA5=UB5=UT5 (7)
【数2】
【0056】
ウォーキングドライブであることが明確であるのは、復動作を行う3区と6区のUB3=−ΣUTj、UA6=−ΣUTjである。B群では3区以外での速度UBjはテーブル速度UTjと同一であり、A群では6区以外での速度UAjはテーブル速度UTjと同一だから、ゼロサムルール
【0057】
UA1+UA2+UA3+UA4+UA5+UA6=0 (9)
UB1+UB2+UB3+UB4+UB5+UB6=0 (10)
【0058】
が成り立つ。復動作を6区で行うA群については同一の周期についてこの式が成り立つ。B群については、復動作を3区で行うから、式(10)において4区〜6区というのは直前の周期の値であり、1〜3区がその周期での値である。あたりまえのことであるがゼロサムルール(9)、(10)が成り立つのはA群、B群の駆動部速度だけであり、テーブル速度についてはゼロサムルールが成立しない。
【0059】
UT1+UT2+UT3+UT4+UT5+UT6=UB1+UA2+UA3+UA4+UB5+UB6
=UA1+UA2+UA3+UA4+UA5+UB6
=UB1+UB2+UA3+UB4+UB5+UB6
≠0 (11)
【0060】
同じことであるが、より単純な表記をすることができる。k区におけるテーブル速度はUTkであるが、それに連続して先行する5つの速度の和としてテーブル余速度WTkというものを定義する。
【0061】
UT1+UT2+UT3+UT4+UT5=−WT6 (12)
UT6+UT1+UT2+UT3+UT4=−WT5 (13)
UT5+UT6+UT1+UT2+UT3=−WT4 (14)
UT4+UT5+UT6+UT1+UT2=−WT3 (15)
UT3+UT4+UT5+UT6+UT1=−WT2 (16)
UT2+UT3+UT4+UT5+UT6=−WT1 (17)
【0062】
簡単な定義であるが、連続して先行する5つの速度であるから、式(12)〜(17)の右辺において、1より前にある6、5、4…などは前回の周期の値である。因果律からそれらの値は既知であり定義は明確である。1〜6の添え字が連続して循環的に繰り返す。
【0063】
余速度というものはA群送り用素子速度UA、B群送り用素子速度UBについても同様に定義することができる。繰り返しになるが念のために陽に書いておこう。
【0064】
UA1+UA2+UA3+UA4+UA5=−WA6 (18)
UA6+UA1+UA2+UA3+UA4=−WA5 (19)
UA5+UA6+UA1+UA2+UA3=−WA4 (20)
UA4+UA5+UA6+UA1+UA2=−WA3 (21)
UA3+UA4+UA5+UA6+UA1=−WA2 (22)
UA2+UA3+UA4+UA5+UA6=−WA1 (23)
【0065】
UB1+UB2+UB3+UB4+UB5=−WB6 (24)
UB6+UB1+UB2+UB3+UB4=−WB5 (25)
UB5+UB6+UB1+UB2+UB3=−WB4 (26)
UB4+UB5+UB6+UB1+UB2=−WB3 (27)
UB3+UB4+UB5+UB6+UB1=−WB2 (28)
UB2+UB3+UB4+UB5+UB6=−WB1 (29)
【0066】
さてテーブル余速度WTの概念を使えば、A群、B群の送り用素子速度は簡単に定義することができる。復動作をする6区ではA群送り用素子速度UA6を6区のテーブル余速度WT6に等しく、復動作をする3区ではB群送り用素子速度UB3を3区のテーブル余速度WT3に等しくし、他のものは全て、テーブル速度に等しく(UAk=UBk=UTk)すればよいのである。
【0067】
より一般的にいえば、復動作区が6区と3区だというのも、必須の条件でない。復動作の区は3区離れていれば良いので、2区と5区、1区と4区であってもかまわないのである。それは周期の切り方による任意性である。だから以後もA群は6区、B群は3区として述べるが、本発明は2、5区、1、4区に復の区間を対応させても良いのである。ここでは全部で6区とするが、全部の区間数が7区、8区でもウォーキングドライブ駆動が可能である。また2本足でなくて、3本足でもよい。3本足の場合は位相が120゜ずつずれる。
【0068】
余速度の概念を使って式(3)〜(8)を繰り返し述べると、
【0069】
1区 UA1=UB1=UT1 (30)
2区 UA2=UB2=UT2 (31)
3区 UA3=UT3 、UB3=WT3 (32)
4区 UA4=UB4=UT4 (33)
5区 UA5=UB5=UT5 (34)
6区 UA6=WT6 、UB6=UT6 (35)
【0070】
ということである。A群、B群の送り用素子の速度がこれによって与えられる。
【0071】
【表2】
【0072】
以上に述べたものはすべてx方向の速度Uに関する定義である。2次元になるとy方向の速度Vが新たに登場する。2次元になってもVが増えるだけで、上記の定義や関係は全く同じである。1次元での運動がわかれば2次元の場合も理解できる。2次元のウォーキングドライブは見かけ上複雑であって分かりにくいから、ことさら1次元の説明に力を入れているのである。
【0073】
1次元の場合経路が決まっているから、送り用素子の運動は速度だけ分かればいいのであるが、実際には変位Xがどうなるのか?という問題が残っている。これは1次元の場合あまり重要でないが、2次元の場合に顕在化してくるので、変位が一つ(Xだけ)の1次元の問題においてこれを明らかにしておく。変位がX、Yに増えるだけで2次元でも全く同じことである。同じことであるが二つになると途端に難しくなるから1次元で準備するのである。
【0074】
テーブルの運動を速度で論じている場合、テーブルのどの点の運動としても同じことである。しかし変位Xを論じる場合はそうはいかない。回転がない場合は、テーブルの運動を任意のテーブル上の固定点によって一義的に表現することができる。回転がある場合は後にまた説明する。任意の固定点であって良いので重心や隅部の点であってもよいしその他の点であってもよい。
【0075】
テーブルのある固定点の座標をテーブル座標XTとする。これの初期値(t=0)をXT0とすると、1周期でのテーブルの変位は、2区〜4区のA群の送り用素子速度UAとτの積の和と5区、6区、1区のB群の送り用素子速度UBとτの積の和である。m周期の1区初め(▲1▼時点)での、テーブル変位XT m 0は、
【0076】
【数3】
【0077】
によって与えられる。m周期のk区終わりでの、テーブル変位XT m kはXT m 0をもとにして
【0078】
XT m 1=XT m 0+UB m 1τ (37)
XT m 2=XT m 0+UB m 1τ+UA m 2τ (38)
XT m 3=XT m 0+UB m 1τ+UA m 2τ+UA m 3τ (39)
XT m 4=XT m 0+UB m 1τ+UA m 2τ+UA m 3τ+UA m 4τ (40)
XT m 5=XT m 0+UB m 1τ+UA m 2τ+UA m 3τ+UA m 4τ+UB m 5τ(41)
XT m 6=XT m 0+UB m 1τ+UA m 2τ+UA m 3τ+UA m 4τ+UB m 5τ+UB m 6
=XT m+1 0 (42)
【0079】
となるのである。実際には、初期値XT0と最終値XT m kが与えられ、τは初めから装置のパラメータとして与えられ、速度UA、UBも好ましい値があるから、繰り返し周期数(m−1)と、m周期での区間kが計算されるということになる。つまりmとkが未定のパラメータということである。テーブルの変位はこのようであって、二次元の場合も同様になる。これについては意味が明瞭である。
【0080】
しかしリセット(復)を何度も繰り返す送り用素子については一つの重大な問題がある。復動作(A群6区、B群3区)における速度が、余速度に等しいというのはA群、B群の送り用素子について常に言えることである。復動作は1区(τ)で行われるから復帰の距離は一義的に決まり、それは余速度にτを掛けたものである。つまり、復帰距離について、
【0081】
UA6τ=WA6τ (43)
UB3τ=WB3τ (44)
【0082】
である。これは常に成り立つのであるが、どこへ帰るのか?という点で一義的に決まらないのである。送り用素子の原点Oを1区の初めに合致させることはもちろんできるが、その他の区の初めに合致させることも同様に可能なのである。
【0083】
循環的な区分であり1区〜6区は同等であるから、送り用素子原点を任意のk区の初めに一致させることができる。その点で6つの選択肢がある。1区の初めを原点に一致させる場合は、6区の終わりが原点である。k区の初めを原点とするときは、(k−1)区の終わりが原点である。A群でもB群でも同じであるからA群について述べる。
【0084】
(あ)
1区の初めを原点とする(復動作で原点に戻る)
1区の終わり XA1=UA1τ (45)
2区の終わり XA2=UA1τ+UA2τ (46)
3区の終わり XA3=UA1τ+UA2τ+UA3τ (47)
4区の終わり XA4=UA1τ+UA2τ+UA3τ+UA4τ (48)
5区の終わり XA5=UA1τ+UA2τ+UA3τ+UA4τ+UA5τ (49)
6区の終わり XA6=0 (50)
【0085】
(い)
2区の初めを原点とする(復動作で−UA1τに戻る)
1区の終わり XA1=0 (51)
2区の終わり XA2= UA2τ (52)
3区の終わり XA3= UA2τ+UA3τ (53)
4区の終わり XA4= UA2τ+UA3τ+UA4τ (54)
5区の終わり XA5= UA2τ+UA3τ+UA4τ+UA5τ (55)
6区の終わり XA6=−UA1τ (56)
【0086】
(う)
3区の初めを原点とする(復動作で−UA1τ−UA2τに戻る)
1区の終わり XA1= −UA2τ (57)
2区の終わり XA2=0 (58)
3区の終わり XA3= UA3τ (59)
4区の終わり XA4= UA3τ+UA4τ (60)
5区の終わり XA5= UA3τ+UA4τ+UA5τ (61)
6区の終わり XA6=−UA1τ−UA2τ (62)
【0087】
(え)
4区の初めを原点とする(復動作で−UA1τ−UA2τ−UA3τに戻る)
1区の終わり XA1= −UA2τ−UA3τ (63)
2区の終わり XA2= −UA3τ (64)
3区の終わり XA3=0 (65)
4区の終わり XA4= UA4τ (66)
5区の終わり XA5= UA4τ+UA5τ (67)
6区の終わり XA6=−UA1τ−UA2τ−UA3τ (68)
【0088】
(お)
5区の初めを原点とする(復動作で−UA1τ−UA2τ−UA3τ−UA4τに戻る)
1区の終わり XA1= −UA2τ−UA3τ−UA4τ (69)
2区の終わり XA2= −UA3τ−UA4τ (70)
3区の終わり XA3= −UA4τ (71)
4区の終わり XA4=0 (72)
5区の終わり XA5= UA5τ (73)
6区の終わり XA6=−UA1τ−UA2τ−UA3τ−UA4τ (74)
【0089】
(か)
6区の初めを原点とする(復動作で−UA1τ−UA2τ−UA3τ−UA4τ−UA5τに戻る)
1区の終わり XA1= −UA2τ−UA3τ−UA4τ−UA5τ(75)
2区の終わり XA2= −UA3τ−UA4τ−UA5τ (76)
3区の終わり XA3= −UA4τ−UA5τ (77)
4区の終わり XA4= −UA5τ(78)
5区の終わり XA5=0 (79)
6区の終わり XA6=−UA1τ−UA2τ−UA3τ−UA4τ−UA5τ(80)
【0090】
6つのどのケースでも6区(復)では、UA6τ=WA6τだけ戻っている。これら6つのケースはA群についてのみ述べている。B群については復動作が3区にあるからこれと少し式の形が異なってくる。6つの場合があるという点は同じである。
【0091】
復動作で原点に戻るという(あ)の場合が最も理解し易いが運動の経路が予め分かっているから(い)〜(か)のどれをとることもできる。圧電素子のストロークを有効に使うという立場から言えば、(あ)や(か)は不利な選択である。限定された圧電素子のストロークを有効に利用するためには、3区、4区の初めに原点が来るようにした(う)や(え)が良い。しかしこれらは説明が難しい。次の二次元の場合については(あ)と(い)の場合を述べる。
【0092】
これは一次元運動であるから軌跡が予め分かっており簡単である。時間の区間τによってA群とB群を同期させて運動させることができる。単純なものをことさら詳しく説明したのは、向、背のような駆動部とテーブルの速度を併せるための運動があるという事を明らかにし用語を明白に定義するためである。ウォーキングドライブは二次元になると運動の方向も変化するから格段に理解困難になる。しかしそれは一次元の場合の拡張であって一次元の運動が確実に分かれば二次元運動も理解できよう。
【0093】
[2.2方向駆動の例;5つの同心円で区分する場合]
x方向にもy方向にも駆動できる二次元駆動の場合を説明する。1周期を6区に分割して、表1、表2のように、送り用素子、支持用素子を運動させるという点は、一次元の場合と同様である。
【0094】
二次元の場合も時間が共通の区切りを与え、6τ=Tである。それはそうなのであるが、時間と空間を常に対応させる必要がある。理解が容易になるように線速度がどの方向にも同一の場合を例にして述べる。6つの区間があり、5つでは搬、1つは復であるから、5つかそれ以下の同心円を描きその上にテーブル代表点が移動するというように考えることができる。復の場合にどこへ戻るかで6つの場合が有り得ることを既に説明した。この例は(あ)の場合を採用しているから5つの同心円が必要になる。
【0095】
図4(a)はテーブルの運動の例をxy座標での曲線によって示している。これはテーブルのある固定点(代表点)の運動である。回転がない場合は、一点の運動によって広いテーブルの運動を表すことができる。
【0096】
曲線上に取ったA1、B1、A2、B2、A3、B3、A4、B4…というのは、A群、B群の送り用素子の周期1、周期2、周期3、周期4…での原点の位置を仮想的に示す。実際には送り用素子はテーブル運動曲線の上にないし、A群、B群の送り用素子といっても複数(m≧3)あるのであるが、代表的なA群、B群送り用素子を想定し、それをテーブル移動曲線へ平行移動したという想定である。それが分かりにくければ、A群、B群によるテーブルの搬送の部分曲線の集合だと考えても良い。これが二次元運動の理解を難しくする一つの原因であるが、この想定自体は不自然でないし矛盾もない。
【0097】
それぞれのA群送り用素子の原点から5つの同心円が描かれている。5つの同心円はそれぞれ1区、2区、3区、4区、5区に対応している。0で原点にあった送り用素子が同心円を切る瞬間の時刻はτ、2τ、3τ、4τ、5τである。同心円半径は速度を時間で積分したもので、一定速度の場合はτ、2τ、3τ、4τ、5τに速度を掛けたものである。
【0098】
ここでは理解を容易にするため線速度がほぼ等しいという場合を想定している。ほぼ等しい速度をここではqとする。これまでx方向の速度をU、y方向の速度をVとしてきたが、線速度qはx、yの両方向のベクトル和である。つまり
【0099】
q2=U2+V2 (81)
【0100】
である。線速度qはA群、B群の搬動作中のどの瞬間において変化しても良い。図4(b)は一つの駆動部原点だけを取り出して5つの同心円を描いたものである。5つの同心円を原点に近い方からg1、g2、g3、g4、g5とする。駆動部のストロークずつ離れた同心円であるが、qが一定の場合半径はqτ、2qτ、3qτ、4qτ、5qτである(qが周期内で変化する場合は∫qdtを0からτ、2τ、3τ、4τ、5τまで積分したもの。)。
【0101】
原点O(c0)にあった接触ブロックCは送り用素子によって運ばれて、1区でg1上のc1点に、2区でg2上のc2点に、3区でg3上のc3点に、4区でg4上のc4点に、5区でg5上のc5点へと進行する。つまりこの同心円は位相(時間)と空間を厳密に対応させるための手段である。一次元の場合も、6つの区間を空間に対応させたが二次元の場合も同様である。A群とB群の二つの駆動部が交代にテーブルを運ぶので、二つの駆動部の位相を常に半周期差に保たなければならない。
【0102】
共通のものは時間(位相が180度異なる)であるから、位相(時間)と空間を厳密に対応させないと別異の駆動部を同期させることができない。位相(時間)を媒介として同期させるために5つの区分同心円が必要になる。
【0103】
1区はg1に、2区はg1〜g2に、3区はg2〜g3に、4区はg3〜g4に、5区はg4〜g5に対応する。A群送り用素子については、1区〜5区で搬、6区で復、B群送り用素子については、4区〜6区、1区〜2区で搬、3区で復である。
【0104】
A群支持用素子は1区で向、2区〜4区で触(図4(b)で×を付して示す)、5区で背、6区で離である。B群支持用素子は、4区で向、5区、6区、1区で触、2区で背、3区で離である。このような事は一次元の時と同じである。またA群、B群のテーブルの速度との関係も一次元のときと同じである。ただし速度成分が二つあるので少し条件が増える。
【0105】
【表3】
【0106】
図4(a)の曲線によって示すように、テーブルは、A群、B群によって交互に運ばれる。その交代は3区間であるから、ある基準から同心円3つ分進んだ点が他の群の基準点になる。そのように3区分ごとにA1、B1、A2、B2、…が並んでいる。テーブルのxy座標での軌跡が予め計算されて決まっていれば、曲線上に初めから、A1、B1、A2、B2、…の点を取ってゆく事ができる。
【0107】
説明のためにA2から区間毎の(nτ)に取った点を、イロハニホヘトチリヌルヲワとする。A2がイとして、3つ目のニがB2である。さらに3つ目のトがA3である。ヌがB3である。A2を中心とする5つの同心円(g1、g2、g3、g4、g5)と、テーブル曲線の交点がロ、ハ、ニ、ホ、へである。
【0108】
A群駆動部にとっては、イロが1区にあたり向動作である。送り用素子の速度はテーブル速度に等しいが接触していない。イロではB群がテーブルを搬送している。ロハでは2区になり触になる。A群がテーブルに接触し搬送する。ロハではB群は背になってテーブルから離れるが速度はテーブルと同一である。ハニは3区であり搬送状態が持続する。B群は離であって原点に復する。ニホは4区でありA群による搬送が続く。B群が原点からテーブルと同じ速度で動き始めるが向動作でありテーブルとは非接触である。ホヘは5区でありA群は背になりテーブルと同じ速度を維持するがテーブルから離れ、B群が代わってテーブルを支持し搬送する。
【0109】
このように、A群、B群は原点から1区離れたところから4区離れた区分でテーブルを支持し搬送する。A群はロハニホ、チリヌル、…の3区間ずつでテーブル搬送し、B群はホヘトチ、ルヲ…などの3区間ずつでテーブル搬送する。
【0110】
交互にとったA1、B1、A2、B2、A3、B3…などは直線距離で3区間ずつとっているから、同心円のうちg3は他の駆動部の原点を通る。それより小さい同心円g1、g2は前後の相手群の同心円g2、g1と外接する。g3より大きい同心円g4、g5は前後の相手群の同心円g1、g2に内接する。
【0111】
テーブル支持の連続性が気になろうがそれは心配ない。微妙なことであるが次のようなことである。テーブル移動軌跡と隣接同心円A、Bの交点と隣接同心円の接点が僅かであるが食い違うということである。
【0112】
図4(a)の1区の終わり(時刻▲2▼点)ロ点はA2の第1同心円g1とテーブル曲線の交点である。ロ点からA群の接触ブロックはテーブルに接触する。ところがB群はB2を中心とする同心円g2とテーブル曲線の交点ロ’まで接触を維持している。短いロロ’間ではA群、B群の両方がテーブルを支える。A2中心g1円と、B2中心g2円は外接するから、曲線との交点ロ、ロ’を結ぶ線分が必ず存在する。曲線が軸線に合致するときロ、ロ’は接点と同一であり、A群とB群の支持は重ならない。いずれにしても、A群、B群ともにテーブルを支持しないという空白の瞬間がない。
【0113】
図4(a)の4区の終わり(時刻▲5▼点)ホ’点はA2の第4同心円g4とテーブル曲線の交点である。ホ点はB2の第1同心円g1とテーブル曲線の交点である。ホ点からB群の接触ブロックはテーブルに接触する。ところがA群はホ’まで接触を維持している。短いホホ’間ではB群、A群の両方がテーブルを支える。A2中心g4円と、B2中心g1円は内接するから、曲線との交点ホ、ホ’を結ぶ線分が必ず存在する。曲線が軸線に合致するときホ、ホ’は接点と同一であり、A群とB群の支持は重ならない。▲5▼の時点においても、A群、B群ともにテーブルを支持しないという空白の瞬間がない。
【0114】
このように線速度を区間に対応させる場合、線速度が常に一定であるという利点がある(等線速度法)。速度が一定であれば長手方向(経路の方向)に加速度が生じないから滑りが発生しない。テーブル曲線の曲率が著しい場合先述のような二重保持の時間(ロロ’やホホ’)が発生するが、それは全く問題でない。もっとも進む方向に直交する方向に加速度(遠心力)が発生するがこれはわずかである。このように距離を基準として6区に分割する方法には等線速度、低加速度、時間と距離の等価性という利点がある。
【0115】
[3.2方向駆動の例;4つの同心円で区分する場合]
x方向にもy方向にも駆動できる二次元駆動で、1周期を6区に分割して、送り用素子、支持用素子を運動させる場合でも5つの同心円に区分を配分するとは限らない。先述の場合は復動作において原点に復帰という(あ)の場合を想定したから、同心円数が5つあって圧電素子のストロークを有効に利用していないという恨みがあった。前述の(い)〜(か)の場合まで、6つの復動作の種類に応じて二次元動作でも6つのモードがありうる。
【0116】
ここでは、原点に復帰するのが1区の終わりだとする(い)のモードについて述べる。(う)〜(か)についても同様に2重同心円、3重同心円、4重同心円、5重同心円を描いて説明できるが煩雑であるから省略する。
これも線速度がどの方向にも同一である。6つの区間があり、5つでは搬、1つは復であるから、4つの同心円を描く必要がある。
【0117】
図5(a)はテーブルの運動の例をxy座標での曲線によって示している。これはテーブルのある固定点(代表点)の運動である。曲線上に取ったA1、B1、A2、B2、A3、B3、A4、B4…というのは、A群、B群の送り用素子の周期1、周期2、周期3、周期4…での原点の位置を仮想的に示す。
【0118】
実際には送り用素子はテーブル運動曲線の上にないし、A群、B群の送り用素子といっても複数(m≧3)あるのであるが、代表的なA群、B群送り用素子を想定し、それをテーブル移動曲線へ平行移動したという想定である。
【0119】
それぞれのA群送り用素子の原点から4つの同心円が描かれている。4つの同心円はそれぞれ1区+2区、3区、4区、5区に対応している。半径はτ、2τ、3τ、4τに速度qを掛けたものである。速度qは1周期内で一定であれば半径は等差数列を成して増えるが、速度qが変化すれば半径は等差数列にならない。しかし時間についての制約は、上のとおり等配分である。
【0120】
図5(b)は一つの駆動部原点だけを取り出して同心円を描いたものである。4つの同心円を原点に近い方からg1、g2、g3、g4とする。一定qの場合、半径はqτ、2qτ、3qτ、4qτである(qが変化する場合は、∫qdtを0から、τ、2τ、3τ、4τまで積分したもの)。
【0121】
円g1は1区と2区を含む。g2は3区、g3は4区、g4は5区を含む。6区の復動作では、−qτまで戻る。つまりc5にあった接触ブロックCは送り用素子によって運ばれて、1区でg1上のc5点に、2区で原点c0点に、3区でg1上のc1点に、4区でg3上のc3点に、5区でg4上のc4点に、6区でg1上のc5点へと進行する。
【0122】
この同心円も時間と空間を厳密に対応させるための手段である。一次元の場合も、6つの区間を空間に対応させたが二次元の場合も同様である。6区において、−qτまで戻し、向で原点に動くから原点から3区に渡ってA群はテーブルを支持する。原点までB群が支持していたのでありここでBからAへ代わる。ここでの受け渡しは重複がない。復の位置を原点の背後c5にもってきているから圧電素子のストロークを半分しか利用しないというような欠点はない。
【0123】
3周期のA群の送り用素子(ト)を基準にして言えば、1区がヘト、2区がトチ、3区がチリ、4区がリヌ、5区がヌルである。区分の分け方が違うだけで、A群、B群の支持用素子、送り用素子の運動は一次元や前述の二次元の場合と同じである。
【0124】
【表4】
【0125】
[4.2方向駆動の例;5つの同心矩形で区分する場合]
二次元駆動であって同心円を使わず同心矩形を使う場合を説明する。1周期を6区に分割して、表1、表2、表3、表4のように、送り用素子、支持用素子を運動させるという点は、一次元、二次元で同心円を使う場合と同様である。時間空間の対応を、同心円でなくて同心矩形を使うということである。
【0126】
同心円を使って、時間(位相)と空間を対応させる先述の例は原理に忠実であって理解しやすいという利点がある。距離と時間を等しく扱うには常に速度(変位量/位相)のベクトル和を計算していなくてはならない。これは2乗の和の平方根を求めるから計算に時間がかかりすぎるという難点がある。
【0127】
X、Yの独立の圧電素子を用いて送り用素子とし、圧電素子のストロークは決まっているので、圧電素子のX、Y方向のストロークを基準にして区分を分けるということも考えられる。二方向を独立に取扱いx方向又はy方向に一定距離進むごとによって区間を割り当てるというような考え(独立速度法)である。これは圧電素子の運動から考えると自然な方法であるが一方、時間分割との対応がつきにくく二次元ウォーキングドライブの理解を甚だ難しくしている。
【0128】
図6(a)はxy座標でのテーブルの運動曲線とその上に取ったA群、B群の送り用素子の図である。これまでの2例で説明したように、曲線の上に、テーブルを搬送するA群、B群の送り用素子の原点をA2、B2、A3、B3、A4…として描いた。
【0129】
時間・空間の対応のために同心矩形(正方形)を用いる。図6(b)に一つの送り用素子の原点を中心とした5重の同心矩形d1、d2、d3、d4、d5をとっている。辺の長さは2、4、6、8、10といったように一定幅ずつ増大する。実際にはこのように等間隔である必要はなく1周期内で速度を変更する場合は矩形の増大の割合も変化する。それは同心円の場合でも同心矩形でも同じである。
【0130】
ここでは図面を簡単にするため同心矩形の辺は等差数列を成すようにしている。そうでなくても隣接矩形は同様にきびすを接することになり問題はない。
【0131】
矩形列d1,d2,d3,d4,d5を想定するとき条件になるのは最大矩形d5も圧電素子のストロークの内部にあるということだけである。同心円をgとしたので矩形はdとするが、意味は同様である。A群、B群ともに原点を中心とする同心矩形を描くことができる。
【0132】
A群の場合d1内部が1区、d1〜d2が2区、d2〜d3が3区、d3〜d4が4区、d4〜d5が5区である。k区がkτ(τk)に対応する。A群の支持用素子は、d1で向、d2,d3,d4で触、d5で背である。6区で離である。
【0133】
B群の場合d1内部が4区、d1〜d2が5区、d2〜d3が6区、d3〜d4が1区、d4〜d5が2区である。(k−3)区或いは(k+3)区がkτ(τk)に対応する。B群の支持用素子は、d1で向、d1〜d4で触、d4〜d5で背である。3区で離である。
【0134】
A群の送り用素子は周期の初めで原点から出発し、τ(τ1)でd1上に至り、2τ(τ2)でd2、3τ(τ3)でd3に、4τ(τ4)でd4に、5τ(τ5)でd5に至る。6τ(τ0)で原点に戻る。B群の送り用素子は周期の初めから3τで原点から出発し、4τでd1上に至り、5τ(τ5)でd2、T+0τ(τ0)でd3に、T+τ(τ1)でd4に、T+2τ(τ2)でd5に至る。3τ(τ3)で原点に戻る。A群の運動とB群の運動は3区食い違うが、同心矩形に対する関係は同じである。このようなことはこれまで述べた、一次元や同心円二次元の場合と同じことである。
【0135】
【表5】
【0136】
図6(b)に5重矩形での送り用素子の運動を示している。原点c0から出発し、c1(ホ)、c2(ヘ)、c3(ト)、c4(チ)、c5(リ)のように、矩形の辺と交差する。支持用素子Sでいえばニホは向、ホヘトチは触、チリは背、リニは離である。送り用素子で言えばニホヘトチリが搬、リニが復である。
【0137】
図6(a)ではテーブルの移動曲線にそって、A群、B群の原点を3矩形ごとに逐次的に取っている。B1のまわりに5重の同心矩形を描いて3つ目の矩形と、曲線の交点をA2とする。A2の周りに5重の同心矩形を書いて3つ目の矩形とテーブル曲線との交点をB2とする。同様にして、曲線上に、A3、B3、A4…を取ってゆく。
【0138】
A群の送り用素子の原点がA2にある時、A群の送り用素子はイロハニホと二次元運動する。イロは向動作であり、ロハニホにおいてテーブルに接触し、これを搬送する。ホヘは背動作でテーブルと同じ速度であるが、テーブルから離れる。ヘから原点へ戻る。次にB群の送り用素子はB2を原点として、ニホヘトチリと動く。ニホは向動作である。ホヘトチで触になりテーブルを運ぶ。チリでは背動作になりテーブルと同じ速度をもつがテーブルから離れる。A2からみれば、イロが1区、ロハが2区、ハニが3区、ニホが4区、ホへが5区、ヘトが6区である。トは次の周期のA群の送り用素子の原点A3になる。A3から見ればトチが1区、チリが2区、リヌが3区、ヌルが4区、ルヲが5区、ヲワが6区である。3区のヌがB群の送り用素子の原点B3となる。ワが次の周期のA群の送り用素子の原点A4となる。
【0139】
原理的に理解しやすい同心円方式(図4、図5)は等線速度にし、曲線の接線方向加速度が0にできるという利点があった。しかしこれらはq2=U2+V2の計算を常に繰り返す必要があった。同心矩形を時空の対応に利用するこの例はそのような計算は不要である。
【0140】
1区の広がりを同等に決めたとしても、図6と、図4、5を比較すれば分かるように、A群、B群の搬送の距離は長く、間隔は広くなっている。それは1区内での移動距離が同心円の場合より必ず長くなるからである。
【0141】
図6(b)を見れば分かるように、原点c0から曲線の一部が出て矩形を横切りd5まで至っているとして、その交点をc1、c2、c3、c4、c5とする。ここではc1、c2は縦線との交点であり、c3、c4、c5は横線との交点である。c2とc3の距離はかなり長くなっている。
【0142】
継ぎ目の問題を考える。A群はロハニホ、チリヌル…でテーブルを支持し、B群はホヘトチ、ルヲワ…でテーブルを支持する。ホ点が継ぎ目であるが、ホを通る縦線でA群とB群の主導権交代が起こるので継ぎ目の綻びはない。チ点も継ぎ目であるが、チを切る横線でB群とA群の主導権が交代するから継ぎ目に穴があくということがない。矩形を組み合わせるから2重支持の瞬間は存在しないが、無支持の瞬間はありえないということである。
【0143】
ただし矩形による時間・空間対応は、線速度が不定であるという欠点がある。例えば、ホヘトではx方向の速度はホへで大きく、ヘトで小さい。y方向の速度はホへで小さく、ヘトで大きい。ヘトチでは、y方向の速度もx方向の速度も急減する。曲線がなめらかな場合であっても矩形から次の矩形までの時間が一律にτだという制限を加えるから緩急の繰り返しが多くて速度変動が多い。しかもその速度変動は接線方向に生じるから滑りを招き易い。注意が必要である。
【0144】
[5.回転を含むウォーキングドライブ装置の例]
これまでに述べたものは一次元でも二次元でもテーブルは平行移動だけで回転しないものであった。そのような場合テーブルの運動はある一つの代表点のx,y座標だけで完全に表される。そのような単純さに応じて駆動部も単純であった。A群、B群の駆動部が3つ以上あるが、それらの運動は全て同一であった。同一であるから一つについて論じれば良かった。
【0145】
しかし本発明のウォーキングドライブは平行移動だけでなく、回転を含む運動を行うこともできる。そのような場合でもA群とB群の2種類の駆動部を組み合わせるが、A群に属するn個の駆動部がそれぞれ取付方向も運動も異なる。A群のn個の駆動部が同期して運動しタイミングは同じであるが、運動方向、運動距離は異なる。同期のための速度の配分も複雑になる。B群も同様である。
【0146】
小型であり、かつ鉛直面内でも回転駆動平行移動が可能な、XYθテーブルの例を示す。その主な構造を図7に示す。このウォーキングドライブ装置は、基盤1、基盤1の上に60度間隔で配置された6個の駆動部D1、D2、D3、D4、D5、D6、6つの駆動部の上に設けられた板状の磁性体テーブル2、テーブル2の中心に固定された永久磁石3から構成される。永久磁石3が磁性体のテーブルを電磁力によって常に引き寄せている。電磁力によって横にしてもテーブル2は基盤1から落ちない。
【0147】
図7では装置内部が見えるようにテーブル2が透明に描かれている(実際に透明であっても不透明であってもよい。)。
各駆動部D1〜D6は拡大図に示されているように接触ブロックCを介してテーブルを支持する支持用素子Sと、接触ブロックCを面に平行な2方向に駆動する2つの送り用素子F、Hの計3つの圧電素子が組み込まれている。
【0148】
6つの駆動部はA群とB群の2種類に分かれる。A群はD1、D3、D5の3つである。B群はD2、D4、D6の3つである。A群、B群の駆動部は180度の位相差を保ちながら、交互にテーブルの支持と送り運動を行う。
【0149】
その駆動アルゴリズムの基本はこれまでで述べたとおりであるが、A群内(D1、D3、D5)でも駆動部の取付の向きが120度ずつ相違する。B群内(D2、D4、D6)でも駆動部の取付の向きが120度ずつ相違する。
【0150】
前節では、X、Y方向の駆動についてのみ説明を行ったが、ここでは各駆動部内の送り用素子は、X、Y方向ではなく、円周方向Hと半径方向Fに組み込まれているため、座標変換を行ってX、Y方向の変位から各素子の変位を求めている。
【0151】
6つの駆動部の接触ブロック中心が基盤の原点Oから距離aにあるとする。駆動部D1〜D6の基盤1での座標は、Dj(acos(jπ/3+φ)、asin(jπ/3+φ))によって表現できる。jは1〜6の整数、φは自由に与えることができる位相定数である。
【0152】
Djの送り用素子Fjは半径方向に変位する。Fjの運動の方向は(cos(jπ/3+φ)、sin(jπ/3+φ))である。
【0153】
Hjは円周方向に向いているからその運動の方向は(−sin(jπ/3+φ)、cos(jπ/3+φ))を向いている。
【0154】
j番目の駆動部のFj方向の変位をfj、Hj方向の変位をhjとすると、x方向の変位δx、y方向の変位δyは
【0155】
δx= fjcos(jπ/3+φ)−hjsin(jπ/3+φ) (82)
δy= fjsin(jπ/3+φ)+hjcos(jπ/3+φ) (83)
【0156】
となる。テーブルが平行移動する場合は、このような式がどの駆動部Djについても同時に成立する。必要なx方向、y方向の変位が与えられるから、それを実現する送り用素子の変位を簡単に計算することができる。それは
【0157】
fj= δxcos(jπ/3+φ)+δysin(jπ/3+φ) (84)
hj= −δxsin(jπ/3+φ)+δycos(jπ/3+φ) (85)
【0158】
である。このような座標変換によって、D1〜D6での必要な送り用素子の変位が求められる。(82)〜(85)の式は変位の間の関係式として求めているが、これを時間によって微分することによって、そのまま速度の関係式と考えることも可能である。必要なx方向の速度をU、y方向の速度をVとすると、そのための駆動部のFj方向、Hj方向の進退の速度ξj、ηjは簡単に、
【0159】
ξj= Ucos(jπ/3+φ)+Vsin(jπ/3+φ) (86)
ηj= −Usin(jπ/3+φ)+Vcos(jπ/3+φ) (87)
【0160】
によって計算できる。
また前節では、X、Y方向の駆動についてのみ説明を行ったが、本装置ではθ方向の駆動も同時に行うことができる。回転方向(θ方向)の計算は、基盤の原点Oの周りの回転の時は容易に各駆動部Djの変位を決めることができる。テーブルの原点O周りの回転角をΘとすると、駆動部Djの必要な変位は
【0161】
hj=aΘ (88)
fj=0 (89)
【0162】
である。回転に対してこのような簡明な関係を与えるために、複数の駆動部を送り用素子Hが接線方向になるように同一円(半径a)上の周りに同一角度間隔で設置しているのである。原点O以外の点K(x,y)を中心にして角Θだけ回転する場合計算はこれらの重ね合わせになる。回転角Θが小さい場合は、
【0163】
fj= yΘcos(jπ/3+φ)−xΘsin(jπ/3+φ) (90)
hj=−yΘsin(jπ/3+φ)−xΘcos(jπ/3+φ)+aΘ(91)
【0164】
近似的にこのような変位になる。Θが大きい場合は、Θを時間微分した値をΩとして、送り用素子の速度成分ξ、ηを決めることができる。
【0165】
ξj= yΩcos(jπ/3+φ)−xΩsin(jπ/3+φ) (92)
ηj=−yΩsin(jπ/3+φ)−xΩcos(jπ/3+φ)+aΩ(93)
【0166】
これは正確な式になるから繰り返しその速度で送り用素子を駆動すればよい。送り用素子を駆動するといってもウォーキングドライブであるからそのままの速度で駆動するということではない。この式の中にある速度ξjとかηjというのはj番目の駆動部におけるテーブル速度UT、VTであって、送り用素子の速度そのものではない。A群送り用素子は1区〜5区ではUT、VTに等しいが、6区ではこれら5区分の和のマイナス(−ΣUT、−ΣVT)に等しい。B群送り用素子は1区、2区、4区〜6区ではUT、VTに等しいが、3区ではこれら5区分の和のマイナス(−ΣUT、−ΣVT)に等しい。
【0167】
原点周りの単純回転の場合は、ξj=0、ηj=aΩであるから、これは一次元の問題に帰着される。適当な時間τを決めてその6倍を周期Tとすれば良いのである。
【0168】
原点以外の点Kの回りの回転の場合は、式(92)(93)で決まるようなテーブル速度を扱うことになり、A群でも送り用素子の速度が相違する。速度が違ってもτは一定で、1区〜6区の時分割はA群、B群に共通である。5つの同心矩形、5つの同心円、4つの同心円…を使う方法のどれを利用しても良いが、5つ目或いは4つ目の最大矩形または最大円の寸法は、もっとも動きが甚だしい駆動部の必要なストロークに等しいか、あるいはそれ以下に決める必要がある。
【0169】
当然に、同じA群(D1、D3、D5)でも位置によってx方向の速度、y方向の速度が相違する。5〜3の同心矩形、同心円を使う場合、それぞれの矩形、円が歪み、長方形や楕円になってしまう。しかしそれは差し支えない事である。支持用素子のタイミングはA群で共通(1区:向、2〜4区:触、5区:背、6区:離)、B群でも共通(1区:触、2区:背、3区:離、4区:向、5〜6区:触)であるから、矩形の歪は自動的に与えられる。
【0170】
むしろこのような放射状の駆動部配置の場合、単純な平行移動の場合が難しい。テーブル平行移動速度をqとして、最大ストロークを6qで割った値をτとして決め、1区〜6区のタイミングを決める。τが決まれば、支持用素子の運動(向触背離)と、送り用素子の運動(搬復)が自然に決まる。
【0171】
この例では、テーブルは永久磁石によって接触ブロックに引き付けられているため、落下することなく鉛直面内で送り運動を行うことができる。平行移動も回転をも許し、しかもテーブルを保持できる機構ならば永久磁石以外の仮止め手段を用いることもできる。
【0172】
ここまでウォーキングドライブのいくつかの例について述べた。テーブルの速度が予め分かっているという場合にA群、B群の運動を決めることができ交互に搬動作させてテーブルを平行移動させることができる。あるいは定点周りに回転移動させることもできる。
【0173】
しかし始点と終点だけが分かっていて、中間の速度の配分は自由であるという場合もある。その場合は、ウォーキングドライブ装置のコンピュータが自由にテーブルの経路を決定し、テーブルの速度変化を与えることができる。
【0174】
【発明が解決しようとする課題】
ウォーキングドライブ方式の送りテーブルでは、A群、B群の駆動部を交互に作用させて一つのテーブルを直接多軸駆動することが可能となる。ここで問題にするのはテーブルの位置の測定である。テーブルが実際にどれだけ動いたのか、テーブルが現在どこにあるのか?どの方向に向いているのか?ということを問題にする。物体の位置の計測であるから光学的、電気的、磁気的センサを利用するということが考えられよう。しかしながら、現状では長ストロークに渡る多軸動作を測定し得る良いセンサがない。
【0175】
テーブルは1周期の内、2区〜4区においてはA群によって、5区〜6区と1区においてはB群によって運ばれているから、1周期ではx方向、y方向にそれぞれ、
【0176】
UB1τ+UA2τ+UA3τ+UA4τ+UB5τ+UB6τ (94)
VB1τ+VA2τ+VA3τ+VA4τ+VB5τ+VB6τ (95)
【0177】
だけテーブルが変位したということである。周期の番号mについて、これを足し合わせることによって、始点から終点までの移動変位が分かるので、
【0178】
Σm(UB m 1τ+UA m 2τ+UA m 3τ+UA m 4τ+UB m 5τ+UB m 6τ)(96)
Σm(VB m 1τ+VA m 2τ+VA m 3τ+VA m 4τ+VB m 5τ+VB m 6τ)(97)
【0179】
によってテーブルの移動量を計算できるはずである。回転がない場合はこれによって移動変位が求められる。速度は初めから現在までの分は全てコンピュータに記憶されているのであるから、この計算は即時にできる。
【0180】
しかしながら圧電振動子のストロークは一定しないし、複数の駆動部の協調動作に狂いがあることもある。更に接触ブロックとテーブルの間には滑りがある。そのため厳密なテーブルの位置を決めることはできない。
【0181】
最終的なテーブルの位置を正確に測定できないと実際にテーブルが所望の位置へ送られたのかどうなのか?ということも分からない。搬送機構として利用する場合それでは困ったことになる。
【0182】
ウォーキングドライブにおいてテーブルの位置を厳密に測定できる方法を提供することが本発明の目的である。
【0183】
【課題を解決するための手段】
我々人間が平面内を移動する際に、もし地面に規則正しく、飛び石が敷き詰めてあったとすれば、踏みしめた飛び石の数と方向から、移動距離と移動方向を知る事ができるはずである。飛び石に番号が付いていれば最後の飛び石だけで位置が決まる。飛び石に番号がなくても規則正しく埋め込まれている飛び石であれば、その数を数えて記憶するとその方向への変位量が計算できる。一次元の場合なら明確であるが、2次元の場合は飛び石の並ぶ方向と移動の方向が食い違うからやや複雑になろう。
【0184】
本発明は、これと類似の方法によって、テーブルの位置を測定する方法を提案する。すなわち、駆動部の接触ブロックが接触するテーブルの下面に、駆動部の送り用素子のストローク以下のピッチの、規則正しい飛び石形状を加工(磁気情報や異種材料を埋め込んでも良い)し、一方あるいは両方の全部あるいは一部の駆動部がその飛び石の上に接触するような経路でテーブルを駆動するようにし、接触した飛び石の数をかぞえることによって、テーブルの移動量を正確に測定する。いくつかの選択肢がある。
【0185】
[a.計測する駆動部の数]
ウォーキングドライブというのは、A群とB群の駆動部で交互にテーブルを保持して(6区間の内、2区〜5区はA群、5区〜2区はB群)テーブルを搬送する。飛び石はテーブルの裏面の全体に形成するが、飛び石に合致して動く駆動部は幾つなければならないか?ということがまず問題になる。A群の駆動部はn個あり、B群の駆動部もn個あるから全体として2n個の駆動部が存在する。
【0186】
2n個の全ての駆動部が飛び石に合致しつつ搬送動作するという場合、A群のn個の全てが飛び石に合致しつつ動くがB群のn個は飛び石とは無関係に移動する場合、A群の一つの代表とB群の一つの代表の駆動部の2個だけが飛び石に合致し(2n−2)個の駆動部は飛び石とは無関係に移動する場合、A群の一つの代表1個だけが飛び石に合致し(2n−1)個の駆動部は飛び石とは無関係に移動する場合…などの場合がありうる。その他にもありうるが4つの場合だけについて述べる。
【0187】
(1)2n個の全ての駆動部が飛び石に合致しつつ搬送動作する場合
2n個の全ての駆動部が飛び石に合致しながらテーブルを搬送する。送り用素子の搬動作は2n個の駆動部において似たようなものである(平行移動の場合は全く同一)。
【0188】
しかし復動作が全部の駆動部について違う。復動作において全ての駆動部の接触ブロックは後方の飛び石の上に飛ぶことになる。復動作における駆動部の飛び石に対する相対位置はランダムであるから、駆動部の原点と接触ブロックの接触開始時のズレはn個全ての駆動部についてランダムだということになる。テーブルに固定した座標から見れば全ての駆動部は、むかでの足のようにランダムな方向に同期して動き、あちこちに散らばる飛び石を践んで行くように見える。つまり式(43)(44)が成り立たず
【0189】
UAj6τ≠WA6τ (98)
UBj3τ≠WB3τ (99)
VAj6τ≠QA6τ (100)
VBj3τ≠QB3τ (101)
【0190】
となるのである。QA6、QB3はA群の6区、B群の3区におけるy方向の余速度である。定義はx方向余速度と同様である。平行移動の場合は、右辺の余速度WA6、WB3(=WT6、WT3)、QA6、QB3(=WQ6、WQ3)はn個のA群、B群の駆動部について共通であるが、左辺の復速度がj番目の駆動部によって異なり一般に等号が成り立たないのである。このような事情は飛び石の上を辿ってゆく駆動部の全てに共通する。
【0191】
それではどうなるのか?というと、k周期目に着地点として選んだ飛び石のテーブル固定座標での座標をxk、ykとして、次のk+1周期目で選んだ飛び石の座標をxk+1、yk+1とする。それらの差からテーブルが復動作中に進むx方向、y方向の距離を引いたものが復動作のための距離だということになる。
【0192】
UAj6τ=xk+1−xk−UT6τ (102)
UBj3τ=xk+1−xk−UT3τ (103)
VAj6τ=yk+1−yk−VT6τ (104)
VBj3τ=yk+1−yk−VT3τ (105)
【0193】
(2)A群のn個の全てが飛び石に合致しつつ動くがB群のn個は飛び石とは無関係に移動する場合
飛び石がテーブル裏面に面一に造形されている場合は、幾つかの駆動部は地の部分や、地と飛び石の境界部分を践むことができる。距離測定のために飛び石と駆動部を合致させるのであるとすれば、A群、B群ともに合致させる必要はない。何れか一方の群だけ飛び石に合致させれば良いのである。A群が飛び石を踏みしめて進み、B群は地、地・飛び石境界を践んで行くというものである。
【0194】
(3)A群の一つの代表とB群の一つの代表の駆動部の2個だけが飛び石に合致し(2n−2)の駆動部は飛び石とは無関係に移動する場合
A群は全て同期して支持用素子を向触背離とするものであるから、n個全てが飛び石を踏みしめて進むとしても全ての(n個の)駆動部が践んだ飛び石の数は常に同一である。n個の全てが同じカウントをするのだから、どれか一つだけで飛び石を数えれば良いのである。B群についても同じである。そういう立場である。
【0195】
(4)A群の二つの代表2個だけが飛び石に合致し(2n−2)個の駆動部は飛び石とは無関係に移動する場合
A群は全て同期して支持用素子を向触背離とするものであるから、n個全てが飛び石を踏みしめて進むとしても全ての(n個の)駆動部が践んだ飛び石の数は常に同一である。n個の全てが同じカウントをするのだから、どれか二つだけで飛び石を数えれば良いのである。B群についても同じである。だからA群のどれか二つの駆動部だけで飛び石の数を数えれば良いのだ。そういうことである。
【0196】
[b.計数の精度はどうか?]
平行移動の場合でも回転を伴う場合でも、前節(1)A群のn個、B群のn個の駆動部の数えた飛び石の数は同じである。(2)の場合はA群のn個について飛び石数は同じである。だからいくつの駆動部が飛び石数を数えても同じことである。飛び石の数は結局周期の数に等しいのであるから、どの駆動部にも共通なのである。ただし、回転を伴う場合には各駆動部がテーブルを送る距離が異なるため、各駆動部が踏む飛び石の数が同じでも飛び越える飛び石の数は異なる。(1)〜(4)の場合について精度の点で優劣は少ない。しかし、平均化効果はある。
【0197】
[c.同時着石の困難]
A群のn個の全て、B群のn個の全ての駆動部が飛び石を踏みしめて行くという(1)又は(2)の場合は、復動作で後方の飛び石に飛ぶようになる。これは駆動部の原点とは違う。だから復動作ですでに接触ブロックが駆動部の原点から外れているようになる。n個の駆動部と飛び石の相対位置はまちまちであるからn個の駆動部の全てについて、次へ行くべき後方の飛び石がどれで、それを践むためにどれだけ復動作をしなければならないかを計算しなければならない。
【0198】
これは困難なことである。それだけでなく、n個の駆動部と飛び石の相対位置はまちまちであるためストロークの限界に達するまで移動できる距離に食い違いがある。A群、B群の各群の中で駆動部を同期させることを前提にすると、最小のものに合わせてテーブル速度UT、VTを決定する必要がある。送り速度が低下する原因になる。
【0199】
【発明の実施の形態】
[ア.飛び石の配列]
本発明は、テーブルの裏面に位置測定の基準となる飛び石を規則正しく等間隔に設け、一つあるいは複数の駆動部がそれに合致するような経路を辿ってゆくようにする。規則正しい繰り返しのパターンとならなければならないから、飛び石は360度の約数である内角をもつ正多角形の繰り返しに限られる。つまり正三角形、正方形、正六角形の繰り返しになるパターンである。正六角形の繰り返しであるハニカム構造や正三角形(斜方格子)の繰り返し、正方形(単純格子)の繰り返しなどが許される。
【0200】
図8(a)に斜方格子の飛び石の例を図示した。テーブル2の裏面に形成する飛び石4の形状自体は任意である。ここでは正六角形としているが、丸でも矩形でも三角形でも正七角形でもよい。
【0201】
図8(b)に飛び石と駆動部の接触ブロックCの対応関係を示している。接触ブロックCが飛び石4に一致しつつ移動するようにする。つまり駆動部は飛び石づたいに歩いてゆくというようにしたいので、接触ブロックCと飛び石の合致を検証する工夫が必要である。接触ブロックCの面に中心センサ部5と周辺センサ部6を設け、中心センサ部5が一つの飛び石4に対向接触すると、周辺センサ部6はその飛び石の周りの6つの飛び石に対向するようにする。二組のセンサの出力を組み合わせると、中心センサ部5が正しく一つの飛び石に対向接触しているかどうかを調べる事ができる。接触ブロックCは単にテーブルに接触してテーブルを運ぶだけでなく、飛び石との合致を調べるセンサの支持台としての役割を持つようになる。
【0202】
[イ.センサの種類]
テーブル裏面に形成した飛び石を接触ブロックに設けたセンサが検知して接触ブロックを飛び石のどれかに合致させなければならない。そのためにはセンサが飛び石を正確に認識しなければならない。駆動部が飛び石を認識する方法としては、磁気、静電容量、光等を利用したセンサを駆動部の接触ブロックに埋め込む方法や、駆動部の接触ブロックの接触面に電磁石や永久磁石を埋め込み、飛び石部の透磁率を高めて一周期毎に飛び石に吸着しながら駆動を行う方法も考えられる。
【0203】
飛び石・接触ブロック合致機構としては、例えば、テーブルと接触ブロック間の間に高周波電圧を掛け、静電容量Cの変化によって飛び石と接触ブロックの接近離隔を感知できる(静電容量法)。あるいは飛び石だけを強磁性体で形成し接触ブロックにサーチコイルを巻いておき、サーチコイル電流の変化で飛び石の位置を求めることもできる(磁気法)。または飛び石だけ反射率を高めておいて接触ブロックに設けた発光素子(LED、LD)と受光素子(PD)の組み合わせによって反射光を検出して飛び石の所在を求めるようにすることもできる(光学法)。これらはセンサ、信号の増幅器やフィードバック機構などを必要とする。
【0204】
より簡単なものもあって、それが最後に挙げたものである。飛び石だけ強磁性体としたり、あるいはテーブルと飛び石の両方を強磁性体として飛び石部分を凸部としたり、飛び石部分をN極(あるいはS極)にしその他の部分をS極(あるいはN極)とし、接触ブロックに電磁石を埋め込んでおき支持用素子が向であるときに電磁石に電流を流し始め、触であるときに最大電流とし、背で電磁石電流を低減してゆくようにすれば、接触ブロックは飛び石へ選択的に引き寄せられるから、触においては常に接触ブロックと飛び石は合致するということになる。より簡易的には、電磁石を永久磁石として接触ブロックを飛び石に吸着させ、力を与えて離すことも可能である。このような飛び石・接触ブロック合致機構はフィードバック系がなく簡単である。その場合は、中心センサ5および周辺センサ6のようなものは不要である。
【0205】
[ウ.ストローク拡大機構]
駆動部の接触ブロックが飛び石づたいに進めることが可能であるため、飛び石の間隔pは、送り用素子のストロークQより小さいという条件がある。そうでないと接触ブロックCが次の飛び石まで跳躍できない。
【0206】
しかしp<Qという条件は実は難しい条件なのである。これまで送り用素子のストロークQについては述べて来なかったが圧電素子を送り用素子に使えば、数μm程度のストロークしかない。長くても10μmの程度である。
【0207】
テーブルを運ぶだけなら繰り返し周波数fを高くすればよいのである。送り用素子のストロークをQとすると、半周期で3Q/5だけテーブルが動くので秒速は6Qf/5ということになる。fを高くしてテーブルの移動速度を上げることは可能である。
【0208】
しかしながら本発明のように接触ブロックが飛び石づたいに進むということであれば、p<Qという条件が新たに課される。Qが例えば10μmだとし、その中に2つの飛び石が含まれるとすると、飛び石の直径はせいぜい3μm程度ということになる。飛び石の面積は7μm2にしかならない。接触ブロックと飛び石はピタッと合致しなければならない。ということは接触ブロックの面積が7μm2ということになる。このように狭い接触ブロックCの面に電気的センサ、磁気的センサ、光学的センサを設置するということは困難である。
【0209】
それに電磁吸着の場には十分な吸着力が得られないであろう。逆にいえば、飛び石の面積をかなり大きなものにしなければならないということである。飛び石面積が大きいとピッチpも大きくならざるを得ない。数μmというのではだめである。
【0210】
つまり従来のストロークの短い圧電素子による送り用素子などを使っていたのでは、p<Qという条件を満たすことはできない。送り用素子自体にブレイクスルーが要求される。
【0211】
送り用素子のストロークの拡張という事自体が本発明の目的ではない。しかし長いストロークの送り用素子が必要であるから、ここに二つの例を説明する。
【0212】
[弾性バネ・電磁石駆動部(図11)]
図11の(a)は弾性バネ・電磁石駆動部の横断平面図、(b)は縦断側面図を示す。固定台40の上に4本の弾性支柱41が立てられる。これは水平方向(x方向、y方向)に弾性変形する。弾性支柱41の上に正方形状の送り用素子枠体42が固定される。送り用素子枠体42は周辺部は中実体であるが、中央部には空洞43があり、空洞43の上下面が薄い板バネ44となっている。板バネ44は上下に弾性変形する。板バネ44によって中央部に強磁性体コア45が支持される。強磁性体コア45が接触ブロックCになり接触面46を上面に有する。強磁性体コア45の直下で上下動用電磁石47が固定台40に設けられる。これは強磁性体のヨークにコイルを巻いたものである。上下動用電磁石47に電流を流すと強磁性体コア45が引き下げられるから、接触面46が下がる。電流を切ると板バネ44の作用で接触面46が上がり、テーブル裏面に接触するようになる。つまり上下動用電磁石47と強磁性体コア45、板バネ44は支持用素子Sを構成している。
【0213】
送り用素子枠体42のx方向の側方には、x方向駆動電磁石48が設けられる。これも強磁性体のヨークにコイルを巻いたものである。送り用素子枠体42自体が強磁性体である。x方向駆動電磁石48のコイルに電流を流すと、送り用素子枠体42が、x方向駆動電磁石48の方(図11で左方)に引き寄せられる。電流を切ると弾性支柱41の弾性力で元へ(右方)戻る。
【0214】
送り用素子枠体42のy方向の側方には、y方向駆動電磁石49が設けられる。これも強磁性体のヨークにコイルを巻いたものである。y方向駆動電磁石49のコイルに電流を流すと、送り用素子枠体42が、y方向駆動電磁石49の方(図11(a)で上方)に引き寄せられる。電流を切ると弾性支柱41の弾性力で元へ(図11(a)で下方)戻る。
【0215】
これは弾性支柱と板バネを用いており、これの剛性によってストロークが決まる。寸法によるが1mm程度のストロークを与えることは容易である。
【0216】
[圧電素子ストローク拡大機構(図12、13)]
3方の動きのうち、水平方向(x方向、y方向)だけストロークを拡大すれば良いのである。それは圧電素子を3つ使った駆動部でも可能な事である。接触ブロックに直接に送り用素子を付けるのではなくて、接触ブロックを支持する棒部材の根元近くに送り用素子を付ければ接触ブロックには拡大した変位が生ずるのである。図12はそのような拡大ストローク機構を設けた駆動部の平面図、図13は正面図である。
【0217】
固定台10の上に、直交位置に第1支持片11と第2支持片12を固定する。それらの延長線の交差点で両者から等距離の点に枢支片13を固定する。枢支片13の上には縦の継ぎ棒14がナット18で固定される。継ぎ棒14上端には中継ブロック15が差し込まれナット19で固定される。中継ブロック15の上に圧電素子である支持用素子(S)16が垂直に立っている。その上に接触ブロック(C)17がある。支持用素子Sに通電するとこれが伸縮し接触ブロックが昇降してテーブルに対し接触、離隔することができる。
【0218】
第1支持片11後方の尾柱20からx方向に長ボルト22、23が伸びておりブラケット21を横向けに支持している。長ボルト22、23のボルト頭24、25は尾柱20の外に露出している。長ボルトの反対側の雄螺子部はブラケットの雌螺穴に螺合する。x方向用圧電素子26が尾柱20とブラケット21の間に設けられる。ブラケット21の前方螺穴には短い横棒27が螺入されナット29によって固定される。横棒27の他端は中継ブロック15の対向面螺穴に螺合しナット28によって固定されている。長ボルト22、23があるからブラケット21はその位置を維持できる。
【0219】
圧電素子26に電圧を印加して圧電素子26を伸長、収縮すると、その力によってボルトも伸縮しブラケット21が前進後退する。すると中継ブロック15がx方向、−x方向へ僅かに動く。継ぎ棒14が撓む。それは数μm〜10μm程度に過ぎないが接触ブロック17は大きくx方向、−x方向へ変位する。固定台10・中継ブロック15の距離eと、固定台10・接触ブロック17の距離hが著しく異なり、その比h/e程度に変位が拡大されるのである。継ぎ棒14は中央部で彎曲するから拡大率は1.3〜1.5h/e倍程度になろう。
【0220】
第2支持片12後方の尾柱30からy方向に2本の長ボルト32が伸びておりブラケット33を横向けに支持している。長ボルト32のボルト頭37は尾柱30の外に露出している。長ボルトの反対側の雄螺子部はブラケットの雌螺穴に螺合する。y方向用圧電素子31が尾柱30とブラケット33の間に設けられる。ブラケット33の前方螺穴には短い横棒34が螺入されナット35によって固定される。横棒34の他端は中継ブロック15の対向面螺穴に螺合しナット36によって固定されている。二本の長ボルトがあるからブラケット33はその位置を維持できるのであるが、圧電素子31に電圧を印加して圧電素子31を伸長、収縮するとその力によってボルトも伸縮しブラケット33が前進後退する。すると中継ブロック15がy方向、−y方向へ僅かに動く。継ぎ棒14が撓み、接触ブロック17は大きくy方向、−y方向へ変位する。
【0221】
これは継ぎ棒14の弾性変形を利用してx方向、y方向の圧電素子のストロークを拡大している。ストロークQを大きくすれば、ピッチpの広い飛び石をテーブル裏面に造形することができる。飛び石面積が広いと接触ブロックもそれに等しく広くできるから、接触ブロックによってテーブルを支持することができるようになる。
【0222】
【実施例】
[1.A群のある駆動部が飛び石を辿る場合のある瞬間にテーブルを固定した説明]
上述のように、A群B群の駆動部Dの接触ブロックCがテーブルの飛び石4、4…を渡り歩く場合、どの飛び石を利用するか、そしてどのように2つ(あるいはそれ以上)のグループの駆動部Dを交互に動作させるかを一周期毎に決めなければならない。人間の場合には、特に意識する事なくこの選択と動作を繰り返す事ができる。駆動部Dの送り装置の場合には自動的に決定し得るアルゴリズムが必要となる。ここではこれらを実現するアルゴリズムの例を示す。
【0223】
各支持部の動作を決定するまでの流れを図9に示す。ここではテーブルが移動するべき軌跡の目標値が予め既知である場合を考える。
テーブルの初期の位置と、姿勢(角度)は既知であることが必要である。
【0224】
まずテーブルの初期位置と姿勢、移動軌跡の目標値から、流れ図に示すように、各駆動部(図7の例では6個(n=3))の可動範囲を通る凸部(飛び石)の移動軌跡を算出する。
そして各駆動部Djが支持する飛び石と動作を決定する。
【0225】
上述の流れの中で重要になるのは、最後の凸部の選択と動作の決定である。 この決定後の駆動部の動作例を図10に示す。この図は極めて理解しにくい図であるから注意深い考察が必要である。図10はテーブル裏面の飛び石のある瞬間の分布を示し、2本の曲線によってA群のある駆動部Dの2周期分を示している。曲線は二つの飛び石甲、乙の移動軌跡である。甲の軌跡である左の曲線の上に付した数字▲1▼、▲2▼、▲3▼、▲4▼、▲5▼、▲6▼は初めの第1周期での区間1、2、3、4、5、6の初めの接触ブロックの位置を示す。図3のタイミングを示す▲1▼、▲2▼、▲3▼、▲4▼、▲5▼、▲6▼と同じである。接触ブロックは飛び石に接触しているから飛び石の軌跡の上に接触ブロックDの経時的な存在点がある。
【0226】
飛び石乙の軌跡を示す右の曲線の上に付した数字▲6▼、▲1▼’、▲2▼’、▲3▼’、▲4▼’、▲5▼’、▲6▼’は第1周期の▲6▼と次の第2周期での区間1、2、3、4、5、6の初めの接触ブロックDの位置を示す。左の曲線と右の曲線はテーブル上にあって近接した飛び石甲と飛び石乙の移動軌跡であるから同じ曲線であって、単に甲乙間の変位分だけ平行移動したものに過ぎない。これらは同じ一つの駆動部の同じ接触ブロックの運動であって、B群のものを示したのではないから注意すべきである。B群の駆動部の運動は別異の領域で同時的に(半周期ずれて)行われている。
【0227】
ここで当該駆動部Dの支持面(接触ブロックC)は、時刻▲1▼において、飛び石甲の位置にあって支持を解除した状態にある。図10では甲はもっと左下に描いているが、時刻▲1▼では甲も接触ブロックも▲1▼の位置に存在する。これがわからないとこの図を理解できない。
【0228】
この瞬間▲1▼から時刻▲2▼までの間に送り動作を行い(1区;向;UA1=UT1、VA1=VT1)ながら▲2▼において飛び石甲の接触ブロックによる支持を完了する。その後時刻▲2▼〜▲5▼まで支持した状態で送り動作を行う(2区、3区、4区;触;UA2=UT2、VA2=VT2、UA3=UT3、VA3=VT3、UA4=UT4、VA4=VT4)。図10において飛び石甲、乙は触において時刻▲4▼と▲5▼の中間(4区)での分布を描いている。これが図10の理解を難しくしているが、そういうことである。
【0229】
時刻▲5▼から▲6▼までの間では、送り動作を行いながら、支持を解除する(5区;背;UA5=UT5、VA5=VT5)。時刻▲6▼から時刻▲1▼’において接触ブロックは一挙に後退し(ストロークを回復し)て近接後背部にある次の飛び石乙の上に移動する(6区;復;UA6τ=WT6τ+Δx、VA6τ=QT6τ+Δy)。時刻▲1▼’の時接触ブロックは▲1▼’の位置にありその下に飛び石乙が接触しているのであるが、図10は4区での飛び石の分布を描いているから▲1▼’において▲1▼’の位置にない。飛び石の移動軌跡を曲線で示していながら飛び石自体は4区の瞬間の分布を描いているから、このような複雑なことになる。
【0230】
▲1▼’の後は駆動部Dは同様に飛び石乙を利用してテーブルの駆動を行う。▲1▼’から時刻▲2▼’までの間に支持動作を行う(1区;向;UA1=UT1、VA1=VT1)。駆動部Dは▲2▼’において飛び石乙の接触ブロックによる支持を完了する。その後時刻▲2▼’〜▲5▼’まで駆動部Dは飛び石乙を接触支持した状態で送り動作を行う(2区、3区、4区;触;UA2=UT2、VA2=VT2、UA3=UT3、VA3=VT3、UA4=UT4、VA4=VT4)。時刻▲5▼’から▲6▼’までの間では、送り動作を行いながら、飛び石乙の支持を解除する(5区;背;UA5=UT5、VA5=VT5)。▲6▼’から▲1▼’’において接触ブロックは一挙に後退し(ストロークを回復し)て近接後背部にある次の飛び石丙(図示しない)の上に移動する(6区;復;UA6τ=WT6τ+Δx、VA6τ=QT6τ+Δy)。
【0231】
次の飛び石乙の選択については、例えば時刻▲6▼(時刻▲1▼の方が良いが計算負荷は大きい)において、支持部(接触ブロック)の可動範囲にある飛び石のうちで残された移動軌跡のもっとも長いものを選ぶ。
【0232】
また、駆動部Dは、2つを組(A群とB群)として、交互に動作し、一方がストロークを回復する間に他方が支持した状態で送り動作を行っていなければならない。
【0233】
この協調を実現するためには、例えば時刻▲1▼から▲4▼までの間に、図10に示す駆動部DAが主導権を持つものとする。ここで主導権を持つというのは、その駆動部の動作に合わせて協調相手の駆動部DBの動作を決めることである。まず▲1▼の時刻で、DAの可動範囲内に残された移動軌跡を▲1▼から▲6▼のように五等分する。この一つの区間が協調する相手DBの1区間より長い場合には、相手の区間に合わせて1区(▲1▼〜▲2▼)および2区(▲2▼〜▲3▼)のみを短くし、残りの軌跡を三等分して3〜5区に再配分する。そして1区(▲1▼〜▲2▼)では、DAは送り動作を行いながら支持動作を行い、相手の駆動部DBは支持した状態で送り動作を行う。2区(▲2▼〜▲3▼)では、DAは支持した状態で送り動作を行い、相手の駆動部DBの支持を解除させる。3区(▲3▼〜▲4▼)では、DAは引き続き支持した状態で送り動作を行い、相手の駆動部DBのストロークを回復させて次の飛び石の上まで移動させる。
【0234】
そして▲4▼の時刻において、主導権を協調相手の駆動部DBに渡し、4区から6区ではDBの動作に合わせて上述の手順を繰り返す。念のために残りの半周期を記述する。▲4▼の時刻で、DBの可動範囲内に残された移動軌跡を五等分する。その一つの区間がDAの1区間(▲4▼〜▲5▼あるいは▲5▼〜▲6▼)より短い場合には、DBの区間に合わせて4区(▲4▼〜▲5▼)および5区(▲5▼〜▲6▼)を短くする。そして4区(▲4▼〜▲5▼)では、DBは送り動作を行いながら支持動作を行い、DAは支持した状態で送り動作を行う。5区(▲5▼〜▲6▼)では、DBは引き続き支持した状態で送り動作を行い、その間にDAは支持を解除する。6区(▲6▼〜▲1▼’)では、DBは引き続き支持した状態で送り動作を行い、その間にDAはストロークを回復して次の飛び石の上に移動する。
【0235】
この様な主導権の受け渡しを交互に行う事で、同時に支持を解除することなく、A群、B群の駆動部DA、DBを協調して、動作させることができる。
【0236】
またここでは回転を含めたオープンループでの位置決め制御方法について述べたが、回転を含まないxyの2方向駆動についても同様に可能である。
【0237】
[2.テーブルに固定した座標においてA群のある駆動部が飛び石を次次に辿る有り様の説明]
前述のようなA群の一つの駆動部が甲、乙の飛び石を辿ってゆく同じ有り様を、テーブルに固定した座標によって説明する。図14はテーブル裏面の飛び石に固定した座標でのA群のある駆動部の動きを破線によって示している。
【0238】
図10のものと軌跡は全く同じであるが、図10は▲4▼〜▲5▼の4区における時点での飛び石群を描き、▲1▼〜▲6▼及び▲1▼’〜▲6▼’での駆動部の接触ブロックの動きを丸付き数字によって示している。それは時空が混合しているからわかりにくい。図14は、テーブル座標の上に駆動部の基台の動きを丸付き数字で表現している。図10と同じ丸付き数字は同時刻を表現しているが、図10では接触ブロックの位置を表現し、図14では駆動部の基台を表現している。
【0239】
第1周期では甲の飛び石に接触ブロックCをおいている。▲1▼の瞬間に基台は▲1▼の位置にあり接触ブロックは甲直下にある。▲1▼〜▲2▼が「向」である。▲2▼の瞬間に基台は▲2▼にあり接触ブロックは甲にあり甲に接触する。▲3▼から触になり、基台は▲3▼にあり接触ブロックCは甲にある。接触ブロックがテーブルを▲3▼〜▲5▼まで押してゆく。▲4▼の時点で基台は▲4▼にあり接触ブロックは甲にある。▲5▼の時点で基台は▲5▼にあり、接触ブロックは甲にある。ここで接触ブロックはテーブルを離れ始めるが同速度で▲6▼まで進む。
【0240】
▲6▼から次の第2周期の▲1▼’に進むまでが復になり、接触ブロックCは飛び石甲直下から飛び石乙直下まで飛躍する。接触ブロックCは速い速度で移動する(細い実線)が、基台自体は破線上をほぼ同速度で進み▲6▼→▲1▼’となる。第2周期での▲1▼’〜▲2▼’が「向」の期間であり接触ブロックはテーブルと離れているが同一速度で動いている。▲2▼’で触になり接触ブロックがテーブルの飛び石乙に接触する。▲2▼’〜▲5▼’では触になり、基台がこの数字の位置を動いてゆく。接触ブロックは乙にあって、支持した状態でテーブルを接触ブロックが搬送することになる。▲1▼’〜▲6▼’では接触ブロックは飛び石乙の上にあり駆動部の基台は数字▲1▼’〜▲6▼’の上にある。一点鎖線で示すものは駆動部の基台と接触ブロックを結ぶ線分(足)である。そのような事情は第1周期でも同じことである。▲1▼〜▲6▼と飛び石甲を結ぶ足の線分があるのであるがたまたま基台の軌跡が甲を通過するから、足も軌跡に重なっており分明でない。
【0241】
このようにA群の一つの駆動部は、接触ブロックを飛び石のどれかにおいて1周期の運動をしてテーブルをある特定の曲線にそって進めてゆくのである。図14は、テーブルの飛び石分布のなかで、駆動部の基台が辿る一つの曲線を描いているから、より理解し易い。図14において基台をしめす曲線は左下から右上へと抜けているが、実際には駆動部の基台は静止しているから、テーブル自身は図14の右上から左下へと進んでゆくのである。1周期毎に接触ブロックが把持する飛び石が前進してゆくということになるのである。図10と全く同じ運動であるが、図14の方が時空が一定しており分かりやすい。
【0242】
【発明の効果】
ウォーキングドライブでは、一つのテーブルを平面内で自由に移動および回転させることができるが、現状ではこれを測定する良いセンサが存在しない。しかし、実際にウォーキングドライブを物体の搬送に利用しようとすると、物体位置の正確な制御が必須になる。他方、ウォーキングドライブでは、駆動部の1周期での送り量(動物の歩行における歩幅のようなもの)はほぼ一定であり、この変動誤差が累積しないような工夫さえあれば、オープンループでも簡便に位置決め制御を行うことができるはずである。本発明では、テーブルの位置制御のために周期的な飛び石を多数設け、A群の駆動部が、あるいは両群の駆動部が必ず飛び石に合致しながらテーブルを搬送するようにした。これによって常にテーブルの絶対位置を制御する事ができる。本発明はテーブルの正確な位置決めを求める要求を初めて満足することができる。ウォーキングドライブの実際的な応用を進める上で顕著な効果をもたらす。
【0243】
なお駆動部の組み合わせは2群を組み合わせ、半周期ずつの駆動(A群=2区〜4区、B群=5区〜1区)を分担する以外に、3群以上を組み合わせ、1/3周期以下の駆動を分担することも可能である。そうすると複雑になるが例えば3群の駆動部DA、DB、DCを組み合わせる場合は、支持用素子S、送り用素子X、Yの動作の区分ごとの配分は例えば次のようになる。
【0244】
【表6】
【図面の簡単な説明】
【図1】 本発明のウォーキングドライブ駆動方式でテーブルを搬送するために用いられる接触ブロックCと送り用素子X、Yと支持用素子Sからなる駆動部Dの斜視図。
【図2】 A群駆動部とB群駆動部によってテーブルを支持し搬送する一次元のウォーキングドライブ搬送方式の1区〜6区の初めのタイミング点▲1▼、▲2▼、▲3▼、▲4▼、▲5▼、▲6▼での、A群、B群駆動部DA、DBの送り用素子XA、XBと支持用素子SA、SBのテーブルに対する動作を示すための側面図。
【図3】 A群駆動部とB群駆動部によってテーブルを支持し搬送するウォーキングドライブ搬送方式の1周期に於けるA群駆動部DAの支持用素子SAと送り用素子XA、B群駆動部DBの支持用素子SBと送り用素子XBとの伸長度の時間変化を示すグラフ。横軸は時間であり1周期分を示す。1周期は6区分に分けられている。▲1▼〜▲2▼が1区、▲2▼〜▲3▼が2区、▲3▼〜▲4▼が3区、▲4▼〜▲5▼が4区、▲5▼〜▲6▼が5区、▲6▼〜▲1▼’が6区である。6区間に於いて、支持用素子は「向触背離」の4相変化を、送り用素子は「搬復」の2相変化をする。
【図4】 周期変化する送り用素子が搬動作に於いて線速度がほぼ一定になるような変化をしており、復動作によって送り用素子が駆動部の原点に戻るようにしたモードのウォーキングドライブにおいて、テーブル移動経路と、その部分経路について取ったA群送り用素子、B群送り用素子の原点の位置と、周期毎の1区〜6区に於ける可能な変位点の包絡線である原点を中心とする5つの同心円g1、g2、g3、g4、g5とを示す経路図(a)と、一つの送り用素子の原点まわりの5つの同心円g1、g2、g3、g4、g5と同心円によって区切られる1区〜5区に於ける支持用素子の向触背離の割当を示す線図(b)。
【図5】 周期変化する送り用素子が搬動作に於いて線速度がほぼ一定になるような変化をしており、復動作によって送り用素子が駆動部の原点より一つ前の位置に戻り1区の終わりに原点を通るようにしたモードのウォーキングドライブにおいて、テーブル移動経路と、その部分経路について取ったA群送り用素子、B群送り用素子の原点の位置と、周期毎の1区〜6区に於ける可能な変位点の包絡線である原点を中心とする4つの同心円g1、g2、g3、g4とを示す経路図(a)と、一つの送り用素子の原点まわりの4つの同心円g1、g2、g3、g4と同心円によって区切られる1区〜5区に於ける支持用素子の向触背離の割当を示す線図(b)。
【図6】 周期変化する送り用素子が搬動作に於いてx方向速度U、y方向速度Vが独立に有限の変化をしており、復動作によって送り用素子が駆動部の原点に戻るようにしたモードのウォーキングドライブにおいて、テーブル移動経路と、その部分経路について取ったA群送り用素子、B群送り用素子の原点の位置と、周期毎の1区〜6区に於ける可能な変位点の包絡線である原点を中心とする5つの同心矩形(正方形)d1、d2、d3、d4、d5とを示す経路図(a)と、一つの送り用素子の原点まわりの5つの同心矩形d1、d2、d3、d4、d5と同心矩形によって区切られる1区〜5区に於ける支持用素子の向触背離の割当を示す線図(b)。
【図7】 XYθ変位可能垂直面内駆動ウォーキングドライブ装置の斜視図。同等の6つの駆動部の一つの拡大図を一部に示す。
【図8】 テーブル位置測定のためにテーブル裏面に規則正しく周期的に形成した飛び石例を示す裏面図(a)とセンサとの対応を示す断面図(b)。
【図9】 各駆動部の動作決定の流れを示す流れ図。
【図10】 テーブルの裏面に設けられた位置測定のための飛び石のいずれかに接触しながらA群、B群の駆動部が、テーブルを搬送するための移動の経路を決定する方法を説明するための底面図。
【図11】 長いストロークの送り用素子を得るための電磁アクチュエータの横断平面図(a)と縦断面図(b)。
【図12】 長いストロークの送り用素子を得るための拡大機構付きの圧電素子型駆動部の平面図。
【図13】 長いストロークの送り用素子を得るための拡大機構付けの圧電素子型駆動部の正面図。
【図14】テーブルに固定した座標における、駆動部の接触ブロックと基台の運動を説明するための図。第1周期では接触ブロックは飛び石甲にあり、第2周期では接触ブロックは飛び石乙にある。駆動部の基台は連続的に移動するが、接触ブロックは第1周期の▲6▼から、第2周期の▲1▼’までに甲から乙へと飛翔する。
【符号の説明】
1 基盤
2 テーブル
3 永久磁石
4 飛び石
5 中心センサ部
6 周辺センサ部
10 固定台
11 第1支持片
12 第2支持片
13 枢支片
14 継ぎ棒
15 中継ブロック
16 支持用素子
17 接触ブロック
18 ナット
19 ナット
20 尾柱
21 ブラケット
22 長ボルト
23 長ボルト
24 ボルト頭
25 ボルト頭
26 第1圧電素子
27 第1横棒
28 ナット
29 ナット
30 尾柱
31 第2圧電素子
32 長ボルト
33 ブラケット
34 第2横棒
35 ナット
36 ナット
37 ボルト頭
40 固定台
41 弾性支柱
42 送り用素子枠体
43 空洞
44 板バネ
45 強磁性体コア
46 接触ブロックの接触面
47 上下動用電磁石
48 x方向駆動電磁石
49 y方向駆動電磁石
D1〜D6 駆動部
j 駆動部の番号
m 周期の番号
n A群、B群に含まれる駆動部の数
s 飛び石の数
Q 送り用素子のストローク
p 飛び石ピッチ
X x方向の送り用素子
Y y方向の送り用素子
S 支持用素子
C 接触ブロック
XA A群に属する駆動部のx方向の送り用素子或いはその接触ブロックのx座標
YA A群の属する駆動部のy方向の送り用素子或いはその接触ブロックのy座標
SA A群に属する駆動部の支持用素子
CA A群に属する駆動部の接触ブロック
XB B群に属する駆動部のx方向の送り用素子或いはその接触ブロックのx座標
YB B群の属する駆動部のy方向の送り用素子或いはその接触ブロックのy座標
SB B群に属する駆動部の支持用素子
CB B群に属する駆動部の接触ブロック
g1〜g5 周期内で1区〜5区で接触ブロックがその上に存在する同心円
d1〜d5 周期内で1区〜5区で接触ブロックがその上に存在する同心矩形
Hj 円周方向に動作方向をもつj番目の送り用素子
Fj 半径方向に動作方向をもつj番目の送り用素子
hj j番目駆動部の位置での必要なテーブルの円周方向変位
fj j番目駆動部の位置での必要なテーブルの半径方向変位
UA1〜UA6 1区〜6区のA群駆動部送り用素子のx方向速度
VA1〜VA6 1区〜6区のA群駆動部送り用素子のy方向速度
UB1〜UB6 1区〜6区のB群駆動部送り用素子のx方向速度
VB1〜VB6 1区〜6区のB群駆動部送り用素子のy方向速度
UT1〜UT6 1区〜6区のテーブルのx方向速度
VT1〜VT6 1区〜6区のテーブルのy方向速度[0001]
BACKGROUND OF THE INVENTION
The present invention relates to a position control method in a walking drive. The drive form called Walking Drive was invented by the present inventors. It is not a generally known driving means. Since the technical field is not understood only by the name, this is first explained and the terms are defined together.
[0002]
The walking drive is a mechanism for conveying an object by moving a plurality of sets of finite-length driving means in a complementary manner. The inventor named it walking drive because it resembles human walking. For example, a piezoelectric element can be used as the finite length driving means.
[0003]
The stroke of the piezoelectric element is limited, but the stroke of the animal's foot is also limited. However, looking at human walking motion, the torso can move infinitely smoothly and freely in the plane while the two legs reciprocate.
[0004]
Similarly to this, the walking drive can perform smooth driving with a long stroke in the X and Y directions or the X, Y and θ directions using two sets of piezoelectric elements that perform complementary movements. . The amount of movement in one cycle is not exactly constant so that the stride is not exactly constant in human walking. In addition, slippage may occur when a plurality of contact surfaces are not accurately cooperating or during acceleration / deceleration. For this reason, if the movement is continued, the difference between the set movement amount and the actual movement amount is accumulated, and the position of the table becomes unknown. Therefore, the present invention is proposed in order not to lose sight of the position of the table.
[0005]
[Prior art]
Many inventions have been proposed in which there is a moving device having some kind of one-dimensional or two-dimensional driving means, and its position is obtained or controlled.
[0006]
(1) Japanese Patent Application Laid-Open No. 59-58825 “Moving device with a function of reducing length measurement error” applies laser light to the end surface of an XY stage for manufacturing a semiconductor device that can move on the XY plane, The movement distance is obtained from the interference fringes. Since the interference of light having a wavelength of about 0.6 μm is used, the resolution is as high as 0.1 μm. However, accurate positioning is not possible over a wide range. The stroke of the table itself is several μm and is narrow.
[0007]
(2) Japanese Patent Application Laid-Open No. 60-7725 “Electromagnetic alignment device” has conventionally used three motors for the stage that can hold a semiconductor wafer and move it in three directions (X, Y, θ) for photolithography. , This is replaced by three or four electromagnetic coils. The stage can be moved in the X, Y, and θ directions by changing the current mode of the electromagnetic coil. Although the necessity of a sensor is described, it does not explain what kind of sensor is used.
[0008]
(3) Japanese Patent Application Laid-Open No. 63-6487 “X / Y / Z fine movement table” provides a table on which a sample is placed in an exposure apparatus. This is a double stacked table with a fine motion table mounted on a coarse motion table. A table supported on a thin longitudinal axis is surrounded by a quadrilateral container and can move slightly in it. When a force is received in the X direction and the Y direction by the magnetic force of the electromagnet, the vertical axis bends and the table is displaced XY. The displacement amount sensor is obtained by a change in capacitance between the sensor surface and the stage end surface. Since it is a very small displacement, it can be measured by electrostatic capacity, but a change in distance exceeding 0.1 mm cannot be measured.
[0009]
(4) Japanese Unexamined Patent Publication No. Hei 4-99989 “Micro-moving method and apparatus” is intended for a large object having a large weight unlike the micro-semiconductor device described so far. A heavy object placed on the ground generates a static frictional force with the ground due to gravity. I want to control the attitude by applying an impact force momentarily and causing a momentary displacement. A spring, magnet, etc. can only exert a force in one direction. Therefore, the shape memory alloy spring and the electromagnetic plunger are combined so that an impact force can be generated in both directions. A sensor for detecting a change in position is not described.
[0010]
(5) Japanese Patent Application Laid-Open No. 61-109638 “Fine-motion up-and-down mechanism” elastically supports a disk-shaped stage for a semiconductor device by a spring so that it can be moved up and down, and an electromagnet is provided below the stage (ferromagnetic material) Has proposed a mechanism to move up and down by sucking and separating. It is a proposal of a vertical drive mechanism and does not describe a sensor for obtaining a vertical displacement amount. Since the deformation of the leaf spring is utilized, the up and down stroke is also short.
[0011]
(6) Japanese Patent Laid-Open No. 8-197358 “XY stage mechanism” proposes a non-contact stage such as a stepper. We propose a non-contact stage because there is a contact part, and if there is friction, a worn object or the like will wrap around and contaminate the semiconductor wafer. The stage is levitated by magnetism so that it can be minutely displaced in the X and Y directions by the balance of magnetic force. The stroke is small because of magnetic levitation. An optical sensor is used to detect the gap.
[0012]
In the stage driving mechanism described so far, the relationship between the stage and the driving mechanism is fixed, and the displacement of the driving mechanism is equal to the displacement of the stage. Therefore, there is a simple relationship in which the position of the stage can be determined by measuring the displacement of the drive mechanism. Moving distance and displacement can be easily measured with existing sensors. However, such a drive mechanism naturally has a very short stroke. A longer stroke mechanism is desired. Therefore, the drive system proposed by the present inventor is called walking drive. this is
[0013]
(7) Japanese Patent Application Laid-Open No. 7-285043 "Feeding device" Patent applicants Eiji Honmoto and Toshimichi Moriwaki proposed for the first time. The table is repeatedly carried in a desired direction by a piezoelectric element that is slightly displaced in the X and Y directions. Details will be described next.
[0014]
[1. Walking drive concept and one-way drive]
First, a method of driving a table using a predetermined displacement pattern is schematically shown in FIGS. FIG. 1 is a perspective view of the drive unit. The contact block C is a cubic block, which is a contact member that moves the table while the upper surface of the contact block C contacts the lower surface of the table. The piezoelectric element S in the vertical direction (referred to as z direction) is an element that displaces the contact block C up and down. The longitudinal piezoelectric element S is referred to as a “supporting element”. The lower end of the supporting element S is fixed to some fixing member. When the support element S is extended, the lower surface of the table is supported, and when the support element S is reduced, the support element S is separated from the lower surface of the table.
[0015]
The contact block C has two piezoelectric elements Y and X in the lateral direction (the x direction and the y direction). The other ends of the lateral piezoelectric elements X and Y are fixed to a fixing member. When the piezoelectric element X is extended, the contact block C moves in the x direction, and when the piezoelectric element X is reduced, the contact block C moves in the −x direction. When the piezoelectric element Y is extended, the contact block C moves in the y direction, and when the piezoelectric element Y is reduced, the contact block C moves in the -y direction. The lateral piezoelectric elements X and Y are called feeding elements. One unit including the supporting element S, the feeding elements X and Y, and the contact block C is referred to as a driving unit D. That is, D = S + X + Y + C.
[0016]
The driving unit D including the contact block C and the piezoelectric elements S, X, and Y includes an A group driving unit and a B group driving unit in units of n (three or more). That is, there are two groups of driving units, each having n units, so that there are 2n driving units in total. The n group A driving units simultaneously contact and are separated from the lower surface of the table. At the same time, the n B-group driving units also come into contact with and separate from the lower surface of the table.
[0017]
However, the A group driving unit and the B group driving unit are in complementary contact with the lower surface of the table. Complementary means that they are complementary in time.
[0018]
Since 3 or more support points are required to support a plane, n is 3 or more, but n of 4, 5 or more can be provided.
[0019]
For simplification, in the following description, the A group driving unit and the B group driving unit are sometimes abbreviated as A group and B group. When it is necessary to distinguish between members such as S, X, Y, C, D, etc.B, XA, ... and so on.
[0020]
Now, in terms of time, both the A group and the B group repeat the synchronous motion with a fixed period T. When one cycle T is expressed by a phase, it is 2π (360 degrees), but the walking drive equally divides this into six sections (60 degrees each).
[0021]
Name the section 1 (0-60 degrees; τ1), 2 wards (60 to 120 degrees; τ2), 3 wards (120 to 180 degrees; τ3) 4 wards (180-240 degrees; τ4), 5 wards (240 to 300 degrees; τ5), 6 (300 to 360 degrees; τ6). Let τ be the time length of the first district. 6τ = T.
[0022]
The supporting element S repeats the same movement with the same period T in both the A group driving unit and the B group driving unit. However, there is a half-cycle (180 degree) shift between Group A and Group B. The feeding elements X and Y also have a half-cycle shift between the A group and the B group. However, the movements of the feeding elements are not necessarily the same in the A group, and are not necessarily the same in the B group. In the case of non-linear movement, the movements of the feeding elements X and Y are different even in the drive units in the same group. However, this is the difference between the speeds U and V, which will be described later, and the timing distribution is determined in the same manner as in the supporting element.
[0023]
Since the movement of the walking drive is difficult to explain, the movement will be explained from the support element S which is typical and easy to understand. That is easier to understand. The supporting element S moves the contact block C and exerts several actions on the table.
[0024]
In some cases, the supporting element S extends to maintain the state, and the contact block C touches and carries the table. This is called “touch”.
[0025]
In some cases, the support element S contracts and the contact block moves away from the table. This is called “back”.
[0026]
In some cases, the contact block C is separated from the table while the supporting element S is kept in a degenerated state. This is called “separation”.
[0027]
Sometimes, the supporting element S extends and the contact block comes into contact with the table. This is called “direction”. The contact block makes a four-phase movement of “touch and back” with respect to the table within one cycle by the supporting element S. The motion speed (displacement amount / phase) and amplitude of the supporting element S are unchanged. In other words, the movement of the touch and the back is always unchanged, and it is not necessary to change the parameters of the supporting element S in order to change the table motion.
[0028]
The feeding elements X and Y also move at the same timing, but this is a two-phase movement. It is difficult to understand walking drive because there are both four-phase exercise and two-phase exercise.
[0029]
The movement forms of these four support elements S are related to the sections. “Direction” and “back” are forward and backward movements of the supporting element S, and time (phase) is assigned to each section. “Separated” is a state in which the supporting element S is degenerated, but this is also assigned to the first section. “Touch” is a state in which the supporting element S is fully extended, but this is assigned to the third section. One of these sections corresponds to the phase, not the time. However, since time is easier to understand, the following explanation will be given by time instead of phase. The phase / time ratio is the angular frequency of the signal, but the moving speed can be freely changed by changing the frequency.
[0030]
Both the A group and the B group repeat the feel-back movement, but the timing is shifted by a half cycle. In Group A, 1 ward is assigned to the direction, 2, 3, 4 wards to the touch, 5 wards to the back, and 6 wards to the remote. In group B, 4 wards in the direction, 5, 6, 1 in the touch, 2 wards in the back, and 3 wards in the back.
[0031]
That is, the movement of the supporting element S is about the A group and the B group.
1 ward ... Group A = direction, Group B = touch
2 wards ... Group A = touch, Group B = back
3 wards ... Group A = touch, Group B = separated
4 wards ... Group A = touch, Group B = direction
5 wards ... Group A = back, Group B = touch
6 wards ... Group A = separated, Group B = touch
It is. This is a common property that is maintained even in the two-dimensional case that follows. It may be said that it is the basic of walking drive.
[0032]
FIG. 3 shows the supporting element S in the case of a one-dimensional movement.A, SBAnd feed element XA, XBRepresents the movement in one cycle. The first graph is a group A supporting element S.AThe third graph shows the movement of the B group supporting element SBShows exercise. The horizontal axis is time (phase). (1) to (2) represent 1 ward, (2) to (3) represent 2 ward,..., (6) to (1) represent 6 ward. The vertical axis represents the extensional displacement of the element. If S is 0, it is degenerate. The contact block is then away from the table. So it becomes “separated”.
[0033]
The increase of S represents the movement of the contact block trying to contact the table and corresponds to “direction”. The maximum value of S hits the “touch” in a state where the contact block contacts the table and the table is held by the frictional force. The decrease in S represents the movement of the contact block moving away from the table and hits the “back”. Release and touch are two static states, but there are four phases of movement because there is a process for transition, a back and a direction.
[0034]
Since the touch extends over three sections, the group A supporting element and the group B supporting element support the table every half cycle. Group A supports the table in 2 wards, 3 wards and 4 wards. Group B supports tables in the 5th, 6th and 1st districts. At time point (2), the B group support is changed to the A group support, and at time point (5), the A group support is changed to the B group support.
[0035]
FIG. 2 shows the relative movement of the driving units of the A group and the B group with respect to the table. In FIG. 2, only one driving unit of the A group and the B group is written, but this is representative. Actually, there are three or more equivalent drive units to support the table. Group A supporting element S in (2), (3), (4), (5)AIt can be seen that it stretches up and holds the table. Group B supporting element S in (5), (6), (1), (2)BExtends up and supports the table. Since (2) and (5) are at the time of switching, both contact blocks are in contact with the back of the table. Between the contact block and the table, the solids come into contact with each other, and the force is transmitted without slipping. There is an assumption that the static friction force is large and there is no slip. In addition to the above mechanism, there is a feed mechanism that moves in the horizontal direction. The feed mechanism is a two-dimensional one, but the one-dimensional case will be described first. Because it is one-dimensional, group A has XAHowever, in group B, XBSuppose there is.
[0036]
In FIG. 2, the feed element X in the x directionA, XBSince the displacements are written in the opposite directions, the actions of the feeding elements of the A group and the B group are opposite to the same feeding.
Group A feed element X as shown in FIG.AContinues to grow at a constant speed U from 1 to 5. In 6th district, it moves backward and returns to the first position in 1st district. Contact block C of group A extending at speed UAIs in contact with the table in the 2nd, 3rd and 4th districts, so the table is the feed element XATherefore, it proceeds at a constant speed by U × 3τ.
[0037]
B group feed element XBContinues to degenerate at a constant speed U in the 4th, 5th, 6th, 1st, 2nd wards. In the 5th, 6th and 1st districts, the supporting elements of the B group continue to contact the table. In the 3rd ward, it expands and returns to the first position in the 4th ward. Contact block C of group B that degenerates at speed UBIs in contact with the table in the 5th, 6th, and 1st districts, so the table is a feed element XBTherefore, it proceeds at a constant speed by U × 3τ.
[0038]
That is, in the 5th to 1st districts, the table is sent in the x direction by 3Uτ by the B group, and in the 2nd to 4th districts, the table A is sent in the x direction by 3Uτ. The table is eventually sent by 6Uτ. Since this is a UT, the table is sent in the x direction at a constant speed U in the period T.
[0039]
There are only two feeding elements, a slow movement carrying the table and a fast movement returning from the table. The exercise of carrying the former table is called “carrying”.
[0040]
The latter movement to return to the original position is called “return”. The feeding element repeats the two-phase operation of carrying back. The carrying speed is U, but the average speed of recovery is -5U, which is 5 times faster.
[0041]
The temporal correspondence of the feeding element that changes in two phases with carry-in / out-recovery, and the supporting element that changes in four phases with touching-back and touch-offing is important. The “return” of the feed element is synchronized with the “release” of the support element.
[0042]
That is, the contact block returns to the original position while the contact block is away from the table. The “carrying” of the feeding element is synchronized with the “facing back” of the supporting element. The “carrying” of the feeding element is a long operation consisting of 5 sections, while the “touch” of the supporting element is an operation of only 3 sections. The “carrying” of the feeding element is synchronized with the 5 sections including “direction” and “back” before and after that.
[0043]
That is, at the beginning and end of “carrying”, the drive unit has no action of carrying the table. The “direction” portion is a preparation period for the contact block C to be at the same speed as the table, and the “back” portion is an inertial motion for preventing a speed fluctuation when the contact block C is separated from the table. . It means that the contact block is smoothly separated from the table by eliminating the difference in linear velocity. Even when the support element is moving in the direction of the back or the back, the feeding element performs the carrying operation, so there is a discrepancy between the four phases and the two phases, but this facilitates the conveyance of the table. . This is one of the important points in the inventor's walking drive.
[0044]
Since the table is carried alternately by the A group and the B group, the speed discontinuity should not occur at the joint. If there is a speed discontinuity, acceleration occurs and a force of table mass × acceleration is generated, so the table slips over the contact block. Therefore, at times (2) and (5), the feeding elements X of the A group and the B groupA, XBThe speed U must be the same. In order to suppress speed fluctuation and prevent slipping, it is only necessary that the speed is the same at that moment.
[0045]
However, the method of the present invention is very thoughtful: when one drive is “direction”, it is equal to the other drive speed, and when it is “back”, it is equal to the other drive speed. From the viewpoint of the “transport” driving section, the first two sections and the last two sections of the five transport sections have the same speed as the other driving section. Of the five carrying zones, only the middle one is different in speed from the other drive unit. At this time, the other drive unit is in a separated state. One period consists of 6 sections, but the speed of the two drive units is different in only 2 sections, but the speed is the same in 4 sections. That is
[0046]
UA= UB A or B is facing or back (1)
UA≠ UB A or B separated (2)
[0047]
There is a relationship. Expressed in terms of time, in one cycle, 2/3, both drive units are moving in parallel at the same speed, and move differently for return by 1/3.
[0048]
Both drive units support the table at the same time only at the time points (2) and (5). The table is always supported and transported by only one side. Even in this case, the drive unit that is separated is moving at the same speed as the table for 2/3 of the time.
[0049]
But that doesn't mean that a one-dimensional walking drive can only move at a constant speed. Changing speed is easy. The horizontal axis in FIG. 3 is regarded as a phase instead of time, and it is only necessary to manipulate the angular velocity that advances this phase. That is, if this phase is advanced rapidly in the positive direction, the table is sent to the right quickly in FIG. 2, and conversely if it is advanced slower in the negative direction, the table is sent to the left later. This speed change and direction change can be made in any phase.
Table 1 shows the relationship of the operations shown in FIG.
[0050]
[Table 1]
[0051]
Let ξ be the stroke of the feed element (moving distance for one stroke), and f (T = f-1), In one cycle, the A group carries the table by 3ξ / 5, and the B group carries the table by 3ξ / 5, so the table advances in the x direction by 6ξ / 5.
[0052]
Table 1 describes the operation of the supporting element and the feeding element, the difference in speed, and the change in initiative for each section. This property is common throughout the subsequent walking drive exercise. The same applies to the two-dimensional case. Next, the speed of the feeding element for each section in one cycle will be described.
[0053]
Group A feed element X in k-sectionAThe speed of UAkAnd
B group feed element X in k sectionBThe speed of UBkAnd
Table X in k wardTThe speed of UTkAnd
[0054]
The above definition is only X because it considers a one-dimensional problem. In the case of a two-dimensional problem, X and Y can be considered. Although only one period is considered, since it is the same in every period, only one period needs to be known. Table speed UTkIs determined in advance. The reason why it has already been decided will be explained later. In this case, the feeding element speed U of the A group and the B groupAk, UBkIs determined for each section as follows. Where UA6, UB3Is the average speed (and so on).
[0055]
1st district UA1= UB1= UT1 (3)
District 2 UA2= UB2= UT2 (4)
[Expression 1]
4th UA4= UB4= UT4 (6)
5th UA5= UB5= UT5 (7)
[Expression 2]
[0056]
It is clear that it is a walking drive because the UB3= -ΣUTj, UA6= -ΣUTjIt is. In group B, speed U in other than 3 wardsBjIs the table speed UTjIt is the same, and in group A, speed U other than 6 wardsAjIs the table speed UTjIs the same as the zero sum rule
[0057]
UA1+ UA2+ UA3+ UA4+ UA5+ UA6= 0 (9)
UB1+ UB2+ UB3+ UB4+ UB5+ UB6= 0 (10)
[0058]
Holds. For the group A in which the backward operation is performed in the 6th section, this equation holds for the same period. For the group B, the backward operation is performed in the 3rd section, so in the formula (10), the 4th to 6th sections are the values of the immediately preceding cycle, and the 1st to 3rd sections are the values in that cycle. Obviously, the zero sum rules (9) and (10) hold only for the driving unit speeds of the A group and the B group, and the zero sum rule does not hold for the table speed.
[0059]
UT1+ UT2+ UT3+ UT4+ UT5+ UT6= UB1+ UA2+ UA3+ UA4+ UB5+ UB6
= UA1+ UA2+ UA3+ UA4+ UA5+ UB6
= UB1+ UB2+ UA3+ UB4+ UB5+ UB6
≠ 0 (11)
[0060]
Same thing, but with a simpler notation. Table speed in k ward is UTkBut the table surplus speed W as the sum of the five speeds that precede itTkIs defined.
[0061]
UT1+ UT2+ UT3+ UT4+ UT5= -WT6 (12)
UT6+ UT1+ UT2+ UT3+ UT4= -WT5 (13)
UT5+ UT6+ UT1+ UT2+ UT3= -WT4 (14)
UT4+ UT5+ UT6+ UT1+ UT2= -WT3 (15)
UT3+ UT4+ UT5+ UT6+ UT1= -WT2 (16)
UT2+ UT3+ UT4+ UT5+ UT6= -WT1 (17)
[0062]
Although it is a simple definition, since it is the five preceding speeds, in the right side of the equations (12) to (17), 6, 5, 4, etc. before 1 are the values of the previous cycle. is there. From causality, their values are known and their definitions are clear. Subscripts 1 to 6 are repeated cyclically.
[0063]
The surplus speed is the A group feed element speed UA, B group feed element speed UBCan be defined similarly. Again, let's write it explicitly just in case.
[0064]
UA1+ UA2+ UA3+ UA4+ UA5= -WA6 (18)
UA6+ UA1+ UA2+ UA3+ UA4= -WA5 (19)
UA5+ UA6+ UA1+ UA2+ UA3= -WA4 (20)
UA4+ UA5+ UA6+ UA1+ UA2= -WA3 (21)
UA3+ UA4+ UA5+ UA6+ UA1= -WA2 (22)
UA2+ UA3+ UA4+ UA5+ UA6= -WA1 (23)
[0065]
UB1+ UB2+ UB3+ UB4+ UB5= -WB6 (24)
UB6+ UB1+ UB2+ UB3+ UB4= -WB5 (25)
UB5+ UB6+ UB1+ UB2+ UB3= -WB4 (26)
UB4+ UB5+ UB6+ UB1+ UB2= -WB3 (27)
UB3+ UB4+ UB5+ UB6+ UB1= -WB2 (28)
UB2+ UB3+ UB4+ UB5+ UB6= -WB1 (29)
[0066]
Table extra speed WTUsing this concept, the feed element speeds of the A group and the B group can be easily defined. In the 6th section where the reverse operation is performed, the A group feed
[0067]
More generally speaking, it is not an indispensable condition that the return operation zones are the 6th and 3rd districts. Since it is sufficient that the ward of the backward movement is separated by three wards, the ward may be two wards, five wards, one ward and four wards. It is arbitrary depending on how the period is cut. Therefore, group A will be described as 6 wards, and group B will be described as 3 wards. However, in the present invention, the reverse sections may be associated with the 2, 5, 1, and 4 sections. Here, the total number is 6 wards, but walking drive can be driven even if the total number of sections is 7 wards and 8 wards. Also, it may be three legs instead of two legs. In the case of three legs, the phase is shifted by 120 °.
[0068]
Using the concept of surplus speed, formulas (3) to (8) are repeated.
[0069]
1st district UA1= UB1= UT1 (30)
District 2 UA2= UB2= UT2 (31)
District 3 UA3= UT3 , UB3= WT3 (32)
4th UA4= UB4= UT4 (33)
5th UA5= UB5= UT5 (34)
6th district UA6= WT6 , UB6= UT6 (35)
[0070]
That's what it means. This gives the speed of the feeding elements of the A group and the B group.
[0071]
[Table 2]
[0072]
All of the above are definitions relating to the velocity U in the x direction. In two dimensions, a new velocity V in the y direction appears. Even if it becomes two-dimensional, only V increases and the above definitions and relationships are exactly the same. If the movement in one dimension is known, the case in two dimensions can be understood. Two-dimensional walking drives are seemingly complicated and difficult to understand, so they are focusing on one-dimensional explanations.
[0073]
Since the path is determined in the one-dimensional case, it is only necessary to know the velocity of the movement of the feeding element, but what actually happens to the displacement X? The problem remains. This is not so important in the case of one dimension, but it becomes apparent in the case of two dimensions, so this will be clarified in a one-dimensional problem with one displacement (only X). Just by increasing the displacement to X and Y, the same is true in two dimensions. It is the same thing, but it becomes difficult as soon as it becomes two, so it is prepared in one dimension.
[0074]
When discussing table motion in terms of velocity, it is the same for any point on the table. However, this is not the case when discussing displacement X. When there is no rotation, the motion of the table can be uniquely expressed by a fixed point on an arbitrary table. If there is a rotation, it will be explained later. Since it may be an arbitrary fixed point, it may be a center of gravity or a corner point, or another point.
[0075]
The coordinate of the fixed point with the table is the table coordinate XTAnd The initial value (t = 0) is set to XT0Then, the displacement of the table in one cycle is the feed element speed U of the A group in the 2nd to 4th zones.AAnd the sum of the product of τ and the feed element speed U of the 5th, 6th, 1st group BBIs the sum of the product of τ and τ. Table displacement X at the beginning of the 1st section of m cycle (time point (1))T m 0Is
[0076]
[Equation 3]
[0077]
Given by. Table displacement X at the end of k period of m cycleT m kIs XT m 0Based on
[0078]
XT m 1= XT m 0+ UB m 1τ (37)
XT m 2= XT m 0+ UB m 1τ + UA m 2τ (38)
XT m 3= XT m 0+ UB m 1τ + UA m 2τ + UA m 3τ (39)
XT m 4= XT m 0+ UB m 1τ + UA m 2τ + UA m 3τ + UA m 4τ (40)
XT m 5= XT m 0+ UB m 1τ + UA m 2τ + UA m 3τ + UA m 4τ + UB m 5τ (41)
XT m 6= XT m 0+ UB m 1τ + UA m 2τ + UA m 3τ + UA m 4τ + UB m 5τ + UB m 6
= XT m + 1 0 (42)
[0079]
It becomes. Actually, the initial value XT0And final value XT m kΤ is given as a device parameter from the beginning and the velocity UA, UBSince there is a preferable value, the number of repetition periods (m-1) and the interval k in m periods are calculated. That is, m and k are undetermined parameters. The table displacement is like this, and the same applies to the case of two dimensions. The meaning is clear.
[0080]
However, there is one serious problem with a feeding element that repeats reset (return) many times. The fact that the speed in the backward operation (Group A,
[0081]
UA6τ = WA6τ (43)
UB3τ = WB3τ (44)
[0082]
It is. This is always true, but where are you going? In this respect, it is not decided uniquely. Of course, the origin O of the feeding element can be matched to the beginning of one section, but it can be matched to the beginning of the other sections as well.
[0083]
Since it is a cyclic section and the first to sixth sections are equivalent, the feed element origin can be made to coincide with the beginning of any k section. There are six options in that regard. When the beginning of the first ward coincides with the origin, the end of the sixth ward is the origin. When the origin of the k section is the origin, the end of the (k-1) section is the origin. Since this is the same for the A group and the B group, the A group will be described.
[0084]
(Ah)
The first point of the first ward is set as the origin (returning to the origin in the backward movement)
End of District 1 XA1= UA1τ (45)
End of District 2 XA2= UA1τ + UA2τ (46)
End of District 3 XA3= UA1τ + UA2τ + UA3τ (47)
End of District 4 XA4= UA1τ + UA2τ + UA3τ + UA4τ (48)
End of District 5 XA5= UA1τ + UA2τ + UA3τ + UA4τ + UA5τ (49)
End of District 6 XA6= 0 (50)
[0085]
(Yes)
The origin of the 2nd ward is the origin (-U in reverse operation)A1(Return to τ)
End of District 1 XA1= 0 (51)
End of District 2 XA2= UA2τ (52)
End of District 3 XA3= UA2τ + UA3τ (53)
End of District 4 XA4= UA2τ + UA3τ + UA4τ (54)
End of District 5 XA5= UA2τ + UA3τ + UA4τ + UA5τ (55)
End of District 6 XA6= -UA1τ (56)
[0086]
(U)
The beginning of the 3rd ward is the origin (-U in reverse operation)A1τ-UA2(Return to τ)
End of District 1 XA1= -UA2τ (57)
End of District 2 XA2= 0 (58)
End of District 3 XA3= UA3τ (59)
End of District 4 XA4= UA3τ + UA4τ (60)
End of District 5 XA5= UA3τ + UA4τ + UA5τ (61)
End of District 6 XA6= -UA1τ-UA2τ (62)
[0087]
(e)
The origin of the 4th ward is the origin (-UA1τ-UA2τ-UA3(Return to τ)
End of District 1 XA1= -UA2τ-UA3τ (63)
End of District 2 XA2= -UA3τ (64)
End of District 3 XA3= 0 (65)
End of District 4 XA4= UA4τ (66)
End of District 5 XA5= UA4τ + UA5τ (67)
End of District 6 XA6= -UA1τ-UA2τ-UA3τ (68)
[0088]
(O)
The origin is at the beginning of the 5th ward (-UA1τ-UA2τ-UA3τ-UA4(Return to τ)
End of District 1 XA1= -UA2τ-UA3τ-UA4τ (69)
End of District 2 XA2= -UA3τ-UA4τ (70)
End of District 3 XA3= -UA4τ (71)
End of District 4 XA4= 0 (72)
End of District 5 XA5= UA5τ (73)
End of District 6 XA6= -UA1τ-UA2τ-UA3τ-UA4τ (74)
[0089]
(Or)
Start from 6th wardA1τ-UA2τ-UA3τ-UA4τ-UA5(Return to τ)
End of District 1 XA1= -UA2τ-UA3τ-UA4τ-UA5τ (75)
End of District 2 XA2= -UA3τ-UA4τ-UA5τ (76)
End of District 3 XA3= -UA4τ-UA5τ (77)
End of District 4 XA4= -UA5τ (78)
End of District 5 XA5= 0 (79)
End of District 6 XA6= -UA1τ-UA2τ-UA3τ-UA4τ-UA5τ (80)
[0090]
In any of the six cases, in District 6 (return), UA6τ = WA6Only τ has returned. These six cases describe only the A group. For group B, the backward movement is in the 3rd ward, so the form of the expression is slightly different. The point is that there are six cases.
[0091]
The case (a) of returning to the origin by a backward movement is most easily understood, but since the path of movement is known in advance, any of (i) to (ka) can be taken. From the standpoint of effectively using the stroke of the piezoelectric element, (a) and (ka) are disadvantageous choices. In order to effectively use the limited stroke of the piezoelectric element, it is preferable that the origin comes at the beginning of the third and fourth sections. But these are difficult to explain. For the next two-dimensional case, (a) and (ii) are described.
[0092]
Since this is a one-dimensional motion, the trajectory is known in advance and is simple. The group A and the group B can be synchronized and moved according to the time interval τ. The simple thing was explained in more detail in order to clarify that there is a movement to match the speed of the drive and the table, such as the head and back, and to clearly define the terminology. Walking drive becomes much harder to understand because the direction of movement changes in 2D. However, it is an extension of the one-dimensional case, and if one-dimensional motion is known, two-dimensional motion can be understood.
[0093]
[Example of 2.2 direction drive; When dividing by 5 concentric circles]
A case of two-dimensional driving capable of driving in both the x direction and the y direction will be described. Dividing one cycle into 6 sections and moving the feed element and the support element as in Tables 1 and 2 are the same as in the one-dimensional case.
[0094]
Also in the case of two dimensions, time is given a common break, and 6τ = T. As it is, time and space must always correspond. In order to facilitate understanding, the case where the linear velocity is the same in any direction will be described as an example. Since there are six sections, five are carrying and one is returning, it can be considered that five or less concentric circles are drawn and the table representative point moves on it. It has already been explained that there are six cases depending on where to go in the case of a return. Since this example employs the case (a), five concentric circles are required.
[0095]
FIG. 4A shows an example of table movement by a curve in the xy coordinates. This is the movement of a fixed point (representative point) with a table. In the absence of rotation, a single table motion can represent a wide table motion.
[0096]
A taken on the curve1, B1, A2, B2, A3, B3, A4, B4... indicates the position of the origin in the period 1, the
[0097]
Five concentric circles are drawn from the origin of each group A feeding element. The five concentric circles correspond to the 1st, 2nd, 3rd, 4th, and 5th districts, respectively. The instants at which the feed element at the origin at 0 cuts a concentric circle is τ, 2τ, 3τ, 4τ, 5τ. The concentric circle radius is obtained by integrating the speed with time. In the case of a constant speed, τ, 2τ, 3τ, 4τ, and 5τ are multiplied by the speed.
[0098]
Here, the case where the linear velocities are almost equal is assumed for easy understanding. Here, an approximately equal speed is assumed to be q. Up to now, the velocity in the x direction is U and the velocity in the y direction is V. The linear velocity q is a vector sum in both the x and y directions. That is
[0099]
q2= U2+ V2 (81)
[0100]
It is. The linear velocity q may change at any moment during the carrying operation of the A group and the B group. FIG. 4B shows five concentric circles extracted from only one drive unit origin. Five concentric circles from the one closer to the origin g1, G2, G3, G4, G5And Concentric circles separated by the stroke of the drive unit, but when q is constant, the radii are qτ, 2qτ, 3qτ, 4qτ, 5qτ (if q changes within a period, ∫qdt is changed from 0 to τ, 2τ, 3τ Integrated to 4τ, 5τ.)
[0101]
Origin O (c0The contact block C that was in the1C above1In point 2 g2C above2In point 3 g3C above3In point 4 g4C above4In point 5 g5C above5Proceed to the point. That is, the concentric circles are means for precisely matching the phase (time) and space. In the one-dimensional case, the six sections correspond to the space, but the same applies to the two-dimensional case. Since the two drive units of the A group and the B group carry the table alternately, the phase of the two drive units must always be kept at a half cycle difference.
[0102]
Since the common thing is time (the phase is different by 180 degrees), different driving units cannot be synchronized unless the phase (time) and the space are exactly matched. Five segmented concentric circles are required to synchronize via phase (time).
[0103]
1st district is g12nd is g1~ G2In addition,
[0104]
The element for supporting the group A is in the 1st section, in the 2nd section to the 4th section, touched (indicated by x in FIG. 4 (b)), in the 5th section, in the back and in the 6th section. Group B supporting elements are in the 4th section, in the 5th section, in the 6th section, in the first section, in the first section, in the second section, in the back and in the third section. This is the same as the one-dimensional case. The relationship between the speeds of the tables in the A group and the B group is the same as that in the one-dimensional case. However, there are two speed components, so the conditions increase a little.
[0105]
[Table 3]
[0106]
As shown by the curve in FIG. 4A, the table is alternately carried by the A group and the B group. Since the change is three sections, a point advanced by three concentric circles from a certain reference becomes a reference point of another group. As such, every three divisions A1, B1, A2, B2, ... are lined up. If the trajectory in the xy coordinates of the table is calculated and determined in advance, A1, B1, A2, B2I can take the point of ...
[0107]
A for explanation2The point taken at (nτ) for each section is defined as Ilohani Hoheto Chirinuruwa. A2Is the third and the second D is B2It is. The third G is A3It is. Nu is B3It is. A25 concentric circles centered on (g1, G2, G3, G4, G5) And the intersection of the table curves are B, C, D, E.
[0108]
For the group A drive unit, the ilo hits the first section and is in the forward direction. The speed of the feed element is equal to the table speed but not in contact. In Iro, the B group carries the table. In Loja, it becomes the second ward and becomes a touch. Group A contacts the table and transports it. In Loja, group B turns back and leaves the table, but the speed is the same as the table. Hani is in the 3rd district, and the transport state continues. Group B is separated and returns to the origin. Niho is in the 4th district, and transportation by Group A continues. Group B starts to move from the origin at the same speed as the table, but it is a directional motion and is not in contact with the table. Hohe is in the 5th ward, and Group A is back and maintains the same speed as the table, but leaves the table and Group B supports and conveys the table on behalf of it.
[0109]
In this way, the A group and the B group support and carry the table in a section that is separated from the origin by 1 section and 4 sections. Group A carries the table in three sections of Rohanijo, Chillinul,..., Group B carries the table in three sections of Hohetochi, Luo, etc.
[0110]
Alternating A1, B1, A2, B2, A3, B3... etc. are 3 sections each with a straight distance, so g of concentric circles3Passes through the origin of the other drive. Smaller concentric circle g1, G2Is the concentric circle g2, G1And circumscribe. g3Larger concentric circle g4, G5Is the concentric circle g1, G2Inscribed in.
[0111]
You don't have to worry about the continuity of the table support. The subtle thing is as follows. This means that the intersection of the table movement trajectory and the adjacent concentric circles A and B and the contact point between the adjacent concentric circles are slightly different.
[0112]
The end of the 1st ward in FIG.2First concentric circle g1And the intersection of the table curves. From point B, the contact block of group A contacts the table. However, B group is B2Concentric circle centered on2The contact is maintained up to the intersection point 'of the table curve. Between the short rolls, both group A and group B support the table. A2Center g1Yen and B2Center g2Since the circle is circumscribed, there is always a line segment connecting the intersections B and B 'with the curve. When the curve matches the axis, B and B 'are the same as the contact points, and the support of the A group and the B group does not overlap. In any case, there is no blank moment that neither the group A nor the group B supports the table.
[0113]
The end of the 4th section in FIG.2No. 4 concentric circle g4And the intersection of the table curves. The point is B2First concentric circle g1And the intersection of the table curves. From point E, the contact block of group B contacts the table. However, Group A maintains contact up to E '. Between the short hoho's, both groups B and A support the table. A2Center g4Yen and B2Center g1Since the circle is inscribed, there is always a line segment connecting the intersections e and h 'with the curve. When the curve coincides with the axis, E and H 'are the same as the contact points, and the support of the A group and the B group does not overlap. Even at the time of (5), there is no blank moment that neither the group A nor the group B supports the table.
[0114]
In this way, when the linear velocity is made to correspond to the section, there is an advantage that the linear velocity is always constant (constant linear velocity method). If the speed is constant, no acceleration occurs in the longitudinal direction (path direction), so no slip occurs. When the curvature of the table curve is significant, the double holding time (Rolo 'or Hoho') as described above occurs, but this is not a problem at all. Although acceleration (centrifugal force) is generated in the direction orthogonal to the traveling direction, this is slight. Thus, the method of dividing into 6 sections on the basis of distance has the advantages of equilinear velocity, low acceleration, and equivalence of time and distance.
[0115]
[Example of two-way drive; when divided by four concentric circles]
Even in the case where one cycle is divided into six sections and the feed element and the support element are moved by two-dimensional driving that can be driven in both the x direction and the y direction, the sections are not necessarily allocated to the five concentric circles. In the above-mentioned case, since the case (a) of returning to the origin in the backward operation was assumed, there was a grudge that there were five concentric circles and the stroke of the piezoelectric element was not used effectively. From the above cases (i) to (ka), there can be six modes in the two-dimensional operation according to the types of the six reverse operations.
[0116]
Here, the (i) mode in which the return to the origin is the end of the first section will be described. Similarly, (u) to (ka) can be described by drawing double concentric circles, triple concentric circles, quadruple concentric circles, and five concentric circles, but they are complicated and will be omitted.
Again, the linear velocity is the same in any direction. Since there are six sections, five carry, and one is reverse, it is necessary to draw four concentric circles.
[0117]
FIG. 5A shows an example of table movement by a curve in the xy coordinates. This is the movement of a fixed point (representative point) with a table. A taken on the curve1, B1, A2, B2, A3, B3, A4, B4... indicates the position of the origin in the period 1, the
[0118]
Actually, the feeding elements do not lie on the table motion curve, and there are a plurality of (m ≧ 3) feeding elements of group A and B, but typical A group and B group feeding elements. Is assumed to have been translated into a table movement curve.
[0119]
Four concentric circles are drawn from the origin of each group A feeding element. The four concentric circles correspond to 1 ward + 2 wards, 3 wards, 4 wards and 5 wards, respectively. The radius is τ, 2τ, 3τ, 4τ multiplied by speed q. If the speed q is constant within one period, the radius increases in an arithmetic sequence, but if the speed q changes, the radius does not become an arithmetic sequence. However, time constraints are equally distributed as above.
[0120]
FIG. 5B shows a concentric circle by taking out only one drive unit origin. Four concentric circles from the one closer to the origin g1, G2, G3, G4And When q is constant, the radius is qτ, 2qτ, 3qτ, 4qτ (when q changes, ∫qdt is integrated from 0 to τ, 2τ, 3τ, 4τ).
[0121]
Yen g1Includes 1 and 2 wards. g2Is the third ward, g3Is 4 districts, g4Includes 5 wards. In the 6th section, the operation returns to -qτ. C5The contact block C in the1C above5At
[0122]
This concentric circle is also a means for making time and space correspond exactly. In the one-dimensional case, the six sections correspond to the space, but the same applies to the two-dimensional case. In the 6th section, it returns to -qτ and moves to the origin in the direction, so the A group supports the table from the origin to the third section. Since the B group was supporting up to the origin, it is changed from B to A here. There is no overlap in delivery here. Set the return position behind the origin c5Therefore, there is no disadvantage that only half of the stroke of the piezoelectric element is used.
[0123]
Speaking on the basis of the feeding element (g) of the A group of 3 periods, the 1st ward is the heel, the 2nd ward is the torch, the 3rd ward is Chile, the 4th ward is Linu, and the 5th ward is null. The movements of the supporting elements and the feeding elements in the A group and the B group are the same as in the one-dimensional case or the two-dimensional case described above, except that the division method is different.
[0124]
[Table 4]
[0125]
[Example of driving in two directions; When dividing by five concentric rectangles]
A case of using a concentric rectangle without using a concentric circle in a two-dimensional drive will be described. Dividing one cycle into 6 sections and moving the feed element and support element as shown in Table 1, Table 2, Table 3, and Table 4 are the cases where concentric circles are used in one and two dimensions. It is the same. The correspondence of time and space is to use concentric rectangles instead of concentric circles.
[0126]
Using the concentric circles, the above example of matching time (phase) and space has the advantage of being faithful to the principle and easy to understand. To treat distance and time equally, the vector sum of velocity (displacement / phase) must always be calculated. This is difficult because it takes too much time to calculate the square root of the sum of squares.
[0127]
Since the feeding elements are made by using independent piezoelectric elements of X and Y, and the stroke of the piezoelectric element is determined, it is conceivable to divide the sections based on the stroke of the piezoelectric element in the X and Y directions. The idea is that the two directions are handled independently and a section is assigned every time a certain distance is advanced in the x direction or the y direction (independent speed method). This is a natural method considering the movement of the piezoelectric element, but on the other hand, it is difficult to cope with the time division and makes it difficult to understand the two-dimensional walking drive.
[0128]
FIG. 6A is a diagram of a table movement curve in the xy coordinates and the group A and group B feeding elements taken thereon. As described in the previous two examples, the origins of the feeding elements of the A group and the B group that transport the table are set on the curve as A.2, B2, A3, B3, A4I drew as ...
[0129]
Concentric rectangles (squares) are used for time and space correspondence. FIG. 6B shows a five-fold concentric rectangle d centered on the origin of one feeding element.1, D2, D3, D4, D5Have taken. The length of the side increases by a certain width such as 2, 4, 6, 8, and 10. Actually, it is not necessary to be equally spaced in this way, and when the speed is changed within one period, the rate of increase of the rectangle also changes. The same is true for concentric circles and concentric rectangles.
[0130]
Here, in order to simplify the drawing, the sides of the concentric rectangles form an arithmetic sequence. Even if this is not the case, the adjacent rectangles will touch the black line as well, and there is no problem.
[0131]
Rectangular row d1, D2, D3, D4, D5Is the largest rectangle d.5Is only within the stroke of the piezoelectric element. Since the concentric circle is g, the rectangle is d, but the meaning is the same. Both A group and B group can draw a concentric rectangle centered on the origin.
[0132]
For group A d11 is inside, d1~ D2Is 2nd ward, d2~ D3Is the 3rd ward, d3~
[0133]
For
[0134]
Group A feed elements start from the origin at the beginning of the period and τ (τ1D)1To 2τ (τ2D)23τ (τ3D)34τ (τ4D)4And 5τ (τ5D)5To. 6τ (τ0) To return to the origin. Group B feed elements start from the origin at 3τ from the beginning of the cycle and d at 4τ.1Up to 5τ (τ5D)2, T + 0τ (τ0D)3T + τ (τ1D)4T + 2τ (τ2D)5To. 3τ (τ3) To return to the origin. The movement of group A and the movement of group B are in conflict with each other, but the relationship to the concentric rectangle is the same. This is the same as the one-dimensional or concentric two-dimensional case described above.
[0135]
[Table 5]
[0136]
FIG. 6B shows the movement of the feeding element in a five-fold rectangle. Origin c0Starting from c1(E), c2(F), c3(G), c4(H), c5As shown in (i), it intersects the sides of the rectangle. Speaking of the supporting element S, Niho is facing, Hohetuchi is touch, Chile is spine, and Rini is separated. Speaking of the feeding element, Nihohetori is carried, and Rini is the return.
[0137]
In FIG. 6A, the origins of the A group and the B group are sequentially taken every three rectangles along the movement curve of the table. B1Draw a five-fold concentric rectangle around the third rectangle and the intersection of the curves A2And A2Write a five-fold concentric rectangle around, and mark the intersection of the third rectangle and the table curve as B2And Similarly, on the curve, A3, B3, A4I'll take ...
[0138]
The origin of the group A feed element is A2The group A feeding element moves two-dimensionally with Irohanijo. The robot moves in the opposite direction and contacts the table at Rohanijo and transports it. Hohe is back and at the same speed as the table, but leaves the table. Return from f to the origin. Next, the group B feed element is B2From the starting point, it moves with Nihohechichiri. Niho is directional. Carry the table with a touch. In Chile, it moves backwards and has the same speed as the table but leaves the table. A2From the perspective, Iro is 1 ward,
[0139]
The concentric circle method (FIGS. 4 and 5), which is easy to understand in principle, has an advantage that the tangential acceleration of the curve can be made zero by setting the linear velocity. But these are q2= U2+ V2It was necessary to always repeat the calculation. This example using a concentric rectangle for space-time correspondence does not require such calculation.
[0140]
Even if the spread of the first section is determined to be equal, the transport distance of the A group and the B group is long and the interval is wide, as can be seen by comparing FIG. 6 with FIGS. This is because the travel distance in the first ward is always longer than in the case of concentric circles.
[0141]
As can be seen from FIG.0A part of the curve comes out of and crosses the rectangle d5The intersection is c1, C2, C3, C4, C5And Here c1, C2Is the intersection with the vertical line, c3, C4, C5Is the intersection with the horizontal line. c2And c3The distance is quite long.
[0142]
Consider the problem of seams. Group A supports the table with Rohanijo, Chilinur ..., and Group B supports the table with Hohechi, Ruwo. The point E is a seam, but there is no failure of the seam because the change of initiative between the group A and the group B occurs along the vertical line passing through the point ho. The H point is also a seam, but there is no hole in the seam because the initiative of the B group and the A group is changed at the horizontal line that cuts the H. There is no moment of double support because of the combination of rectangles, but there is no moment of no support.
[0143]
However, the time / space correspondence by the rectangle has a disadvantage that the linear velocity is indefinite. For example, the speed in the x direction is high at Ho and low at Hete. The speed in the y direction is small toward ho and large at hete. In Hetchi, both the speed in the y direction and the speed in the x direction rapidly decrease. Even if the curve is smooth, there is a limit that the time from the rectangle to the next rectangle is uniformly τ. In addition, the speed fluctuation occurs in the tangential direction, so that slip is likely to occur. Caution must be taken.
[0144]
[5. Example of walking drive device including rotation]
What has been described so far has been that the table does not rotate, only in one dimension and in two dimensions. In such a case, the motion of the table is completely represented by only the x and y coordinates of one representative point. According to such simplicity, the drive unit was also simple. Although there were three or more drive parts of A group and B group, those movements were all the same. Since it was the same, it was enough to discuss one.
[0145]
However, the walking drive of the present invention can perform not only translation but also motion including rotation. Even in such a case, the two types of drive units of the A group and the B group are combined, but the n drive units belonging to the A group have different mounting directions and motions. The n drive parts of group A move synchronously and have the same timing, but the movement direction and movement distance are different. The distribution of speed for synchronization is also complicated. The same applies to the group B.
[0146]
An example of an XYθ table that is compact and that can be rotationally driven and translated even in a vertical plane will be described. The main structure is shown in FIG. This walking drive device has a base 1 and six drive units D arranged on the base 1 at intervals of 60 degrees.1, D2, D3, D4, D5, D6, A plate-like magnetic body table 2 provided on the six drive units, and a
[0147]
In FIG. 7, the table 2 is drawn transparent so that the inside of the apparatus can be seen (which may be transparent or opaque in practice).
Each drive part D1~ D6As shown in the enlarged view, there are a total of 3 elements: a supporting element S for supporting the table via the contact block C and two feeding elements F and H for driving the contact block C in two directions parallel to the surface. Two piezoelectric elements are incorporated.
[0148]
The six drive units are divided into two types, group A and group B. Group A is D1, D3, D5It is three. Group B is D2, D4, D6It is three. The driving units of the A group and the B group alternately support and feed the table while maintaining a phase difference of 180 degrees.
[0149]
The basics of the driving algorithm are as described above, but within the A group (D1, D3, D5However, the mounting direction of the drive unit is different by 120 degrees. Within group B (D2, D4, D6However, the mounting direction of the drive unit is different by 120 degrees.
[0150]
In the previous section, only the driving in the X and Y directions has been described, but here the feeding elements in each driving unit are incorporated in the circumferential direction H and the radial direction F, not in the X and Y directions. Coordinate conversion is performed to determine the displacement of each element from the displacement in the X and Y directions.
[0151]
Assume that the contact block centers of the six drive units are at a distance a from the origin O of the base. Drive unit D1~ D6The coordinates of base 1 of D are DjIt can be expressed by (acos (jπ / 3 + φ), asin (jπ / 3 + φ)). j is an integer of 1 to 6, and φ is a phase constant that can be freely given.
[0152]
DjFeed element FjIs displaced in the radial direction. FjThe direction of motion of (cos (jπ / 3 + φ), sin (jπ / 3 + φ)).
[0153]
HjSince is oriented in the circumferential direction, the direction of motion is (−sin (jπ / 3 + φ), cos (jπ / 3 + φ)).
[0154]
F of the jth drive unitjDirection displacement fj, HjDirectional displacement is hjThen, the displacement δ in the x directionx, Y-direction displacement δyIs
[0155]
δx= Fjcos (jπ / 3 + φ) −hjsin (jπ / 3 + φ) (82)
δy= Fjsin (jπ / 3 + φ) + hjcos (jπ / 3 + φ) (83)
[0156]
It becomes. If the table moves in parallel, this formula will determine which drive DjThis holds true at the same time. Since necessary displacements in the x and y directions are given, the displacement of the feed element that realizes the displacement can be easily calculated. that is
[0157]
fj= Δxcos (jπ / 3 + φ) + δysin (jπ / 3 + φ) (84)
hj= -Δxsin (jπ / 3 + φ) + δycos (jπ / 3 + φ) (85)
[0158]
It is. By such coordinate transformation, D1~ D6The required displacement of the feed element is required. Although the equations (82) to (85) are obtained as relational expressions between displacements, they can be considered as speed relational expressions as they are by differentiating them with time. If the required speed in the x direction is U and the speed in the y direction is V, the drive F for that purposejDirection, HjSpeed of forward and backward movement in direction ξj, ΗjIs easy,
[0159]
ξj= Ucos (jπ / 3 + φ) + Vsin (jπ / 3 + φ) (86)
ηj= −Usin (jπ / 3 + φ) + Vcos (jπ / 3 + φ) (87)
[0160]
Can be calculated by
In the previous section, only driving in the X and Y directions has been described. However, in the present apparatus, driving in the θ direction can be performed simultaneously. The rotation direction (θ direction) can be easily calculated when rotating around the origin O of the base.jCan be determined. If the rotation angle around the origin O of the table is Θ, the drive unit DjThe required displacement of
[0161]
hj= AΘ (88)
fj= 0 (89)
[0162]
It is. In order to give such a simple relationship to the rotation, a plurality of driving units are installed around the same circle (radius a) at the same angular interval so that the feeding element H is in the tangential direction. is there. In the case of rotating by an angle Θ about a point K (x, y) other than the origin O, the calculation is an overlap of these. If the rotation angle Θ is small,
[0163]
fj= YΘcos (jπ / 3 + φ) −xΘsin (jπ / 3 + φ) (90)
hj= −yΘsin (jπ / 3 + φ) −xΘcos (jπ / 3 + φ) + aΘ (91)
[0164]
Such a displacement is approximately. When Θ is large, the velocity components ξ and η of the feeding element can be determined with Ω as a value obtained by time differentiation of Θ.
[0165]
ξj= YΩcos (jπ / 3 + φ) −xΩsin (jπ / 3 + φ) (92)
ηj= −yΩsin (jπ / 3 + φ) −xΩcos (jπ / 3 + φ) + aΩ (93)
[0166]
Since this is an accurate equation, the feeding element may be driven repeatedly at that speed. Driving the feed element does not mean that it is driven at the same speed because it is a walking drive. Velocity ξ in this equationjOr ηjThis is because the table speed U in the j-th drive unitT, VTHowever, it is not the speed of the feed element itself. A group feed element is U in 1st to 5th districtsT, VTHowever, in the 6th district, the sum of these 5 categories is minus (-ΣUT, -ΣVT)be equivalent to. B group feed element is U in 1st, 2nd, 4th to 6th districtsT, VTHowever, in
[0167]
For simple rotation around the origin, ξj= 0, ηjThis results in a one-dimensional problem since = aΩ. It is only necessary to determine an appropriate time τ and set the period T to 6 times that time.
[0168]
In the case of rotation around the point K other than the origin, the table speed determined by the equations (92) and (93) is handled, and the speed of the feeding element is different even in the A group. Even if the speed is different, τ is constant, and the time division of 1st to 6th districts is common to the A group and the B group. Any of the five concentric rectangles, the five concentric circles, the four concentric circles, etc. may be used, but the fifth or fourth largest rectangle or the largest circle has the most Must be less than or equal to the required stroke.
[0169]
Naturally, the same group A (D1, D3, D5) However, the speed in the x direction and the speed in the y direction differ depending on the position. When 5 to 3 concentric rectangles and concentric circles are used, the respective rectangles and circles are distorted and become rectangles or ellipses. But that's okay. The timing of the supporting elements is common in the A group (1st ward: facing, 2-4th ward: touch, 5th ward: back, 6th ward: separated), and the same for the B group (1st ward: touch, 2nd ward: back, 3 (Division: Separation, 4 Division: Orientation, 5-6 Division: Touch), the rectangular distortion is automatically given.
[0170]
Rather, in the case of such a radial drive arrangement, a simple translation is difficult. A value obtained by dividing the table parallel movement speed by q and the maximum stroke divided by 6q is determined as τ, and the timings of the first to sixth sections are determined. Once τ is determined, the movement of the supporting element (tactile separation) and the movement of the feeding element (carrying back) are naturally determined.
[0171]
In this example, since the table is attracted to the contact block by the permanent magnet, the table can be moved in the vertical plane without falling. Temporary fixing means other than permanent magnets can be used as long as the mechanism can permit both translation and rotation and can hold the table.
[0172]
So far we have mentioned some examples of walking drives. When the speed of the table is known in advance, the movements of the A group and the B group can be determined, and the table can be moved alternately to translate the table. Alternatively, it can be rotated around a fixed point.
[0173]
However, there are cases where only the start and end points are known, and the distribution of intermediate speeds is free. In that case, the computer of the walking drive apparatus can freely determine the path of the table and give a change in the speed of the table.
[0174]
[Problems to be solved by the invention]
In the walking drive type feed table, one table can be directly driven in multiple axes by alternately driving the driving units of the A group and the B group. The problem here is the measurement of the position of the table. How much the table actually moved, and where is the table now? Which direction are you facing? That is the problem. Since it is a measurement of the position of an object, it can be considered that an optical, electrical, or magnetic sensor is used. However, there is currently no good sensor that can measure multi-axis motion over a long stroke.
[0175]
The table is carried by the A group in the 2nd to 4th zones in the 1st cycle, and the B group in the 5th to 6th zones and the 1st zone, so in the 1st cycle, the x direction and the y direction respectively.
[0176]
UB1τ + UA2τ + UA3τ + UA4τ + UB5τ + UB6τ (94)
VB1τ + VA2τ + VA3τ + VA4τ + VB5τ + VB6τ (95)
[0177]
Only the table is displaced. By adding this for the cycle number m, the movement displacement from the start point to the end point can be understood.
[0178]
Σm(UB m 1τ + UA m 2τ + UA m 3τ + UA m 4τ + UB m 5τ + UB m 6τ) (96)
Σm(VB m 1τ + VA m 2τ + VA m 3τ + VA m 4τ + VB m 5τ + VB m 6τ) (97)
[0179]
Should be able to calculate the amount of table movement. When there is no rotation, the displacement of movement is obtained. Since all the speeds from the beginning to the present are stored in the computer, this calculation can be done immediately.
[0180]
However, the stroke of the piezoelectric vibrator is not constant, and the cooperative operation of a plurality of drive units may be out of order. There is also a slip between the contact block and the table. Therefore, the exact table position cannot be determined.
[0181]
If the final table position cannot be measured accurately, is the table actually sent to the desired position? I don't know. That would be a problem when used as a transport mechanism.
[0182]
It is an object of the present invention to provide a method that can accurately measure the position of a table in a walking drive.
[0183]
[Means for Solving the Problems]
When we move in the plane, if the stepping stones are regularly spread on the ground, we should be able to know the distance and direction of movement from the number and direction of the stepping stones that have been stepped on. If the stepping stones are numbered, the position is determined only by the last stepping stone. Even if there is no stepping stone number, if it is a stepping stone that is embedded regularly, the amount of displacement in that direction can be calculated by counting and storing the number. In the case of the one-dimensional case, it is clear, but in the case of the two-dimensional case, the direction in which the stepping stones are lined up and the direction of movement will be slightly complicated.
[0184]
The present invention proposes a method for measuring the position of the table by a similar method. That is, a regular stepping stone shape with a pitch equal to or less than the stroke of the driving element of the driving unit is processed on the lower surface of the table to which the contact block of the driving unit comes into contact (magnetic information or different materials may be embedded), and either or both The table is driven in such a way that all or a part of the drive units come in contact with the stepping stone, and the number of the stepping stones touched is counted to accurately measure the amount of movement of the table. There are several options.
[0185]
[A. Number of drive units to measure]
The walking drive holds the table alternately between the driving units of the A group and the B group (among the 6 sections, the 2nd to the 5th groups are the A group and the 5th to the 2nd groups are the B group), and transports the table. . Stepping stones are formed on the entire back of the table, but how many drive parts must be moved to match the stepping stones? That is the first problem. Since there are n drive units in the A group and n drive units in the B group, there are 2n drive units as a whole.
[0186]
If all the 2n drive units move while matching the stepping stone, all the n members of the A group move while matching the stepping stone, but if the n members of the B group move independently of the stepping stone, If only one representative of the group and one representative drive of the B group match the stepping stone and (2n-2) drive units move independently of the stepping stone, one representative of the A group 1 There may be a case where only one piece matches the stepping stone and (2n-1) pieces of driving units move independently of the stepping stone. Only four cases are described, although there are other possibilities.
[0187]
(1) When all 2n drive units are transporting while matching the stepping stones
All the 2n driving units convey the table while matching the stepping stones. The carrying operation of the feeding element is similar in 2n drive units (the same is true in the case of parallel movement).
[0188]
However, the reverse operation is different for all drive units. In the backward operation, the contact blocks of all the drive units fly on the rear stepping stone. Since the relative position of the drive unit with respect to the stepping stone in the backward operation is random, the deviation at the start of contact between the origin of the drive unit and the contact block is random for all n drive units. Seen from the coordinates fixed on the table, all the driving parts seem to move in sync with random directions, like a bare foot, and practice the stepping stones scattered around. In other words, equations (43) and (44) do not hold
[0189]
UAj6τ ≠ WA6τ (98)
UBj3τ ≠ WB3τ (99)
VAj6τ ≠ QA6τ (100)
VBj3τ ≠ QB3τ (101)
[0190]
It becomes. QA6, QB3Is the surplus velocity in the y direction in the 6th section of the A group and the 3rd section of the B group. The definition is the same as the x direction surplus velocity. In the case of parallel movement, the extra speed W on the right sideA6, WB3(= WT6, WT3), QA6, QB3(= WQ6, WQ3) Is common to the drive units of n A groups and B groups, but the return speed on the left side differs depending on the j-th drive unit, and generally no equal sign is established. Such a situation is common to all drive units that follow the stepping stone.
[0191]
What will happen then? That is, the coordinates of the stepping stone selected as the landing point in the k period in the table fixed coordinates are xk, YkThe coordinates of the stepping stone selected in the next k + 1 period arek + 1, Yk + 1And A distance for the backward operation is obtained by subtracting the distances in the x and y directions that the table advances during the backward movement from the difference.
[0192]
UAj6τ = xk + 1-Xk-UT6τ (102)
UBj3τ = xk + 1-Xk-UT3τ (103)
VAj6τ = yk + 1-Yk-VT6τ (104)
VBj3τ = yk + 1-Yk-VT3τ (105)
[0193]
(2) A case where all n members of group A move while matching the stepping stones, but n members of group B move independently of the stepping stones.
If the stepping stones are modeled flush with the back of the table, some drive units can practice the ground part or the boundary part between the ground and the stepping stone. If the stepping stone and the drive unit are matched for distance measurement, it is not necessary to match both the A group and the B group. Only one of the groups needs to match the stepping stone. Group A is stepping on the stepping stone and group B is practicing the boundary between the ground, the ground and the stepping stone.
[0194]
(3) When only one representative of the A group and one representative driving unit of the B group match the stepping stone, and the driving unit (2n-2) moves independently of the stepping stone.
Since all the A groups synchronize the supporting elements, the number of stepping stones practiced by all (n) drive units is always the same even if all n steps on the stepping stones. Are the same. Since all n pieces have the same count, it is only necessary to count one stepping stone. The same applies to Group B. That is the position.
[0195]
(4) When only two representatives of group A match stepping stones and (2n-2) drive units move independently of stepping stones
Since all the A groups synchronize the supporting elements, the number of stepping stones practiced by all (n) drive units is always the same even if all n steps on the stepping stones. Are the same. Since all n have the same count, it is only necessary to count the stepping stones with only two. The same applies to Group B. Therefore, it is only necessary to count the number of stepping stones with only two of the drive units in group A. That's it.
[0196]
[B. What about counting accuracy? ]
In both cases of parallel movement and rotation, the number of stepping stones counted by the n drive units in the previous section (1) A group and n group B is the same. In the case of (2), the number of stepping stones is the same for n pieces in Group A. So no matter how many drive units count the number of stepping stones. Since the number of stepping stones is equal to the number of cycles after all, it is common to all drive units. However, when rotation is involved, the distance that each drive unit sends the table is different, so the number of stepping stones that jump is different even if the number of stepping stones that each driving unit steps on is the same. In the cases of (1) to (4), there is little superiority or inferiority in terms of accuracy. However, there is an averaging effect.
[0197]
[C. Difficulty of simultaneous stone setting]
In the case of (1) or (2) in which all the n drive units in the A group and all the n drive units in the B group step on the stepping stones, they return to the rear stepping stones in the backward operation. This is different from the origin of the drive. Therefore, the contact block is already out of the origin of the drive unit by the backward movement. Since the relative positions of n drive units and stepping stones vary, for all n drive units, which is the rear stepping stone to go to the next, and how much return operation must be performed to practice it. Must be calculated.
[0198]
This is difficult. In addition, since the relative positions of the n drive units and the stepping stones vary, there is a discrepancy in the distance that can be moved until the stroke limit is reached. Assuming that the drive unit is synchronized in each of the groups A and B, the table speed U is adjusted to the minimum.T, VTNeed to be determined. This will cause the feed speed to decrease.
[0199]
DETAILED DESCRIPTION OF THE INVENTION
[A. Stepping stone arrangement]
According to the present invention, stepping stones as position measurement references are regularly arranged at regular intervals on the back surface of the table, and one or a plurality of driving units follow a path that matches the stepping stones. Stepping stones are limited to regular polygon repetitions with interior angles that are divisors of 360 degrees because they must be regular repeating patterns. That is, the pattern is a regular triangle, square, or regular hexagon. Repetition of regular hexagonal honeycomb structure, regular triangle (rhombic lattice), square (simple lattice), etc. are allowed.
[0200]
FIG. 8A shows an example of an orthorhombic stepping stone. The shape of the
[0201]
FIG. 8B shows the correspondence between the stepping stone and the contact block C of the drive unit. The contact block C moves so as to coincide with the stepping
[0202]
[I. Sensor type]
A sensor provided on the contact block detects the stepping stone formed on the back of the table, and the contact block must be matched with one of the stepping stones. For this purpose, the sensor must accurately recognize the stepping stone. As a method for the drive unit to recognize the stepping stone, a method of embedding a sensor using magnetism, capacitance, light, etc. in the contact block of the drive unit, or embedding an electromagnet or a permanent magnet in the contact surface of the contact block of the drive unit, A method of increasing the magnetic permeability of the stepping stone and driving it while adsorbing to the stepping stone every cycle is also conceivable.
[0203]
As the stepping stone / contact block matching mechanism, for example, a high-frequency voltage is applied between the table and the contact block, and the approach / separation between the stepping stone and the contact block can be detected by a change in the capacitance C (capacitance method). Alternatively, only the stepping stone is formed of a ferromagnetic material, a search coil is wound around the contact block, and the position of the stepping stone can be obtained by changing the search coil current (magnetic method). Alternatively, the reflectance of only the stepping stone can be increased, and the location of the stepping stone can be obtained by detecting the reflected light by a combination of a light emitting element (LED, LD) and a light receiving element (PD) provided in the contact block (optical). Law). These require sensors, signal amplifiers and feedback mechanisms.
[0204]
Some are simpler, and that is the last one. Only stepping stones are made of ferromagnets, or both the table and stepping stones are made of ferromagnets, the stepping stones are convex, the stepping stones are N poles (or S poles), and the other parts are S poles (or N poles). If the electromagnet is embedded in the contact block and the support element is oriented, the current starts to flow through the electromagnet, the maximum current is reached when touching, and the electromagnet current is reduced at the back. Will be selectively attracted to the stepping stone, so that the touch block and stepping stone will always match in touch. More simply, the contact block can be attracted to the stepping stone using an electromagnet as a permanent magnet, and a force can be applied to release the contact block. Such a stepping stone / contact block mating mechanism is simple without a feedback system. In that case, things like the
[0205]
[U. Stroke expansion mechanism]
Since it is possible to advance the contact block of the drive unit in a stepping stone, there is a condition that the stepping pitch p is smaller than the stroke Q of the feeding element. Otherwise, the contact block C cannot jump to the next stepping stone.
[0206]
However, the condition p <Q is actually a difficult condition. Although the stroke Q of the feeding element has not been described so far, if a piezoelectric element is used for the feeding element, the stroke is only about several μm. It is about 10 μm at the longest.
[0207]
If only the table is carried, the repetition frequency f should be increased. If the stroke of the feeding element is Q, the table moves by 3Q / 5 in a half cycle, so the second speed is 6Qf / 5. It is possible to increase the moving speed of the table by increasing f.
[0208]
However, if the contact block advances like a step as in the present invention, a condition of p <Q is newly imposed. If Q is 10 μm, for example, and two stepping stones are included in it, the diameter of the stepping stone will be about 3 μm at most. Stepping stone area is 7μm2It can only be. The contact blocks and stepping stones must match exactly. This means that the contact block area is 7μm2It turns out that. Thus, it is difficult to install an electrical sensor, a magnetic sensor, and an optical sensor on the surface of the narrow contact block C.
[0209]
In addition, sufficient adsorption force will not be obtained in the electromagnetic adsorption field. In other words, the area of the stepping stone must be quite large. If the stepping stone area is large, the pitch p must be large. A few μm is not enough.
[0210]
That is, if a conventional feeding element such as a piezoelectric element having a short stroke is used, the condition of p <Q cannot be satisfied. Breakthrough is required for the feeding element itself.
[0211]
The extension of the stroke of the feed element itself is not the object of the present invention. However, since a long-stroke feed element is required, two examples are described here.
[0212]
[Elastic spring / electromagnet drive section (Fig. 11)]
FIG. 11A is a transverse plan view of the elastic spring / electromagnet drive unit, and FIG. 11B is a longitudinal side view. Four
[0213]
An
[0214]
A y-
[0215]
This uses elastic struts and leaf springs, and the stroke is determined by the rigidity thereof. Depending on the dimensions, it is easy to give a stroke of about 1 mm.
[0216]
[Piezoelectric element stroke expansion mechanism (FIGS. 12 and 13)]
Of the three movements, the stroke only needs to be enlarged in the horizontal direction (x direction, y direction). This is also possible with a drive unit using three piezoelectric elements. If the feeding element is not attached directly to the contact block, but near the base of the bar member supporting the contact block, an enlarged displacement occurs in the contact block. FIG. 12 is a plan view of a drive unit provided with such an expansion stroke mechanism, and FIG. 13 is a front view.
[0217]
On the fixed
[0218]
[0219]
When a voltage is applied to the
[0220]
Two
[0221]
This uses the elastic deformation of the connecting
[0222]
【Example】
[1. An explanation of fixing the table at a certain moment when a drive unit of group A follows a stepping stone]
As described above, when the contact block C of the driving unit D of the group A and the group B walks over the stepping
[0223]
FIG. 9 shows a flow until the operation of each support portion is determined. Here, consider a case where the target value of the trajectory to which the table should move is known in advance.
The initial position and posture (angle) of the table must be known.
[0224]
First, from the initial position and orientation of the table, and the target value of the movement trajectory, as shown in the flowchart, the movement of the convex part (stepping stone) passing through the movable range of each drive part (6 (n = 3) in the example of FIG. 7) Calculate the trajectory.
And each drive part DjDetermine the stepping stones and movements that you support.
[0225]
What is important in the above-described flow is selection of the final convex portion and determination of the operation. An example of the operation of the drive unit after this determination is shown in FIG. This figure is extremely difficult to understand, so careful consideration is required. FIG. 10 shows the instantaneous distribution of the stepping stones on the back surface of the table, and shows two cycles of the driving unit D having the A group by two curves. The curve is the movement trajectory of the two stepping stone shells, the second. The numbers (1), (2), (3), (4), (5), and (6) on the left curve that is the trajectory of the former are the
[0226]
The numbers (6), (1) ', (2)', (3) ', (4)', (5) ', and (6)' on the right curve indicating the trajectory of the stepping stone are The position of the first contact block D in the
[0227]
Here, the support surface (contact block C) of the driving unit D is in a state where the support is released at the position of the stepping stone shell at time {circle around (1)}. In FIG. 10, the upper is depicted at the lower left, but at time {circle around (1)}, both the upper and the contact block exist at the position {circle around (1)}. If this is not understood, this figure cannot be understood.
[0228]
From this moment (1) to time (2), a feeding operation is performed (1st district; direction; UA1= UT1, VA1= VT1) However, in (2), the support by the contact block of the stepping stone is completed. After that, the feeding operation is carried out while being supported from time (2) to time (5) (2nd, 3rd, 4th; touch; UA2= UT2, VA2= VT2, UA3= UT3, VA3= VT3, UA4= UT4, VA4= VT4). In FIG. 10, the stepping stone shell and the second are drawn in the middle (4 wards) between times (4) and (5). This makes it difficult to understand FIG.
[0229]
From time (5) to time (6), the support is released while performing the feeding operation (5th ward; back; UA5= UT5, VA5= VT5). From time {circle over (6)} to time {circle around (1)}, the contact block moves backward (recovers the stroke) and moves onto the next stepping stone in the back of the vicinity (6th district; return; UA6τ = WT6τ + Δx, VA6τ = QT6τ + Δy). At time (1), the contact block is at position (1), and the stepping stones are in contact therewith, but since Figure 10 shows the distribution of stepping stones in the four districts, (1) It is not in the position of “1” in “. The stepping stone itself shows the distribution of moments in the four districts while showing the movement trajectory of the stepping stone with a curve, so this is complicated.
[0230]
After {circle around (1)} ', the drive unit D similarly drives the table using the stepping stone. Support operation is performed from (1) 'to time (2)' (1st; direction; UA1= UT1, VA1= VT1). The drive unit D completes the support by the contact block of the stepping stone in (2) '. Thereafter, from time {circle around (2)} to {circle around (5)}, the drive unit D performs a feeding operation with the stepping stones in contact and support (second zone, third zone, fourth zone; touch; UA2= UT2, VA2= VT2, UA3= UT3, VA3= VT3, UA4= UT4, VA4= VT4). From time (5) 'to (6)', the support of Stepping Stone B is released while performing the feeding operation (5th ward; back; UA5= UT5, VA5= VT5). From {circle over (6)} to {circle around (1)}, the contact block moves backward (recovers the stroke) and moves onto the next stepping stone urn (not shown) on the rear back (6th section; return; UA6τ = WT6τ + Δx, VA6τ = QT6τ + Δy).
[0231]
Regarding the selection of the next stepping stones, for example, at time {circle around (6)} (time {circle around (1)} is better but the calculation load is larger), the remaining movement among the stepping stones within the movable range of the support portion (contact block) Choose the longest track.
[0232]
Moreover, the drive part D should operate | move alternately by making two into a group (A group and B group), and the other supported while the other recovered | restored a stroke.
[0233]
In order to realize this cooperation, for example, between the times (1) to (4), the drive unit D shown in FIG.AShall have the initiative. Here, having the initiative means that the driving unit D of the cooperative partner is synchronized with the operation of the driving unit.BIt is to decide the operation. First, at time 1), DAThe movement trajectory remaining in the movable range is divided into five equal parts such as (1) to (6). Partner D with which this one section cooperatesBIf it is longer than 1 section, only the 1st ward (▲ 1 ▼-▲ 2 ▼) and 2nd ward (▲ 2 ▼-▲ 3 ▼) are shortened according to the opponent's section, and the remaining trajectory is divided into three equal parts. Then redistribute to 3-5 wards. And in District 1 (▲ 1 ▼ ~ ▲ 2 ▼)APerforms the support operation while performing the feed operation, and the counterpart drive unit DBPerforms the feeding operation in a supported state. In District 2 (▲ 2 ▼ to ▲ 3 ▼), DAPerforms the feeding operation in a supported state, and the other drive unit DBRelease support. In District 3 (▲ 3 ▼ to (4 ▼)), DAPerforms the feeding operation in the state of being supported, and the other drive unit DBRecover the stroke and move it to the next stepping stone.
[0234]
At time {circle around (4)}, the
[0235]
By alternately transferring such initiative, the driving unit D of the A group and the B group without simultaneously releasing the support.A, DBCan be operated in coordination.
[0236]
Although the positioning control method in the open loop including the rotation is described here, the xy two-way driving not including the rotation can be similarly performed.
[0237]
[2. Explanation of how the drive unit with the group A follows the stepping stones next to the coordinates fixed on the table]
The same manner in which one drive unit of group A as described above follows the stepping stones of Party A and Party B will be described with coordinates fixed on the table. FIG. 14 shows the movement of the driving unit with the group A at the coordinates fixed to the stepping stone on the back surface of the table by broken lines.
[0238]
The trajectory is exactly the same as that in FIG. 10, but FIG. 10 depicts a group of stepping stones in the four wards of (4) to (5), and (1) to (6) and (1) 'to (6) The movement of the contact block of the drive unit at ▼ 'is indicated by a circled number. It's hard to understand because space-time is mixed. FIG. 14 expresses the movement of the base of the drive unit on the table coordinates with circled numbers. The same circled numbers as in FIG. 10 represent the same time, but FIG. 10 represents the position of the contact block, and FIG. 14 represents the base of the drive unit.
[0239]
In the first period, the contact block C is placed on the stepping stone of the former. At the moment of (1), the base is in the position of (1) and the contact block is directly under the instep. “1” to “2” are “directions”. At the moment of (2), the base is at (2) and the contact block is on the upper and touches the upper. From (3), the base is in (3) and the contact block C is on the back. The contact block pushes the table from (3) to (5). At the time of (4), the base is at (4) and the contact block is on the former. At the time of (5), the base is at (5) and the contact block is on the former. Here, the contact block starts to leave the table but proceeds to {circle around (6)} at the same speed.
[0240]
From {circle around (6)} to the next second period {circle around (1)} ', the contact block C jumps from directly under the stepping stone shell to immediately under the stepping stone edge. The contact block C moves at a high speed (thin solid line), but the base itself proceeds on the broken line at substantially the same speed and becomes (6) → (1) '. The period (1) 'to (2)' in the second period is the "direction" period, and the contact block moves away from the table but moves at the same speed. Touch with (2) 'and the contact block contacts the stepping stones on the table. From (2) 'to (5)', it becomes a touch and the base moves in the position of this number. The contact block is in the second party, and the contact block conveys the table in a supported state. In {circle around (1)} to {circle around (6)}, the contact block is on the stepping stones and the base of the drive unit is above the numbers {circle around (1)} to {circle around (6)}. What is indicated by the alternate long and short dash line is a line segment (foot) connecting the base of the drive unit and the contact block. Such a situation is the same in the first period. Although there is a line segment between ▲ 1 to -6 and the stepping stone instep, the trajectory of the base happens to pass through the instep, so the foot overlaps the trajectory and is not clear.
[0241]
In this way, one drive unit of the A group moves the table along a specific curve by moving the contact block in one step in one of the stepping stones. FIG. 14 depicts one curve that the base of the driving unit traces in the stepping stone distribution of the table, so that it is easier to understand. In FIG. 14, the curve indicating the base is missing from the lower left to the upper right, but actually the base of the drive unit is stationary, so the table itself proceeds from the upper right to the lower left in FIG. 14. . This means that the stepping stones held by the contact block move forward every cycle. The movement is exactly the same as in FIG. 10, but FIG. 14 is easier to understand because the spacetime is constant.
[0242]
【The invention's effect】
In the walking drive, one table can be freely moved and rotated in a plane, but there is no good sensor for measuring this at present. However, if the walking drive is actually used for conveying an object, accurate control of the object position becomes essential. On the other hand, in the walking drive, the feed amount in one cycle of the drive unit (like the stride in walking of animals) is almost constant. Positioning control should be possible. In the present invention, a large number of periodic stepping stones are provided for controlling the position of the table, and the driving unit of the A group or the driving units of both groups always carry the table while matching the stepping stones. This makes it possible to always control the absolute position of the table. The present invention can satisfy the demand for accurate positioning of the table for the first time. It has a remarkable effect on the practical application of walking drive.
[0243]
In addition, the combination of the drive units is a combination of two groups, and in addition to sharing a half-cycle drive (A group = 2 ward to 4 ward, B group = 5 ward to 1 ward), 3 or more groups are combined, and 1/3 It is also possible to share the driving below the period. If it does so, it will become complicated, but for example 3 groups of drive parts DA, DB, DCFor example, the distribution of the operation of the supporting element S and the feeding elements X and Y for each section is as follows.
[0244]
[Table 6]
[Brief description of the drawings]
FIG. 1 is a perspective view of a drive unit D including a contact block C, feeding elements X and Y, and a supporting element S used for transporting a table by the walking drive driving system of the present invention.
FIG. 2 shows the first timing points {circle around (1)}, {circle around (2)}, {circle around (3)} of the first to sixth sections of the one-dimensional walking drive transport system in which the table is supported and transported by the A group driving unit and the B group driving unit. A group, B group drive part D in (4), (5), (6)A, DBFeed element XA, XBAnd supporting element SA, SBThe side view for showing the operation | movement with respect to the table.
FIG. 3 shows a group A drive unit D in one cycle of a walking drive transport system in which a table is supported and transported by a group A drive unit and a group B drive unit.ASupport element SAAnd feed element XA, B group drive unit DBSupport element SBAnd feed element XBThe graph which shows the time change of the expansion degree with. The horizontal axis represents time and represents one cycle. One cycle is divided into six sections. ▲ 1 to ▲ 2 ▼ is 1 ward, ▲ 2 ▼ to ▲ 3 ▼ is 2 wards, ▲ 3 ▼ to ▲ 4 ▼ are 3 wards, ▲ 4 to ▲ 5 ▼ are 4 wards, ▲ 5 ▼ to ▲ 6 ▼ is 5 wards, and (6) to (1) 'are 6 wards. In the 6th section, the supporting element undergoes a four-phase change of “tactile separation” and the feeding element undergoes a two-phase change of “carry back”.
FIG. 4 shows a mode walking in which a periodically changing feeding element changes so that the linear velocity becomes almost constant in the carrying operation, and the feeding element returns to the origin of the drive unit by a backward operation. In the drive, the table movement path, the position of the origin of the A group feeding element and the B group feeding element taken for the partial path, and the envelope of the possible displacement points in the 1st to 6th sections of each
FIG. 5 shows that the periodically changing feed element changes so that the linear velocity becomes substantially constant during the carrying operation, and the return element returns to the position one before the origin of the drive unit by the reverse operation. In the walking drive in the mode in which the origin is passed at the end of the first section, the table moving path, the position of the origin of the A group feeding element and the B group feeding element taken for the partial path, and the first section for each period Four concentric circles centered on the origin, which is an envelope of possible displacement points in 6 zones1, G2, G3, G4(A) showing the path and four concentric circles g around the origin of one feed element1, G2, G3, G4FIG. 6B is a diagram (b) showing the allocation of the feel-back separation of the supporting elements in the first to fifth sections separated by concentric circles.
FIG. 6 shows that the feed element that changes periodically has a finite change in the x-direction velocity U and the y-direction velocity V independently during the carrying operation, and the return element returns to the origin of the drive unit by the reverse operation. In the walking drive of the selected mode, the table moving path, the position of the origin of the A group feeding element and the B group feeding element taken for the partial path, and the possible displacement in the first to sixth sections for each
FIG. 7 is a perspective view of an XYθ displaceable vertical in-plane driving walking drive device. An enlarged view of one of six equivalent drive units is shown in part.
FIG. 8 is a back view (a) showing an example of a stepping stone regularly and periodically formed on the back surface of the table for measuring the position of the table, and a cross-sectional view (b) showing the correspondence between the sensors.
FIG. 9 is a flowchart showing a flow of operation determination of each drive unit.
FIG. 10 illustrates a method in which the driving units of the A group and the B group determine a moving path for transporting the table while contacting any one of the stepping stones provided on the back surface of the table. Bottom view for.
FIGS. 11A and 11B are a cross-sectional plan view and a longitudinal sectional view of an electromagnetic actuator for obtaining a long stroke feeding element, respectively.
FIG. 12 is a plan view of a piezoelectric element type drive unit with an enlargement mechanism for obtaining a long stroke feed element.
FIG. 13 is a front view of a piezoelectric element type drive unit with an enlargement mechanism for obtaining a long stroke feed element.
FIG. 14 is a view for explaining the movement of the contact block of the driving unit and the base at the coordinates fixed to the table. In the first period, the contact block is on the stepping stone shell, and in the second period, the contact block is on stepping stone B. The base of the drive unit moves continuously, but the contact block flies from the former to the second from {circle around (6)} in the first cycle to {circle around (1)} in the second cycle.
[Explanation of symbols]
1 foundation
2 tables
3 Permanent magnet
4 Stepping stones
5 Center sensor
6 Peripheral sensor
10 fixed base
11 First support piece
12 Second support piece
13 pivot piece
14 Joint rod
15 Relay block
16 Supporting element
17 Contact block
18 nuts
19 Nut
20 tail pillar
21 Bracket
22 Long bolt
23 Long bolt
24 bolt head
25 bolt head
26 First piezoelectric element
27 First horizontal bar
28 nuts
29 nuts
30 tail pillar
31 Second piezoelectric element
32 long bolt
33 Bracket
34 Second horizontal bar
35 nuts
36 nuts
37 bolt head
40 fixed base
41 Elastic support
42 Element frame for feeding
43 cavity
44 leaf spring
45 Ferromagnetic core
46 Contact surface of the contact block
47 Electromagnet for vertical movement
48 x-direction drive electromagnet
49 Y-direction drive electromagnet
D1~ D6 Drive part
j Drive unit number
m Period number
n Number of drive units included in Group A and Group B
s Number of stepping stones
Q Stroke of feed element
p Stepping stone pitch
X x direction feed element
Y Y direction feed element
S Support element
C Contact block
XA X-coordinate of the x-direction feed element of the drive unit belonging to group A or its contact block
YA Y-coordinate of the y-direction feed element of the drive unit to which the group A belongs or its contact block
SA Supporting element for the drive part belonging to group A
CA Contact block of drive unit belonging to group A
XB X-coordinate of the x-direction feed element of the drive unit belonging to group B or its contact block
YB Y coordinate of the feed element in the y direction of the drive unit to which the group B belongs or the contact block thereof
SB Supporting element for the drive unit belonging to group B
CB Contact block of drive unit belonging to group B
g1~ G5 Concentric circles with contact blocks on them in the 1st to 5th zones in the cycle
d1~ D5 Concentric rectangle with contact block on it in 1st to 5th part in the cycle
Hj J-th feed element with direction of movement in the circumferential direction
Fj J-th feeding element having a moving direction in the radial direction
hj Necessary table circumferential displacement at j-th drive position
fj Necessary table radial displacement at j-th drive position
UA1~ UA6 X-direction speed of group A drive unit feed element for 1st to 6th wards
VA1~ VA6 Y-direction velocity of group A drive unit feed element for 1st to 6th wards
UB1~ UB6 X-direction velocity of B group drive unit feed element in 1st to 6th wards
VB1~ VB6 Y-direction velocity of B group drive unit feed element in 1st to 6th wards
UT1~ UT6 X-direction speed of tables in 1st to 6th districts
VT1~ VT6 Y-direction speed of 1st to 6th table
Claims (9)
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2001150604A JP4385142B2 (en) | 2001-05-21 | 2001-05-21 | Position control method in walking drive |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2001150604A JP4385142B2 (en) | 2001-05-21 | 2001-05-21 | Position control method in walking drive |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2002341941A JP2002341941A (en) | 2002-11-29 |
| JP4385142B2 true JP4385142B2 (en) | 2009-12-16 |
Family
ID=18995591
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2001150604A Expired - Fee Related JP4385142B2 (en) | 2001-05-21 | 2001-05-21 | Position control method in walking drive |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP4385142B2 (en) |
-
2001
- 2001-05-21 JP JP2001150604A patent/JP4385142B2/en not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| JP2002341941A (en) | 2002-11-29 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US11342828B2 (en) | Methods and systems for controllably moving multiple moveable stages in a displacement device | |
| CA2988803C (en) | Methods and systems for controllably moving one or more moveable stages in a displacement device | |
| US7932684B2 (en) | Absolute position sensing | |
| CN108155770B (en) | Control system and method of three-degree-of-freedom electromagnetic machine | |
| JP4385142B2 (en) | Position control method in walking drive | |
| CN102822631B (en) | Kinematic state encoder and target object with magnetic sensor | |
| Kim et al. | Magnetically-actuated micro-scale bristle-bots | |
| JP6438112B2 (en) | Interaction between two timer components | |
| TW202414966A (en) | Positioning device and drive unit | |
| Reznik et al. | Leaving on a plane jet | |
| Bohringer et al. | Algorithmic mems | |
| CN107842571B (en) | Blind guiding robot chassis and balance damping device thereof | |
| Levillain et al. | A bi-directional low-Reynolds-number swimmer with passive elastic arms | |
| Yue et al. | Untethered Swarm Robots with Independent Crawling and Rolling Motions | |
| JP2662697B2 (en) | Non-contact actuator | |
| JP2008141899A (en) | Drive control method for actuator and conveyance control method therewith | |
| TW202514882A (en) | Systems and methods for magnetically levitated object stages | |
| CN207526922U (en) | A kind of blind-guidance robot chassis and its balanced shock-absorbing device | |
| KR101525875B1 (en) | Guide system using magnetic levitation | |
| Kasisomayajula et al. | Magnetic field assisted heterogeneous device assembly | |
| JP2008141898A (en) | Actuator and conveyance device | |
| JPS63140650A (en) | Moving unit |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20080328 |
|
| RD03 | Notification of appointment of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7423 Effective date: 20080328 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A821 Effective date: 20080328 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20090806 |
|
| 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: 20090818 |
|
| 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: 20090904 |
|
| 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: 20121009 Year of fee payment: 3 |
|
| S533 | Written request for registration of change of name |
Free format text: JAPANESE INTERMEDIATE CODE: R313533 |
|
| R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20131009 Year of fee payment: 4 |
|
| S111 | Request for change of ownership or part of ownership |
Free format text: JAPANESE INTERMEDIATE CODE: R313113 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20131009 Year of fee payment: 4 |
|
| R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| LAPS | Cancellation because of no payment of annual fees |