JP2005078479A - Positioning control unit - Google Patents
Positioning control unit Download PDFInfo
- Publication number
- JP2005078479A JP2005078479A JP2003309818A JP2003309818A JP2005078479A JP 2005078479 A JP2005078479 A JP 2005078479A JP 2003309818 A JP2003309818 A JP 2003309818A JP 2003309818 A JP2003309818 A JP 2003309818A JP 2005078479 A JP2005078479 A JP 2005078479A
- Authority
- JP
- Japan
- Prior art keywords
- slider
- simulated
- controller
- control input
- output
- 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.)
- Abandoned
Links
Landscapes
- Control Of Position Or Direction (AREA)
Abstract
Description
本発明は、ひとつの機台上に二つのスライダを有し、各々のスライダが別の対象物を搬送する、例えば電子部品実装装置や露光装置などに用いられる位置決め制御装置に関する。 The present invention relates to a positioning control device used in, for example, an electronic component mounting apparatus or an exposure apparatus, which has two sliders on one machine base and each slider conveys another object.
近年、生産性の向上を狙い、工作機や電子部品実装装置の搬送系が高速化されている。それに伴い、テーブルの反力が機台に印加され、機台と地上との間に存するバネ要素により機台が振動し、そのために機台に乗っているスライダの位置決め性能に悪影響を及ぼす事例が報告され、その改善発明が報告されている（例えば、特許文献１参照）。
従来のリニアスライダによる機台振動問題の改善事例を図４に基づいて説明する（特許文献１より）。
図４は、従来例を示す図である。図４において、１０１は電動機伝達関数、１０２は減速器及び極／直行座標変換定数、１０３はテーブル変位／力変換バネ定数、１０４はテーブル駆動伝達関数、１０５は機台駆動伝達関数、１０６は機台変位／力変換バネ定数、１０７はテーブルの地上からみた絶対変位、１０８は機台からみたテーブル変位、１０９は地上からみた機台変位、１１０はテーブルを駆動する推進力、１１１はテーブルと電動機出力との変位差、１１２は電動機変位、１１３は電動機を駆動するためのトルク（推進力）、１１４は減速器及び直行／極座標変換定数、１２１は電動機、１２６は電動機制御器、１２８は電動機位置検出信号、１３４は位置目標値信号、１３５は電動機位置補償器、１３９は従来例のモデルによる前置補償器、１４１は電動機制御器に対する位置指令、１４２は電動機モデル位置時系列データ、１４４はトルクモデル指令時系列データ、１５１は前置補償器内制御器である。
従来例ではまず、入力トルク１１３と減速器および直行／極座標変換定数１０２を掛けたテーブル推進力１１０を合わせた入力より電動機変位１１２を発生する電動機伝達関数１０１と、前記電動機変位１１２に減速器および極／直行座標変換定数１０２を掛け合わせた出力と機台からみたテーブル変位１０８との偏差に、テーブル変位／力変換バネ定数１０３を掛け合わせてテーブル推進力１１０を発生させ、前記テーブル推進力１１０によりテーブルの地上からみた絶対変位１０７を出力するテーブル伝達関数１０４と、機台変位１０９に機台変位／力変換バネ定数１０６を掛け合わせ前記テーブル推進力１１０と共に入力して機台変位１０９を発生する機台駆動伝達関数１０５を配し、前記テーブルの地上からみた絶対変位１０７と前記機台変位１０９との差により機台からみたテーブル変位１０８を発生させる、機台振動モデルを定義し、そのモデル演算を前置補償器内にて実行し、その結果得られた各状態量を用いて補償器１５１を設計することで、モデル内のテーブル変位を安定に制御し、安定に制御された状態量を用いて電動機制御器１２６が構成されるため、モデルが実制御対象の特性を十分に反映していれば、実制御対象も前置補償器１３９内のモデル同様、安定に制御されるとするものである。
An example of improving the machine vibration problem by the conventional linear slider will be described with reference to FIG. 4 (from Patent Document 1).
FIG. 4 is a diagram showing a conventional example. In FIG. 4, 101 is a motor transfer function, 102 is a speed reducer and pole / rectangular coordinate conversion constant, 103 is a table displacement / force conversion spring constant, 104 is a table drive transfer function, 105 is a machine base drive transfer function, and 106 is a machine. Table displacement / force conversion spring constant, 107 is the absolute displacement of the table viewed from the ground, 108 is the table displacement viewed from the machine base, 109 is the machine table displacement viewed from the ground, 110 is the propulsive force that drives the table, 111 is the table and electric motor Displacement difference from output; 112, motor displacement; 113, torque (propulsive force) for driving the motor; 114, decelerator and direct / polar coordinate conversion constant; 121, motor; 126, motor controller; 128, motor position Detection signal, 134 is a position target value signal, 135 is a motor position compensator, 139 is a precompensator based on a conventional model, and 141 is a motor control. Position command for, 142 motor model position time series data, 144 is a torque model command time series data, the 151 is a predistorter in the controller.
In the conventional example, first, the motor transfer function 101 for generating the motor displacement 112 from the input of the table torque 110 multiplied by the input torque 113, the speed reducer, and the direct / polar coordinate conversion constant 102, and the motor displacement 112 with the speed reducer and The table driving force 110 is generated by multiplying the deviation between the output obtained by multiplying the polar / rectangular coordinate conversion constant 102 and the table displacement 108 viewed from the machine base by the table displacement / force converting spring constant 103. The table transfer function 104 that outputs the absolute displacement 107 viewed from the ground of the table and the machine table displacement 109 multiplied by the machine table displacement / force conversion spring constant 106 are input together with the table driving force 110 to generate the machine table displacement 109. The machine table drive transfer function 105 is arranged, and the absolute displacement 107 and the front of the table as viewed from the ground. A table vibration model that generates a table displacement 108 as seen from the table due to the difference from the table displacement 109 is defined, the model calculation is executed in the precompensator, and each state quantity obtained as a result is calculated. By using the compensator 151 to design, the table displacement in the model is stably controlled, and the motor controller 126 is configured using the state quantity that is stably controlled. If it is sufficiently reflected, it is assumed that the actual control target is stably controlled as in the model in the precompensator 139.
しかしながら、従来例のモデルは、スライダテーブルが一つのものについてである。近年適用の増えている一つの機台上に二つのスライダを有するリニアスライダでは、各スライダの推力が機台に与える影響は、他方のスライダにも影響を及ぼすため、単純に、従来例を二つ並列に用いればよいということにはならない。そのため、スライダ2個搭載型のリニアスライダには、従来とは異なった振動問題が残ることとなり、性能劣化の問題を抱えていた。
そこで、本発明はこのような問題点に鑑みてなされたものであり、各スライダが他方のスライダに与える影響を考慮し、その影響を抑えるようにし、二つのリニアスライダ双方の位置決め性能を、同時に向上させることができる位置決め制御装置を提供することを目的とする。
However, the conventional model is for a single slider table. In a linear slider having two sliders on one machine base, which has been increasingly applied in recent years, the influence of the thrust of each slider on the machine base also affects the other slider. It does not mean that they should be used in parallel. For this reason, the linear slider with two sliders has a vibration problem different from the conventional one, and has a problem of performance deterioration.
Therefore, the present invention has been made in view of such problems, considering the influence of each slider on the other slider, and suppressing the influence, so that the positioning performance of both the two linear sliders can be improved simultaneously. An object of the present invention is to provide a positioning control device that can be improved.
上記問題を解決するため、本発明は、次のように構成したのである。
請求項１に記載の発明は、
ひとつの機台上に二つのスライダを有するリニアスライダの、前記二つのスライダ位置を各々制御する位置決め制御装置において、
スライダ１の位置を制御する制御器１と
スライダ２の位置を制御する制御器２と
前記制御器１から出力される制御入力１に基づいて、スライダ１を駆動するための推力を与えるパワー部１と
前記制御器２から出力される制御入力２に基づいて、スライダ２を駆動するための推力を与えるパワー部２と
前記リニアスライダの機械定数と前記制御入力１および制御入力２に基づいてスライダ１およびスライダ２が各々他方のスライダに与える影響を除去するための、制御器１に出力する非干渉補償量１および制御器２に出力する非干渉補償量２を演算する非干渉補償演算部とを有し、
前記制御器１は、前記スライダ１に対する位置指令１と、前記非干渉補償量１を用いて前記制御入力１を出力し、
前記制御器２は、前記スライダ２に対する位置指令２と、前記非干渉補償量２を用いて前記制御入力２を出力するように構成されること
を特徴とするものである。
このようになっているため、お互いのスライダから受ける干渉影響を除去でき、位置決め性能を向上させることができる。
In order to solve the above problem, the present invention is configured as follows.
The invention described in claim 1
In a positioning control device for controlling each of the two slider positions of a linear slider having two sliders on one machine base,
A controller 1 that controls the position of the slider 1, a controller 2 that controls the position of the slider 2, and a power unit 1 that provides thrust for driving the slider 1 based on a control input 1 output from the controller 1. Based on the control input 2 output from the controller 2, the power unit 2 that gives thrust for driving the slider 2, the mechanical constant of the linear slider, the control input 1, and the slider 1 based on the control input 2 And a non-interference compensation calculation unit for calculating a non-interference compensation amount 1 output to the controller 1 and a non-interference compensation amount 2 output to the controller 2 for removing the influence of the slider 2 on the other slider. Have
The controller 1 outputs the control input 1 using the position command 1 for the slider 1 and the non-interference compensation amount 1,
The controller 2 is configured to output the control input 2 using the position command 2 for the slider 2 and the non-interference compensation amount 2.
Since it is in this way, the influence of interference received from the sliders can be removed, and the positioning performance can be improved.
また、請求項２に記載の発明は、請求項１の発明において
前記スライダ１は位置検出器１を、前記スライダ２は位置検出器２をそなえ、各々の位置検出器は各々のスライダ位置を検出し、前記スライダ１の位置検出値１を制御器１へ出力し、前記スライダ２の位置検出値２を制御器２へ出力し、
前記制御器１は前記スライダ１に対する前記位置指令１と、前記非干渉補償量１と前記位置検出値１を用いて制御入力１を出力し、
前記制御器２は前記スライダ２に対する前記位置指令２と、前記非干渉補償量２と前記位置検出値２を用いて制御入力２を出力するように構成されること
を特徴とするものである。
このようになっているため、請求項１の効果に加えて位置検出値を用いてフィードバック制御器を構成できるため、さらに制御性能を向上させることができる。
According to a second aspect of the present invention, in the first aspect of the invention, the slider 1 includes a position detector 1, the slider 2 includes a position detector 2, and each position detector detects each slider position. The position detection value 1 of the slider 1 is output to the controller 1, the position detection value 2 of the slider 2 is output to the controller 2,
The controller 1 outputs a control input 1 using the position command 1 for the slider 1, the non-interference compensation amount 1 and the position detection value 1,
The controller 2 is configured to output a control input 2 using the position command 2 for the slider 2, the non-interference compensation amount 2 and the position detection value 2.
Thus, in addition to the effect of the first aspect, the feedback controller can be configured using the position detection value, so that the control performance can be further improved.
また、請求項３に記載の発明は、非干渉補償演算部の構成について、二つの一次フィルタと二つの微分器によって構成することを特徴とするものである。
このようになっているため、簡便に補償演算を行うことができる。
According to a third aspect of the present invention, the configuration of the non-interference compensation calculation unit is configured by two primary filters and two differentiators.
Since this is the case, the compensation calculation can be easily performed.
また、請求項４に記載の発明は、
ひとつの機台上に二つのスライダを有し、各々のスライダの位置はセンサにより検出されるリニアスライダの、前記二つのスライダ位置を各々制御する位置決め制御装置において、
スライダ１の位置を制御する実制御器１と
スライダ２の位置を制御する実制御器２と
前記実制御器１から出力される実制御入力１に基づいて、スライダ１を駆動するための推力を与えるパワー部１と
前記実制御器２から出力される実制御入力２に基づいて、スライダ２を駆動するための推力を与えるパワー部２と
前記スライダ１および前記スライダ２および前記機台の状態量を、動特性写像を演算することで算出し、前記リニアスライダの模擬状態量を出力する模擬リニアスライダモデル演算部と
前記模擬リニアスライダモデル演算部より出力された前記模擬状態量を入力し、各々の状態量にゲインを乗算し加算して模擬リニアスライダモデルに対する補償入力を演算する模擬制御入力演算部と
前記実制御器１および前記実制御器２は、スライダ１に対する位置指令１およびスライダ２に対する位置指令２と前記模擬状態量と前記模擬制御入力の少なくとも一つと、スライダ１の位置検出器１の出力である位置検出値１およびスライダ２の位置検出器２の出力である位置検出値２を用いて前記パワー部１および前記パワー部２への前記実制御入力１および前記実制御入力２を決定するように構成されること
を特徴とするものである。
このようになっているため、位置決め性能を安定に向上させることができ、さらに模擬制御入力演算部の設定により制御応答設定の自由度が増すので、きめ細かく応答の設定をすることができる。
The invention according to claim 4
In a positioning control device that has two sliders on one machine base, and each slider position is controlled by a sensor, and each of the two slider positions is controlled by a sensor.
Based on an actual controller 1 for controlling the position of the slider 1, an actual controller 2 for controlling the position of the slider 2, and an actual control input 1 output from the actual controller 1, thrust for driving the slider 1 is obtained. The power unit 1 for applying power and the power unit 2 for applying thrust for driving the slider 2 based on the actual control input 2 output from the actual controller 2 and the state quantities of the slider 1, the slider 2, and the machine base Is calculated by calculating a dynamic characteristic map, and a simulated linear slider model calculating unit that outputs a simulated state amount of the linear slider and the simulated state amount output from the simulated linear slider model calculating unit, A simulated control input computing unit that computes a compensation input for the simulated linear slider model by multiplying and adding a gain to the state quantity, and the actual controller 1 and the actual controller 2 are: Position command 1 for rider 1, position command 2 for slider 2, at least one of the simulated state quantity and simulated control input, position detection value 1 which is the output of position detector 1 of slider 1, and position detector of slider 2 The actual control input 1 and the actual control input 2 to the power unit 1 and the power unit 2 are determined using a position detection value 2 that is an output of 2. .
Thus, the positioning performance can be stably improved, and the degree of freedom for setting the control response is increased by setting the simulated control input calculation unit, so that the response can be set finely.
また、請求項５に記載の発明は、
請求項４記載の発明における模擬リニアスライダモデル演算部が、少なくとも６つの積分器で構成されること
を特徴とするものである。
このようになっているため、簡便に制御系の設計ができる。
The invention according to claim 5
According to a fourth aspect of the present invention, the simulated linear slider model calculation unit is composed of at least six integrators.
Because of this, the control system can be designed easily.
また請求項６記載の発明は
請求項４もしくは請求項５の発明における模擬リニアスライダモデル演算部が、
前記スライダ１の模擬位置、模擬速度、模擬加速度、模擬推力のうちの少なくとも一つおよび
前記スライダ２の模擬位置、模擬速度、模擬加速度、模擬推力のうちの少なくとも一つを出力すること
を特徴とするものである。
このようになっているため、模擬リニアスライダモデル演算部の模擬状態量を実制御器にくまなく反映できる。
Further, in the invention according to claim 6, the simulated linear slider model calculation unit in the invention according to claim 4 or claim 5,
Outputting at least one of a simulated position, simulated speed, simulated acceleration, and simulated thrust of the slider 1 and at least one of a simulated position, simulated speed, simulated acceleration, and simulated thrust of the slider 2; To do.
As a result, the simulated state quantity of the simulated linear slider model calculation unit can be reflected in the actual controller.
また請求項７記載の発明は
請求項４もしくは請求項５もしくは請求項６の発明における前記位置指令１が、模擬リニアスライダモデル演算部における前記スライダ１の模擬位置１であり、前記位置指令２は前記模擬リニアスライダモデル演算部における前記スライダ２の模擬位置２であること
を特徴とするものである。
このようになっているため、模擬制御入力により制御された模擬リニアスライダモデル演算部の安定化された模擬状態量を実制御器に反映できる。
According to a seventh aspect of the invention, the position command 1 in the invention of the fourth, fifth, or sixth aspect is the simulated position 1 of the slider 1 in the simulated linear slider model calculation unit, and the position command 2 is It is a simulated position 2 of the slider 2 in the simulated linear slider model calculation unit.
Thus, the stabilized simulated state quantity of the simulated linear slider model calculation unit controlled by the simulated control input can be reflected in the actual controller.
本発明の第一の発明である位置決め制御装置によれば、各スライダが他方のスライダに与える影響を有効に除去することができるので、位置決め制御性能を向上させることができるという効果がある。
また、第２の発明である位置決め制御装置によれば、模擬リニアスライダモデル演算部を装置に搭載し、全模擬状態量を用いて模擬制御入力を構成することにより、模擬リニアスライダモデル演算部内の各スライダおよび機台の模擬状態量を安定化し、その模擬状態量を実制御器に用いるので制御系を安定化させ、位置決め性能を向上させることができる。さらに、模擬制御入力演算部および模擬リニアスライダモデル演算部を有することにより、制御系の設計自由度が増えるので、応答をきめ細かく設定することができるという効果もある。
According to the positioning control device according to the first aspect of the present invention, the influence of each slider on the other slider can be effectively removed, so that the positioning control performance can be improved.
Further, according to the positioning control device of the second invention, the simulated linear slider model calculation unit is mounted on the device, and the simulated control input is configured using all simulated state quantities. Since the simulated state quantity of each slider and machine base is stabilized and the simulated state quantity is used in the actual controller, the control system can be stabilized and the positioning performance can be improved. Further, since the simulation control input calculation unit and the simulation linear slider model calculation unit are provided, the degree of freedom in design of the control system is increased, so that the response can be set finely.
以下、本発明の具体的実施例を図に基づいて説明する。 Hereinafter, specific embodiments of the present invention will be described with reference to the drawings.
図１は、本発明の位置決め制御装置の構成ブロック図である。図において１は本発明である位置決め制御装置、２は制御器１、３は制御器２、４は位置指令１、５は位置指令２、５ａは非干渉補償演算部、６は非干渉補償量１、７は非干渉補償量２、８は制御入力１、９は制御入力２、１０はパワー部１、１１はパワー部２、１２はスライダ１、１３はスライダ２、１４はスライダ１を駆動するための推力、１５はスライダ２を駆動するための推力、１６は機台である。
スライダ１に対する位置指令１が制御器１に、スライダ２に対する位置指令２が制御器２に入力され、各制御器からは各パワー部へ推力指令が出力される。各パワー部は、入力した指令に基づいて推力を発生させ、スライダを駆動する。
二つの可動子を搭載する機台が、地上とバネ要素で接合されている場合、そのダイナミクスを表すブロック線図は図５のようになる。図５において、３１はスライダ１に入力される推力f1、３２はスライダ２に入力される推力f2、３３はスライダ１の推力を入力として位置を出力とする伝達関数、３４はスライダ２の推力を入力として位置を出力とする伝達関数、３５は機台の推力を入力として位置を出力とする伝達関数、３６は地上と機台間に存在するバネ要素を表す変位／力変換定数、３７は機台変位を入力として力を出力する粘性摩擦伝達関数、３８は地上からみたスライダ１の絶対位置χT1、３９は地上からみたスライダ２の絶対位置χT2、４０は機台からみたスライダ１の相対位置χt1、４１は機台からみたスライダ２の相対位置χt2、４２は地上からみた機台の絶対位置χBである。ここで、ブロック線図を変形していくと、図６のブロック図を得る。図６において、５１はスライダ１の位置伝達関数、５２はスライダ２の位置伝達関数、５３はスライダ間の干渉力伝達関数、他の符号は図５と同じものである。このように、スライダ間の干渉力は数学モデルで記述できるので、何らかの方法でその干渉力を写像する（例えば、ファジィルールの使用やニューラルネットワークの適用など）ことにより、前もって、干渉力を除去する非干渉補償量を決定することができる。
例えば、干渉力伝達関数は
FIG. 1 is a block diagram showing the configuration of a positioning control device according to the present invention. In the figure, 1 is a positioning control device according to the present invention, 2 is a controller 1, 3 is a controller 2, 4 is a position command 1, 5 is a position command 2, 5 a is a non-interference compensation calculation unit, and 6 is a non-interference compensation amount. 1 and 7 are non-interference compensation amounts 2, 8 is a control input 1, 9 is a control input 2, 10 is a power unit 1, 11 is a power unit 2, 12 is a slider 1, 13 is a slider 2, and 14 is a slider 1. , 15 is a thrust for driving the slider 2, and 16 is a machine base.
A position command 1 for the slider 1 is input to the controller 1, and a position command 2 for the slider 2 is input to the controller 2, and a thrust command is output from each controller to each power unit. Each power unit generates a thrust based on the input command and drives the slider.
FIG. 5 is a block diagram showing the dynamics when a machine base equipped with two movers is joined to the ground by a spring element. In FIG. 5, 31 is a thrust f 1 input to the slider 1 , 32 is a thrust f 2 input to the slider 2 , 33 is a transfer function in which the thrust of the slider 1 is input and a position is output, and 34 is the slider 2. A transfer function that takes a thrust as an input and outputs a position, 35 is a transfer function that takes a thrust of the machine base as an input and outputs a position, 36 is a displacement / force conversion constant that represents a spring element existing between the ground and the machine base, 37 Is the viscous friction transfer function that outputs force with the machine base displacement as input, 38 is the absolute position χ T1 of the slider 1 viewed from the ground, 39 is the absolute position χ T2 of the slider 2 viewed from the ground, 40 is the slider 1 viewed from the machine base Relative positions χ t1 , 41 are relative positions χ t2 of the slider 2 as seen from the machine base, and 42 are absolute positions χ B of the machine base as seen from the ground. Here, if the block diagram is modified, the block diagram of FIG. 6 is obtained. In FIG. 6, 51 is a position transfer function of the slider 1, 52 is a position transfer function of the slider 2, 53 is an interference force transfer function between the sliders, and other symbols are the same as those in FIG. In this way, the interference force between the sliders can be described by a mathematical model, so the interference force can be removed in advance by mapping the interference force in some way (for example, using a fuzzy rule or applying a neural network). A non-interference compensation amount can be determined.
For example, the interference force transfer function is
と変形できるので、一次フィルタ2個と微分器2個を用いることで干渉力を表現でき、よって請求項３のように非干渉補償量演算部を一次フィルタ2個、微分器2個で構成することができる。
図２は各スライダの位置を検出する場合の構成図を示したものである。図２において、１７は位置検出器１、１８は位置検出器２、１９は位置検出値１、２０は位置検出値２である。図２に示すように、各スライダの位置検出器１および位置検出器２を用いて位置検出値１および位置検出値２を検出し、各検出値を制御器１および制御器２へフィードバックして制御系をフィードバック制御構成とする請求項２に示す位置決め制御装置を用いることで、位置決め制御性能をさらに向上させることができる。
Therefore, the interference force can be expressed by using two primary filters and two differentiators. Therefore, as shown in claim 3, the non-interference compensation amount calculation unit is composed of two primary filters and two differentiators. be able to.
FIG. 2 shows a configuration diagram in the case of detecting the position of each slider. In FIG. 2, 17 is a position detector 1, 18 is a position detector 2, 19 is a position detection value 1, and 20 is a position detection value 2. As shown in FIG. 2, the position detection value 1 and the position detection value 2 are detected using the position detector 1 and the position detector 2 of each slider, and the detected values are fed back to the controller 1 and the controller 2. By using the positioning control device shown in claim 2 in which the control system has a feedback control configuration, the positioning control performance can be further improved.
図３は第２実施例の構成を示す図である。図３において、２ａは実制御器１、３ａは実制御器２、８ａは実制御入力１、９ａは実制御入力２、２１は模擬制御入力演算部、２２は模擬リニアスライダモデル演算部、２３は模擬制御入力１、２４は模擬制御入力２、２５は模擬状態量、他の符号は、図１および図２と同じである。
模擬リニアスライダ演算部２２では、スライダ１およびスライダ２に加わる推力と、スライダ１およびスライダ２および機台の状態量との関係を写像する（例えばファジィルールの使用、ニューラルネットワークの適用など）ような構造とする。例えば、請求項５の発明のように、図５に示す数学モデルのような少なくとも6個の積分器を用いて模擬リニアスライダモデル演算部を構成してもよい。そこから得た模擬状態量を用いて、模擬制御入力演算部は模擬制御入力１および模擬制御入力２を演算する。模擬制御入力演算部では、実制御対象では検出できない状態量を模擬して使用できるので、単に実制御対象の状態のみを用いて制御するよりも安定した制御系を実現することができる。この模擬制御入力演算部の模擬制御入力と、模擬制御入力によって安定化された状態量を実制御器１および実制御器２に出力し、実制御器１および実制御器２はそれらの情報とスライダ１およびスライダ２の位置検出値を用いて実制御入力を決定する。模擬リニアスライダモデル演算部の、制御入力に対する模擬状態量への写像が、実制御対象のものを非常に精度よく反映していれば、本発明はスライダ１およびスライダ２の位置決め性能を大幅に向上できる。
請求項６のように、模擬リニアスライダモデル演算部は、スライダおよび機台の位置、速度、加速度、推力を出力すれば、各実制御器はリニアスライダの挙動をくまなく反映できるので、制御性能を向上させることができる。
また請求項７のように、位置指令そのものを模擬リニアスライダモデル演算部出力の模擬位置を用いることで、安定化された指令を導入でき、制御性能の向上を図ることができる。
FIG. 3 is a diagram showing the configuration of the second embodiment. In FIG. 3, 2a is an actual controller 1, 3a is an actual controller 2, 8a is an actual control input 1, 9a is an actual control input 2, 21 is a simulated control input calculation unit, 22 is a simulated linear slider model calculation unit, 23 Are simulated control inputs 1 and 24, simulated control inputs 2 and 25 are simulated state quantities, and the other symbols are the same as those in FIGS.
The simulated linear slider calculation unit 22 maps the relationship between the thrust applied to the slider 1 and the slider 2 and the state quantities of the slider 1, the slider 2, and the machine base (for example, use of fuzzy rules, application of a neural network). Structure. For example, as in the invention of claim 5, the simulated linear slider model calculation unit may be configured using at least six integrators such as the mathematical model shown in FIG. The simulation control input calculation unit calculates the simulation control input 1 and the simulation control input 2 using the simulation state quantity obtained therefrom. Since the simulated control input computing unit can simulate and use a state quantity that cannot be detected by the actual control target, it is possible to realize a more stable control system than when control is performed using only the state of the actual control target. The simulated control input of the simulated control input calculation unit and the state quantity stabilized by the simulated control input are output to the actual controller 1 and the actual controller 2, and the actual controller 1 and the actual controller 2 The actual control input is determined using the position detection values of the slider 1 and the slider 2. The present invention greatly improves the positioning performance of the slider 1 and the slider 2 if the mapping of the simulated linear slider model calculation unit to the simulated state quantity with respect to the control input accurately reflects the actual control target. it can.
According to the sixth aspect of the present invention, if the simulated linear slider model calculation unit outputs the position, speed, acceleration, and thrust of the slider and the machine base, each actual controller can reflect the behavior of the linear slider throughout. Can be improved.
Further, as described in claim 7, by using the simulated position of the simulated linear slider model calculation unit as the position command itself, a stabilized command can be introduced and the control performance can be improved.
１ 位置決め制御装置
２ 制御器１
２ａ 実制御器１
３ 制御器２
３ａ 実制御器２
４ 位置指令１
５ 位置指令２
５ａ 非干渉補償演算部
６ 非干渉補償量１
７ 非干渉補償量２
８ 制御入力１
８ａ 実制御入力１
９ 制御入力２
９ａ 実制御入力２
１０ パワー部１
１１ パワー部２
１２ スライダ１
１３ スライダ２
１４ スライダ１を駆動するための推力
１５ スライダ２を駆動するための推力
１６ 機台
１７ 位置検出器１
１８ 位置検出器２
１９ 位置検出値１
２０ 位置検出値２
２１ 模擬制御入力演算部
２２ 模擬リニアスライダモデル演算部
２３ 模擬制御入力１
２４ 模擬制御入力２
２５ 模擬状態量
３１ スライダ１に入力される推力f1
３２ スライダ２に入力される推力f2
３３ スライダ１の推力を入力として位置を出力とする伝達関数
３４ スライダ２の推力を入力として位置を出力とする伝達関数
３５ 機台の推力を入力として位置を出力とする伝達関数
３６ 地上と機台間に存在するバネ要素を表す変位／力変換定数KB
３７ 機台変位を入力として力を出力する粘性摩擦伝達関数
３８ 地上からみたスライダ１の絶対位置χT1
３９ 地上からみたスライダ２の絶対位置χT2
４０ 機台からみたスライダ１の相対位置χt1
４１ 機台からみたスライダ２の相対位置χt2
４２ 地上からみた機台の絶対位置χB
５１ スライダ１の位置伝達関数
５２ スライダ２の位置伝達関数
５３ スライダ間の干渉力伝達関数
１０１ 電動機伝達関数
１０２ 減速器及び極／直行座標変換定数
１０３ テーブル変位／力変換バネ定数
１０４ テーブル駆動伝達関数
１０５ 機台駆動伝達関数
１０６ 機台変位／力変換バネ定数
１０７ テーブルの地上からみた絶対変位
１０８ 機台からみたテーブル変位
１０９ 地上からみた機台変位
１１０ テーブルを駆動する推進力
１１１ テーブルと電動機出力との変位差
１１２ 電動機変位
１１３ 電動機を駆動するためのトルク（推進力）
１１４ 減速器及び直行／極座標変換定数
１２１ 電動機
１２６ 電動機制御器
１２８ 電動機位置検出信号
１３４ 位置目標値信号
１３５ 電動機位置補償器
１３９ 従来例のモデルによる前置補償器
１４１ 電動機制御器に対する位置指令
１４２ 電動機モデル位置時系列データ
１４４ トルクモデル指令時系列データ
１５１ 前置補償器内制御器
1 Positioning control device 2 Controller 1
2a Actual controller 1
3 Controller 2
3a Actual controller 2
4 Position command 1
5 Position command 2
5a Non-interference compensation calculation unit 6 Non-interference compensation amount 1
7 Non-interference compensation amount 2
8 Control input 1
8a Actual control input 1
9 Control input 2
9a Actual control input 2
10 Power section 1
11 Power section 2
12 Slider 1
13 Slider 2
14 Thrust for driving the slider 1 15 Thrust for driving the slider 2 16 Machine base 17 Position detector 1
18 Position detector 2
19 Position detection value 1
20 Position detection value 2
21 Simulated control input computing unit 22 Simulated linear slider model computing unit 23 Simulated control input 1
24 Simulated control input 2
25 Simulated state quantity 31 Thrust f 1 input to the slider 1
32 Thrust f 2 input to slider 2
33 Transfer function 34 that takes the thrust of the slider 1 as an input and outputs the position 34 Transfer function 35 that takes the thrust of the slider 2 as an input and outputs the position 35 Transfer function that takes the thrust of the machine base as an input and outputs the position 36 Ground and machine base Displacement / force conversion constant K B representing spring element in between
37 Viscous frictional transfer function 38 that outputs force with machine base displacement as input 38 Absolute position χ T1 of slider 1 viewed from the ground
39 Absolute position χ T2 of slider 2 as seen from the ground
40 Relative position χ t1 of slider 1 from the stand
41 Relative position χ t2 of slider 2 from the stand
42 Absolute position of machine base from the ground χ B
51 Position transfer function 52 of slider 1 Position transfer function 53 of slider 2 Interference force transfer function 101 between sliders Motor transfer function 102 Reducer and pole / rectangular coordinate conversion constant 103 Table displacement / force conversion spring constant 104 Table drive transfer function 105 Machine table transfer function 106 Machine table displacement / force conversion spring constant 107 Absolute displacement of table viewed from the ground 108 Table displacement viewed from machine table 109 Machine table displacement viewed from the ground 110 Propulsive force driving table 111 Table and motor output Displacement difference 112 Motor displacement 113 Torque for driving the motor (propulsion force)
114 Speed reducer and direct / polar coordinate conversion constant 121 Motor 126 Motor controller 128 Motor position detection signal 134 Position target value signal 135 Motor position compensator 139 Precompensator 141 based on model of conventional example Position command 142 for motor controller 142 Motor model Position time series data 144 Torque model command time series data 151 Controller in precompensator
Claims (7)
前記二つのスライダ位置を各々制御する位置決め制御装置において、
スライダ１の位置を制御する制御器１と、
スライダ２の位置を制御する制御器２と、
前記制御器１から出力される制御入力１に基づいて、スライダ１を駆動するための推力を与えるパワー部１と、
前記制御器２から出力される制御入力２に基づいて、スライダ２を駆動するための推力を与えるパワー部２と、
前記リニアスライダの機械定数と前記制御入力１および制御入力２に基づいてスライダ１およびスライダ２が各々他方のスライダに与える影響を除去するための、制御器１に出力する非干渉補償量１および制御器２に出力する非干渉補償量２を演算する非干渉補償演算部とを有し、
前記制御器１は、前記スライダ１に対する位置指令１と、前記非干渉補償量１を用いて前記制御入力１を出力し、
前記制御器２は、前記スライダ２に対する位置指令２と、前記非干渉補償量２を用いて前記制御入力２を出力するように構成されることを特徴とする位置決め制御装置。 Of a linear slider with two sliders on one machine stand,
In the positioning control device for controlling each of the two slider positions,
A controller 1 for controlling the position of the slider 1;
A controller 2 for controlling the position of the slider 2;
Based on a control input 1 output from the controller 1, a power unit 1 that gives a thrust for driving the slider 1;
Based on the control input 2 output from the controller 2, a power unit 2 that gives a thrust for driving the slider 2;
Non-interference compensation amount 1 output to the controller 1 and control for removing the influence of the slider 1 and the slider 2 on the other slider based on the mechanical constant of the linear slider and the control input 1 and control input 2, respectively. A non-interference compensation calculation unit for calculating a non-interference compensation amount 2 to be output to the device 2;
The controller 1 outputs the control input 1 using the position command 1 for the slider 1 and the non-interference compensation amount 1,
The controller 2 is configured to output the control input 2 using a position command 2 for the slider 2 and the non-interference compensation amount 2.
前記制御器１は前記スライダ１に対する前記位置指令１と、前記非干渉補償量１と前記位置検出値１を用いて制御入力１を出力し、
前記制御器２は前記スライダ２に対する前記位置指令２と、前記非干渉補償量２と前記位置検出値２を用いて制御入力２を出力するように構成されることを特徴とする請求項１記載の位置決め制御装置。 The slider 1 includes a position detector 1, and the slider 2 includes a position detector 2. Each position detector detects each slider position, and outputs the position detection value 1 of the slider 1 to the controller 1. The position detection value 2 of the slider 2 is output to the controller 2,
The controller 1 outputs a control input 1 using the position command 1 for the slider 1, the non-interference compensation amount 1 and the position detection value 1,
2. The controller 2 is configured to output a control input 2 using the position command 2 for the slider 2, the non-interference compensation amount 2, and the position detection value 2. Positioning control device.
スライダ１の位置を制御する実制御器１と、
スライダ２の位置を制御する実制御器２と、
前記実制御器１から出力される実制御入力１に基づいて、スライダ１を駆動するための推力を与えるパワー部１と、
前記実制御器２から出力される実制御入力２に基づいて、スライダ２を駆動するための推力を与えるパワー部２と、
前記スライダ１および前記スライダ２および前記機台の状態量を、動特性写像を演算することで算出し、前記リニアスライダの模擬状態量を出力する模擬リニアスライダモデル演算部と、
前記模擬リニアスライダモデル演算部より出力された前記模擬状態量を入力し、各々の状態量にゲインを乗算し加算して模擬リニアスライダモデルに対する補償入力を演算する模擬制御入力演算部と、
前記実制御器１および前記実制御器２は、スライダ１に対する位置指令１およびスライダ２に対する位置指令２と前記模擬状態量と前記模擬制御入力の少なくとも一つと、スライダ１の位置検出器１の出力である位置検出値１およびスライダ２の位置検出器の出力である位置検出値２を用いて前記パワー部１および前記パワー部２への前記実制御入力１および前記実制御入力２を決定するように構成されることを特徴とする位置決め制御装置。 In a positioning control device that has two sliders on one machine base, and each slider position is controlled by a sensor, and each of the two slider positions is controlled by a sensor.
An actual controller 1 for controlling the position of the slider 1;
An actual controller 2 for controlling the position of the slider 2;
Based on the actual control input 1 output from the actual controller 1, a power unit 1 that provides a thrust for driving the slider 1,
Based on the actual control input 2 output from the actual controller 2, a power unit 2 that gives a thrust for driving the slider 2,
A simulated linear slider model calculation unit that calculates the state quantities of the slider 1, the slider 2, and the machine base by calculating a dynamic characteristic map, and outputs a simulated state quantity of the linear slider;
A simulated control input computing unit that inputs the simulated state quantity output from the simulated linear slider model computing unit, calculates a compensation input for the simulated linear slider model by multiplying and adding each state quantity by a gain, and
The actual controller 1 and the actual controller 2 include at least one of a position command 1 for the slider 1, a position command 2 for the slider 2, the simulated state quantity, and the simulated control input, and an output of the position detector 1 of the slider 1. The actual control input 1 and the actual control input 2 to the power unit 1 and the power unit 2 are determined using the detected position value 1 and the detected position value 2 which is the output of the position detector of the slider 2. A positioning control device comprising:
前記スライダ２の模擬位置、模擬速度、模擬加速度、模擬推力のうちの少なくとも一つを出力することを特徴とする請求項４又は請求項５記載の位置決め制御装置。 The simulated linear slider model calculation unit includes at least one of a simulated position, simulated speed, simulated acceleration, and simulated thrust of the slider 1, and at least one of a simulated position, simulated speed, simulated acceleration, and simulated thrust of the slider 2. 6. The positioning control device according to claim 4, wherein one is output.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2003309818A JP2005078479A (en) | 2003-09-02 | 2003-09-02 | Positioning control unit |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2003309818A JP2005078479A (en) | 2003-09-02 | 2003-09-02 | Positioning control unit |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JP2005078479A true JP2005078479A (en) | 2005-03-24 |
Family
ID=34411867
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2003309818A Abandoned JP2005078479A (en) | 2003-09-02 | 2003-09-02 | Positioning control unit |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP2005078479A (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2011097794A (en) * | 2009-10-31 | 2011-05-12 | Xiaolin Zhang | Coordination control device |
-
2003
- 2003-09-02 JP JP2003309818A patent/JP2005078479A/en not_active Abandoned
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2011097794A (en) * | 2009-10-31 | 2011-05-12 | Xiaolin Zhang | Coordination control device |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US7986118B2 (en) | Open-loop torque control on joint position-controlled robots | |
| US20080036413A1 (en) | Servo Control Device | |
| US20100171458A1 (en) | Servo controller | |
| JP2010051104A (en) | Motor control apparatus | |
| JP2012104047A (en) | Servo controller | |
| EP1023973B1 (en) | Robot control method and device | |
| JP2006215626A (en) | Position controller | |
| JP4930938B2 (en) | Remote control system for transmitting and receiving signals via a communication path having a communication delay | |
| JP4771078B2 (en) | Motor control device | |
| JP4487073B2 (en) | External force estimation method and external force estimation device | |
| JP2005078479A (en) | Positioning control unit | |
| JP2009038942A (en) | Load inertia identification method and servo motor controller | |
| JP3214270B2 (en) | Motor speed control device and speed and position control device | |
| JP2006121806A (en) | Friction compensation method of motor control device, and the motor control device | |
| JP4630684B2 (en) | Operation device, operation adjustment method for operation device, and program therefor | |
| JP2002331477A (en) | Robot controlling method and device | |
| JP5662836B2 (en) | Synchronous control device and synchronous control method | |
| JP2009032009A (en) | Linear actuator | |
| WO2000052543A1 (en) | Positioning control method | |
| JP4632171B2 (en) | Motor control device and control method | |
| JP2007221937A (en) | System identification apparatus and system identification method therefor | |
| JP2007183715A (en) | Speed controller for servo mechanism | |
| JP5063981B2 (en) | Electric motor position control device | |
| JP2006074896A (en) | Motor control device | |
| JP2005182427A (en) | Control computing device |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20060817 |
|
| A762 | Written abandonment of application |
Free format text: JAPANESE INTERMEDIATE CODE: A762 Effective date: 20090325 |