JPS6318413A - Highly precise positioning device - Google Patents
Highly precise positioning deviceInfo
- Publication number
- JPS6318413A JPS6318413A JP16255986A JP16255986A JPS6318413A JP S6318413 A JPS6318413 A JP S6318413A JP 16255986 A JP16255986 A JP 16255986A JP 16255986 A JP16255986 A JP 16255986A JP S6318413 A JPS6318413 A JP S6318413A
- Authority
- JP
- Japan
- Prior art keywords
- phase
- reversible counter
- rotary encoder
- controller
- value
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 230000002441 reversible effect Effects 0.000 abstract description 19
- 238000001514 detection method Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
Landscapes
- Control Of Position Or Direction (AREA)
Abstract
Description
【発明の詳細な説明】
発明の技術分野
本発明は、ディジタルサーボ方式の高精度位置決め装置
に関する。DETAILED DESCRIPTION OF THE INVENTION Technical Field of the Invention The present invention relates to a digital servo type high precision positioning device.
従来技術
この種のディジタルサーボ方式では、制御対象のモータ
にロータリエンコーダが直結されており、CPUなどの
制御回路から指令速度パターンに応じた所定の周波数の
パルスが送り指令値として可逆カウンタに入力される。Conventional technology In this type of digital servo system, a rotary encoder is directly connected to the motor to be controlled, and pulses of a predetermined frequency according to a command speed pattern are input from a control circuit such as a CPU to a reversible counter as a feed command value. Ru.
この可逆カウンタは、指令パルスを入力とし、上記ロー
タリエンコーダの出力パルスをフィードバック信号とし
、その偏差をD−A変換器を経て、上記モータの速度サ
ーボ増幅器に出力している。このようにして、速度サー
ボ増幅器は、可逆カウンタのパルス数に比例した電圧を
速度信号として、モータを駆動していくことになる。This reversible counter receives the command pulse as an input, uses the output pulse of the rotary encoder as a feedback signal, and outputs the deviation thereof to the speed servo amplifier of the motor via the DA converter. In this way, the speed servo amplifier drives the motor using a voltage proportional to the number of pulses of the reversible counter as a speed signal.
この間に、上記可逆カウンタの偏差がrOJになると、
これに追従して速度信号も「o」となるため、モータは
、目標の位置で、自動的に停止する。During this time, if the deviation of the reversible counter becomes rOJ,
Following this, the speed signal also becomes "o", so the motor automatically stops at the target position.
ところで、上記制御対象のモータの停止精度は、ロータ
リエンコーダおよび制御回路の1パルス分に相当してい
る。したがって、停止位置の高精度化は、ロータリエン
コーダの分解能を高めることにより達成できる。しかし
、ロータリエンコーダの分解能が高くなると、これに対
応してモータの1回転当たりのパルス数が増加するため
、可逆カウンタの容量を大きくしないと、適切な対応が
できなくなる。また、これに応じてD−A変換器や速度
サーボ増幅器の分解能も高める必要があるため、制御系
やサーボ系自体の設計変更が必要となり、また各制御要
素が高価なものとなるため、組み込み対象との関係で、
実用化に限界がある。By the way, the stopping accuracy of the motor to be controlled corresponds to one pulse of the rotary encoder and the control circuit. Therefore, higher accuracy of the stop position can be achieved by increasing the resolution of the rotary encoder. However, as the resolution of the rotary encoder increases, the number of pulses per revolution of the motor increases accordingly, so it is impossible to respond appropriately unless the capacity of the reversible counter is increased. In addition, it is necessary to increase the resolution of the D-A converter and speed servo amplifier accordingly, which requires design changes to the control system and servo system itself, and each control element becomes expensive, making it difficult to incorporate In relation to the object,
There are limits to practical application.
発明の目的
したがって、本発明の目的は、制御系の要素やフィード
バック系の構成要素について分解能を高くしないまま、
制御対象の停止時の位置決め精度を高めることである。Purpose of the Invention Therefore, the purpose of the present invention is to improve the resolution of control system elements and feedback system components without increasing their resolution.
The aim is to improve positioning accuracy when the controlled object is stopped.
発明の解決手段
そこで、本発明は、ロータリエンコーダの2相パルスに
着目し、その2相パルスの組み合わせ状態と、予め指定
したパルス位相とを比較し、これらの比較結果の−・致
状態に応して、制御対象の停止位置を決定するようにし
ている。Solution to the Invention Therefore, the present invention focuses on the two-phase pulses of a rotary encoder, compares the combination state of the two-phase pulses with a pre-specified pulse phase, and calculates the result according to the match state of these comparison results. Then, the stopping position of the controlled object is determined.
これの具体化のために、本発明は、第1の比較手段とし
ての可逆カウンタとD−A変換器との間に停止制御器を
介在させ、この停止制御器中の第2の比較手段で、設定
値とロータリエンコーダからの2相の信号の位相を比較
している。そして、停止制御器中の停止制御手段は、可
逆カウンタの計数値が「0」であり、しかも上記第2の
比較手段の比較結果が一致しているときにのみ、停止の
ための制御信号を後段の制御系に送る。この結果、この
ような制御系では、カウント値の1偏差に対応する停止
域が2相のパルス出力の組み合わせの数の分だけ分割さ
れるため、制御系やサーボ系が高精度化のものとして構
成されていなくても、停止時の位置決め精度が高められ
ることになる。In order to realize this, the present invention interposes a stop controller between the reversible counter as the first comparing means and the D-A converter, and the second comparing means in the stop controller. , the set value and the phase of the two-phase signal from the rotary encoder are compared. Then, the stop control means in the stop controller outputs a control signal for stopping only when the count value of the reversible counter is "0" and the comparison result of the second comparison means matches. Sends to the subsequent control system. As a result, in such a control system, the stop region corresponding to one deviation of the count value is divided by the number of combinations of two-phase pulse outputs, so the control system and servo system can be used as highly accurate ones. Even if it is not configured, the positioning accuracy at the time of stopping will be improved.
なお、可逆カウンタのカウント値が「0」以外であれば
、上記停止制御器は、可逆カウンタの位置偏差をそのま
ま次段のD−A変換器に送り込んでいる。したがって、
停止時以外の制御は、従来のディジタルサーボ方式と同
様に動作する。Note that if the count value of the reversible counter is other than "0", the stop controller sends the positional deviation of the reversible counter as it is to the next-stage DA converter. therefore,
Control other than when stopping operates in the same way as the conventional digital servo system.
発明の構成
第1図は、本発明のディジタルサーボ方式の高精度位置
決め装置lを示している。この高精度位置決め装置1は
、指令値Aを1つの入力とする第1の比較手段としての
可逆カウンタ2、本発明の特徴的な部分としての停止制
御器3、D−A変換器4、および速度サーボ増幅器5お
よび制御対象の回転部材としてモータ6を順次直列に備
えている。Structure of the Invention FIG. 1 shows a digital servo type high precision positioning device 1 of the present invention. This high-precision positioning device 1 includes a reversible counter 2 as a first comparison means that receives a command value A as one input, a stop controller 3 as a characteristic part of the present invention, a DA converter 4, and A speed servo amplifier 5 and a motor 6 as a rotating member to be controlled are sequentially connected in series.
そして、上記モータ6に速度サーボ系の速度検出器7お
よびディジタルフィードバック系のロータリエンコーダ
8がそれぞれ機械的に連結されている。この速度検出器
7は、タコジェネレータなどであり、速度サーボ増幅器
5の入力側の加え合わせ点9に接続されている。また、
ロータリエンコーダ8は、モータ6の回転方向を検出す
るために、例えば90度の位相差で2相のパルス出力B
1、B2を発生し、これを上記停止制御器3およびエン
コーダインターフェイス10を経て、上記可逆カウンタ
2の他方の入力端に送り込む。A speed detector 7 of a speed servo system and a rotary encoder 8 of a digital feedback system are mechanically connected to the motor 6, respectively. This speed detector 7 is a tacho generator or the like, and is connected to a summing point 9 on the input side of the speed servo amplifier 5. Also,
The rotary encoder 8 outputs two-phase pulses B with a phase difference of 90 degrees, for example, in order to detect the rotation direction of the motor 6.
1 and B2, which are sent to the other input terminal of the reversible counter 2 via the stop controller 3 and the encoder interface 10.
次に第2図は、上記停止制御器3の内部の構成を示して
いる。この停止制御器3は、停止制御手段としてのデー
タセレクタ11および第2の比較手段としてのマグニチ
ュードコンパレータ12のほか、ゼロ検出回路13を備
えている。Next, FIG. 2 shows the internal configuration of the stop controller 3. As shown in FIG. The stop controller 3 includes a data selector 11 as a stop control means, a magnitude comparator 12 as a second comparison means, and a zero detection circuit 13.
上記データセレクタ11は、ROMなどによって構成さ
れており、停止時の制御信号Gとして、予め複数例えば
3つの「0」パターン、「+1」パターンおよび「−1
」パターンなどを記憶しており、上記マグニチュードコ
ンパレータ12の比較結果に応じて、上記パターンのう
ちいずれか1つを選択的に出力する。また、上記ゼロ検
出回路13は、可逆カウンタ2と、データセレクタ11
との間に介在し、モータ6の停止すべき位置、すなわち
カウント値「0」を検出している。また、マグニチュー
ドコンパレータ12は、CPUなどで構成されており、
予め入力された設定値Hと、ロータリエンコーダ8から
のパルス出力Bl、B2との大小関係を比較し、その結
果に応じて、デ−タセレクタ11の選択動作を指定する
ために設けられている。なお、マグニチュードコンパレ
ータ12の入力側のエクスクリユーシブオアゲート14
は、パルス出力B1、B2の実際の位相の順番を揃える
ために設けられている。The data selector 11 is constituted by a ROM, etc., and has a plurality of, for example, three "0" patterns, "+1" patterns, and "-1" patterns, as the control signal G at the time of stop.
'' patterns, etc., and selectively outputs one of the patterns according to the comparison result of the magnitude comparator 12. The zero detection circuit 13 also includes a reversible counter 2 and a data selector 11.
, and detects the position where the motor 6 should stop, that is, the count value "0". Furthermore, the magnitude comparator 12 is composed of a CPU, etc.
It is provided to compare the magnitude relationship between the pre-input set value H and the pulse outputs B1 and B2 from the rotary encoder 8, and to designate the selection operation of the data selector 11 according to the result. Note that the exclusive or gate 14 on the input side of the magnitude comparator 12
is provided to align the actual phase order of the pulse outputs B1 and B2.
発明の作用
最初に、オペレータによってマグニチュードコンパレー
タ12の一方の入力端に、予め設定値Hとして、例えば
「1.0=2」の定義が入力される。またオペレータは
、パルス出力B1、B2の4通りの組み合わせについて
後記の表に示すような大きさの数値Bを設定するととも
に、データセレクタ11に制御信号Gとして「0」パタ
ーン、「−1」パターン、および「+1」パターンをそ
れぞれ記憶させる。Effect of the Invention First, an operator inputs a definition of "1.0=2", for example, as a preset value H into one input terminal of the magnitude comparator 12 in advance. In addition, the operator sets a numerical value B of the magnitude as shown in the table below for the four combinations of pulse outputs B1 and B2, and also sets a "0" pattern and a "-1" pattern as the control signal G to the data selector 11. , and "+1" patterns are respectively stored.
さて、最初に制御系に、制御回路側から指令値Aが可逆
カウンタ2の一方の入力端に与えられる。First, a command value A is given to one input terminal of the reversible counter 2 from the control circuit side to the control system.
この初期の状態では、そのカウント値Cが「0」でない
ため、そのカウント値Cの値は、そのまま停止制御器3
を通過し、D−A変換器4によりアナログ量の指令信号
りとなって、速度サーボ増幅器5に送り込まれる。そこ
で、速度サーボ増幅器5は、指令信号りに比例する駆動
信号Eを発生し、これによって制御対象のモータ6の回
転速度を決定し、それを回転させる。このモータ6の回
転速度は、速度検出器7によって検出され、速度フィー
ドバンク信号Fとして加え合わせ点9に負帰還される。In this initial state, the count value C is not "0", so the value of the count value C remains unchanged at the stop controller 3.
The signal is converted into an analog command signal by the DA converter 4 and sent to the speed servo amplifier 5. Therefore, the speed servo amplifier 5 generates a drive signal E that is proportional to the command signal, thereby determining the rotational speed of the motor 6 to be controlled and causing it to rotate. The rotational speed of the motor 6 is detected by a speed detector 7 and is negatively fed back to a summing point 9 as a speed feed bank signal F.
一方、モータ6の回転量は、ロータリエンコーダ8によ
って、第3図に示すようなパルス出力B1、B2のパル
ス数として検出され、そのうちパルス出力B1は、エン
コーダインターフェイス10を経て、可逆カウンタ2の
他方の入力端に減算値として帰還される。このようにし
て、可逆カウンタ2のカウント値Cは、設定値Aと実際
の回転量との差に対応する偏差値となるため、それ以降
に、モータ6は、その偏差値に比例した状態で制御され
ることになる。On the other hand, the rotation amount of the motor 6 is detected by the rotary encoder 8 as the number of pulse outputs B1 and B2 as shown in FIG. is fed back to the input terminal as a subtracted value. In this way, the count value C of the reversible counter 2 becomes a deviation value corresponding to the difference between the set value A and the actual rotation amount, so that from then on, the motor 6 is in a state proportional to the deviation value. It will be controlled.
ところで可逆カウンタ2のカウント値Cが「0」となっ
たとき、すなわち制御対象のモータ6が第3図に示す停
止域にあるとき、ゼロ検出器13は、その状態を検出し
て、データセレクタ11に、停止制御のために1つの条
件を与える。一方、マグニチュードコンパレータ12は
、パルス出力B1、B2の組み合わせに基づく大きさの
数値Bと設定値Hとを比較し、その比較結果に対応した
データをデータセレクタ11に他の1つの選択条件とし
て出力している。そこで、データセレクタ11は、(H
−B)>Oのとき、制御信号Gから「+1」パターンを
出力し、また(H−B)<0のとき、「−1」パターン
を出力し、さらに(H−B)=0のときに「0」パター
ンを選択的に出力する。By the way, when the count value C of the reversible counter 2 becomes "0", that is, when the motor 6 to be controlled is in the stop region shown in FIG. 11, one condition is given for stop control. On the other hand, the magnitude comparator 12 compares a numerical value B of the magnitude based on the combination of pulse outputs B1 and B2 with a set value H, and outputs data corresponding to the comparison result to the data selector 11 as another selection condition. are doing. Therefore, the data selector 11 (H
When -B)>O, a "+1" pattern is output from the control signal G, and when (H-B)<0, a "-1" pattern is output, and when (H-B)=0, a "-1" pattern is output. selectively outputs a “0” pattern.
この結果、第3図に示すように、制御対象のモータ6の
停止域すなわちカウント値C=0の範囲が4分割され、
その分割後の停止範囲で、モータ6の停止位置が決定さ
れる。このため、この制御1系でのモータ6の位置決め
精度は、従来のものに比較して4倍に高められているこ
とになる。しかも、この実際の停止位置は、設定値Hの
数値設定Gとよって、カウント値C=0の1/4の範囲
で自由に設定できる。As a result, as shown in FIG. 3, the stop range of the motor 6 to be controlled, that is, the range of count value C=0, is divided into four,
The stop position of the motor 6 is determined in the stop range after the division. Therefore, the positioning accuracy of the motor 6 in this control system 1 is increased four times compared to the conventional system. Moreover, this actual stopping position can be freely set within the range of 1/4 of the count value C=0 by the numerical value setting G of the set value H.
なお、既に述べたように、上記エクスクリユーシブオア
ゲート14は、数値Bの設定との関係で、rO−1−3
−2Jの変化をro−1−2−34の関係に直すために
設けられており、必要に応じて省略することもできる。As already mentioned, the exclusive or gate 14 has rO-1-3 in relation to the setting of numerical value B.
It is provided to correct the change in -2J to the relationship ro-1-2-34, and can be omitted if necessary.
発明の変形例
上記実施例は、ロータリエンコーダ8からの2相のパル
ス出力B1、B2を利用しているが、この異なる位相の
パルス出力の数は、2相に限らず、3以上であってもよ
い。このように位相の数が多くなれば、それだけ停止域
の分割数が多くなるため、高い精度の停止位置が確保で
きる。また、上記データセレクタ11は、一般的な回路
要素として、ROMなどによって構成されるが、上記実
施例のように2相のパルス出力B1、B2に対しては、
単なるエクスクリユーシブオアゲートとパターン発生回
路などの組み合わせによっても実現できる。Modifications of the Invention The above embodiment utilizes two-phase pulse outputs B1 and B2 from the rotary encoder 8, but the number of pulse outputs of different phases is not limited to two phases, but may be three or more. Good too. As the number of phases increases in this manner, the number of divisions of the stop area increases accordingly, and a highly accurate stop position can be ensured. Further, the data selector 11 is constituted by a ROM or the like as a general circuit element, but for two-phase pulse outputs B1 and B2 as in the above embodiment,
It can also be realized by simply combining an exclusive OR gate and a pattern generation circuit.
発明の効果
本発明では、ディジタル制御系や、フィードバック系の
制御要素の精度を高めることなく、制御対象の位置決め
精度が停止域の分割数に応じて高められ、またこのよう
な効果が従来の制御系に停止制御器を追加するのみで実
用化できるため、高精度の位置決め精度が安価に、しか
も従来装置の一部改良のみで具体化できる。Effects of the Invention In the present invention, the positioning accuracy of the controlled object is increased according to the number of divisions of the stop area without increasing the accuracy of the digital control system or the control elements of the feedback system. Since it can be put into practical use by simply adding a stop controller to the system, high positioning accuracy can be achieved at low cost and with only some improvements to conventional equipment.
第1図は本発明の高精度位置決め装置のブロック線図、
第2図は停止制御器のブロック線図、第3図は動作時の
波形図である。
■・・高精度位置決め装置、2・・可逆カウンタ、3・
・停止制御器、4・・D−A変換器、5・・速度サーボ
増幅器、6・・モータ、8・・ロータリエンコーダ、1
1・・データセレクタ、12・・マグニチュードコンパ
レータ、13・・ゼロ検出回路。
3、 第2図
第3図FIG. 1 is a block diagram of a high-precision positioning device of the present invention;
FIG. 2 is a block diagram of the stop controller, and FIG. 3 is a waveform diagram during operation. ■... High precision positioning device, 2... Reversible counter, 3...
・Stop controller, 4...D-A converter, 5...Speed servo amplifier, 6...Motor, 8...Rotary encoder, 1
1...Data selector, 12...Magnitude comparator, 13...Zero detection circuit. 3. Figure 2 Figure 3
Claims (1)
ロータリエンコーダの出力値とを比較する第1の比較手
段とを備え、上記第1の比較手段の一致信号で上記回転
部材を停止させる位置決め装置において、位相のずれた
複数のパルス出力を発生するロータリエンコーダをもち
、複数の制御信号を記憶しこれらのうちの1つを選択的
に出力する停止制御手段と、予め指定した設定値と上記
ロータリエンコーダからの複数のパルス出力の位相とを
比較する第2の比較手段とを備え、第1の比較手段およ
び第2の比較手段がともに一致信号を出力したとき、上
記停止制御手段から上記回転部材を停止させるための制
御信号を出力することを特徴とする高精度位置決め装置
。A positioning device comprising a rotary encoder provided on a rotating member and a first comparing means for comparing a command value and an output value of the rotary encoder, and stopping the rotating member in response to a coincidence signal from the first comparing means. , a stop control means having a rotary encoder that generates a plurality of phase-shifted pulse outputs, a stop control means that stores a plurality of control signals and selectively outputs one of them, a prespecified setting value, and the rotary encoder. and a second comparison means for comparing the phases of the plurality of pulse outputs from the stop control means, and when the first comparison means and the second comparison means both output matching signals, the stop control means controls the rotating member. A high-precision positioning device characterized by outputting a control signal for stopping.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP61162559A JP2649513B2 (en) | 1986-07-09 | 1986-07-09 | High precision positioning device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP61162559A JP2649513B2 (en) | 1986-07-09 | 1986-07-09 | High precision positioning device |
Publications (2)
Publication Number | Publication Date |
---|---|
JPS6318413A true JPS6318413A (en) | 1988-01-26 |
JP2649513B2 JP2649513B2 (en) | 1997-09-03 |
Family
ID=15756888
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP61162559A Expired - Lifetime JP2649513B2 (en) | 1986-07-09 | 1986-07-09 | High precision positioning device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2649513B2 (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2018136696A (en) * | 2017-02-21 | 2018-08-30 | オムロン株式会社 | Motor controller |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS59208614A (en) * | 1983-05-13 | 1984-11-27 | Hitachi Ltd | Method for controlling positional information of encoder motor |
JPS61100818A (en) * | 1984-10-23 | 1986-05-19 | エヌ・シー・アール・カナダ・リミテッド― エヌ・シー・アール・カナダ・エル・テイー・イー・イー | Fine/rough positioning controller |
JPS61120968A (en) * | 1984-11-19 | 1986-06-09 | Matsushita Electric Ind Co Ltd | Generation circuit for direction of rotation pulse |
-
1986
- 1986-07-09 JP JP61162559A patent/JP2649513B2/en not_active Expired - Lifetime
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS59208614A (en) * | 1983-05-13 | 1984-11-27 | Hitachi Ltd | Method for controlling positional information of encoder motor |
JPS61100818A (en) * | 1984-10-23 | 1986-05-19 | エヌ・シー・アール・カナダ・リミテッド― エヌ・シー・アール・カナダ・エル・テイー・イー・イー | Fine/rough positioning controller |
JPS61120968A (en) * | 1984-11-19 | 1986-06-09 | Matsushita Electric Ind Co Ltd | Generation circuit for direction of rotation pulse |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2018136696A (en) * | 2017-02-21 | 2018-08-30 | オムロン株式会社 | Motor controller |
US10948893B2 (en) | 2017-02-21 | 2021-03-16 | Omron Corporation | Motor control device |
Also Published As
Publication number | Publication date |
---|---|
JP2649513B2 (en) | 1997-09-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR930008332B1 (en) | Spindle position and speed control device | |
JPS62162968A (en) | Speed detecting device | |
US5058145A (en) | System for determining the position of movable machine parts | |
CA1154521A (en) | Angular position controller | |
US4204257A (en) | Numerical control resolver position measuring device | |
US3562619A (en) | A control system for selectively positioning an output member | |
US4034276A (en) | Digital signal processor for servo velocity control | |
US3984831A (en) | Tracking digital angle encoder | |
US4982413A (en) | Method and device for evaluating signals of an incremental pulse generator | |
JPS6318413A (en) | Highly precise positioning device | |
JP3401971B2 (en) | Digital servo device | |
JPS6110715A (en) | Absolute-position detecting system | |
JPS6173002A (en) | Angle detecting device | |
US4308525A (en) | Dual speed resolver to digital converter with improved course-fine interlock | |
JPH0219720B2 (en) | ||
JPH0421098A (en) | Encoder signal detection circuit | |
JPS6234210A (en) | Detector for original point position | |
JPS60222719A (en) | Displacement converter | |
SU1277064A1 (en) | Device for generating error signal | |
JPS61290512A (en) | Multipoint position control system | |
SU1522060A1 (en) | Source of reference signal to balancing machine | |
JPS6399793A (en) | Method of controlling synchronous motor | |
SU1185312A1 (en) | Device for controlling positional drive | |
JPH01135447A (en) | Absolute position detector | |
JPS6181185A (en) | Digital servo controlling method |