JPH0756608B2 - 位置決め制御装置 - Google Patents
位置決め制御装置Info
- Publication number
- JPH0756608B2 JPH0756608B2 JP61063939A JP6393986A JPH0756608B2 JP H0756608 B2 JPH0756608 B2 JP H0756608B2 JP 61063939 A JP61063939 A JP 61063939A JP 6393986 A JP6393986 A JP 6393986A JP H0756608 B2 JPH0756608 B2 JP H0756608B2
- Authority
- JP
- Japan
- Prior art keywords
- movable body
- speed
- target position
- true
- current position
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Lifetime
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/19—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
- G05B19/21—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device
- G05B19/23—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device for point-to-point control
- G05B19/231—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device for point-to-point control the positional error is used to control continuously the servomotor according to its magnitude
- G05B19/232—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device for point-to-point control the positional error is used to control continuously the servomotor according to its magnitude with speed feedback only
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/416—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control of velocity, acceleration or deceleration
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/42—Servomotor, servo controller kind till VSS
- G05B2219/42104—Loop switch, speed loop then position loop, mode switch
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/43—Speed, acceleration, deceleration control ADC
- G05B2219/43115—Adaptive stopping
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position Or Direction (AREA)
- Exposure Of Semiconductors, Excluding Electron Or Ion Beam Exposure (AREA)
- Numerical Control (AREA)
- Exposure And Positioning Against Photoresist Photosensitive Materials (AREA)
Description
【発明の詳細な説明】 ［発明の属する分野］ 本発明は、ステップアンドリピート型露光装置やICボン
ダー等の半導体製造装置、産業用ロボットおよびNC工作
機械等における可動体の位置決め制御装置に関する。
ダー等の半導体製造装置、産業用ロボットおよびNC工作
機械等における可動体の位置決め制御装置に関する。
［従来の技術］ 従来、この種の位置決め制御装置は第５図のように構成
されており、可動体の位置決めは、第６図のような速度
曲線に従って行なわれていた。
されており、可動体の位置決めは、第６図のような速度
曲線に従って行なわれていた。
第６図において、横軸は時間、縦軸が速度で、ａ〜ｄま
でが速度制御区間であり、可動体が位置決め目標位置
（停止目標位置）近傍に達する点ｄで位置制御に切り換
えて最終的な位置決めを行なっている。同図において、
ａは加速開始点、ｂは最高速度に達して定速駆動に移行
する加速終了点、ｃは減速開始点、ｄは速度制御から位
置制御への制御モード切換点、ｅは位置決め完了点であ
る。
でが速度制御区間であり、可動体が位置決め目標位置
（停止目標位置）近傍に達する点ｄで位置制御に切り換
えて最終的な位置決めを行なっている。同図において、
ａは加速開始点、ｂは最高速度に達して定速駆動に移行
する加速終了点、ｃは減速開始点、ｄは速度制御から位
置制御への制御モード切換点、ｅは位置決め完了点であ
る。
第５図において、速度制御モード時、アナログスイッチ
６は、速度指令用D/A変換器２を選択し、速度関数発生
器１で第６図の区間ａ〜ｄのような速度曲線を作り、D/
A変換器２で速度指令電圧を得る。増幅器７、モータ８
および速度検出器９の閉ループは速度フィードバック制
御による速度制御を行ない、D/A変換器２からの速度指
令電圧に従った速度で可動体10を移動する。次に、制御
切換位置ｄにて、より高精度に位置決めする位置制御モ
ードに切り換わり、アナログスイッチ６は位置偏差出力
用D/A変換器５を選択する。位置偏差カウンタ４に始ま
るD/A変換器５は、増幅器７、モータ８、可動体10、位
置検出器11、現在位置カウンタ12の閉ループは、位置決
めフィードバック制御系を形成する。
６は、速度指令用D/A変換器２を選択し、速度関数発生
器１で第６図の区間ａ〜ｄのような速度曲線を作り、D/
A変換器２で速度指令電圧を得る。増幅器７、モータ８
および速度検出器９の閉ループは速度フィードバック制
御による速度制御を行ない、D/A変換器２からの速度指
令電圧に従った速度で可動体10を移動する。次に、制御
切換位置ｄにて、より高精度に位置決めする位置制御モ
ードに切り換わり、アナログスイッチ６は位置偏差出力
用D/A変換器５を選択する。位置偏差カウンタ４に始ま
るD/A変換器５は、増幅器７、モータ８、可動体10、位
置検出器11、現在位置カウンタ12の閉ループは、位置決
めフィードバック制御系を形成する。
ところが、このような構成では、位置制御モードに切り
変えた後、第２図に示したように目標位置近傍で可動体
10の速度の値（すなわち位置）が大きく振動し、目標位
置に収束整定して位置決めされるまでの時間が長いとい
う欠点があった。
変えた後、第２図に示したように目標位置近傍で可動体
10の速度の値（すなわち位置）が大きく振動し、目標位
置に収束整定して位置決めされるまでの時間が長いとい
う欠点があった。
［発明の目的］ 本発明の目的は、上述従来例の欠点に鑑み、位置決め制
御装置において、位置決め時間の短縮および位置決め精
度の向上を図ることにある。
御装置において、位置決め時間の短縮および位置決め精
度の向上を図ることにある。
［発明の概要］ 上記目的を達成するため本発明の位置決め制御装置は、
可動体を移動するための駆動手段と、前記可動体の仮の
停止目標位置を設定する第１設定手段と、前記可動体の
真の停止目標位置を設定する第２設定手段と、前記可動
体の現在位置と前記第１設定手段に設定されている仮の
停止目標位置との差が所定値となる第１時点まで前記駆
動手段を速度指令に基づいて制御する速度サーボ制御手
段と、前記第１時点後から前記可動体の現在位置と前記
第１設定手段に設定されている仮の停止目標位置との差
に基づいて前記駆動手段を制御すると共に、前記第１時
点後で前記可動体の移動速度が実質的に零に等しくなる
第２時点から前記可動体の現在位置と前記第２設定手段
に設定されている真の停止目標位置との差に基づいて前
記駆動手段を制御する位置サーボ制御手段を有すること
を特徴とする。
可動体を移動するための駆動手段と、前記可動体の仮の
停止目標位置を設定する第１設定手段と、前記可動体の
真の停止目標位置を設定する第２設定手段と、前記可動
体の現在位置と前記第１設定手段に設定されている仮の
停止目標位置との差が所定値となる第１時点まで前記駆
動手段を速度指令に基づいて制御する速度サーボ制御手
段と、前記第１時点後から前記可動体の現在位置と前記
第１設定手段に設定されている仮の停止目標位置との差
に基づいて前記駆動手段を制御すると共に、前記第１時
点後で前記可動体の移動速度が実質的に零に等しくなる
第２時点から前記可動体の現在位置と前記第２設定手段
に設定されている真の停止目標位置との差に基づいて前
記駆動手段を制御する位置サーボ制御手段を有すること
を特徴とする。
仮の停止目標位置は、前記可動体の前記第１時点での現
在位置と前記第２時点での現在位置の差と前記第２設定
手段に設定される真の停止目標位置から決定することが
できる。
在位置と前記第２時点での現在位置の差と前記第２設定
手段に設定される真の停止目標位置から決定することが
できる。
これによれば、可動体を速度サーボによって高速に移動
させることができると共に、速度サーボ後の位置サーボ
によって可動体を位置決めする際、位置制御されている
可動体の速度を（真の）停止目標位置近傍で実質的に零
にすることが可能である。このため、可動体が（真の）
停止目標位置を中心に大きく振動することが防止され、
速度制御後の位置制御によって可動体は（真の）停止目
標位置に高精度に且つ短時間に位置決めされる。
させることができると共に、速度サーボ後の位置サーボ
によって可動体を位置決めする際、位置制御されている
可動体の速度を（真の）停止目標位置近傍で実質的に零
にすることが可能である。このため、可動体が（真の）
停止目標位置を中心に大きく振動することが防止され、
速度制御後の位置制御によって可動体は（真の）停止目
標位置に高精度に且つ短時間に位置決めされる。
［実施例の説明］ 以下、図面を用いて本発明の実施例を説明する。なお、
従来例と共通または対応する部分については同一の符号
で表す。
従来例と共通または対応する部分については同一の符号
で表す。
第１図は、本発明の一実施例に係る位置決め制御装置の
制御回路の構成を示すブロック図である。同図におい
て、１（1a,1b）は速度関数発生器で、1aは第６図の区
間ａ〜ｃに相当する速度曲線を作るための立上げ速度関
数発生器、1bは第６図の区間ｃ〜ｄに相当する速度曲線
を作るための立下げ速度関数発生器である。２は速度指
令値を速度指令電圧に変換するD/A変換器、３は真の目
標位置設定器、４は可動体10の現在位置と目標位置との
差（現在位置偏差）を出力する位置偏差カウンタ、５は
位置偏差カウンタ４の出力値を電圧に変換するD/A変換
器、６は速度制御モードと位置制御モードとを切り換え
るアナログスイッチ、７はサーボアンプである増幅器、
８は可動体10を駆動するモータ、９はタコジェネレータ
等のモータ速度検出器、10はスライドテーブル等の可動
体、11はロータリィエンコーダ、リニアスケールまたは
レーザ測長器等の位置検出器、12は可動体10の現在位置
を記憶するための現在位置カウンタ、13は可動体10の実
際の速度を現在位置から求めるための速度変換器、14は
可動体10の位置決め目標位置を仮の目標位置から真の目
標位置へ切り換える基準となる速度（切換速度）を設定
する速度設定器、15は可動体10の実速度と上記切換速度
とを比較する比較器、16は仮の目標位置と真の目標位置
とを切り換えるスイッチ、17は仮の目標位置を決めるた
めの補正値カウンタ、18は仮の目標位置設定器、19はス
イッチを切り換えるときの位置偏差である切換位置を設
定する位置設定器、20はこの切換位置のデータと偏差カ
ウンタ４のデータ（現在位置偏差）とを比較する比較
器、21は速度制御から位置制御にモードを切り換えたと
きの現在位置をラッチするラッチカウンタ、22は可動体
の速度が位置制御モードに切り換えた後最初に切換速度
設定器14に設定されているデータ（例えば零）に等しく
なった位置をラッチするラッチカウンタ、23は速度関数
発生器１のモードを切り換えるスイッチ、24は速度立下
げ位置設定器、25は立下げ位置と偏差カウンタ４のデー
タとを比較する比較器である。
制御回路の構成を示すブロック図である。同図におい
て、１（1a,1b）は速度関数発生器で、1aは第６図の区
間ａ〜ｃに相当する速度曲線を作るための立上げ速度関
数発生器、1bは第６図の区間ｃ〜ｄに相当する速度曲線
を作るための立下げ速度関数発生器である。２は速度指
令値を速度指令電圧に変換するD/A変換器、３は真の目
標位置設定器、４は可動体10の現在位置と目標位置との
差（現在位置偏差）を出力する位置偏差カウンタ、５は
位置偏差カウンタ４の出力値を電圧に変換するD/A変換
器、６は速度制御モードと位置制御モードとを切り換え
るアナログスイッチ、７はサーボアンプである増幅器、
８は可動体10を駆動するモータ、９はタコジェネレータ
等のモータ速度検出器、10はスライドテーブル等の可動
体、11はロータリィエンコーダ、リニアスケールまたは
レーザ測長器等の位置検出器、12は可動体10の現在位置
を記憶するための現在位置カウンタ、13は可動体10の実
際の速度を現在位置から求めるための速度変換器、14は
可動体10の位置決め目標位置を仮の目標位置から真の目
標位置へ切り換える基準となる速度（切換速度）を設定
する速度設定器、15は可動体10の実速度と上記切換速度
とを比較する比較器、16は仮の目標位置と真の目標位置
とを切り換えるスイッチ、17は仮の目標位置を決めるた
めの補正値カウンタ、18は仮の目標位置設定器、19はス
イッチを切り換えるときの位置偏差である切換位置を設
定する位置設定器、20はこの切換位置のデータと偏差カ
ウンタ４のデータ（現在位置偏差）とを比較する比較
器、21は速度制御から位置制御にモードを切り換えたと
きの現在位置をラッチするラッチカウンタ、22は可動体
の速度が位置制御モードに切り換えた後最初に切換速度
設定器14に設定されているデータ（例えば零）に等しく
なった位置をラッチするラッチカウンタ、23は速度関数
発生器１のモードを切り換えるスイッチ、24は速度立下
げ位置設定器、25は立下げ位置と偏差カウンタ４のデー
タとを比較する比較器である。
なお、補正値カウンタ17および切換位置設定器19は、電
源投入後初めて位置決め動作をするとき、および最高速
度または速度関数等の条件を変えたときはクリアされ
る。真の目標位置設定器３、切換速度設定器14および切
換位置設定器19のそれぞれの値は、オペレータの入力操
作またはこの制御回路が適用される主装置からの指令に
より適宜設定または変更することができる。
源投入後初めて位置決め動作をするとき、および最高速
度または速度関数等の条件を変えたときはクリアされ
る。真の目標位置設定器３、切換速度設定器14および切
換位置設定器19のそれぞれの値は、オペレータの入力操
作またはこの制御回路が適用される主装置からの指令に
より適宜設定または変更することができる。
次に同図の制御回路の作用を説明する。同図の回路にお
いて、まず、オペレータの操作または上記主装置からの
指令により真の目標位置設定器３に真の目標位置が設定
され、かつ、補正値カウンタ17に零が設定される。これ
により、仮の目標位置設定器18には真の目標位置設定器
３と同じデータが記憶される。さらにスイッチ６はD/A
変換器２に、スイッチ16は仮の目標位置設定器18に、ス
イッチ23は立上げ速度関数発生器1aにそれぞれ切り換え
られ、立上げ速度関数発生器1aがトリガされることによ
り、速度制御が開始される。
いて、まず、オペレータの操作または上記主装置からの
指令により真の目標位置設定器３に真の目標位置が設定
され、かつ、補正値カウンタ17に零が設定される。これ
により、仮の目標位置設定器18には真の目標位置設定器
３と同じデータが記憶される。さらにスイッチ６はD/A
変換器２に、スイッチ16は仮の目標位置設定器18に、ス
イッチ23は立上げ速度関数発生器1aにそれぞれ切り換え
られ、立上げ速度関数発生器1aがトリガされることによ
り、速度制御が開始される。
速度制御モードにおいては、立上げ速度関数発生器1aに
よりモータ８を駆動する。モータ８によって可動体10が
移動するに従い、偏差カウンタ４のデータ値が減少して
ゆき、これが立下げ位置設定器24のデータ値と等しくな
った時、比較器25によりトリガ信号が出され、スイッチ
23が立下げ速度関数発生器1bの方に切り換わり、立下げ
速度曲線（第６図の区間ｃ〜ｄ）に沿った指令が立下げ
速度関数発生切1bにより出力される。以上の操作によ
り、可動体10は、第６図の区間ａ〜ｄの速度曲線に従っ
て移動する。実際には可動体10の速度は可動体10の慣性
の影響により、第２図のａ→ｂ→ｃ→ｄのように変化す
る。切換位置設定器19のデータ値と偏差カウンタ４のデ
ータ値とが等しくなる時刻tdにおいて、比較器20よりト
リガ信号が出力され、アナログスイッチ６がD/A変換器
５の方に切り換えられることにより速度制御モードから
位置制御モードに切り換わる。これと同時に、可動体10
の第２図の現在位置Xdがラッチカウンタ21に記憶され
る。
よりモータ８を駆動する。モータ８によって可動体10が
移動するに従い、偏差カウンタ４のデータ値が減少して
ゆき、これが立下げ位置設定器24のデータ値と等しくな
った時、比較器25によりトリガ信号が出され、スイッチ
23が立下げ速度関数発生器1bの方に切り換わり、立下げ
速度曲線（第６図の区間ｃ〜ｄ）に沿った指令が立下げ
速度関数発生切1bにより出力される。以上の操作によ
り、可動体10は、第６図の区間ａ〜ｄの速度曲線に従っ
て移動する。実際には可動体10の速度は可動体10の慣性
の影響により、第２図のａ→ｂ→ｃ→ｄのように変化す
る。切換位置設定器19のデータ値と偏差カウンタ４のデ
ータ値とが等しくなる時刻tdにおいて、比較器20よりト
リガ信号が出力され、アナログスイッチ６がD/A変換器
５の方に切り換えられることにより速度制御モードから
位置制御モードに切り換わる。これと同時に、可動体10
の第２図の現在位置Xdがラッチカウンタ21に記憶され
る。
位置制御モードに切り換わった後、可動体10は慣性を持
つために、第２図の真の目標位置Xgを通り過ぎてしま
う。Xgを通り過ぎてから速度変換器13によって可動体10
の速度をモニタするとともに、切換速度設定器14に設定
されているデータ（実際には零）と比較し、可動体10の
速度と切換速度設定器14のデータとが等しくなった時、
つまり、第２図の時刻tfに比較器15からトリガ信号が出
力される。このトリガ信号により、可動体10の現在位置
がラッチカウンタ22に記憶される。さらにラッチカウン
タ21のデータつまり時刻tdにおける位置Xdとラッチカウ
ンタ22のデータつまり時刻tfにおける位置Xfとの差ｌ
が、補正値カウンタ17に記憶される。また、この時、ス
イッチ16は真の目標位置３の方に切り換えられ、時刻te
において第１回目の位置決めが終了する。
つために、第２図の真の目標位置Xgを通り過ぎてしま
う。Xgを通り過ぎてから速度変換器13によって可動体10
の速度をモニタするとともに、切換速度設定器14に設定
されているデータ（実際には零）と比較し、可動体10の
速度と切換速度設定器14のデータとが等しくなった時、
つまり、第２図の時刻tfに比較器15からトリガ信号が出
力される。このトリガ信号により、可動体10の現在位置
がラッチカウンタ22に記憶される。さらにラッチカウン
タ21のデータつまり時刻tdにおける位置Xdとラッチカウ
ンタ22のデータつまり時刻tfにおける位置Xfとの差ｌ
が、補正値カウンタ17に記憶される。また、この時、ス
イッチ16は真の目標位置３の方に切り換えられ、時刻te
において第１回目の位置決めが終了する。
第２回目以降の位置決めは、以下のようになる。
初めに、真の目標位置設定器３に真の目標位置が設定さ
れるとともに、そのデータと補正値カウンタ17のデータ
（第１回目の補正値データ）ｌとの差が仮の目標位置設
定器18に設定される。つまり第２図のXg′（＝Xg−ｌ）
が仮の目標位置設定器18に設定される。
れるとともに、そのデータと補正値カウンタ17のデータ
（第１回目の補正値データ）ｌとの差が仮の目標位置設
定器18に設定される。つまり第２図のXg′（＝Xg−ｌ）
が仮の目標位置設定器18に設定される。
速度制御モード時の動作は第１回目のときと全く同じで
ある。ただし、仮の目標位置が第２図のXgからXg′に変
化していることにより、実際に可動体10の位置および速
度は第２図の２点鎖線のようになる。つまり、可動体10
の速度および制御モードの切換点はａ→ｂ→ｃ′→ｄ′
となる。
ある。ただし、仮の目標位置が第２図のXgからXg′に変
化していることにより、実際に可動体10の位置および速
度は第２図の２点鎖線のようになる。つまり、可動体10
の速度および制御モードの切換点はａ→ｂ→ｃ′→ｄ′
となる。
そして、時刻td′において速度制御モードから位置制御
モードに切り換わると、第１回目と同様にラッチカウン
タ21に時刻td′における位置が記憶される。可動体10は
慣性のために仮の目標位置Xg′を通り過ぎる。通り過ぎ
た後、速度変換器13によって可動体10の速度をモニタ
し、切換速度設定器14のデータと等しくなった時に、比
較器15からトリガ信号が発生する。このトリガ信号によ
り、第１回目と同様に、スイッチ16は真の目標位置設定
器３の方に切り換えられるとともに、可動体10の現在位
置がラッチカウンタ22に記憶され、補正値カウンタ17に
補正値（ラッチカウンタ22とラッチカウンタ21との差）
が記憶される。このとき、可動体10はほぼ真の目標位置
に位置しており、かつ、可動体10の速度は零のため、位
置決め完了までの時間が短縮される。
モードに切り換わると、第１回目と同様にラッチカウン
タ21に時刻td′における位置が記憶される。可動体10は
慣性のために仮の目標位置Xg′を通り過ぎる。通り過ぎ
た後、速度変換器13によって可動体10の速度をモニタ
し、切換速度設定器14のデータと等しくなった時に、比
較器15からトリガ信号が発生する。このトリガ信号によ
り、第１回目と同様に、スイッチ16は真の目標位置設定
器３の方に切り換えられるとともに、可動体10の現在位
置がラッチカウンタ22に記憶され、補正値カウンタ17に
補正値（ラッチカウンタ22とラッチカウンタ21との差）
が記憶される。このとき、可動体10はほぼ真の目標位置
に位置しており、かつ、可動体10の速度は零のため、位
置決め完了までの時間が短縮される。
以上の位置決め動作を繰り返すことにより、最終的に可
動体10はａ→ｂ→ｃ′→ｄ′→ｆ′で位置決め完了する
ことができるようになる。
動体10はａ→ｂ→ｃ′→ｄ′→ｆ′で位置決め完了する
ことができるようになる。
［他の実施例］ 第３図は計算器を使用した本発明の他の実施例を示す。
同図において、27はマイクロコンピュータまたはミニコ
ンピュータ等の中央演算装置（CPU）、28はROMやRAM等
のメモリ装置、29は計算器のバス、26は指令を出すため
のD/A変換器である。
同図において、27はマイクロコンピュータまたはミニコ
ンピュータ等の中央演算装置（CPU）、28はROMやRAM等
のメモリ装置、29は計算器のバス、26は指令を出すため
のD/A変換器である。
ここでは、第１図の0,1,3,4,13〜25で示されるブロック
の機能が、計算機のソフト処理に置き換えられている。
の機能が、計算機のソフト処理に置き換えられている。
次に、第４図のフローチャートを参照しながら第３図の
制御回路の作用を説明する。
制御回路の作用を説明する。
位置決め動作において、CPU27は、まず、ステップ１で
目標位置Xgの計算をする。目標位置は、現在位置と移動
距離との和で、最終的には可動体10を位置決めしたい位
置である。
目標位置Xgの計算をする。目標位置は、現在位置と移動
距離との和で、最終的には可動体10を位置決めしたい位
置である。
電源投入後の初期駆動または設定条件の変更時にはステ
ップ２からステップ３へ進み、補正値を零とし、立下げ
位置偏差を所定の値に設定する。
ップ２からステップ３へ進み、補正値を零とし、立下げ
位置偏差を所定の値に設定する。
次にCPU27は仮の目標位置を計算する（ステップ４）。
仮の目標位置は目標位置Xgと補正値との差である。
仮の目標位置は目標位置Xgと補正値との差である。
次に、加速時速度関数を、ある一定時間毎にD/A変換器2
6に出力することにより、可動体10を移動させ、最大速
度になるまで加速させる（ステップ５）。上記加速時速
度関数が最大速度指令値になったら、可動体10が減速開
始位置に達するのを待つ。減速開始位置に達したかどう
かは、可動体10の現在位置を現在位置カウンタ12の計数
値から読み取って仮の目標位置との差をCPU27で計算
し、その計算値と立下げ位置偏差とを比較することを繰
り返すことによって判定する（ステップ6,7）。
6に出力することにより、可動体10を移動させ、最大速
度になるまで加速させる（ステップ５）。上記加速時速
度関数が最大速度指令値になったら、可動体10が減速開
始位置に達するのを待つ。減速開始位置に達したかどう
かは、可動体10の現在位置を現在位置カウンタ12の計数
値から読み取って仮の目標位置との差をCPU27で計算
し、その計算値と立下げ位置偏差とを比較することを繰
り返すことによって判定する（ステップ6,7）。
上記比較の結果、計算値が立下げ位置偏差より小さい
か、または等しくなったら、減速開始位置に達したもの
と判断してステップ８へ移り、減速データをある一定時
間毎にD/A変換器26に出力する。全ての減速データを出
力し終えたなら、制御モードを位置制御モードに切り換
えると同時に現在位置カウンタ12の値Xdをメモリ28に記
憶する（ステップ9,10）。
か、または等しくなったら、減速開始位置に達したもの
と判断してステップ８へ移り、減速データをある一定時
間毎にD/A変換器26に出力する。全ての減速データを出
力し終えたなら、制御モードを位置制御モードに切り換
えると同時に現在位置カウンタ12の値Xdをメモリ28に記
憶する（ステップ9,10）。
次に現在位置カウンタ12から可動体10の現在位置X1を読
み取りつつ、X1とその１回前に現在位置カウンタ12から
読み取った可動体10の現在位置X2との比較を繰り返し、
X1−X2≦０になるのを待つ（ステップ11,12）。
み取りつつ、X1とその１回前に現在位置カウンタ12から
読み取った可動体10の現在位置X2との比較を繰り返し、
X1−X2≦０になるのを待つ（ステップ11,12）。
X1−X2≦０になったなら、仮の目標位置から真の目標位
置Xgに目標位置を切り換え（ステップ13）、その時の可
動体10の現在位置Xfを読み取って記憶し（ステップ1
4）、位置制御を続行する（ステップ15）。
置Xgに目標位置を切り換え（ステップ13）、その時の可
動体10の現在位置Xfを読み取って記憶し（ステップ1
4）、位置制御を続行する（ステップ15）。
位置決めが終了（ステップ16）した後、補正値ｌ＝（Xf
−Xd）をCPU27で計算し（ステップ17）、位置決め動作
を終了する。
−Xd）をCPU27で計算し（ステップ17）、位置決め動作
を終了する。
上記補正値は以上説明した位置決め動作を繰り返すこと
によって収束して安定する。
によって収束して安定する。
以上説明したように、制御モードの切換位置からの行き
過ぎ位置量を補正値として、仮の目標位置を決定するこ
とによって、可動体の慣性による目標位置からの行き過
ぎ量を減少させあるいは無くすことができるため、特に
位置決め時間の短縮を図ることができ、さらに位置決め
精度の向上をも図ることができる。
過ぎ位置量を補正値として、仮の目標位置を決定するこ
とによって、可動体の慣性による目標位置からの行き過
ぎ量を減少させあるいは無くすことができるため、特に
位置決め時間の短縮を図ることができ、さらに位置決め
精度の向上をも図ることができる。
［実施例の変形例］ なお、本発明は上述の２つの実施例に限定されることな
く適宜変形して実施することができる。例えば上述の実
施例においては、立下げ位置偏差および補正値は目標位
置（絶対位置）にかかわらずそれぞれ１つのデータを設
定しているが、それらを目標位置座標の関数として目標
位置ごとに選択して使用できるようにしてもよいし、ま
たは可動体10の全移動領域を数個のブロックに分割し、
ブロックごとに補正値を持つように構成してもよい。
く適宜変形して実施することができる。例えば上述の実
施例においては、立下げ位置偏差および補正値は目標位
置（絶対位置）にかかわらずそれぞれ１つのデータを設
定しているが、それらを目標位置座標の関数として目標
位置ごとに選択して使用できるようにしてもよいし、ま
たは可動体10の全移動領域を数個のブロックに分割し、
ブロックごとに補正値を持つように構成してもよい。
［発明の効果］ 以上のように本発明によれば、可動体を速度サーボによ
って高速に移動させることができると共に、速度サーボ
後の位置サーボによって可動体を位置決めする際、位置
制御されている可動体の速度を（真の）停止目標位置近
傍で実質的に零にすることができるため、可動体が（真
の）停止目標位置を中心に大きく振動することを防止す
ることができ、速度制御後の位置制御によって可動体を
（真の）停止目標位置に高精度に且つ短時間に位置決め
することができる。
って高速に移動させることができると共に、速度サーボ
後の位置サーボによって可動体を位置決めする際、位置
制御されている可動体の速度を（真の）停止目標位置近
傍で実質的に零にすることができるため、可動体が（真
の）停止目標位置を中心に大きく振動することを防止す
ることができ、速度制御後の位置制御によって可動体を
（真の）停止目標位置に高精度に且つ短時間に位置決め
することができる。
第１図は、本発明の一実施例に係る位置決め制御装置の
制御回路の構成を示すブロック図、 第２図は、本発明の一実施例における可動体の位置と速
度の変化を示すグラフ、 第３図は、本発明の他の実施例を示すブロック図、 第４図は、第３図の装置の動作のアルゴリズムを示すフ
ローチャート、 第５図は、従来の位置決め装置の制御回路を示すブロッ
ク図、 第６図は、速度指令曲線の１例を示すグラフである。 1a:立上げ速度関数発生器、 1b:立下げ速度関数発生器、2:D/A変換器、 3:真の目標位置設定器、4:偏差カウンタ、 5:D/A変換器、6:アナログスイッチ、 7:増幅器、8:可動体を駆動するモータ、 9:速度検出器、10:可動体、11:位置検出器、 12:現在位置カウンタ、13:速度変換器、 14:速度設定器、15:比較器、16:スイッチ、 17:補正値カウンタ、18:仮の目標位置設定器、 19:位置設定器、20:比較器、 21,22:ラッチカウンタ、23:スイッチ、 24:速度立下げ位置設定器、25:比較器。
制御回路の構成を示すブロック図、 第２図は、本発明の一実施例における可動体の位置と速
度の変化を示すグラフ、 第３図は、本発明の他の実施例を示すブロック図、 第４図は、第３図の装置の動作のアルゴリズムを示すフ
ローチャート、 第５図は、従来の位置決め装置の制御回路を示すブロッ
ク図、 第６図は、速度指令曲線の１例を示すグラフである。 1a:立上げ速度関数発生器、 1b:立下げ速度関数発生器、2:D/A変換器、 3:真の目標位置設定器、4:偏差カウンタ、 5:D/A変換器、6:アナログスイッチ、 7:増幅器、8:可動体を駆動するモータ、 9:速度検出器、10:可動体、11:位置検出器、 12:現在位置カウンタ、13:速度変換器、 14:速度設定器、15:比較器、16:スイッチ、 17:補正値カウンタ、18:仮の目標位置設定器、 19:位置設定器、20:比較器、 21,22:ラッチカウンタ、23:スイッチ、 24:速度立下げ位置設定器、25:比較器。
Claims (2)
- 【請求項１】可動体を移動するための駆動手段と、前記
可動体の仮の停止目標位置を設定する第１設定手段と、
前記可動体の真の停止目標位置を設定する第２設定手段
と、前記可動体の現在位置と前記第１設定手段に設定さ
れている仮の停止目標位置との差が所定値となる第１時
点まで前記駆動手段を速度指令に基づいて制御する速度
サーボ制御手段と、前記第１時点後から前記可動体の現
在位置と前記第１設定手段に設定されている仮の停止目
標位置との差に基づいて前記駆動手段を制御すると共
に、前記第１時点後で前記可動体の移動速度が実質的に
零に等しくなる第２時点から前記可動体の現在位置と前
記第２設定手段に設定されている真の停止目標位置との
差に基づいて前記駆動手段を制御する位置サーボ制御手
段を有することを特徴とする位置決め制御装置。 - 【請求項２】前記可動体の前記第１時点での現在位置と
前記第２時点での現在位置の差と前記第２設定手段に設
定される真の停止目標位置から前記第１設定手段に設定
される仮の停止目標位置を決定することを特徴とする特
許請求の範囲第１項記載の位置決め制御装置。
Priority Applications (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP61063939A JPH0756608B2 (ja) | 1986-03-24 | 1986-03-24 | 位置決め制御装置 |
| US07/028,406 US4888536A (en) | 1986-03-24 | 1987-03-20 | Device for controlling positioning of an object |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP61063939A JPH0756608B2 (ja) | 1986-03-24 | 1986-03-24 | 位置決め制御装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPS62221006A JPS62221006A (ja) | 1987-09-29 |
| JPH0756608B2 true JPH0756608B2 (ja) | 1995-06-14 |
Family
ID=13243818
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP61063939A Expired - Lifetime JPH0756608B2 (ja) | 1986-03-24 | 1986-03-24 | 位置決め制御装置 |
Country Status (2)
| Country | Link |
|---|---|
| US (1) | US4888536A (ja) |
| JP (1) | JPH0756608B2 (ja) |
Families Citing this family (16)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6346520A (ja) * | 1986-08-14 | 1988-02-27 | Omron Tateisi Electronics Co | 位置決め機構の駆動方法 |
| JPH01273115A (ja) * | 1988-04-25 | 1989-11-01 | Canon Inc | 位置決め制御装置 |
| JP2704734B2 (ja) * | 1988-09-05 | 1998-01-26 | キヤノン株式会社 | ステージ位置決め補正方法及び装置 |
| JPH02139607A (ja) * | 1988-11-21 | 1990-05-29 | Japan Servo Co Ltd | 動体の位置制御装置 |
| JP2735131B2 (ja) * | 1989-07-12 | 1998-04-02 | 三菱電機株式会社 | 物理量の設定方法 |
| US5184055A (en) * | 1989-10-06 | 1993-02-02 | Canon Kabushiki Kaisha | Device for positioning control |
| US5239248A (en) * | 1991-01-23 | 1993-08-24 | Seiko Instruments Inc. | Servo control system |
| JPH05118302A (ja) * | 1991-09-25 | 1993-05-14 | Toshiba Corp | サーボモータの制御装置 |
| US5544376A (en) * | 1994-01-31 | 1996-08-13 | Maxwell Products, Inc. | Articulated bed with customizable remote control |
| JPH07302748A (ja) * | 1994-05-02 | 1995-11-14 | Canon Inc | 半導体露光装置 |
| EP0806715B1 (de) * | 1995-11-30 | 1999-03-17 | Siemag Transplan Gmbh | Verfahren zum Regeln eines rechnergesteuerten Regalbediengerätes |
| JP3658339B2 (ja) * | 2001-05-17 | 2005-06-08 | キヤノン株式会社 | モータの制御のための方法及び装置 |
| JP2003059216A (ja) * | 2001-08-16 | 2003-02-28 | Internatl Business Mach Corp <Ibm> | ハード・ディスク・ドライブ、データ記憶再生装置、ヘッド移動制御装置およびヘッド移動制御方法 |
| JP4797323B2 (ja) * | 2001-08-27 | 2011-10-19 | 三菱電機株式会社 | 同期電動機のセンサレス制御装置 |
| JP4382123B2 (ja) * | 2007-12-13 | 2009-12-09 | ファナック株式会社 | 制御モード切り換え機能を有する数値制御装置 |
| JP5972941B2 (ja) * | 2014-08-06 | 2016-08-17 | ファナック株式会社 | 数値制御装置付き工作機械 |
Family Cites Families (19)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US3555252A (en) * | 1967-05-11 | 1971-01-12 | Leeds & Northrup Co | Learning control of actuators in control systems |
| US3876873A (en) * | 1971-06-07 | 1975-04-08 | Haudaille Ind Inc | Machine tool control system and method |
| US3917930A (en) * | 1974-11-25 | 1975-11-04 | Cincinnati Milacron Inc | Method and apparatus for adaptively positioning a machine element |
| US4203064A (en) * | 1977-04-05 | 1980-05-13 | Tokyo Shibaura Electric Co., Ltd. | Method for automatically controlling the position of small objects |
| JPS5458179A (en) * | 1977-10-18 | 1979-05-10 | Yaskawa Electric Mfg Co Ltd | Self-correcting type control apparatus |
| JPS5460671A (en) * | 1977-10-21 | 1979-05-16 | Ricoh Co Ltd | Positioning system |
| JPS54140069A (en) * | 1978-04-24 | 1979-10-30 | Toshiba Corp | Automatic positioning system |
| JPS5615602Y2 (ja) * | 1979-09-20 | 1981-04-13 | ||
| US4355273A (en) * | 1980-09-15 | 1982-10-19 | Xerox Corporation | Servo capture system |
| JPS5775753A (en) * | 1980-10-30 | 1982-05-12 | Fanuc Ltd | Main shaft rotary position control system |
| JPS57211452A (en) * | 1981-06-16 | 1982-12-25 | Fanuc Ltd | Movable portion returning system |
| JPS6045811A (ja) * | 1983-08-24 | 1985-03-12 | Kobe Steel Ltd | 学習制御方法 |
| JPS6057409A (ja) * | 1983-09-08 | 1985-04-03 | Kobe Steel Ltd | 学習制御方法 |
| JPS6057410A (ja) * | 1983-09-08 | 1985-04-03 | Kobe Steel Ltd | 学習制御方法 |
| JPS60171506A (ja) * | 1984-02-15 | 1985-09-05 | Kobe Steel Ltd | 学習制御方法 |
| US4609954A (en) * | 1984-03-02 | 1986-09-02 | Eastman Kodak Company | Tracking servo for a disk player with a dc motor |
| US4646635A (en) * | 1984-10-04 | 1987-03-03 | Pitney Bowes Inc. | Microprocessor controlled D.C. motor for controlling print value selection means |
| US4710865A (en) * | 1984-11-14 | 1987-12-01 | Canon Kabushiki Kaisha | Control system for positioning an object using switching from a speed control mode to a position control mode with adjustable brain |
| US4641071A (en) * | 1985-09-25 | 1987-02-03 | Canon Kabushiki Kaisha | System for controlling drive of a wafer stage |
-
1986
- 1986-03-24 JP JP61063939A patent/JPH0756608B2/ja not_active Expired - Lifetime
-
1987
- 1987-03-20 US US07/028,406 patent/US4888536A/en not_active Expired - Lifetime
Also Published As
| Publication number | Publication date |
|---|---|
| US4888536A (en) | 1989-12-19 |
| JPS62221006A (ja) | 1987-09-29 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JPH0756608B2 (ja) | 位置決め制御装置 | |
| JP4390415B2 (ja) | ロボットの位置決め制御方法と位置決め制御装置 | |
| JPH08179831A (ja) | フルクローズド・ループ方式における象限突起補正方法 | |
| EP0790543A1 (en) | Method for switching a control mode of a servo control system | |
| JPWO2004008624A1 (ja) | サーボ制御装置のゲイン調整方法 | |
| WO1989006066A1 (fr) | Procede de commande de vitesse pour servomoteur | |
| JP4553158B2 (ja) | モータ制御装置及び方法 | |
| JPH0616246B2 (ja) | 位置決め制御装置 | |
| JPH10143249A (ja) | 制御システムおよび制御システムにおける加速度パターンの設定方法およびパラメータ設定方法 | |
| JPH06242803A (ja) | 自動調整サーボ制御装置 | |
| JPH07210225A (ja) | 数値制御装置 | |
| JP3073399B2 (ja) | パルスレーザ加工装置 | |
| JP3388426B2 (ja) | 任意補間を可能としたモータのパルス列制御方式 | |
| JPH08249073A (ja) | 移動体の速度制御方法およびその制御装置 | |
| JP4084173B2 (ja) | レーザ加工方法及び装置 | |
| JPS6232508A (ja) | 数値制御装置のサ−ボ系の位置決め制御方法 | |
| JPS62229307A (ja) | 位置決め制御装置 | |
| JPH02137006A (ja) | 速度制御装置 | |
| JP3408048B2 (ja) | 走査型露光装置 | |
| JPH01273115A (ja) | 位置決め制御装置 | |
| WO2024122066A1 (ja) | パラメータ調整装置及びコンピュータ読み取り可能な記録媒体 | |
| JPH08150540A (ja) | 工作機械の干渉防止装置 | |
| JPS60132207A (ja) | 制御装置 | |
| JPH06274229A (ja) | 数値制御装置 | |
| JPS6368912A (ja) | 位置決め制御装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| EXPY | Cancellation because of completion of term |