JPH095115A - Position detection circuit - Google Patents

Position detection circuit

Info

Publication number
JPH095115A
JPH095115A JP15490995A JP15490995A JPH095115A JP H095115 A JPH095115 A JP H095115A JP 15490995 A JP15490995 A JP 15490995A JP 15490995 A JP15490995 A JP 15490995A JP H095115 A JPH095115 A JP H095115A
Authority
JP
Japan
Prior art keywords
angle information
load
output
motor
predetermined 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.)
Granted
Application number
JP15490995A
Other languages
Japanese (ja)
Other versions
JP3329142B2 (en
Inventor
Kenji Inoue
堅治 井上
Katsuyoshi Nakano
克好 中野
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shinko Electric Co Ltd
Original Assignee
Shinko Electric Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Shinko Electric Co Ltd filed Critical Shinko Electric Co Ltd
Priority to JP15490995A priority Critical patent/JP3329142B2/en
Publication of JPH095115A publication Critical patent/JPH095115A/en
Application granted granted Critical
Publication of JP3329142B2 publication Critical patent/JP3329142B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Abstract

PURPOSE: To provide a position detection circuit which is constituted at low costs, by which a position can be detected with high accuracy and which enhances the degree of freedom regarding the installation of the driving mechanism of a servomotor. CONSTITUTION: A pulse signal which is outputted from an incremental encoder 1 is counted by a counter 2, and a counted value is outputted to a frequency divider 3 as angle information on a motor. Then, the angle information on the motor is converted into angle information on a load by the frequency divider 3. Then, in an instruction generator 4, detection position information, on a load,, which is outputted from the outside is made to correspond to the angle information on the motor on the basis of the angle information on the load by the frequency divider 3 and on the basis of the counted value which is outputted from the counter 2. After that, in a comparator 5, the detection position information is compared with the counted value by the counter 2. When they become an identical value, a position detection signal is outputted.

Description

【発明の詳細な説明】Detailed Description of the Invention

【0001】[0001]

【産業上の利用分野】この発明は、サーボモータの制御
に用いて好適な位置検出回路に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a position detecting circuit suitable for controlling a servomotor.

【0002】[0002]

【従来の技術】従来より、サーボモータによる負荷の位
置制御は、その負荷の位置または回転角度を検出するこ
とで行っている。図4に、従来のサーボモータの駆動機
構を示す。この図において、20はサーボモータであ
り、負荷であるテーブル23の位置制御を行う。また、
20aはサーボモータ20の駆動軸である。1はサーボ
モータ20の構成部品であるインクリメンタルエンコー
ダであり、駆動軸20aの回転に応じて等角度間隔毎に
パルス信号を出力する。21は歯数がP(Pは整数)の
駆動ギアであり、駆動軸20aに取り付けられている。
2. Description of the Related Art Conventionally, position control of a load by a servo motor has been performed by detecting the position or rotation angle of the load. FIG. 4 shows a conventional servomotor drive mechanism. In this figure, reference numeral 20 is a servo motor which controls the position of a table 23 which is a load. Also,
Reference numeral 20a is a drive shaft of the servomotor 20. Reference numeral 1 denotes an incremental encoder which is a component of the servo motor 20, and outputs a pulse signal at equal angular intervals according to the rotation of the drive shaft 20a. Reference numeral 21 denotes a drive gear having a number of teeth P (P is an integer), which is attached to the drive shaft 20a.

【0003】22は歯数がQ(Qは整数)の被動ギアで
あり、テーブル23の回転軸に取り付けられ駆動ギア2
1と噛み合う。したがって、サーボーモータ20の駆動
軸20aの回転は、駆動ギア21および被動ギア22を
介してテーブル23に伝えられる。また、この時のギア
比はQ/Pとなる。24はセンサであり、テーブル23
の縁部に付けられたマーカーを検出し、該マーカーを検
出した場合は検出信号を出力する。
Reference numeral 22 denotes a driven gear having a number of teeth of Q (Q is an integer), which is attached to a rotary shaft of a table 23 and is a driving gear
Engage with 1. Therefore, the rotation of the drive shaft 20 a of the servo motor 20 is transmitted to the table 23 via the drive gear 21 and the driven gear 22. Further, the gear ratio at this time is Q / P. 24 is a sensor, the table 23
The marker attached to the edge of the is detected, and when the marker is detected, a detection signal is output.

【0004】上述したサーボモータの駆動機構において
は、インクリメンタルエンコーダ1から出力されるパル
ス信号およびセンサ24から出力される位置検出信号に
基づいて、サーボモータ20の速度制御やテーブル23
の位置制御を行っている。また、この種の駆動機構の中
には、センサ24の代わりとして、テーブル23の回転
軸に回転角度を絶対値で出力するアブソリュートエンコ
ーダ25を取り付けたものがある。このような駆動機構
においては、アブソリュートエンコーダ25から出力さ
れる角度情報をテーブル23の絶対位置情報とし、これ
に基づいてテーブル23の位置制御を行う。
In the servo motor drive mechanism described above, the speed control of the servo motor 20 and the table 23 are performed based on the pulse signal output from the incremental encoder 1 and the position detection signal output from the sensor 24.
Position control. Further, in this type of drive mechanism, an absolute encoder 25 that outputs a rotation angle as an absolute value is attached to the rotation shaft of the table 23 instead of the sensor 24. In such a drive mechanism, the angle information output from the absolute encoder 25 is used as the absolute position information of the table 23, and the position control of the table 23 is performed based on this.

【0005】[0005]

【発明が解決しようとする課題】ところで、センサ24
から出力される位置検出信号に基づいてテーブル23の
位置制御を行うサーボモータの駆動機構においては、テ
ーブル23の位置検出精度が低く、また、複数の位置を
検出する必要がある場合それに応じてセンサの数を増や
さなくてはならず、コストアップや、センサの取付位置
等の問題があった。
By the way, the sensor 24
In the drive mechanism of the servomotor that controls the position of the table 23 based on the position detection signal output from the table 23, the position detection accuracy of the table 23 is low, and when it is necessary to detect a plurality of positions, the sensor is adjusted accordingly. However, there are problems such as an increase in cost and the mounting position of the sensor.

【0006】また、センサ24の代わりにアブソリュー
トエンコーダ25を用いたサーボモータの駆動機構にお
いては、アブソリュートエンコーダ自体が高価であり、
また、駆動機構の設置位置の関係で、負荷側の回転軸に
アブソリュートエンコーダを取り付けることができない
場合があるといった問題があった。
Further, in the drive mechanism of the servo motor using the absolute encoder 25 instead of the sensor 24, the absolute encoder itself is expensive,
Further, there is a problem that the absolute encoder may not be attached to the rotating shaft on the load side due to the installation position of the drive mechanism.

【0007】この発明は、上記の点に鑑みてなされたも
のであり、安価な構成で高精度の位置検出を可能とする
位置検出回路を提供することを目的としている。
The present invention has been made in view of the above points, and it is an object of the present invention to provide a position detection circuit which enables highly accurate position detection with an inexpensive structure.

【0008】[0008]

【課題を解決するための手段】請求項1記載の発明は、
モータにより所定のギア比を介して回転制御される負荷
の所定位置を検出する位置検出回路において、前記モー
タの回転に応じて該モータの角度情報を順次出力する角
度情報出力手段と、今回入力された前記モータの角度情
報と前回入力された前記モータの角度情報との変化量を
検出する変化量検出手段と、該変化量検出手段が出力す
る変化量を前記負荷の角度変化量に変換する変化量変換
手段と、該変化量変換手段から出力された前記負荷の角
度変化量と、前回得られた負荷の角度情報とに基づい
て、前記今回入力されたモータの角度情報に対する負荷
の角度情報を出力する負荷角度出力手段と、該負荷角度
出力手段から出力される負荷の角度情報が、予め設定さ
れた周期に従って出力されるよう処理する周期処理手段
と、該周期処理手段から出力される負荷の角度情報に基
づいて前記負荷の所定位置を検出する所定位置検出手段
とを具備することを特徴とする位置検出回路である。
According to the first aspect of the present invention,
In a position detection circuit that detects a predetermined position of a load that is rotationally controlled by a motor through a predetermined gear ratio, an angle information output unit that sequentially outputs angle information of the motor according to the rotation of the motor, and an input this time. Change amount detecting means for detecting a change amount between the motor angle information and the previously input motor angle information, and a change amount for converting the change amount output by the change amount detecting means into the load angle change amount. Based on the load angle change amount output from the amount conversion unit, the change amount conversion unit, and the load angle information obtained last time, the load angle information with respect to the motor angle information input this time is displayed. Load angle output means for outputting, cycle processing means for processing so that the load angle information outputted from the load angle output means is outputted in accordance with a preset cycle, and the cycle processing means. A position detecting circuit, characterized by comprising a position detecting means for detecting a predetermined position of the load based on the angle information of al the outputted loads.

【0009】請求項2記載の発明は、前記所定位置検出
手段は、前記所定位置に対応する負荷の角度情報が予め
入力され、前記順次出力されるモータの角度情報と前記
周期処理手段から出力される負荷の角度情報とに基づい
て、前記所定位置に対応する負荷の角度情報を、モータ
の角度情報に対応させる検出角度変換手段と、該検出角
度変換手段から出力されるモータの角度情報と、前記角
度情報出力手段から順次出力されるモータの角度情報と
を比較し、双方の角度情報が一致した場合に位置検出信
号を出力する位置検出信号出力手段とからなることを特
徴とする請求項1記載の位置検出回路である。
According to a second aspect of the present invention, the predetermined position detecting means is preliminarily inputted with load angle information corresponding to the predetermined position, and is sequentially outputted from the motor angle information and the cycle processing means. Load angle information of the load, the angle information of the load corresponding to the predetermined position, the detection angle conversion unit that corresponds to the angle information of the motor, and the angle information of the motor output from the detection angle conversion unit, 2. A position detection signal output unit for comparing the angle information of the motor sequentially output from the angle information output unit and outputting a position detection signal when both angle information match. It is the described position detection circuit.

【0010】請求項3記載の発明は、前記検出角度変換
手段は、前記所定位置に対応する負荷の角度情報と前記
周期処理手段から出力される現時点の負荷の角度情報と
の差を求めると共に、前記所定位置に対応する負荷の角
度情報の、前記周期処理手段から出力される負荷の角度
情報の最小値および最大値間の範囲内における位置を判
断し、該位置に応じて前記求めた差に前記予め設定され
た周期の値を加算または減算を行うか、もしくは該加減
算を行わないかを決定し、その結果得られた値を前記ギ
ア比に基づいて前記モータの角度情報に換算して該換算
結果を現時点のモータの角度情報に加算することによっ
て前記所定位置に対応する負荷の角度情報をモータの角
度情報に対応させることを特徴とする請求項2記載の位
置検出回路である。
According to a third aspect of the present invention, the detected angle conversion means obtains a difference between the load angle information corresponding to the predetermined position and the current load angle information output from the cycle processing means, and The position of the load angle information corresponding to the predetermined position within the range between the minimum value and the maximum value of the load angle information output from the cycle processing means is determined, and the determined difference is determined according to the position. It is determined whether the value of the preset cycle is added or subtracted, or the addition or subtraction is not performed, and the value obtained as a result is converted into angle information of the motor based on the gear ratio. 3. The position detection circuit according to claim 2, wherein the load angle information corresponding to the predetermined position is made to correspond to the motor angle information by adding the conversion result to the current motor angle information.

【0011】請求項4記載の発明は、駆動軸の回転に応
じて等角度間隔毎にパルス信号を出力するインクリメン
タルエンコーダを内蔵したサーボモータによって、所定
のギア比を介して回転制御される負荷の所定位置を検出
する位置検出回路において、前記インクリメンタルエン
コーダから出力されるパルス信号を順次計数して出力す
るカウンタと、前記カウンタから出力される計数値と、
前記ギア比とに基づいて、前記サーボモータによって回
転させられた前記負荷の角度に対応する負荷の角度情報
を、予め設定された周期に従って出力する分周器と、前
記カウンタから順次出力される計数値と、前記分周器か
ら出力される負荷の角度情報とに基づいて、予め設定さ
れた負荷の所定位置に対応する角度情報を、前記カウン
タから順次出力される計数値に準じて変換し、該計数値
に準じた前記所定位置の角度情報を検出指令情報として
出力する指令発生器と、該指令発生器から出力される検
出指令情報の値と前記カウンタから順次出力される計数
値とを比較し、同じ値になった時に位置検出信号を出力
する比較器とを具備することを特徴とする位置検出回路
である。
According to a fourth aspect of the present invention, a load of which rotation is controlled via a predetermined gear ratio by a servo motor having a built-in incremental encoder that outputs a pulse signal at equal angular intervals according to the rotation of the drive shaft. In a position detection circuit that detects a predetermined position, a counter that sequentially counts and outputs pulse signals output from the incremental encoder, and a count value output from the counter,
A frequency divider that outputs load angle information corresponding to the angle of the load rotated by the servo motor based on the gear ratio in accordance with a preset cycle, and a counter that sequentially outputs from the counter. Based on the numerical value and the angle information of the load output from the frequency divider, the angle information corresponding to the predetermined position of the preset load is converted according to the count value sequentially output from the counter, A command generator that outputs angle information of the predetermined position according to the count value as detection command information, and a value of the detection command information output from the command generator and a count value sequentially output from the counter And a comparator that outputs a position detection signal when the values become the same, a position detection circuit.

【0012】[0012]

【作用】請求項1記載の発明による位置検出回路におい
ては、モータの角度情報の変化量を求め、それを負荷の
角度変化に変換し、その変換結果と前回の負荷の角度情
報に基づいて上記モータの角度変化量に応じた負荷の角
度情報を求め、求めた負荷の角度情報を予め設定された
周期に従って出力する。このため、負荷の角度情報を任
意の周期で発生させることができる。このため、直接負
荷側の位置または角度を検出することなく該負荷の所定
位置を検出することができるばかりでなく、負荷の角度
情報を所望する周期で発生させることができる。
In the position detecting circuit according to the first aspect of the present invention, the amount of change in the angle information of the motor is obtained, converted into an angle change of the load, and based on the conversion result and the previous angle information of the load, The load angle information corresponding to the angle change amount of the motor is obtained, and the obtained load angle information is output according to a preset cycle. Therefore, the load angle information can be generated at an arbitrary cycle. Therefore, not only the position or angle of the load side can be directly detected but also the predetermined position of the load can be detected, and the angle information of the load can be generated at a desired cycle.

【0013】請求項2記載の発明による位置検出回路に
おいては、負荷の所定位置に対応した角度情報をモータ
の角度情報に対応させ、その負荷の所定位置に対応した
モータの角度情報と順次出力されるモータの角度情報と
に基づいて位置検出信号が出力される。これにより、負
荷における所定位置の判定が、負荷の角度情報の元とな
るモータの角度情報に基づいてなされるため、正確な位
置検出を行うことができる。
In the position detecting circuit according to the second aspect of the present invention, the angle information corresponding to the predetermined position of the load is made to correspond to the angle information of the motor, and the angle information of the motor corresponding to the predetermined position of the load is sequentially output. A position detection signal is output based on the motor angle information. As a result, the predetermined position in the load is determined based on the angle information of the motor that is the basis of the angle information of the load, so that accurate position detection can be performed.

【0014】請求項3記載の発明による位置検出回路
は、順次出力される負荷の角度情報の出力範囲内におけ
る所定位置に対応した負荷の角度情報の位置を判断し、
判断した位置に応じて、前記所定位置に対応した負荷の
角度情報と順次出力される負荷の角度情報との差に予め
設定した周期の値を加算または減算あるいはこの加減算
の不実行のいずれかを行い、その結果をモータの角度情
報に換算した後それを現時点のモータ角度情報に加算す
ることで、前記所定位置に対応した負荷の角度情報をモ
ータの角度情報に対応させる。これにより、所定位置に
対応した負荷の角度情報が負荷の角度情報の出力範囲内
の何処であっても正確に前記所定位置に対応した負荷の
角度情報をモータの角度情報に対応させることが可能と
なる。
The position detecting circuit according to the third aspect of the present invention determines the position of the load angle information corresponding to a predetermined position within the output range of the load angle information that is sequentially output,
Depending on the determined position, addition or subtraction of a preset cycle value to the difference between the load angle information corresponding to the predetermined position and the load angle information sequentially output, or non-execution of this addition or subtraction is performed. The angle information of the load corresponding to the predetermined position is made to correspond to the angle information of the motor by converting the result into the angle information of the motor and adding it to the current motor angle information. This makes it possible to accurately associate the load angle information corresponding to the predetermined position with the motor angle information regardless of where the load angle information corresponding to the predetermined position is within the output range of the load angle information. Becomes

【0015】請求項4記載の発明による位置検出回路
は、サーボモータに内蔵されたインクリメンタルエンコ
ーダから順次出力されるパルスを計数し、この計数値に
基づいて負荷の回転角度を求め、求めた負荷の回転角度
と上記計数値とにより負荷の所定位置に対応する角度情
報がモータの角度情報に準じて変換され、それを上記計
数値と比較し、一致した場合に位置検出信号を出力す
る。このため、安価な構成で高精度の位置検出を行うこ
とができる。
According to the fourth aspect of the present invention, the position detection circuit counts the pulses sequentially output from the incremental encoder built in the servo motor, calculates the rotation angle of the load based on the counted value, and calculates the load rotation angle. The angle information corresponding to the predetermined position of the load is converted according to the angle information of the motor based on the rotation angle and the above-mentioned count value, which is compared with the above-mentioned count value, and when they match, a position detection signal is output. Therefore, highly accurate position detection can be performed with an inexpensive configuration.

【0016】[0016]

【実施例】以下、図面を参照してこの発明の一実施例に
ついて説明する。図1は、本実施例における位置検出回
路の構成を示すブロック図である。また、本実施例にお
ける位置検出回路は、図4に示すサーボモータの駆動機
構(但し、センサ24およびアブソリュートエンコーダ
25は除く)に適用されるものとして説明する。
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS An embodiment of the present invention will be described below with reference to the drawings. FIG. 1 is a block diagram showing the configuration of the position detection circuit in this embodiment. Further, the position detection circuit in this embodiment will be described as being applied to the drive mechanism of the servo motor shown in FIG. 4 (excluding the sensor 24 and the absolute encoder 25).

【0017】図1において、1はインクリメンタルエン
コーダ(パルス発生器)であり、前述したように、サー
ボーモータの駆動軸20aの回転に応じて等角度間隔毎
にパルス信号を出力する。ここでは、駆動軸20aが1
回転する毎にパルス信号を出力するものとする。2はカ
ウンタであり、インクリメンタルエンコーダ1から出力
されるパルスをカウントし、このカウント値を駆動軸2
0aの角度情報(以下、駆動軸角度情報という)θ
m(k) として出力する。
In FIG. 1, reference numeral 1 denotes an incremental encoder (pulse generator), which outputs pulse signals at equal angular intervals according to the rotation of the drive shaft 20a of the servomotor, as described above. Here, the drive shaft 20a is 1
A pulse signal shall be output each time it rotates. Reference numeral 2 denotes a counter, which counts the pulses output from the incremental encoder 1 and uses this count value as the drive axis 2
Angle information of 0a (hereinafter referred to as drive axis angle information) θ
Output as m (k).

【0018】ここで、本実施例においてカウンタ2とし
て16ビットのバイナリカウンタを使用するものとす
る。したがって、上記駆動軸角度情報は、0000から
FFFFの範囲で順次出力され、また、1カウントアッ
プされる毎に駆動軸が1回転したことになる。
In this embodiment, a 16-bit binary counter is used as the counter 2. Therefore, the drive shaft angle information is sequentially output in the range of 0000 to FFFF, and the drive shaft makes one rotation for each count up.

【0019】3は分周器(角度情報変換手段)であり、
カウンタ2から出力されるカウント値を、駆動ギア21
の歯数P、被動ギア22の歯数Q(但しP<Q)および
テーブル23の1回転当たりの角度検出ポイント総数T
(以下、周期Tという)に基づいて、テーブル23の回
転に対応したポイント数を計数し、これを、テーブル2
3の角度情報(以下、負荷角度情報という)θL(k)
として出力する。
Reference numeral 3 is a frequency divider (angle information conversion means),
The count value output from the counter 2 is used as the drive gear 21.
Number of teeth P of the driven gear 22, the number of teeth Q of the driven gear 22 (where P <Q), and the total number T of angle detection points per rotation of the table 23.
Based on (hereinafter, referred to as cycle T), the number of points corresponding to the rotation of the table 23 is counted, and this is calculated as the table 2
Angle information of 3 (hereinafter referred to as load angle information) θ L (k)
Output as

【0020】本実施例においては、駆動ギア21の歯数
Pを10、被動ギア22の歯数Qを100とし、したが
ってギア比は10となる。また、テーブル23の1回転
当たりの角度検出ポイント総数Tを360とし、分周器
3は負荷角度情報θL(k)として、0から359の数
値をテーブル23の回転角度に応じて出力するものとす
る。
In this embodiment, the number of teeth P of the drive gear 21 is 10, and the number of teeth Q of the driven gear 22 is 100, so that the gear ratio is 10. Further, the total number T of angle detection points per rotation of the table 23 is set to 360, and the frequency divider 3 outputs a numerical value from 0 to 359 as load angle information θ L (k) according to the rotation angle of the table 23. And

【0021】4は指令発生器であり、テーブル23の検
出位置を分周器3の出力値に対応した値(固定値)に対
応させて表した検出位置情報θL *、負荷角度情報θ
L(k)、ギア比P/Qおよび、駆動軸角度情報θ
m(k)とに基づいて、検出位置情報θL *に対応した駆
動軸20a側の検出位置情報(以下、駆動側位置検出情
報という)θm *(k)を出力する。
Reference numeral 4 denotes a command generator, which detects detected position information θ L * and load angle information θ in which the detected position of the table 23 is represented by a value (fixed value) corresponding to the output value of the frequency divider 3.
L (k), gear ratio P / Q, and drive axis angle information θ
Based on m (k), the detection position information on the drive shaft 20a side corresponding to the detection position information θ L * (hereinafter referred to as drive side position detection information) θ m * (k) is output.

【0022】すなわち、テーブル23の検出位置を原点
から90゜回転した位置と定めた場合、本実施例におい
ては検出位置情報θL *が90となり、指令発生器4は、
この検出位置情報θL *を駆動軸角度情報に対応させるの
で、駆動側位置検出情報θm *(k)は、テーブル23が
1回転する毎に1194,1FA4,2DB4,……と
変化していく。
That is, when the detection position of the table 23 is defined as a position rotated 90 ° from the origin, the detection position information θ L * becomes 90 in this embodiment, and the command generator 4
Since the detected position information θ L * corresponds to the drive axis angle information, the drive side position detection information θ m * (k) changes to 1194, 1FA4, 2DB4, ... Every time the table 23 makes one rotation. Go.

【0023】また、指令発生器4に入力されるθ0は、
検出位置情報θL *を駆動軸角度情報に対応させる際に必
要となる値であり、これについては後に詳述する。
Further, θ 0 input to the command generator 4 is
It is a value required when the detected position information θ L * is associated with the drive axis angle information, which will be described in detail later.

【0024】5は比較器であり、駆動側位置検出情報θ
m *(k)と駆動軸角度情報θm(k)とを比較し、両者
の値が等しくなった場合、位置検出信号を出力する。6
はスイッチであり、指令発生器4から出力禁止信号(後
述する)が出力された場合OFFになり、比較器5から
出力される位置検出信号を強制的にOFFにする。
Reference numeral 5 denotes a comparator, which is drive side position detection information θ.
The drive axis angle information θ m (k) is compared with m * (k), and when the two values are equal, a position detection signal is output. 6
Is a switch, which is turned off when an output inhibit signal (described later) is output from the command generator 4, and forcibly turns off the position detection signal output from the comparator 5.

【0025】次に、図2を参照して上述した位置検出回
路の分周器3の構成について説明する。図2において、
10はメモリであり、前回入力された駆動側位置情報θ
m(k−1)を記憶する。11は減算器であり、入力さ
れた駆動軸角度情報θm(k)と、前回入力された駆動
軸角度情報θm(k−1)との差Δθm(k)を出力す
る。また、例えばカウンタ2がフルカウント値(FFF
F)から0000にカウントアップされると、減算器1
1は前回値(FFFF)との差を1として出力する。
Next, the configuration of the frequency divider 3 of the position detection circuit described above will be described with reference to FIG. In FIG.
Reference numeral 10 denotes a memory, which is the previously input drive side position information θ.
Store m (k-1). A subtracter 11 outputs a difference Δθ m (k) between the input drive axis angle information θ m (k) and the previously input drive axis angle information θ m (k−1). In addition, for example, the counter 2 may display the full count value (FFF
F) is counted up to 0000, subtracter 1
1 outputs the difference from the previous value (FFFF) as 1.

【0026】12は電子ギアであり、外部より入力され
る駆動ギア21の歯数Pと被動ギア22の歯数Qにより
ギア比を求めこれに基づいて、減算器11から出力され
た差Δθm(k)に対応する負荷の角度変化量Δθ
L(k)を出力する。したがって、負荷の角度変化量Δ
θL(k)は、 ΔθL(k)=P/Q・Δθm(k) となる。本実施例においてはギア比は10であり、駆動
軸20aが1回転する毎にカウンタ2がカウントアップ
するので、もし、差Δθm(k)が10であれば、電子
ギア12は負荷の回転変化量ΔθL(k)として1を出
力する。
Reference numeral 12 denotes an electronic gear, which determines a gear ratio from the number P of teeth of the driving gear 21 and the number Q of teeth of the driven gear 22 which are input from the outside, and based on this, a difference Δθ m output from the subtractor 11 Angle change amount Δθ of load corresponding to (k)
Output L (k). Therefore, the load angle change Δ
θ L (k) is Δθ L (k) = P / Q · Δθm (k). In the present embodiment, the gear ratio is 10, and the counter 2 counts up each time the drive shaft 20a makes one rotation. Therefore, if the difference Δθ m (k) is 10, the electronic gear 12 rotates the load. 1 is output as the amount of change Δθ L (k).

【0027】13は加算器であり、電子ギア12から出
力される負荷の角度変化量ΔθL(k)に、メモリ15
に記憶された前回の負荷側位置情報θL(k−1)を加
算し、位置情報θ(k)を出力する。14は周期関数発
生部であり、加算器13から出力される位置情報θ
(k)が周期Tで出力されるように調整し、負荷角度情
報θL(k)として出力する。例えば本実施例の場合、
加算器13の加算結果により位置情報θ(k)が359
を超えた場合、超えた値に応じて再び0から負荷角度情
報θL(k)を出力するよう調整する。
Reference numeral 13 denotes an adder, which stores the load angle change amount Δθ L (k) output from the electronic gear 12 into the memory 15
The previous load side position information θ L (k−1) stored in is added and the position information θ (k) is output. Reference numeral 14 denotes a periodic function generator, which is the position information θ output from the adder 13.
(K) is adjusted so as to be output in the cycle T, and output as the load angle information θ L (k). For example, in the case of this embodiment,
The position information θ (k) is 359 based on the addition result of the adder 13.
When the value exceeds, the load angle information θ L (k) is adjusted to be output from 0 again according to the value that has exceeded.

【0028】以下、上述した位置検出回路の動作につい
て図1〜図3を参照して説明する。ここで、図3はカウ
ンタ2および分周器3から出力される各カウント値の関
係を示すグラフである。まず、本実施例の位置検出回路
が起動されると、カウンタ2および分周器3にリセット
信号が供給され、各々のカウント値が0に設定される。
これにより駆動軸20aおよびテーブル23の各原点が
設定される。また、上記リセット信号はメモリ10,1
5にも出力され、各メモリの記憶内容をクリアする。
The operation of the above-mentioned position detection circuit will be described below with reference to FIGS. Here, FIG. 3 is a graph showing the relationship between the count values output from the counter 2 and the frequency divider 3. First, when the position detection circuit of this embodiment is activated, a reset signal is supplied to the counter 2 and the frequency divider 3, and the count value of each is set to zero.
As a result, the origins of the drive shaft 20a and the table 23 are set. Further, the reset signal is sent to the memory 10, 1
It is also output to 5, and the stored contents of each memory are cleared.

【0029】次に、サーボーモータ20が回転し、これ
に応じてインクリメンタルエンコーダ1からパルス信号
が出力されると、カウンタ2によってそのパルス信号が
カウントされ、駆動軸角度情報θm(k)として分周器
3へ出力される。そして、分周器3は、以下の処理を行
うことにより駆動軸角度情報θm(k)を負荷角度情報
θL(k)に変換して出力する。
Next, when the servo motor 20 rotates and a pulse signal is output from the incremental encoder 1 in response to the rotation, the pulse signal is counted by the counter 2 and divided as drive axis angle information θ m (k). Output to the container 3. Then, the frequency divider 3 converts the drive axis angle information θ m (k) into load angle information θ L (k) by performing the following processing, and outputs the load angle information θ L (k).

【0030】図2において、まず、駆動軸角度情報θm
(k)が分周器3に入力されると、減算器11におい
て、前回入力された駆動軸角度情報θm(k−1)との
差がとられ、駆動軸の角度変化量Δθm(k)が算出さ
れる。また、メモリ10は、前回の駆動軸角度情報θm
(k−1)を出力後、今回入力された駆動軸角度情報θ
m(k)を記憶する。次に、電子ギア12において、駆
動軸の角度変化量Δθm(k)がテーブル23の位置変
化量ΔθL(k)に変換され、加算器13において前回
出力された負荷角度情報θL(k−1)が加算される。
In FIG. 2, first, the drive axis angle information θ m
When (k) is input to the frequency divider 3, the subtracter 11 takes the difference from the previously input drive axis angle information θ m (k−1), and the drive axis angle change amount Δθ m ( k) is calculated. Further, the memory 10 stores the previous drive axis angle information θ m.
After outputting (k-1), the drive axis angle information θ input this time
Remember m (k). Next, in the electronic gear 12, the angle change amount Δθ m (k) of the drive shaft is converted into the position change amount Δθ L (k) of the table 23, and the load angle information θ L (k (k) previously output in the adder 13 is converted. -1) is added.

【0031】その結果、位置情報θ(k)が得られ、こ
の位置情報θ(k)は周期関数発生部14へ出力され
る。周期関数発生部14では、外部から設定される周期
Tの値に基づいて上記位置情報θ(k)に対して以下の
条件処理を行う。すなわち、 位置情報θ(k)がT−1よりも大きい場合、θ
(k)−Tを負荷角度情報θL(k)として出力する。 位置情報θ(k)が0よりも小さい場合、θ(k)+
Tを負荷角度情報θL(k)として出力する。 位置情報θ(k)が0以上、かつ、T−1以下である
場合、θ(k)をそのまま負荷角度情報θL(k)とし
て出力する。
As a result, position information θ (k) is obtained, and this position information θ (k) is output to the periodic function generator 14. The periodic function generator 14 performs the following conditional processing on the position information θ (k) based on the value of the period T set from the outside. That is, when the position information θ (k) is larger than T−1, θ
(K) -T is output as the load angle information θ L (k). If the position information θ (k) is smaller than 0, θ (k) +
Output T as load angle information θ L (k). When the position information θ (k) is 0 or more and T−1 or less, θ (k) is output as it is as the load angle information θ L (k).

【0032】次に指令発生器4において、分周器3から
出力される負荷角度情報θL(k)とカウンタ2から出
力される駆動軸角度情報θm(k)を基に、外部から入
力される検出位置情報θL *を駆動側位置検出情報θ
m *(k)に変換する。以下、その手順を図3を参照して
説明する。
Next, in the command generator 4, the load angle information θ L (k) output from the frequency divider 3 and the drive axis angle information θ m (k) output from the counter 2 are input from the outside. The detected position information θ L *
Convert to m * (k). The procedure will be described below with reference to FIG.

【0033】まず、上述した変換に先立ち、初期設定と
して検出位置情報θL *に対してある範囲を設定するため
に、外部から入力される範囲情報θo(但しθo<T/
2)に基づいて以下の条件処理を行い、上述した範囲の
上限値θP *、下限値θN *を算出する。 θL *+θoがT−1よりも大きい場合、上限値θP *
θL *+θo−Tとする。また、θL *+θoがT−1以下で
ある場合は、上限値θP をθL *+θoとする。 θL *−θoが0よりも小さい場合、下限値θNをθL *
θo+Tとする。また、θL *−θoが0以上である場合
は、下限値θN *をθL *−θoとする。
First, prior to the above-mentioned conversion, in order to set a certain range for the detected position information θ L * as an initial setting, range information θ o input from the outside (where θ o <T /
Based on 2), the following condition processing is performed to calculate the upper limit value θ P * and the lower limit value θ N * of the above range. When θ L * + θ o is larger than T−1, the upper limit value θ P * is set to θ L * + θ o −T. When θ L * + θ o is T−1 or less, the upper limit value θ P is set to θ L * + θ o. When θ L * −θ o is smaller than 0, the lower limit value θ N is set to θ L *
Let θo + T. When θ L * -θo is 0 or more, the lower limit value θ N * is set to θ L * -θ o.

【0034】上述した条件判定により求めた上限値
θP *、下限値θN *による範囲の設定は、テーブル23の
原点に対する検出位置の位置関係と周期Tとに応じてθ
L *をθm *(k)に変換するために必要となる。そして、
この初期設定を行った後、さらに以下の条件処理を行っ
て、θL *をθm *(k)に変換する。
The range is set by the upper limit value θ P * and the lower limit value θ N * obtained by the above-mentioned condition judgment, according to the positional relationship of the detected position with respect to the origin of the table 23 and the cycle T.
It is needed to convert L * to θ m * (k). And
After performing this initial setting, the following condition processing is further performed to convert θ L * into θ m * (k).

【0035】θN *<θP *、かつ、θN *<θL(k)<
θP *の時、 θm *=θm(k)+(P/Q){θL *−θL(k)} θN *>θP *、かつ、T/2<θL *、かつ、θN *<θL
(k)の時、 θm *=θm(k)+(P/Q){θL *−θL(k)} θN *>θP *、かつ、T/2<θL *、かつ、θP *>θL
(k)の時、 θm *=θm(k)+(P/Q){θL *−θL(k)−T} θN *>θP *、かつ、T/2>θL *、かつ、θN *<θL
(k)の時、 θm *=θm(k)+(P/Q){θL *−θL(k)+T} θN *>θP *、かつ、T/2>θL *、かつ、θP *>θL
(k)の時、 θm *=θm(k)+(P/Q){θL *−θL(k)} また、上述した〜の条件のいずれにも当てはまらな
い場合は、θm *は前回の値のまま変更せず、出力停止信
号を出力する。
Θ N *P * and θ N *L (k) <
When θ P * , θ m * = θ m (k) + (P / Q) {θ L * −θ L (k)} θ N * > θ P * , and T / 2 <θ L * , And θ N *L
When (k), θ m * = θ m (k) + (P / Q) {θ L * −θ L (k)} θ N * > θ P * , and T / 2 <θ L * , And θ P * > θ L
When (k), θ m * = θ m (k) + (P / Q) {θ L *L (k) -T} θ N * > θ P * and T / 2> θ L * And θ N *L
When (k), θ m * = θ m (k) + (P / Q) {θ L * −θ L (k) + T} θ N * > θ P * and T / 2> θ L * , And θ P * > θ L
At the time of (k), θ m * = θ m (k) + (P / Q) {θ L * −θ L (k)} Further, when none of the above-mentioned conditions 1 to 3 is satisfied, θ m * * Outputs the output stop signal without changing the previous value.

【0036】例えば、上述した各値が図3に示される関
係にある場合は、上記〜の条件の内、の条件に該
当し、したがって、駆動側位置検出情報θm *(k)は、
カウンタ2から出力される駆動軸角度情報に、検出位置
情報から負荷角度情報を引いてギア比の逆数を掛けた値
を加えた値となる。
For example, in the case where the above-mentioned respective values have the relationship shown in FIG. 3, among the above conditions (1) to (4), the driving side position detection information θ m * (k) is:
A value obtained by adding the value obtained by subtracting the load angle information from the detected position information and multiplying it by the reciprocal of the gear ratio is added to the drive shaft angle information output from the counter 2.

【0037】指令発生器4から出力された駆動側位置検
出情報θm *(k)は比較器5において駆動軸角度情報θ
m(k)と比較され、同じ値になった時に位置検出信号
が出力される。そして、スイッチ6において、指令発生
器4から出力禁止信号が出力されていない場合スイッチ
6はONとなり、比較器5から位置検出信号が外部へ出
力される。
The drive side position detection information θ m * (k) output from the command generator 4 is used by the comparator 5 as drive axis angle information θ.
The position detection signal is output when compared with m (k) and when they have the same value. Then, in the switch 6, when the output prohibition signal is not output from the command generator 4, the switch 6 is turned on, and the position detection signal is output from the comparator 5 to the outside.

【0038】なお、カウンタ2として、サーボモータの
正転時にカウントアップし、逆転時にはカウントダウン
するカウンタを用い、また、分周器3内の電子ギア12
として、正転時には正符号の負荷の回転変化量Δθ
L(k)を出力し、逆転時には負符号の負荷の回転変化
量ΔθL(k)を出力するものを用いれば、逆転時にお
いても所望する負荷の位置を検出できる位置検出回路を
構成することができる。
As the counter 2, a counter that counts up when the servomotor rotates forward and counts down when the servomotor rotates in reverse is used, and the electronic gear 12 in the frequency divider 3 is used.
Is the rotation change amount Δθ of the positive sign during normal rotation
If a device that outputs L (k) and outputs the rotation change amount Δθ L (k) of the load with a negative sign during reverse rotation is used, a position detection circuit that can detect the desired load position even during reverse rotation should be configured. You can

【0039】このように、本実施例における位置検出回
路は、サーボモータの制御に必須であり、かつ、通常サ
ーボモータに内蔵されるインクリメンタルエンコーダか
ら出力されるパルス信号に基づいて、所望する負荷の位
置を検出するため、安価で高精度の位置検出が可能とな
る。
As described above, the position detection circuit in this embodiment is indispensable for the control of the servomotor, and the desired load is determined based on the pulse signal output from the incremental encoder normally built in the servomotor. Since the position is detected, inexpensive and highly accurate position detection can be performed.

【0040】[0040]

【発明の効果】以上説明したように、請求項1記載の発
明によれば、モータにより所定のギア比を介して回転制
御される負荷の所定位置を検出する位置検出回路におい
て、前記モータの回転に応じて該モータの角度情報を順
次出力する角度情報出力手段と、今回入力された前記モ
ータの角度情報と前回入力された前記モータの角度情報
との変化量を検出する変化量検出手段と、該変化量検出
手段が出力する変化量を前記負荷の角度変化量に変換す
る変化量変換手段と、該変化量変換手段から出力された
前記負荷の角度変化量と、前回得られた負荷の角度情報
とに基づいて、前記今回入力されたモータの角度情報に
対する負荷の角度情報を出力する負荷角度出力手段と、
該負荷角度出力手段から出力される負荷の角度情報が、
予め設定された周期に従って出力されるよう処理する周
期処理手段と、該周期処理手段から出力される負荷の角
度情報に基づいて前記負荷の所定位置を検出する所定位
置検出手段とを具備するので、直接負荷側の位置または
角度を検出することなく該負荷の所定位置を検出するこ
とができるばかりでなく、負荷の角度情報を所望する周
期で発生させることができ、これにより、サーボモータ
の駆動機構の設置に関する自由度が向上する。
As described above, according to the first aspect of the invention, in the position detection circuit for detecting the predetermined position of the load whose rotation is controlled by the motor through the predetermined gear ratio, the rotation of the motor Angle information output means for sequentially outputting angle information of the motor according to, and change amount detection means for detecting a change amount between the angle information of the motor input this time and the angle information of the motor input last time, A change amount conversion means for converting the change amount output by the change amount detection means into the load angle change amount, the load angle change amount output from the change amount conversion means, and the load angle obtained last time. Load angle output means for outputting the angle information of the load with respect to the angle information of the motor input this time based on the information,
The load angle information output from the load angle output means is
Since it comprises a cycle processing means for processing so as to output according to a preset cycle, and a predetermined position detecting means for detecting a predetermined position of the load based on angle information of the load output from the cycle processing means, Not only the predetermined position of the load can be detected without directly detecting the position or the angle on the load side, but also the angle information of the load can be generated at a desired cycle. The degree of freedom regarding installation is improved.

【0041】請求項2記載の発明によれば、前記所定位
置検出手段が、前記所定位置に対応する負荷の角度情報
が予め入力され、前記順次出力されるモータの角度情報
と前記周期処理手段から出力される負荷の角度情報とに
基づいて、前記所定位置に対応する負荷の角度情報を、
モータの角度情報に対応させる検出角度変換手段と、該
検出角度変換手段から出力されるモータの角度情報と、
前記角度情報出力手段から順次出力されるモータの角度
情報とを比較し、双方の角度情報が一致した場合に位置
検出信号を出力する位置検出信号出力手段とからなるの
で、負荷における所定位置の判定が、負荷の角度情報の
元となるモータの角度情報に基づいてなされるため、正
確な位置検出を行うことができる。
According to the second aspect of the present invention, the predetermined position detecting means is preliminarily inputted with the load angle information corresponding to the predetermined position, and the sequentially output motor angle information and the cycle processing means are used. Based on the output load angle information, load angle information corresponding to the predetermined position,
A detected angle converting means corresponding to the angle information of the motor, and motor angle information output from the detected angle converting means,
The position detection signal output unit that compares the angle information of the motor sequentially output from the angle information output unit and outputs a position detection signal when the two pieces of angle information match, thus determining the predetermined position in the load. However, since it is performed based on the angle information of the motor that is the basis of the angle information of the load, accurate position detection can be performed.

【0042】請求項3記載の発明によれば、前記検出角
度変換手段は、前記所定位置に対応する負荷の角度情報
と前記周期処理手段から出力される現時点の負荷の角度
情報との差を求めると共に、前記所定位置に対応する負
荷の角度情報の、前記周期処理手段から出力される負荷
の角度情報の最小値および最大値間の範囲内における位
置を判断し、該位置に応じて前記求めた差に前記予め設
定された周期の値を加算または減算を行うか、もしくは
該加減算を行わないかを決定し、その結果得られた値を
前記ギア比に基づいて前記モータの角度情報に換算して
該換算結果を現時点のモータの角度情報に加算すること
によって前記所定位置に対応する負荷の角度情報をモー
タの角度情報に対応させるので、所定位置に対応した負
荷の角度情報が負荷の角度情報の出力範囲内の何処であ
っても、該所定位置に対応した負荷の角度情報をモータ
の角度情報に正確に対応させることが可能となる。
According to the third aspect of the invention, the detected angle conversion means obtains the difference between the load angle information corresponding to the predetermined position and the current load angle information output from the cycle processing means. At the same time, the position of the load angle information corresponding to the predetermined position within the range between the minimum value and the maximum value of the load angle information output from the cycle processing means is determined, and the position is determined according to the position. It is determined whether the value of the preset period is added to or subtracted from the difference or whether the addition or subtraction is not performed, and the resulting value is converted into angle information of the motor based on the gear ratio. The load angle information corresponding to the predetermined position is negative because the load angle information corresponding to the predetermined position is made to correspond to the motor angle information by adding the conversion result to the current motor angle information. Even anywhere within the output range of the angular information, it becomes possible to accurately correspond to the load angle information the angle information of the motor corresponding to the predetermined position.

【0043】請求項4記載の発明によれば、駆動軸の回
転に応じて等角度間隔毎にパルス信号を出力するインク
リメンタルエンコーダを内蔵したサーボモータによっ
て、所定のギア比を介して回転制御される負荷の所定位
置を検出する位置検出回路において、前記インクリメン
タルエンコーダから出力されるパルス信号を順次計数し
て出力するカウンタと、前記カウンタから出力される計
数値と、前記ギア比とに基づいて、前記サーボモータに
よって回転させられた前記負荷の角度に対応する負荷の
角度情報を、予め設定された周期に従って出力する分周
器と、前記カウンタから順次出力される計数値と、前記
分周器から出力される負荷の角度情報とに基づいて、予
め設定された負荷の所定位置に対応する角度情報を、前
記カウンタから順次出力される計数値に準じて変換し、
該計数値に準じた前記所定位置の角度情報を検出指令情
報として出力する指令発生器と、該指令発生器から出力
される検出指令情報の値と前記カウンタから順次出力さ
れる計数値とを比較し、同じ値になった時に位置検出信
号を出力する比較器とを具備するので、安価な構成で高
精度の位置検出を行うことができるばかりでなく、セン
サやアブソリュートエンコーダ等を設置して直接負荷の
位置または角度等を検出する必要がないため、サーボモ
ータの駆動機構の設置に関する自由度が向上する。
According to the fourth aspect of the invention, the rotation is controlled through a predetermined gear ratio by the servo motor having the built-in incremental encoder that outputs a pulse signal at regular angular intervals according to the rotation of the drive shaft. In a position detection circuit that detects a predetermined position of the load, a counter that sequentially counts and outputs pulse signals output from the incremental encoder, a count value output from the counter, and the gear ratio based on the A frequency divider that outputs load angle information corresponding to the angle of the load rotated by a servo motor in accordance with a preset cycle, a count value that is sequentially output from the counter, and an output from the frequency divider. The angle information corresponding to the predetermined position of the load set in advance based on the load angle information Converted in accordance with the force is the count value,
A command generator that outputs angle information of the predetermined position according to the count value as detection command information, and a value of the detection command information output from the command generator and a count value sequentially output from the counter However, since it is equipped with a comparator that outputs a position detection signal when it becomes the same value, not only can it perform highly accurate position detection with an inexpensive configuration, but it can also be installed directly by installing a sensor or absolute encoder. Since it is not necessary to detect the position or angle of the load, the degree of freedom regarding the installation of the drive mechanism of the servo motor is improved.

【図面の簡単な説明】[Brief description of drawings]

【図1】 この発明の一実施例における位置検出回路の
構成を示すブロック図である。
FIG. 1 is a block diagram showing a configuration of a position detection circuit according to an embodiment of the present invention.

【図2】 同位置検出回路の計測カウンタの構成を示す
ブロック図である。
FIG. 2 is a block diagram showing a configuration of a measurement counter of the position detection circuit.

【図3】 この発明の第2実施例における位置検出回路
の構成を説明するためのグラフである。
FIG. 3 is a graph for explaining the configuration of the position detection circuit in the second embodiment of the present invention.

【図4】 従来のサーボモータ駆動機構の構成を説明す
るための説明図である。
FIG. 4 is an explanatory diagram for explaining a configuration of a conventional servo motor drive mechanism.

【符号の説明】[Explanation of symbols]

1……インクリメンタルエンコーダ、2……カウンタ、
3……分周器、4……指令発生部、5……コンパレー
タ、6……スイッチ、10,15……メモリ、11……
減算器、12……電子ギア、13……加算器、14……
周期関数発生部
1 ... Incremental encoder, 2 ... Counter,
3 ... Frequency divider, 4 ... Command generator, 5 ... Comparator, 6 ... Switch, 10, 15 ... Memory, 11 ...
Subtractor, 12 ... Electronic gear, 13 ... Adder, 14 ...
Periodic function generator

Claims (4)

【特許請求の範囲】[Claims] 【請求項1】 モータにより所定のギア比を介して回転
制御される負荷の所定位置を検出する位置検出回路にお
いて、 前記モータの回転に応じて該モータの角度情報を順次出
力する角度情報出力手段と、 今回入力された前記モータの角度情報と前回入力された
前記モータの角度情報との変化量を検出する変化量検出
手段と、 該変化量検出手段が出力する変化量を前記負荷の角度変
化量に変換する変化量変換手段と、 該変化量変換手段から出力された前記負荷の角度変化量
と、前回得られた負荷の角度情報とに基づいて、前記今
回入力されたモータの角度情報に対する負荷の角度情報
を出力する負荷角度出力手段と、 該負荷角度出力手段から出力される負荷の角度情報が、
予め設定された周期に従って出力されるよう処理する周
期処理手段と、 該周期処理手段から出力される負荷の角度情報に基づい
て前記負荷の所定位置を検出する所定位置検出手段とを
具備することを特徴とする位置検出回路。
1. A position detection circuit for detecting a predetermined position of a load whose rotation is controlled by a motor through a predetermined gear ratio, wherein angle information output means for sequentially outputting angle information of the motor according to rotation of the motor. And a change amount detecting means for detecting a change amount between the motor angle information inputted this time and the motor angle information inputted last time, and the change amount outputted by the change amount detecting means, to the angle change of the load. Based on the load angle change amount output from the change amount conversion unit, and the load angle information obtained last time, with respect to the motor angle information input this time. Load angle output means for outputting load angle information, and load angle information output from the load angle output means,
A cycle processing means for processing so that the load is outputted in accordance with a preset cycle; and a predetermined position detecting means for detecting a predetermined position of the load based on angle information of the load outputted from the cycle processing means. Characteristic position detection circuit.
【請求項2】 前記所定位置検出手段は、 前記所定位置に対応する負荷の角度情報が予め入力さ
れ、前記順次出力されるモータの角度情報と前記周期処
理手段から出力される負荷の角度情報とに基づいて、前
記所定位置に対応する負荷の角度情報を、モータの角度
情報に対応させる検出角度変換手段と、 該検出角度変換手段から出力されるモータの角度情報
と、前記角度情報出力手段から順次出力されるモータの
角度情報とを比較し、双方の角度情報が一致した場合に
位置検出信号を出力する位置検出信号出力手段とからな
ることを特徴とする請求項1記載の位置検出回路。
2. The predetermined position detecting means is preliminarily input with load angle information corresponding to the predetermined position, and sequentially outputs the motor angle information and the load angle information output from the cycle processing means. The angle information of the load corresponding to the predetermined position to the angle information of the motor, the angle information of the motor output from the detection angle conversion unit, and the angle information output unit 2. The position detection circuit according to claim 1, further comprising position detection signal output means for comparing the angle information of the sequentially output motors and outputting a position detection signal when both angle information match.
【請求項3】 前記検出角度変換手段は、 前記所定位置に対応する負荷の角度情報と前記周期処理
手段から出力される現時点の負荷の角度情報との差を求
めると共に、前記所定位置に対応する負荷の角度情報
の、前記周期処理手段から出力される負荷の角度情報の
最小値および最大値間の範囲内における位置を判断し、
該位置に応じて前記求めた差に前記予め設定された周期
の値を加算または減算を行うか、もしくは該加減算を行
わないかを決定し、その結果得られた値を前記ギア比に
基づいて前記モータの角度情報に換算して該換算結果を
現時点のモータの角度情報に加算することによって前記
所定位置に対応する負荷の角度情報をモータの角度情報
に対応させることを特徴とする請求項2記載の位置検出
回路。
3. The detected angle converting means obtains a difference between load angle information corresponding to the predetermined position and current load angle information output from the cycle processing means, and corresponds to the predetermined position. The position of the load angle information within the range between the minimum value and the maximum value of the load angle information output from the cycle processing means is determined,
It is determined whether the value of the preset period is added to or subtracted from the calculated difference according to the position, or whether the addition or subtraction is not performed, and the resulting value is determined based on the gear ratio. 3. The load angle information corresponding to the predetermined position is made to correspond to the motor angle information by converting the motor angle information and adding the conversion result to the current motor angle information. The position detection circuit described.
【請求項4】 駆動軸の回転に応じて等角度間隔毎にパ
ルス信号を出力するインクリメンタルエンコーダを内蔵
したサーボモータによって、所定のギア比を介して回転
制御される負荷の所定位置を検出する位置検出回路にお
いて、 前記インクリメンタルエンコーダから出力されるパルス
信号を順次計数して出力するカウンタと、 前記カウンタから出力される計数値と、前記ギア比とに
基づいて、前記サーボモータによって回転させられた前
記負荷の角度に対応する負荷の角度情報を、予め設定さ
れた周期に従って出力する分周器と、 前記カウンタから順次出力される計数値と、前記分周器
から出力される負荷の角度情報とに基づいて、予め設定
された負荷の所定位置に対応する角度情報を、前記カウ
ンタから順次出力される計数値に準じて変換し、該計数
値に準じた前記所定位置の角度情報を検出指令情報とし
て出力する指令発生器と、 該指令発生器から出力される検出指令情報の値と、前記
カウンタから順次出力される計数値とを比較し、同じ値
になった時に位置検出信号を出力する比較器とを具備す
ることを特徴とする位置検出回路。
4. A position for detecting a predetermined position of a load which is rotationally controlled via a predetermined gear ratio by a servomotor having a built-in incremental encoder which outputs a pulse signal at equal angular intervals according to the rotation of a drive shaft. In the detection circuit, a counter that sequentially counts and outputs the pulse signals output from the incremental encoder, a count value output from the counter, and the gear ratio based on the gear ratio, and A load divider that outputs load angle information corresponding to a load angle according to a preset cycle, a count value that is sequentially output from the counter, and a load angle information that is output from the divider. Based on this, the angle information corresponding to the predetermined position of the preset load is changed according to the count value sequentially output from the counter. In other words, a command generator that outputs angle information of the predetermined position according to the count value as detection command information, a value of the detection command information output from the command generator, and a counter that sequentially outputs from the counter. A position detecting circuit comprising: a comparator that compares a numerical value and outputs a position detecting signal when the values are the same.
JP15490995A 1995-06-21 1995-06-21 Position detection circuit Expired - Fee Related JP3329142B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP15490995A JP3329142B2 (en) 1995-06-21 1995-06-21 Position detection circuit

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP15490995A JP3329142B2 (en) 1995-06-21 1995-06-21 Position detection circuit

Publications (2)

Publication Number Publication Date
JPH095115A true JPH095115A (en) 1997-01-10
JP3329142B2 JP3329142B2 (en) 2002-09-30

Family

ID=15594618

Family Applications (1)

Application Number Title Priority Date Filing Date
JP15490995A Expired - Fee Related JP3329142B2 (en) 1995-06-21 1995-06-21 Position detection circuit

Country Status (1)

Country Link
JP (1) JP3329142B2 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7102317B2 (en) 2004-01-20 2006-09-05 Samsung Electronics Co., Ltd. Method and apparatus to process an analog encoder signal
KR101502259B1 (en) * 2011-01-07 2015-03-12 오리엔탈모터가부시끼가이샤 Device for detecting multi-turn absolute rotation angle, and method for detecting rotation angle thereof

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7102317B2 (en) 2004-01-20 2006-09-05 Samsung Electronics Co., Ltd. Method and apparatus to process an analog encoder signal
KR101502259B1 (en) * 2011-01-07 2015-03-12 오리엔탈모터가부시끼가이샤 Device for detecting multi-turn absolute rotation angle, and method for detecting rotation angle thereof

Also Published As

Publication number Publication date
JP3329142B2 (en) 2002-09-30

Similar Documents

Publication Publication Date Title
US7012704B2 (en) Position detecting device
WO1999001927A1 (en) Position controller
US4827203A (en) Rotor rotational position detector for a motor
KR0185465B1 (en) Absolute encoder and method of generating its current position
US5006772A (en) Position monitor for a stepper motor
JPH095115A (en) Position detection circuit
JP3528949B2 (en) Absolute position detection device for output rotary shaft
JP3251827B2 (en) Positioning device
US4724371A (en) Apparatus for detecting the degree of rotation of a rotational axis
JP3250356B2 (en) Rotational position detector
US6167108A (en) Method of processing signals of encoders and apparatus employing the same
JP3033297B2 (en) Multi-turn absolute encoder
JP2000175497A (en) Device and method for controlling pulse motor and recording medium with pulse motor control program recorded therein
JPH0719849A (en) Apparatus and method for reading position
JPS6375807A (en) Deviation correcting device for servo mechanism
JP2576956B2 (en) Industrial robot rotation angle detector
JPH07175523A (en) Position controller
JPH065175B2 (en) Absolute type encoder
JPH099666A (en) Speed controller for motor
JP2735324B2 (en) Motor rotation speed control device
JPH0469079A (en) Apparatus for sensing motor speed
JPH099669A (en) Rotation controller for motor
KR20020055046A (en) A error detecting method of incremental encoder
JPH0993993A (en) Device for detecting step-out of stepping motor
JPS6289110A (en) Stop position control device for motor

Legal Events

Date Code Title Description
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20020618

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

Free format text: PAYMENT UNTIL: 20080719

Year of fee payment: 6

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

Free format text: PAYMENT UNTIL: 20080719

Year of fee payment: 6

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

Free format text: PAYMENT UNTIL: 20090719

Year of fee payment: 7

LAPS Cancellation because of no payment of annual fees