JP3329142B2 - Position detection circuit - Google Patents

Position detection circuit

Info

Publication number
JP3329142B2
JP3329142B2 JP15490995A JP15490995A JP3329142B2 JP 3329142 B2 JP3329142 B2 JP 3329142B2 JP 15490995 A JP15490995 A JP 15490995A JP 15490995 A JP15490995 A JP 15490995A JP 3329142 B2 JP3329142 B2 JP 3329142B2
Authority
JP
Japan
Prior art keywords
angle information
load
output
motor
angle
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Fee Related
Application number
JP15490995A
Other languages
Japanese (ja)
Other versions
JPH095115A (en
Inventor
堅治 井上
克好 中野
Original Assignee
神鋼電機株式会社
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 神鋼電機株式会社 filed Critical 神鋼電機株式会社
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

Landscapes

  • Transmission And Conversion Of Sensor Element Output (AREA)

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 servomotor is performed by detecting the position or rotation angle of the load. FIG. 4 shows a conventional servo motor driving mechanism. In this figure, reference numeral 20 denotes a servomotor which controls the position of a table 23 as a load. Also,
Reference numeral 20a denotes a drive shaft of the servo motor 20. Reference numeral 1 denotes an incremental encoder which is a component of the servomotor 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 P teeth (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 Q teeth (Q is an integer).
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. The gear ratio at this time is Q / P. Reference numeral 24 denotes a sensor, and a table 23
And outputs a detection signal when the marker is detected.

【0004】上述したサーボモータの駆動機構において
は、インクリメンタルエンコーダ1から出力されるパル
ス信号およびセンサ24から出力される位置検出信号に
基づいて、サーボモータ20の速度制御やテーブル23
の位置制御を行っている。また、この種の駆動機構の中
には、センサ24の代わりとして、テーブル23の回転
軸に回転角度を絶対値で出力するアブソリュートエンコ
ーダ25を取り付けたものがある。このような駆動機構
においては、アブソリュートエンコーダ25から出力さ
れる角度情報をテーブル23の絶対位置情報とし、これ
に基づいてテーブル23の位置制御を行う。
In the above-described servo motor driving mechanism, 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. Some drive mechanisms of this type include an absolute encoder 25 that outputs a rotation angle as an absolute value to a rotation shaft of a 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 of the table 23 is controlled based on this.

【0005】[0005]

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

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

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

【0008】[0008]

【課題を解決するための手段】請求項1記載の発明は、
モータにより所定のギア比を介して回転制御される負荷
の所定位置を検出する位置検出回路において、前記モー
タの回転に応じて該モータの角度情報を順次出力する角
度情報出力手段と、今回入力された前記モータの角度情
報と前回入力された前記モータの角度情報との変化量を
検出する変化量検出手段と、該変化量検出手段が出力す
る変化量を前記負荷の角度変化量に変換する変化量変換
手段と、該変化量変換手段から出力された前記負荷の角
度変化量と、前回得られた負荷の角度情報とに基づい
て、前記今回入力されたモータの角度情報に対する負荷
の角度情報を出力する負荷角度出力手段と、該負荷角度
出力手段から出力される負荷の角度情報が、予め設定さ
れた周期に従って出力されるよう処理する周期処理手段
と、該周期処理手段から出力される負荷の角度情報に基
づいて前記負荷の所定位置を検出する所定位置検出手段
とを具備することを特徴とする位置検出回路である。
According to the first aspect of the present invention,
An angle information output means for sequentially outputting angle information of the motor in accordance with the rotation of the motor, and a position detection circuit for detecting a predetermined position of a load rotationally controlled by the motor via a predetermined gear ratio; 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 change amount conversion unit and the load angle information obtained last time, the load angle information corresponding to the motor angle information input this time. Load angle output means for outputting, load processing means for outputting angle information of the load output from the load angle output means in accordance with a preset cycle, and the periodic 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 receives in advance angle information of a load corresponding to the predetermined position, and outputs the angle information of the motor sequentially outputted and the periodic processing means. Detection angle conversion means for making the load angle information corresponding to the predetermined position correspond to the motor angle information, based on the load angle information, and motor angle information output from the detection angle conversion means, 2. A position detection signal output means for comparing the angle information of the motor sequentially output from said angle information output means and outputting a position detection signal when both the angle information match. It is a position detection circuit of description.

【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 periodic processing means, A position of the load angle information corresponding to the predetermined position within a range between a minimum value and a maximum value of the load angle information output from the periodic processing means is determined, and the obtained difference is determined according to the position. Whether to add or subtract the value of the preset cycle or not to perform the addition / subtraction, convert the resulting value into angle information of the motor based on the gear ratio, and 3. The position detecting circuit according to claim 2, wherein the conversion result is added to the current angle information of the motor so that the angle information of the load corresponding to the predetermined position corresponds to the angle information of the motor.

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

【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, and the obtained amount is converted into the change in the angle of the load. Load angle information corresponding to the amount of change in the angle of the motor is obtained, and the obtained load angle information is output in accordance with a preset cycle. Therefore, the load angle information can be generated at an arbitrary cycle. Therefore, not only can a predetermined position of the load be detected without directly detecting the position or angle on the load side, but also angle information of the load can be generated at a desired cycle.

【0013】請求項2記載の発明による位置検出回路に
おいては、負荷の所定位置に対応した角度情報をモータ
の角度情報に対応させ、その負荷の所定位置に対応した
モータの角度情報と順次出力されるモータの角度情報と
に基づいて位置検出信号が出力される。これにより、負
荷における所定位置の判定が、負荷の角度情報の元とな
るモータの角度情報に基づいてなされるため、正確な位
置検出を行うことができる。
In the position detecting circuit according to 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. Accordingly, since the determination of the predetermined position in the load 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.

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

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

【0016】[0016]

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

【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 a pulse signal at equal angular intervals in accordance with the rotation of the drive shaft 20a of the servo motor, as described above. Here, the drive shaft 20a is 1
A pulse signal is output each time the motor rotates. Reference numeral 2 denotes a counter, which counts the pulses output from the incremental encoder 1 and counts this count value on the drive shaft 2.
0a angle information (hereinafter referred to as drive shaft angle information) θ
Output as m (k).

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

【0019】3は分周器(角度情報変換手段)であり、
カウンタ2から出力されるカウント値を、駆動ギア21
の歯数P、被動ギア22の歯数Q(但しP<Q)および
テーブル23の1回転当たりの角度検出ポイント総数T
(以下、周期Tという)に基づいて、テーブル23の回
転に対応したポイント数を計数し、これを、テーブル2
3の角度情報(以下、負荷角度情報という)θL(k)
として出力する。
Reference numeral 3 denotes a frequency divider (angle information conversion means).
The count value output from the counter 2 is
, The number of teeth Q of the driven gear 22 (where P <Q), and the total number of angle detection points T per rotation of the table 23
(Hereinafter referred to as period T), the number of points corresponding to the rotation of the table 23 is counted.
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 driving gear 21 is set to 10, and the number of teeth Q of the driven gear 22 is set to 100, so that the gear ratio is 10. Also, the total number T of angle detection points per rotation of the table 23 is set to 360, and the frequency divider 3 outputs numerical values 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 represents detected position information θ L * and load angle information θ representing the detected position of the table 23 in correspondence with the value (fixed value) corresponding to the output value of the frequency divider 3.
L (k), gear ratio P / Q, and drive shaft angle information θ
based on the m (k), the detected position information of the drive shaft 20a side corresponding to the detected position information theta L * (hereinafter referred to as the drive-side position detection information) to the theta m * a (k).

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

【0023】また、指令発生器4に入力されるθ0は、
検出位置情報θL *を駆動軸角度情報に対応させる際に必
要となる値であり、これについては後に詳述する。
Further, θ 0 input to the command generator 4 is:
This is a value required when the detected position information θ L * is associated with the drive shaft 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 used to detect drive-side position detection information θ.
m * (k) is compared with the drive shaft angle information θ m (k), and when both values are equal, a position detection signal is output. 6
Is a switch, which is turned off when an output prohibition 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 above-described position detection circuit will be described with reference to FIG. In FIG.
Reference numeral 10 denotes a memory, which is the drive-side position information θ input previously.
m (k-1) is stored. A subtractor 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). Further, for example, the counter 2 has a full count value (FFF).
When the count is incremented from 0000 to 0000, the subtractor 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. A gear ratio is obtained from the number of teeth P of the driving gear 21 and the number of teeth Q of the driven gear 22 which are input from the outside, and based on this, the difference Δθ m output from the subtractor 11 is obtained. Angle change Δθ of load corresponding to (k)
Output L (k). Therefore, the angle change Δ of the load
θ L (k) is as follows: Δθ L (k) = P / Q · Δθ m (k) In this 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 will rotate the load. 1 is output as the change amount Δθ 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 a load angle change Δθ L (k) output from the electronic gear 12 into a memory 15.
Is added to the previous load-side position information θ L (k−1), and the position information θ (k) is output. Reference numeral 14 denotes a periodic function generator, which outputs position information θ output from the adder 13.
(K) is adjusted so as to be output in the cycle T, and output as 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.
Is exceeded, the load angle information θ L (k) is adjusted to be output again from 0 in accordance with the exceeded value.

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

【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 the frequency is divided as drive shaft angle information θ m (k). Output to the device 3. Then, the frequency divider 3 converts the drive shaft angle information θ m (k) into load angle information θ L (k) and outputs it by performing the following processing.

【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, drive shaft angle information θ m
When (k) is input to the frequency divider 3, the subtracter 11 calculates a difference from the previously input drive shaft angle information θ m (k−1), and the drive shaft angle change Δθ m ( k) is calculated. Further, the memory 10 stores the previous drive shaft angle information θ m
After outputting (k-1), the drive shaft angle information θ input this time
m (k) is stored. 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) previously output by the adder 13. -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 the position information θ (k) is output to the periodic function generator 14. The periodic function generator 14 performs the following condition 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 load angle information θ L (k). When the position information θ (k) is smaller than 0, θ (k) +
T is output as load angle information θ L (k). When the position information θ (k) is equal to or more than 0 and equal to or less than T−1, θ (k) is directly output as load angle information θ L (k).

【0032】次に指令発生器4において、分周器3から
出力される負荷角度情報θL(k)とカウンタ2から出
力される駆動軸角度情報θm(k)を基に、外部から入
力される検出位置情報θL *を駆動側位置検出情報θ
m *(k)に変換する。以下、その手順を図3を参照して
説明する。
Next, the command generator 4 receives an external input based on the load angle information θ L (k) output from the frequency divider 3 and the drive shaft angle information θ m (k) output from the counter 2. Detected position information θ L *
Convert to m * (k). Hereinafter, the procedure will be described 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-described conversion, in order to set a certain range for the detected position information θ L * as an initial setting, range information θo (where θo <T /
The following condition processing is performed based on 2) to calculate the upper limit value θ P * and the lower limit value θ N * of the above range. If θ L * + θo is larger than T-1, the upper limit value theta P * and θ L * + θo-T. Further, if θ L * + θo is T-1 or less, the upper limit theta P and θ L * + θo. If θ L * −θo is smaller than 0, the lower limit θ N is set to θ L * −.
θ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 setting of the range based on the upper limit value θ P * and the lower limit value θ N * obtained by the above-described condition determination depends on the positional relationship of the detected position with respect to the origin of the table 23 and the period T.
It is required to convert L * to θ m * (k). And
After 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
(K) When, θ m * = θ m ( k) + (P / Q) {θ L * -θ L (k)} θ N *> θ P *, and, T / 2 <θ L * , And θ P * > θ L
(K) When, θ m * = θ m ( k) + (P / Q) {θ L * -θ L (k) -T} θ N *> θ P *, and, T / 2> θ L * And θ N *L
(K) When, θ m * = θ m ( k) + (P / Q) {θ L * -θ L (k) + T} θ N *> θ P *, and, T / 2> θ L * And θ P * > θ L
In the case of (k), θ m * = θ m (k) + (P / Q) {θ L * −θ L (k)} In addition, if none of the above-mentioned conditions is satisfied, θ m * Outputs the output stop signal without changing the previous value.

【0036】例えば、上述した各値が図3に示される関
係にある場合は、上記〜の条件の内、の条件に該
当し、したがって、駆動側位置検出情報θm *(k)は、
カウンタ2から出力される駆動軸角度情報に、検出位置
情報から負荷角度情報を引いてギア比の逆数を掛けた値
を加えた値となる。
For example, when the above-mentioned values have the relationship shown in FIG. 3, the above-mentioned conditions are satisfied, and therefore, the drive-side position detection information θ m * (k) becomes
A value obtained by subtracting the load angle information from the detected position information and multiplying the result 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 output to the comparator 5 by drive-axis angle information θ.
The position detection signal is output when the value is compared with m (k) and becomes the same value. When the output prohibition signal is not output from the command generator 4 in the switch 6, 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 servo motor rotates forward and counts down when the servo motor rotates reversely is used.
In the forward rotation, the rotation change amount Δθ of the positive sign load
Outputs L (k), if at the time of reverse rotation by using the outputs a rotational change amount [Delta] [theta] L of the load minus sign (k), to constitute a position detecting circuit capable of detecting the position of the desired load even during reverse rotation Can be.

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

【0040】[0040]

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

【0041】請求項2記載の発明によれば、前記所定位
置検出手段が、前記所定位置に対応する負荷の角度情報
が予め入力され、前記順次出力されるモータの角度情報
と前記周期処理手段から出力される負荷の角度情報とに
基づいて、前記所定位置に対応する負荷の角度情報を、
モータの角度情報に対応させる検出角度変換手段と、該
検出角度変換手段から出力されるモータの角度情報と、
前記角度情報出力手段から順次出力されるモータの角度
情報とを比較し、双方の角度情報が一致した場合に位置
検出信号を出力する位置検出信号出力手段とからなるの
で、負荷における所定位置の判定が、負荷の角度情報の
元となるモータの角度情報に基づいてなされるため、正
確な位置検出を行うことができる。
According to the second aspect of the present invention, the predetermined position detecting means receives the angle information of the load corresponding to the predetermined position in advance, and outputs the angular information of the motor sequentially outputted and the periodic processing means. Based on the output load angle information, the load angle information corresponding to the predetermined position,
Detection angle conversion means corresponding to the angle information of the motor, angle information of the motor output from the detection angle conversion means,
A 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 both of the angle information match, so that the determination of the predetermined position in the load is performed. Is performed based on the angle information of the motor which is the basis of the angle information of the load, so that accurate position detection can be performed.

【0042】請求項3記載の発明によれば、前記検出角
度変換手段は、前記所定位置に対応する負荷の角度情報
と前記周期処理手段から出力される現時点の負荷の角度
情報との差を求めると共に、前記所定位置に対応する負
荷の角度情報の、前記周期処理手段から出力される負荷
の角度情報の最小値および最大値間の範囲内における位
置を判断し、該位置に応じて前記求めた差に前記予め設
定された周期の値を加算または減算を行うか、もしくは
該加減算を行わないかを決定し、その結果得られた値を
前記ギア比に基づいて前記モータの角度情報に換算して
該換算結果を現時点のモータの角度情報に加算すること
によって前記所定位置に対応する負荷の角度情報をモー
タの角度情報に対応させるので、所定位置に対応した負
荷の角度情報が負荷の角度情報の出力範囲内の何処であ
っても、該所定位置に対応した負荷の角度情報をモータ
の角度情報に正確に対応させることが可能となる。
According to the 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 periodic 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 periodic processing means is determined, and the position is determined according to the position. Whether to add or subtract the value of the preset cycle to the difference or not to perform the addition / subtraction, convert the resulting value into angle information of the motor based on the gear ratio. By adding the conversion result to the current angle information of the motor, the angle information of the load corresponding to the predetermined position is made to correspond to the angle information of the motor, so that the angle information of the load corresponding to the predetermined position is negative. 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 present invention, the rotation is controlled via a predetermined gear ratio by a servomotor having a built-in incremental encoder which outputs a pulse signal at equal angular intervals in accordance with 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, based on a count value output from the counter, and the gear ratio, A frequency divider that outputs load angle information corresponding to the load angle rotated by the servomotor according to a preset cycle, a count value sequentially output from the counter, and an output from the frequency divider Based on the load angle information to be performed, the angle information corresponding to the predetermined position of the load set in advance, sequentially from the counter 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 compares a value of the detection command information output from the command generator with a count value sequentially output from the counter. However, since it has a comparator that outputs a position detection signal when the value becomes the same, not only can it perform high-precision position detection with an inexpensive configuration, but also directly install a sensor or absolute encoder, etc. Since there is no need to detect the position or angle of the load, the degree of freedom regarding the installation of the drive mechanism of the servomotor is improved.

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

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

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

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

【図4】 従来のサーボモータ駆動機構の構成を説明す
るための説明図である。
FIG. 4 is an explanatory diagram for explaining a configuration of a conventional servo motor driving 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

───────────────────────────────────────────────────── フロントページの続き (58)調査した分野(Int.Cl.7,DB名) G01D 5/00 - 5/62 G01B 7/00 - 7/34 G01B 11/00 - 11/30 G01P 1/00 - 3/80 ──────────────────────────────────────────────────続 き Continued on the front page (58) Field surveyed (Int.Cl. 7 , DB name) G01D 5/00-5/62 G01B 7/00-7/34 G01B 11/00-11/30 G01P 1 / 00-3/80

Claims (4)

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

Families Citing this family (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
TWI500907B (en) * 2011-01-07 2015-09-21 Oriental Motor Co Ltd Apparatus for detecting multi-turn absolute rotation angle and method for detecting the same

Also Published As

Publication number Publication date
JPH095115A (en) 1997-01-10

Similar Documents

Publication Publication Date Title
US4856607A (en) Apparatus for automatically setting steering center for use in power steering apparatus
US20050213111A1 (en) Position detecting device
KR920002347B1 (en) Velocity control system
JP3370845B2 (en) Absolute encoder
JPS62213537A (en) Rotor rotational position detector for motor
KR0185465B1 (en) Absolute encoder and method of generating its current position
JP3329142B2 (en) Position detection circuit
US5099197A (en) Method of determining the rotational speed of a machine, and device for performing the method
JP3528949B2 (en) Absolute position detection device for output rotary shaft
JPH0565827B2 (en)
JPH10315173A (en) Abnormality detector for robot
US4642542A (en) Velocity control systems
KR0180971B1 (en) Positioning apparatus
AU2012272221B2 (en) Method and device for the cyclic digital transmission of a position value of a moving object with inertial mass
US5900711A (en) Stepping motor driving apparatus
KR100518638B1 (en) processing method of Multi-turn type Encoder
JP3265811B2 (en) Servo motor control device
KR100377362B1 (en) Monitoring camera and controlling method thereof
US6167108A (en) Method of processing signals of encoders and apparatus employing the same
US5949208A (en) Circuit and method for controlling a DC motor
JP3273836B2 (en) Encoder signal output method
KR100383994B1 (en) A error detecting method of incremental encoder
JPH0719849A (en) Apparatus and method for reading position
JP3320454B2 (en) Motor position control device and motor position control method
JPH0448598B2 (en)

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