JPH08313298A - Apparatus and method for detecting origin position - Google Patents

Apparatus and method for detecting origin position

Info

Publication number
JPH08313298A
JPH08313298A JP12241695A JP12241695A JPH08313298A JP H08313298 A JPH08313298 A JP H08313298A JP 12241695 A JP12241695 A JP 12241695A JP 12241695 A JP12241695 A JP 12241695A JP H08313298 A JPH08313298 A JP H08313298A
Authority
JP
Japan
Prior art keywords
pulse
dog
rotary shaft
origin position
origin
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.)
Withdrawn
Application number
JP12241695A
Other languages
Japanese (ja)
Inventor
Hiroo Karube
裕夫 軽部
Ichiro Mino
伊知郎 三野
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.)
Canon Inc
Original Assignee
Canon Inc
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 Canon Inc filed Critical Canon Inc
Priority to JP12241695A priority Critical patent/JPH08313298A/en
Publication of JPH08313298A publication Critical patent/JPH08313298A/en
Withdrawn legal-status Critical Current

Links

Abstract

PURPOSE: To detect an origin by the simplest constitution of a pair of dogs and an origin sensor which eliminates a special construction even when an operating range of a rotary shaft exceeds 360 deg.. CONSTITUTION: The rotation of a driving source for diving a rotary shaft of a robot or the like is transmitted to the rotary shaft via a mechanism of a fractional acceleration/deceleration ratio. The rotary shaft is rotated in a CW direction or CCW direction in accordance with states of a dog and a sensor for detecting the presence/absence of the dog (steps S1-S4). When a positional relation between the dog and the sensor becomes equal (step S7), the rotary shaft is rotated in the CCW direction, and with the utilization of the fact that a count of pulses of an encoder fitted to the driving source becomes different by a controlling point of view, an origin can be detected at every rotational angular position even when a rotating range of the rotary shaft exceeds 360 deg. (steps S10-S13).

Description

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

【0001】[0001]

【産業上の利用分野】本発明は、ロボット等の回転軸に
おいて、特に1回転以上回転する軸の原点位置検出装置
及びその検出方法に関するものである。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to an origin position detecting device for a rotary shaft of a robot or the like, and more particularly to a shaft that rotates more than one revolution and a detecting method therefor.

【0002】[0002]

【従来の技術】従来の回転軸の構成は、大きく次の2種
類に大別される。 (1)駆動源と回転軸の軸芯が同一の場合、駆動源とな
るモーターの回転を、減速機等を介して直接回転軸に伝
達する構成。
2. Description of the Related Art The structure of a conventional rotary shaft is roughly classified into the following two types. (1) When the drive source and the rotary shaft have the same axis, the rotation of the motor serving as the drive source is directly transmitted to the rotary shaft via a speed reducer or the like.

【0003】図10に従来例としての駆動源と回転軸の
軸芯が同一の場合の回転軸を示す。 (2)駆動源と回転軸の軸芯が異なる場合、駆動源とな
るモーターの回転を、1対のベルトとプーリー、あるい
は1対のギヤ等を介して回転軸に伝達する構成。図11
に従来例としての駆動源と回転軸の軸芯が異なる場合の
回転軸を示す。
FIG. 10 shows a rotary shaft in the case where the drive source and the rotary shaft have the same axis as a conventional example. (2) When the drive source and the rotary shaft have different axes, the rotation of the motor serving as the drive source is transmitted to the rotary shaft via a pair of belts and pulleys, a pair of gears, or the like. Figure 11
Fig. 3 shows a rotary shaft in the case where the drive source and the rotary shaft have different axes as a conventional example.

【0004】[0004]

【発明が解決しようとする課題】以上、前述2つの構成
での回転軸の原点位置検出装置の従来例としては、 (1)駆動源と回転軸の軸芯が同一の場合 1).回転軸に取付けたドグを原点センサーで検出する方
法 原点センサーにおけるドグの有無によるON,OFFの
みで判別する方法が、最も一般的で簡単な原点位置検出
装置であり、コスト、スペース的にも有利である。しか
し、回転軸が1回転以上回転すると、原点センサーとド
グの位置関係が同一となる部分が生じる。従ってこの方
法では、回転軸の動作範囲は、1回転(360°)未満
となる。
As described above, the conventional examples of the origin position detecting device for the rotary shaft in the above-mentioned two configurations are as follows: (1) When the drive source and the rotary shaft have the same axis 1). The method of detecting the dog attached to the origin sensor with the origin sensor The method of determining only by ON / OFF depending on the presence / absence of the dog in the origin sensor is the most general and simple origin position detection device, and is advantageous in terms of cost and space. . However, when the rotation shaft rotates one or more times, there is a portion where the positional relationship between the origin sensor and the dog is the same. Therefore, in this method, the operating range of the rotating shaft is less than one rotation (360 °).

【0005】2).回転軸に取付けた遅延ドグにて検出す
る方法 回転軸の回転に対し、ある角度遅延して、追随しながら
回転動作するドグを設ける。これにより、回転軸の動作
範囲が1回転(360°)以上となっても、ドグの動作
範囲は1回転(360°)未満となる。このドグを原点
センサーにより検出する方法がある。しかしこの方法
は、特開昭62−282892など多くの方式がある
が、いずれもドグの構成が複雑、スペースが大きくなる
等の問題がある。
2). Method of detecting with a delay dog attached to the rotary shaft A dog is provided which is rotated by following a certain angle delay with respect to the rotation of the rotary shaft. As a result, even if the operating range of the rotary shaft is one rotation (360 °) or more, the operating range of the dog is less than one rotation (360 °). There is a method of detecting this dog by an origin sensor. However, this method has many methods such as Japanese Patent Laid-Open No. 62-282892, but all of them have problems such as a complicated dog structure and a large space.

【0006】3).回転軸に回転角度の絶対位置検出手段
を設ける方法 絶対位置検出エンコーダ等を回転軸に取付ける方法があ
る。回転軸の絶対位置の検出とともに基準位置からの回
転角度も検出することで、回転動作範囲が1回転(36
0°)以上の場合の原点位置を検出可能である。しかし
この場合、回転角度検出の信号処理回路の構成が複雑に
なる。また、センサー等多くの検出手段を配置しなけれ
ばならない。また、高価な絶対位置検出用エンコーダが
必要であるなど技術的、コスト的にも多くの問題を有す
る。
3). Method of Providing Absolute Position Detecting Means of Rotation Angle on Rotating Shaft There is a method of mounting an absolute position detecting encoder or the like on the rotating shaft. By detecting the absolute position of the rotation axis and the rotation angle from the reference position, the rotation operation range can be one rotation (36
It is possible to detect the origin position in the case of 0 ° or more. However, in this case, the configuration of the signal processing circuit for detecting the rotation angle becomes complicated. Also, many detection means such as sensors must be arranged. Further, there are many technical and cost problems such as the need for an expensive encoder for absolute position detection.

【0007】(2)駆動源と回転軸の軸芯が異なる場
合、 この場合、例えば駆動側のプーリーの歯数を回転軸側の
プーリーの歯数より多くする等の手段により、回転軸側
を増速させる機構を設け、駆動側は1回転しなくとも回
転軸側は1回転以上回転するようにする。この駆動側に
回転軸に取付けたドグを原点センサーで検出するような
一般的な原点検出機構を設けることにより、回転軸の動
作範囲が1回転(360°)以上の原点位置検出が可能
となる。
(2) When the drive source and the rotary shaft have different axial cores, in this case, the rotary shaft side is moved by means such as making the number of teeth of the pulley on the drive side larger than the number of teeth of the pulley on the rotary shaft. A mechanism for increasing the speed is provided so that the drive shaft does not rotate once but the rotating shaft rotates one or more rotations. By providing a general origin detection mechanism that detects the dog attached to the rotary shaft on the drive side with the origin sensor, it becomes possible to detect the origin position of the rotary shaft operating range of one rotation (360 °) or more. .

【0008】しかしこの場合、駆動軸側と回転軸側の増
速機構部で発生するバックラッシュ、また増速すること
による原点検出時の誤差等が増速比分拡大するといった
精度的な問題がある。更に軸芯が異なることによる回転
軸機構全体としてのスペースが大きくなるといった問題
がある。
However, in this case, there is a precision problem that backlash occurs in the speed increasing mechanism on the drive shaft side and the rotating shaft side, and an error in origin detection due to the speed increase is increased by the speed increasing ratio. . Furthermore, there is a problem that the space of the entire rotary shaft mechanism becomes large due to the different shaft cores.

【0009】そこで本発明の解決すべき課題は、回転軸
の動作範囲が360°を越えるような場合においても、
特別な構造が不要な最も簡単な1対のドグと原点センサ
ーの構成により原点検出を行なうことである。
Therefore, the problem to be solved by the present invention is that even when the operating range of the rotary shaft exceeds 360 °,
Origin detection is performed by the simplest pair of dog and origin sensor configuration that does not require a special structure.

【0010】[0010]

【課題を解決するための手段】及び[Means for Solving the Problems] and

【作用】本発明の課題を解決するための構成として、請
求項1は、1回転以上の動作範囲を有する回転軸の原点
位置を検出するための装置において、前記の回転軸を駆
動するための駆動源が発する第1のパルスと第2のパル
ス、及び前記の回転軸上のドグとそのドグの有無を検知
するためのセンサーにより、前記の動作範囲内の全ての
位置において原点を検出することを特徴とする原点位置
検出装置である。
As a structure for solving the problems of the present invention, claim 1 is a device for detecting the origin position of a rotary shaft having an operation range of one rotation or more, for driving the rotary shaft. Detecting the origin at all positions within the operating range by the first pulse and the second pulse generated by the drive source, the dog on the rotation axis and the sensor for detecting the presence or absence of the dog. Is an origin position detecting device.

【0011】請求項2は、前記の駆動源及び回転軸の増
減速比が、端数であることを特徴とする請求項1記載の
原点位置検出装置である。これにより回転方向が異なれ
ば、ドグの位置が同じ場合に、基準となる第2のパルス
との位置関係を捉えることにより原点位置の検出が行な
える。
A second aspect of the present invention is the origin position detecting device according to the first aspect, wherein the acceleration / deceleration ratio of the drive source and the rotary shaft is a fraction. Accordingly, if the rotation direction is different and the dog position is the same, the origin position can be detected by capturing the positional relationship with the reference second pulse.

【0012】請求項3は、前記のドグは、前記の回転軸
の任意の位置に固定されていることを特徴とする請求項
1記載の原点位置検出装置である。この場合、ドグが回
転軸と一体に回転する原点位置検出装置である。
A third aspect of the present invention is the origin position detecting device according to the first aspect, wherein the dog is fixed at an arbitrary position of the rotary shaft. In this case, the dog is an origin position detection device that rotates integrally with the rotation shaft.

【0013】請求項4は、前記の回転軸が所定の範囲を
回転する間、第1のパルスを計数する手段と、その計数
された値と予め設定した基準値を比較する手段を備えた
ことを特徴とする請求項1記載の原点位置検出装置であ
る。
According to a fourth aspect of the present invention, there is provided means for counting the first pulse and means for comparing the counted value with a preset reference value while the rotary shaft rotates in a predetermined range. The origin position detecting device according to claim 1.

【0014】請求項5は、前記の基準値は、前記のドグ
が所定の位置より右または左回転を開始してから前記の
第2のパルスを最初に検知するまでの間の前記の第1の
パルスの左右それぞれの計数値であることを特徴とする
請求項4記載の原点位置検出装置である。これによりド
グの位置が同じでも、なす角が異なっていることを具体
的に表現することができた。
According to a fifth aspect of the present invention, the reference value is the first value from when the dog starts rotating right or left from a predetermined position to when the second pulse is first detected. 5. The origin position detecting device according to claim 4, wherein the count values are the left and right count values of the pulse. As a result, it was possible to specifically express that the angles formed were different even if the dog positions were the same.

【0015】請求項6は、前記の回転軸が所定の範囲を
回転する間は、前記のドグが所定の位置より右または左
回転を開始してから前記の第2のパルスを最初に検知す
るまでの間であることを特徴とする請求項4記載の原点
位置検出装置である。これにより基準値との比較の条件
を同じにすることができた。
According to a sixth aspect of the present invention, the second pulse is first detected after the dog starts rotating right or left from a predetermined position while the rotation shaft rotates in a predetermined range. The origin position detecting device according to claim 4, characterized in that This allowed the conditions for comparison with the reference value to be the same.

【0016】請求項7は、前記の第1のパルスは、前記
の駆動源が回転に従って所定の分解能で発するパルスで
あることを特徴とする請求項4記載の原点位置検出装置
である。これにより原点位置検出のための最も基礎的な
信号を得ることができた。
A seventh aspect of the present invention is the origin position detecting apparatus according to the fourth aspect, wherein the first pulse is a pulse emitted by the drive source with a predetermined resolution as the drive source rotates. This made it possible to obtain the most basic signal for detecting the origin position.

【0017】請求項8は、前記の第2のパルスは、前記
の駆動源が1回転毎に発するパルスであることを特徴と
する請求項4記載の原点位置検出装置である。これによ
り回転軸に回転角度を把握するための特別な構成を持た
なくても、回転の基準となる信号を得ることができた。
According to an eighth aspect of the present invention, the origin position detecting device according to the fourth aspect is characterized in that the second pulse is a pulse generated by the drive source every one rotation. This makes it possible to obtain a signal that serves as a reference for rotation, even if the rotation shaft does not have a special configuration for grasping the rotation angle.

【0018】また、同課題の解決のための他の構成とし
て、請求項9は、1回転以上の動作範囲を有する回転軸
の原点位置を検出するための装置において、前記の回転
軸を駆動するための駆動源が発する第1のパルスと第2
のパルス、及び前記の回転軸上のドグとそのドグの有無
を検知するためのセンサーにより、前記の動作範囲内の
全ての位置において原点を検出することを特徴とする原
点位置検出方法である。
As another configuration for solving the same problem, a ninth aspect of the present invention is a device for detecting the origin position of a rotary shaft having an operation range of one rotation or more, which drives the rotary shaft. The first pulse and the second pulse generated by the driving source for
The origin position detecting method is characterized in that the origin is detected at all positions within the operating range by the pulse of, the dog on the rotation axis, and the sensor for detecting the presence or absence of the dog.

【0019】請求項10は、前記の駆動源及び回転軸の
増減速比が、端数であることを特徴とする請求項9記載
の原点位置検出方法である。これにより回転方向が異な
れば、ドグの位置が同じ場合に、基準となる第2のパル
スとの位置関係を捉えることにより原点位置の検出が行
なえる。
A tenth aspect of the present invention is the origin position detecting method according to the ninth aspect, wherein the acceleration / deceleration ratio of the drive source and the rotary shaft is a fraction. Accordingly, if the rotation direction is different and the dog position is the same, the origin position can be detected by capturing the positional relationship with the reference second pulse.

【0020】請求項11は、前記のドグは、前記の回転
軸の任意の位置に固定されていることを特徴とする請求
項9記載の原点位置検出方法である。この場合、ドグが
回転軸と一体に回転する原点位置検出装置である。
The eleventh aspect of the present invention is the origin position detecting method according to the ninth aspect, wherein the dog is fixed at an arbitrary position of the rotary shaft. In this case, the dog is an origin position detection device that rotates integrally with the rotation shaft.

【0021】請求項12は、前記の回転軸が所定の範囲
を回転する間、第1のパルスを計数し、その計数された
値と予め設定した基準値を比較することを特徴とする請
求項9記載の原点位置検出方法である。
According to a twelfth aspect of the present invention, the first pulse is counted while the rotating shaft rotates in a predetermined range, and the counted value is compared with a preset reference value. 9 is the origin position detection method.

【0022】請求項13は、前記の基準値は、前記のド
グが所定の位置より右または左回転を開始してから前記
の第2のパルスを最初に検知するまでの間の前記の第1
のパルスの左右それぞれの計数値であることを特徴とす
る請求項12記載の原点位置検出方法である。これによ
りドグの位置が同じでも、なす角が異なっていることを
具体的に表現することができた。
According to a thirteenth aspect of the present invention, the reference value is the first value from when the dog starts rotating right or left from a predetermined position to when the second pulse is first detected.
13. The origin position detection method according to claim 12, wherein the count values are the left and right count values of the pulse. As a result, it was possible to specifically express that the angles formed were different even if the dog positions were the same.

【0023】請求項14は、前記の回転軸が所定の範囲
を回転する間は、前記のドグが所定の位置より右または
左回転を開始してから前記の第2のパルスを最初に検知
するまでの間であることを特徴とする請求項12記載の
原点位置検出方法である。これにより基準値との比較の
条件を同じにすることができた。
According to a fourteenth aspect of the present invention, the second pulse is first detected after the dog starts rotating right or left from a predetermined position while the rotation shaft rotates in a predetermined range. 13. The origin position detecting method according to claim 12, characterized in that This allowed the conditions for comparison with the reference value to be the same.

【0024】請求項15は、前記の第1のパルスは、前
記の駆動源が回転に従って所定の分解能で発するパルス
であることを特徴とする請求項12記載の原点位置検出
方法である。これにより原点位置検出のための最も基礎
的な信号を得ることができた。
According to a fifteenth aspect of the present invention, the origin position detecting method according to the twelfth aspect is characterized in that the first pulse is a pulse emitted by the drive source with a predetermined resolution in accordance with the rotation. This made it possible to obtain the most basic signal for detecting the origin position.

【0025】請求項16は、前記の第2のパルスは、前
記の駆動源が1回転毎に発するパルスであることを特徴
とする請求項12記載の原点位置検出方法である。これ
により回転軸に回転角度を把握するための特別な構成を
持たなくても、回転の基準となる信号を得ることができ
た。
According to a sixteenth aspect of the present invention, the origin position detecting method according to the twelfth aspect is characterized in that the second pulse is a pulse generated by the drive source every one rotation. This makes it possible to obtain a signal that serves as a reference for rotation, even if the rotation shaft does not have a special configuration for grasping the rotation angle.

【0026】[0026]

【実施例】【Example】

(実施例1)以下に本発明の一実施例を図1〜図9を参
照して詳細に説明する。
(Embodiment 1) An embodiment of the present invention will be described in detail below with reference to FIGS.

【0027】まず図1、図2を参照して装置の構成を説
明する。
First, the structure of the apparatus will be described with reference to FIGS.

【0028】図1は、本発明の一実施例としてのロボッ
ト先端の回転軸の要部中心断面図である。
FIG. 1 is a sectional view of the center of a main part of a rotary shaft at the tip of a robot according to an embodiment of the present invention.

【0029】図2は、本発明の一実施例としての図1の
X−X矢視図である。
FIG. 2 is a view taken along the line XX in FIG. 1 as an embodiment of the present invention.

【0030】図1及び図2において、回転軸1は、例え
ばロボットハンド等を取付ける軸であり、スぺーサー
2、大プーリー3、フランジ9と固定されており、本体
アーム4に組込まれたベアリング5により回転可能に支
持されている。駆動モーター6の回転は、小プーリー
7、タイミングベルト8を介して大プーリー3に伝達さ
れ、回転軸1が回転する。フランジ9には、逆U字状の
ストッパーピン14を固定するための不図示の上下方向
の穴及び、その穴から半径方向に溝が加工されている。
ブロック16の長穴状溝16aには玉15が回転軸1に
対してある回転角度の範囲内で遊動(長穴状溝16aの
内部を転がりながら移動)できるように組み込まれてい
る。また、ブロック16の上部には、ストッパーピン1
4が回転した時に、ブロック16に干渉しないためのニ
ゲ溝16bが設けられている。またニゲ溝16bは、長
穴状溝16aと位置が重なる部分においてはつながって
いる。ドグ10及びストッパーピン14は、フランジ9
に固定され、回転軸1と一体に回転する。ブロック16
は、ストッパーピン14がニゲ溝16bの間を移動し、
長穴状溝16aに組込まれた玉15と突き当たるような
位置関係になるように、本体アーム4に固定されたオサ
エフランジ11に取り付けられている。原点センサー1
3は、ブラケット12を介して、本体アーム4に固定さ
れたオサエフランジ11に取り付けられている。すなわ
ち、駆動モーター6が回転すると、回転軸1は小プーリ
ー7と大プーリー3の歯数比分減速された角度(θとす
る)回転し、ドグ10も同一角度(θ)回転する。原点
センサー13は固定であり、上記ドグ10の動作が検出
可能な位置に取付けられている。
In FIGS. 1 and 2, a rotary shaft 1 is a shaft for mounting a robot hand, for example, and is fixed to a spacer 2, a large pulley 3 and a flange 9, and a bearing incorporated in a main body arm 4. It is rotatably supported by 5. The rotation of the drive motor 6 is transmitted to the large pulley 3 via the small pulley 7 and the timing belt 8 to rotate the rotating shaft 1. The flange 9 is provided with a vertical hole (not shown) for fixing the inverted U-shaped stopper pin 14, and a groove is radially formed from the hole.
The ball 15 is incorporated in the slot 16a of the block 16 so as to be free to move (move while rolling inside the slot 16a) within a certain rotation angle range with respect to the rotating shaft 1. In addition, on the upper part of the block 16, the stopper pin 1
A nib groove 16b is provided so as not to interfere with the block 16 when the 4 rotates. The niger groove 16b is connected at a portion where the position overlaps with the slotted groove 16a. The dog 10 and the stopper pin 14 are the flange 9
Is fixed to and rotates integrally with the rotary shaft 1. Block 16
, The stopper pin 14 moves between the nig groove 16b,
It is attached to the tooth flange 11 fixed to the main body arm 4 so that the ball 15 assembled in the slot 16a abuts on the ball. Origin sensor 1
Reference numeral 3 is attached to a flange 11 fixed to the body arm 4 via a bracket 12. That is, when the drive motor 6 rotates, the rotation shaft 1 rotates by an angle (θ) reduced by the tooth number ratio of the small pulley 7 and the large pulley 3, and the dog 10 also rotates by the same angle (θ). The origin sensor 13 is fixed and is attached at a position where the operation of the dog 10 can be detected.

【0031】本実施例の前提として、原点位置での原点
センサー13とドグ10の回転方向の位置関係は、図2
に示す状態とする。そして回転軸1(ドグ10も同一)
の回転角度範囲は、図2に示す位置を原点位置(θ=0
°)とし、±(180°+α)の回転範囲となるようス
トッパーピン14、玉15、ブロック16、長穴状溝1
6a、ニゲ溝16bによって機械的に動作が制限できる
構造となっている。但しαは、α=2°〜10°程度の
小さな角度であるオーバーラン角度とする。また、ドグ
10の形状は図2に示すように180°の範囲を占有す
る半円状とする。
As a premise of this embodiment, the positional relationship in the rotation direction between the origin sensor 13 and the dog 10 at the origin position is shown in FIG.
The state is shown in. And rotary shaft 1 (dog 10 is the same)
The rotation angle range of is the origin position (θ = 0
°), and the stopper pin 14, the ball 15, the block 16, the slotted groove 1 so that the rotation range is ± (180 ° + α).
The structure is such that the operation can be mechanically limited by the 6a and the relief groove 16b. However, α is an overrun angle which is a small angle of α = 2 ° to 10 °. Further, the dog 10 has a semicircular shape occupying a range of 180 ° as shown in FIG.

【0032】次に図3〜図8を参照し回転軸1がθ=±
(180°+α)の範囲で回転した時のドグ10と原点
センサー13の動作を説明する。
Next, referring to FIGS. 3 to 8, the rotation axis 1 is θ = ±.
The operations of the dog 10 and the origin sensor 13 when rotated in the range of (180 ° + α) will be described.

【0033】図3は、本発明の一実施例としての動作説
明図である(回転軸1の回転角度θ=−(180°+
α)の位置)。
FIG. 3 is an operation explanatory view as one embodiment of the present invention (rotation angle θ of the rotary shaft 1 = − (180 ° +
position of α)).

【0034】図4は、本発明の一実施例としての動作説
明図である(回転軸1の回転角度θ=−180°の位
置)。
FIG. 4 is an explanatory view of the operation as one embodiment of the present invention (position of the rotation angle θ of the rotary shaft 1 = −180 °).

【0035】図5は、本発明の一実施例としての動作説
明図である(回転軸1の回転角度θ=0°の位置:原点
位置)。
FIG. 5 is an explanatory view of the operation as one embodiment of the present invention (position of the rotation angle θ of the rotary shaft 1 = 0 °: origin position).

【0036】図6は、本発明の一実施例としての動作説
明図である(回転軸1の回転角度θ=+180°の位
置)。
FIG. 6 is an explanatory view of the operation as one embodiment of the present invention (position of the rotation angle θ of the rotary shaft 1 = + 180 °).

【0037】図7は、本発明の一実施例としての動作説
明図である(回転軸1の回転角度θ=+(180°+
α)の位置)。尚、図5に示すようにθの回転はCW方
向を+(プラス)、CCW方向を−(マイナス)とす
る。
FIG. 7 is a diagram for explaining the operation as one embodiment of the present invention (the rotation angle θ of the rotary shaft 1 = + (180 ° +
position of α)). In addition, as shown in FIG. 5, the rotation of θ is + (plus) in the CW direction and − (minus) in the CCW direction.

【0038】図8は、本発明の一実施例としての回転軸
1の回転角度と原点センサー13の動作の関係を示す図
である。
FIG. 8 is a diagram showing the relationship between the rotation angle of the rotary shaft 1 and the operation of the origin sensor 13 as one embodiment of the present invention.

【0039】(1)回転軸1(ドグ10)の回転角度と
原点センサー13の動作状態の関係 原点センサー13は、ドグ10を検出時にON、未検出
時をOFFとする。回転軸1が原点位置(θ=0°)か
らCW方向に回転し、図5→図6→図7へと回転する場
合、又、反対にCCW方向に図5→図4→図3と回転し
た時の原点センサー13のON/OFFの状態を図8に
示す。すなわち、原点センサー13がONの範囲は、 ・θ=−180°〜−(180°+α)(のエリアと
する) ・θ=0°〜+180° (のエリアと
する) また、原点センサー13がOFFの範囲は、 ・θ=0°〜−180° (のエリアと
する) ・θ=+180°〜+(180°+α)(のエリアと
する) となり、単純に原点センサー13のON,OFFでのみ
で回転軸1の位置を検出しようとすると、図8における
とのエリアの区別、またとのエリアの区別がで
きない。そこで以下の原点検出を行う。
(1) Relationship between Rotation Angle of Rotating Shaft 1 (Dog 10) and Operating State of Origin Sensor 13 The origin sensor 13 turns on when the dog 10 is detected and turns off when it is not detected. When the rotary shaft 1 rotates in the CW direction from the origin position (θ = 0 °) and rotates in the direction of Fig. 5 → Fig. 6 → Fig. 7, and vice versa, it rotates in the CCW direction as shown in Fig. 5 → Fig. 4 → Fig. 3. FIG. 8 shows an ON / OFF state of the origin sensor 13 at the time of performing. That is, the range in which the origin sensor 13 is ON is: θ = −180 ° to − (180 ° + α) (area of) θ = 0 ° to + 180 ° (area of) The range of OFF is: θ = 0 ° to −180 ° (area of) θ = + 180 ° to + (180 ° + α) (area of), simply by turning on and off the origin sensor 13. If the position of the rotary shaft 1 is to be detected only by itself, the areas of and in FIG. 8 cannot be distinguished from each other. Therefore, the following origin detection is performed.

【0040】(2)原点検出のポイント 図8に示すように、駆動モーター6のエンコーダからの
パルスは所定の分解能で出されている。また、C相のパ
ルスは駆動モーター6が1回転したときに1回出てい
る。小プーリー7と大プーリー3の歯数の比を端数の値
とし(例えば、小プーリー7が1回転したときに大プー
リー3は3/4回転等)、減速比を端数とすれば、図8
のようにθ=+180°の位置とθ=−180°の位置
の判別が可能となる。すなわちθ=±180°のそれぞ
れの位置を考えた場合、ドグ10と原点センサー13の
位置関係は同一である(図4、図6参照)。しかし減速
比を端数としたことにより、θ=+180°の位置にお
いてドグ10をCCW方向に回転し、最初にC相のパル
スが出るまでの駆動モーター6のエンコーダが出すパル
ス数21と、同様にθ=−180°の位置においてドグ
10をCCW方向に回転し、最初にC相のパルスが出る
までの駆動モーター6のエンコーダが出すパルス数22
のパルスの数は異なっている。また、駆動モーター6の
C相のパルスとエンコーダのパルス及びドグ10(回転
軸1)の位置関係は常に一定である。このためパルス数
21とパルス数22を比較すれば、回転軸1の回転角度
θ=±(180°+α)の範囲内で原点検出が可能とな
る。
(2) Point of Origin Detection As shown in FIG. 8, the pulse from the encoder of the drive motor 6 is emitted with a predetermined resolution. The C-phase pulse is emitted once when the drive motor 6 makes one rotation. If the ratio of the number of teeth of the small pulley 7 and the large pulley 3 is set as a fractional value (for example, when the small pulley 7 makes one rotation, the large pulley 3 makes 3/4 rotation, etc.)
As described above, the position of θ = + 180 ° and the position of θ = −180 ° can be discriminated. That is, when the respective positions of θ = ± 180 ° are considered, the dog 10 and the origin sensor 13 have the same positional relationship (see FIGS. 4 and 6). However, by setting the reduction ratio as a fraction, the dog 10 is rotated in the CCW direction at the position of θ = + 180 °, and the number of pulses 21 output by the encoder of the drive motor 6 until the first C-phase pulse is output is similar to When the dog 10 is rotated in the CCW direction at the position of θ = −180 °, the number of pulses output by the encoder of the drive motor 6 until the first C-phase pulse is output 22
The number of pulses in is different. The positional relationship between the C-phase pulse of the drive motor 6, the pulse of the encoder, and the dog 10 (rotating shaft 1) is always constant. Therefore, if the number of pulses 21 and the number of pulses 22 are compared, the origin can be detected within the range of the rotation angle θ of the rotary shaft 1 = ± (180 ° + α).

【0041】(3)原点検出方法 前述のように、本実施例でのポイントは、図8のと
のエリア、またとのエリアの判別をどのように行な
うかである。
(3) Origin Detection Method As described above, the point in this embodiment is how to discriminate the areas of and from FIG.

【0042】そこでドグ10(回転軸1)が、または
のエリア内から原点検出する場合は、ドグ10(回転
軸1)を→,→へと回転させ、必ずかのど
ちらかのエリアに移動させる。一方、またはのエリ
アからの原点検出は、最も単純な原点位置への移動手段
(原点センサー13がONならばCCW方向、OFFな
らばCW方向へと回転し、原点センサー13のON/O
FFが切換わった時点で位置修正し、設定の原点位置へ
と移る。)にて行なう。
Therefore, when the dog 10 (rotating shaft 1) detects the origin from within the area of or, the dog 10 (rotating shaft 1) is rotated in the order of →, → to move to either one of the areas. . On the other hand, the origin detection from the or area is the simplest means for moving to the origin position (when the origin sensor 13 is ON, it rotates in the CCW direction, when it is OFF, it rotates in the CW direction, and the origin sensor 13 turns ON / O.
When the FF is switched, the position is corrected and the set origin position is reached. ).

【0043】以下にドグ10(回転軸1)を→,
→へと移動する方法について、図8及び図9を参照し
て説明する。尚、及びのエリアから原点位置への移
動は、前述した一般的な方法を用いるため説明を省略す
る。
In the following, the dog 10 (rotary shaft 1) is →
A method of moving to → will be described with reference to FIGS. 8 and 9. It should be noted that since the general method described above is used for the movement from the areas and to the origin position, the description thereof will be omitted.

【0044】図9は、本発明の一実施例としての処理の
流れを示すフローチャートである。
FIG. 9 is a flow chart showing the flow of processing as an embodiment of the present invention.

【0045】ここで駆動モーター6が1回転以上2回転
以下(例えば1.5回転程度)するまでにエンコーダが
出すパルス数をサーチパルス数とする。
Here, the number of pulses output by the encoder before the drive motor 6 makes one revolution or more and two revolutions or less (for example, about 1.5 revolutions) is defined as the number of search pulses.

【0046】処理を始めるに当たって、まずドグ10が
原点位置にあるかどうかを確認する(ステップS1)。
原点位置にあれば原点センサー13がONなので、ドグ
10(回転軸1)の回転方向をCW方向とする(ステッ
プS2)。一方原点位置になければ原点センサー13が
OFFなので、ドグ10(回転軸1)の回転方向をCC
W方向とする(ステップS3)。ステップS4におい
て、それぞれの方向に回転を開始し、原点センサー13
のON/OFF状態の変化の有無を監視する(ステップ
S5)。前述のサーチパルスの数まで駆動モーター6の
回転を継続しても原点センサー13のON/OFF状態
が変化しない場合(ステップS6)は、原点位置への移
動処理(ステップS14)に進む。一方ステップS5に
おいて、前述のサーチパルスの数まで駆動モーター6を
回転させる前に原点センサー13のON/OFF状態が
変化した場合は、原点センサー13のON/OFFを確
認する(ステップS7)。原点センサー13がOFFの
場合は、ドグ10(回転軸1)の回転方向をそれまでと
反対方向に回転させる(ステップS8)。ステップS7
において、原点センサー13がONの場合は、駆動モー
ター6のエンコーダの出すパルスのカウンターを0にリ
セットし(ステップS9)、ドグ10(回転軸1)をC
CW方向への回転を開始する(ステップS10)。CC
W方向への回転を開始してから駆動モーター6のC相の
パルスが最初に発生するのを監視し(ステップS1
1)、C相のパルスが発生したときの駆動モーター6の
エンコーダが出すパルスのカウンターの値を、前述のパ
ルス数21あるいはパルス数22と比較する(ステップ
S12)。その結果がパルス数21と等しい場合は、原
点位置への移動処理(ステップS14)に進む。一方パ
ルス数22と等しい場合は、サーチパルス数にあたる分
だけドグ10(回転軸1)をCW方向へ回転させ(ステ
ップS13)、原点位置への移動処理(ステップS1
4)に進む。
Before starting the processing, it is first confirmed whether or not the dog 10 is at the origin position (step S1).
If it is at the origin position, the origin sensor 13 is ON, so the rotation direction of the dog 10 (rotation shaft 1) is set to the CW direction (step S2). On the other hand, if it is not at the origin position, the origin sensor 13 is OFF, so the rotation direction of the dog 10 (rotation axis 1) is CC.
The direction is W (step S3). In step S4, rotation starts in each direction, and the origin sensor 13
The presence / absence of a change in the ON / OFF state of is monitored (step S5). If the ON / OFF state of the origin sensor 13 does not change even if the rotation of the drive motor 6 is continued until the number of search pulses described above (step S6), the process proceeds to the movement processing to the origin position (step S14). On the other hand, in step S5, if the ON / OFF state of the origin sensor 13 is changed before the drive motor 6 is rotated up to the number of search pulses, the ON / OFF state of the origin sensor 13 is confirmed (step S7). When the origin sensor 13 is OFF, the dog 10 (rotating shaft 1) is rotated in the opposite direction (step S8). Step S7
In the case where the origin sensor 13 is ON, the pulse counter output from the encoder of the drive motor 6 is reset to 0 (step S9), and the dog 10 (rotary shaft 1) is rotated to C
The rotation in the CW direction is started (step S10). CC
It is monitored that the C-phase pulse of the drive motor 6 is first generated after the rotation in the W direction is started (step S1).
1) The value of the pulse counter output by the encoder of the drive motor 6 when the C-phase pulse is generated is compared with the above-mentioned pulse number 21 or pulse number 22 (step S12). If the result is equal to the number of pulses 21, the process proceeds to the movement to the origin position (step S14). On the other hand, if the number of pulses is equal to 22, the dog 10 (rotating shaft 1) is rotated in the CW direction by the number corresponding to the number of search pulses (step S13), and processing for moving to the origin position (step S1) is performed.
Proceed to 4).

【0047】(他の実施例) (1)図2において、ドグ10の形状は180°の範囲
を専有する半円状としているが、例えば、ドグの角度を
90°とすれば、回転軸1の回転範囲をθ=+90°+
α〜−(270°+α)にすることができる。すなわ
ち、ドグの角度をβとすると、回転角度θは、θ=+
(β+α)〜−(360°−β+α)、又、原点センサ
ーON,OFFを逆にすれば、θ=+(360°−β+
α)〜−(β+α)という関係になり、任意の角度範囲
で設定が可能である。
(Other Embodiments) (1) In FIG. 2, the dog 10 has a semicircular shape having a range of 180 °, but if the dog angle is 90 °, for example, the rotating shaft 1 Rotation range of θ = + 90 ° +
It can be α to − (270 ° + α). That is, if the dog angle is β, the rotation angle θ is θ = +
(Β + α) to − (360 ° −β + α), or by reversing the origin sensor ON and OFF, θ = + (360 ° −β +
There is a relationship of α) to − (β + α), which can be set in any angle range.

【0048】(2)図1において、端数の減速比を得る
ために1対のプーリーを使用している。そのため駆動源
と回転軸の軸芯が異なっているが、端数の減速機を用い
れば、駆動源と回転軸を同一軸芯とできる。
(2) In FIG. 1, a pair of pulleys is used to obtain a fractional reduction ratio. Therefore, the drive source and the rotary shaft have different axes, but if a fractional speed reducer is used, the drive source and the rotary shaft can be made to have the same axis.

【0049】(3)減速のみでなく、端数の増速機構を
設けた場合にも適用は可能である。
(3) Not only deceleration but also a case where a fraction speedup mechanism is provided is applicable.

【0050】(4)図1において、1対のプーリーを1
対のギヤ、1対のローラ等の伝達機構に変更してもよ
い。
(4) In FIG. 1, one pair of pulleys is
You may change to a transmission mechanism, such as a pair of gears and a pair of rollers.

【0051】(5)図8において、パルス数21とパル
ス数22の値が異なり、かつ原点センサーON/OFF
の位置と駆動モーターのC相のパルスの位置が異なれば
その他の構成でもよい。すなわち増減速比が端数でなく
ともよい。
(5) In FIG. 8, the values of the pulse number 21 and the pulse number 22 are different, and the origin sensor is ON / OFF.
Other configurations may be used as long as the position of and the position of the C-phase pulse of the drive motor are different. That is, the acceleration / deceleration ratio does not have to be a fraction.

【0052】尚、本発明は、複数の機器から構成される
システムに適用しても、1つの機器から成る装置に適用
しても良い。また、本発明はシステム或は装置にプログ
ラムを供給することによって達成される場合にも適用で
きることはいうまでもない。 <実施例の効果> (1)減速比を端数とし、基準となる駆動モーター6の
C相のパルスとの位置関係を捉えることにより、ドグ1
0(回転軸1)のθ=+180°の位置とθ=−180
°の位置の判別が可能となった。 (2)ドグ10(回転軸1)が、またはのエリア内
から原点検出する場合、→,→へと回転させ、
必ずかのどちらかのエリアに移動させることによ
り、原点検出の処理と原点位置への移動処理をシンプル
に分割することができた。 (3)サーチパルス数を駆動モーター6が1回転以上2
回転以下(例えば1.5回転程度)するまでにエンコー
ダが出すパルス数としたことにより、C相のパルス間隔
よりも長く、かつ駆動モーター6を必要以上に長時間回
転させることを防げた。 (4)ドグ10が原点位置にあれば、ドグ10(回転軸
1)の回転方向をCW方向、一方原点位置になければド
グ10(回転軸1)の回転方向をCCW方向としたこと
により、どの位置からの原点検出においても、駆動モー
ター6がドグ10(回転軸1)を回転範囲の外へ移動さ
せることを防ぐことができた。 (5)サーチパルス数の分だけドグ10(回転軸1)を
回転させても原点センサー13の状態変化がない場合以
外は、どの位置からの原点検出においても、ドグ10の
位置を図4または図6の状態(すなわちθ=±180°
のそれぞれの位置)に移動させて統一することにより、
それ以降の処理を場合分けすることなく1つの処理の流
れで行なうことができた。 (6)エンコーダの出すパルスのカウンターを0にリセ
ットし、かつドグ10(回転軸1)を回転させ、最初に
C相のパルスが出るまでのエンコーダのパルス数をパル
ス数21とパルス数22と比較することにより、シンプ
ルな方法で駆動モーター6のC相のパルスとエンコーダ
のパルス及びドグ10(回転軸1)の位置関係が常に一
定であることを利用してθ=±180°のそれぞれの位
置を検出することができた。
The present invention may be applied to a system composed of a plurality of devices or an apparatus composed of one device. Further, it goes without saying that the present invention can be applied to the case where it is achieved by supplying a program to a system or an apparatus. <Effects of the Embodiment> (1) By using the reduction ratio as a fraction and grasping the positional relationship with the C-phase pulse of the drive motor 6 serving as a reference, the dog 1
The position of 0 (rotary axis 1) at θ = + 180 ° and θ = −180
It became possible to determine the position of °. (2) When the dog 10 (rotating shaft 1) detects the origin from within the area of or, rotate it to →, →
By always moving to either of the areas, the processing of origin detection and the processing of moving to the origin position could be simply divided. (3) The number of search pulses is equal to or more than 1 rotation of the drive motor 6 2
By setting the number of pulses output by the encoder before the rotation is performed (for example, about 1.5 rotations), it is possible to prevent the drive motor 6 from rotating longer than necessary and longer than the C-phase pulse interval. (4) If the dog 10 is at the origin position, the rotation direction of the dog 10 (rotating shaft 1) is the CW direction, and if not at the origin position, the rotation direction of the dog 10 (rotating shaft 1) is the CCW direction. It was possible to prevent the drive motor 6 from moving the dog 10 (rotating shaft 1) out of the rotation range in detecting the origin from any position. (5) Except when the state of the origin sensor 13 does not change even if the dog 10 (rotating shaft 1) is rotated by the number of search pulses, the position of the dog 10 is set to the position shown in FIG. The state of FIG. 6 (that is, θ = ± 180 °
By moving to each position) and unifying
The subsequent processing could be performed by one processing flow without dividing the case. (6) Reset the counter of the pulse output by the encoder to 0, rotate the dog 10 (rotary shaft 1), and set the number of pulses of the encoder until the C-phase pulse is first output to 21 and 22 pulses. By comparison, by utilizing the fact that the positional relationship between the pulse of the C phase of the drive motor 6 and the pulse of the encoder and the dog 10 (rotating shaft 1) is always constant by a simple method, θ = ± 180 ° The position could be detected.

【0053】[0053]

【発明の効果】以上説明したように、本発明によれば、
回転軸の動作範囲が360°を越えるような場合におい
ても、特別な構造が不要な最も簡単な1対のドグと原点
センサーの構成により原点検出が可能となる。更に、増
減速どちらの機構でも可能であると共に、幅広い範囲の
増減速比にも適用することが可能となる。
As described above, according to the present invention,
Even when the operating range of the rotary shaft exceeds 360 °, the origin can be detected by the simplest pair of dog and origin sensor configuration that does not require a special structure. Further, both the acceleration and deceleration mechanisms are possible, and the invention can be applied to a wide range of acceleration and deceleration ratios.

【0054】[0054]

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

【図1】本発明の一実施例としてのロボット先端の回転
軸の要部中心断面図である。
FIG. 1 is a central sectional view of a main part of a rotary shaft at a tip of a robot as an embodiment of the present invention.

【図2】本発明の一実施例としての図1のX−X矢視図
である。
FIG. 2 is a view on arrow XX in FIG. 1 as one embodiment of the present invention.

【図3】本発明の一実施例としての動作説明図である
(回転軸1の回転角度θ=−(180°+α)の位置)
FIG. 3 is an operation explanatory diagram as one embodiment of the present invention (position of rotation angle θ of rotary shaft 1 = − (180 ° + α)).

【図4】本発明の一実施例としての動作説明図である
(回転軸1の回転角度θ=−180°の位置)。
FIG. 4 is an operation explanatory diagram as one embodiment of the present invention (position of rotation angle θ of rotary shaft 1 = −180 °).

【図5】本発明の一実施例としての動作説明図である
(回転軸1の回転角度θ=0°の位置:原点位置)。
FIG. 5 is an operation explanatory diagram as one embodiment of the present invention (position of rotation angle θ of the rotary shaft 1 = 0 °: origin position).

【図6】本発明の一実施例としての動作説明図である
(回転軸1の回転角度θ=+180°の位置)。
FIG. 6 is an operation explanatory view as one embodiment of the present invention (position of rotation angle θ of rotation shaft 1 = + 180 °).

【図7】本発明の一実施例としての動作説明図である
(回転軸1の回転角度θ=+(180°+α)の位
置)。
FIG. 7 is an operation explanatory diagram as one embodiment of the present invention (position of rotation angle θ of rotation shaft 1 = + (180 ° + α)).

【図8】本発明の一実施例としての回転軸1の回転角度
と原点センサー13の動作の関係を示す図である。
FIG. 8 is a diagram showing the relationship between the rotation angle of the rotary shaft 1 and the operation of the origin sensor 13 as one embodiment of the present invention.

【図9】本発明の一実施例としての処理の流れを示すフ
ローチャートである。
FIG. 9 is a flowchart showing a flow of processing as an embodiment of the present invention.

【図10】従来例としての駆動源と回転軸の軸芯が同一
の場合の回転軸を示す図である。
FIG. 10 is a diagram showing a rotary shaft in the case where the drive source and the rotary shaft have the same shaft center as a conventional example.

【図11】従来例としての駆動源と回転軸の軸芯が異な
る場合の回転軸を示す図である。
FIG. 11 is a diagram showing a rotating shaft in the case where the drive source and the rotating shaft of the rotating shaft are different from each other as a conventional example.

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

1 回転軸 2 スぺーサ 3 大プーリ 4 本体アーム 5 ベアリング 6 駆動モーター(エンコーダ付) 7 小プーリ 8 ベルト 9 フランジ 10 ドグ 11 オサエフランジ 12 ブラケット 13 原点センサー 14 ストッパーピン 15 玉 16 ブロック 16a 長穴状溝 16b ニゲ溝 21 パルス数 22 パルス数 1 rotary shaft 2 spacer 3 large pulley 4 main body arm 5 bearing 6 drive motor (with encoder) 7 small pulley 8 belt 9 flange 10 dog 11 tooth flange 12 bracket 13 origin sensor 14 stopper pin 15 ball 16 block 16a long hole shape Groove 16b Nige groove 21 pulse number 22 pulse number

Claims (16)

【特許請求の範囲】[Claims] 【請求項1】 1回転以上の動作範囲を有する回転軸の
原点位置を検出するための装置において、 前記の回転軸を駆動するための駆動源が発する第1のパ
ルスと第2のパルス、及び前記の回転軸上のドグとその
ドグの有無を検知するためのセンサーにより、 前記の動作範囲内の全ての位置において原点を検出する
ことを特徴とする原点位置検出装置。
1. A device for detecting an origin position of a rotary shaft having an operation range of one rotation or more, wherein a first pulse and a second pulse emitted from a drive source for driving the rotary shaft, and An origin position detecting device, characterized in that the origin is detected at all positions within the operating range by a dog for detecting the presence or absence of the dog on the rotation axis.
【請求項2】 前記の駆動源及び回転軸の増減速比が、
端数であることを特徴とする請求項1記載の原点位置検
出装置。
2. The acceleration / deceleration ratio of the drive source and the rotary shaft is
The origin position detection device according to claim 1, wherein the origin position detection device is a fractional number.
【請求項3】 前記のドグは、前記の回転軸の任意の位
置に固定されていることを特徴とする請求項1記載の原
点位置検出装置。
3. The origin position detecting device according to claim 1, wherein the dog is fixed at an arbitrary position of the rotary shaft.
【請求項4】 前記の回転軸が所定の範囲を回転する
間、第1のパルスを計数する手段と、 その計数された値と予め設定した基準値を比較する手段
を備えたことを特徴とする請求項1記載の原点位置検出
装置。
4. A means for counting the first pulse while the rotating shaft rotates in a predetermined range, and means for comparing the counted value with a preset reference value. The origin position detecting device according to claim 1.
【請求項5】 前記の基準値は、 前記のドグが所定の位置より右または左回転を開始して
から前記の第2のパルスを最初に検知するまでの間の前
記の第1のパルスの左右それぞれの計数値であることを
特徴とする請求項4記載の原点位置検出装置。
5. The reference value is a value of the first pulse from when the dog starts rotating right or left from a predetermined position to when the second pulse is first detected. The origin position detecting device according to claim 4, wherein the count values are left and right respectively.
【請求項6】 前記の回転軸が所定の範囲を回転する間
は、 前記のドグが所定の位置より右または左回転を開始して
から前記の第2のパルスを最初に検知するまでの間であ
ることを特徴とする請求項4記載の原点位置検出装置。
6. The rotation shaft rotates within a predetermined range from when the dog starts rotating right or left from a predetermined position to when the second pulse is first detected. The origin position detecting device according to claim 4, wherein
【請求項7】 前記の第1のパルスは、 前記の駆動源が回転に従って所定の分解能で発するパル
スであることを特徴とする請求項4記載の原点位置検出
装置。
7. The origin position detecting apparatus according to claim 4, wherein the first pulse is a pulse emitted by the drive source with a predetermined resolution as the drive source rotates.
【請求項8】 前記の第2のパルスは、 前記の駆動源が1回転毎に発するパルスであることを特
徴とする請求項4記載の原点位置検出装置。
8. The origin position detecting device according to claim 4, wherein the second pulse is a pulse generated by the drive source for each rotation.
【請求項9】 1回転以上の動作範囲を有する回転軸の
原点位置を検出するための装置において、 前記の回転軸を駆動するための駆動源が発する第1のパ
ルスと第2のパルス、及び前記の回転軸上のドグとその
ドグの有無を検知するためのセンサーにより、 前記の動作範囲内の全ての位置において原点を検出する
ことを特徴とする原点位置検出方法。
9. An apparatus for detecting an origin position of a rotary shaft having an operation range of one rotation or more, wherein a first pulse and a second pulse emitted from a drive source for driving the rotary shaft, An origin position detecting method, characterized in that the origin is detected at all positions within the operating range by a dog for detecting the presence or absence of the dog on the rotation axis.
【請求項10】 前記の駆動源及び回転軸の増減速比
が、端数であることを特徴とする請求項9記載の原点位
置検出方法。
10. The origin position detecting method according to claim 9, wherein the acceleration / deceleration ratio of the drive source and the rotary shaft is a fraction.
【請求項11】 前記のドグは、前記の回転軸の任意の
位置に固定されていることを特徴とする請求項9記載の
原点位置検出方法。
11. The origin position detecting method according to claim 9, wherein the dog is fixed at an arbitrary position of the rotation shaft.
【請求項12】 前記の回転軸が所定の範囲を回転する
間、第1のパルスを計数し、 その計数された値と予め設定した基準値を比較すること
を特徴とする請求項9記載の原点位置検出方法。
12. The method according to claim 9, wherein the first pulse is counted while the rotating shaft is rotating in a predetermined range, and the counted value is compared with a preset reference value. Origin position detection method.
【請求項13】 前記の基準値は、 前記のドグが所定の位置より右または左回転を開始して
から前記の第2のパルスを最初に検知するまでの間の前
記の第1のパルスの左右それぞれの計数値であることを
特徴とする請求項12記載の原点位置検出方法。
13. The reference value is a value of the first pulse from when the dog starts rotating right or left from a predetermined position to when the second pulse is first detected. 13. The origin position detecting method according to claim 12, wherein the count values are for each of the left and right sides.
【請求項14】 前記の回転軸が所定の範囲を回転する
間は、 前記のドグが所定の位置より右または左回転を開始して
から前記の第2のパルスを最初に検知するまでの間であ
ることを特徴とする請求項12記載の原点位置検出方
法。
14. While the rotation shaft rotates within a predetermined range, from when the dog starts rotating right or left from a predetermined position to when the second pulse is first detected. 13. The origin position detecting method according to claim 12, wherein
【請求項15】 前記の第1のパルスは、 前記の駆動源が回転に従って所定の分解能で発するパル
スであることを特徴とする請求項12記載の原点位置検
出方法。
15. The origin position detecting method according to claim 12, wherein the first pulse is a pulse emitted by the drive source with a predetermined resolution as the drive source rotates.
【請求項16】 前記の第2のパルスは、 前記の駆動源が1回転毎に発するパルスであることを特
徴とする請求項12記載の原点位置検出方法。
16. The origin position detecting method according to claim 12, wherein the second pulse is a pulse generated by the drive source for each rotation.
JP12241695A 1995-05-22 1995-05-22 Apparatus and method for detecting origin position Withdrawn JPH08313298A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP12241695A JPH08313298A (en) 1995-05-22 1995-05-22 Apparatus and method for detecting origin position

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP12241695A JPH08313298A (en) 1995-05-22 1995-05-22 Apparatus and method for detecting origin position

Publications (1)

Publication Number Publication Date
JPH08313298A true JPH08313298A (en) 1996-11-29

Family

ID=14835287

Family Applications (1)

Application Number Title Priority Date Filing Date
JP12241695A Withdrawn JPH08313298A (en) 1995-05-22 1995-05-22 Apparatus and method for detecting origin position

Country Status (1)

Country Link
JP (1) JPH08313298A (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101885110A (en) * 2009-05-15 2010-11-17 三菱电机株式会社 Device for detecting rotational position and laser machine
WO2015074595A1 (en) * 2013-11-21 2015-05-28 科沃斯机器人有限公司 Distance measuring device and method thereof for seeking distance measuring starting point

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101885110A (en) * 2009-05-15 2010-11-17 三菱电机株式会社 Device for detecting rotational position and laser machine
JP2010266362A (en) * 2009-05-15 2010-11-25 Mitsubishi Electric Corp Rotational position detector and laser processing machine
WO2015074595A1 (en) * 2013-11-21 2015-05-28 科沃斯机器人有限公司 Distance measuring device and method thereof for seeking distance measuring starting point
US10663322B2 (en) 2013-11-21 2020-05-26 Ecovacs Robotics Co., Ltd. Distance measuring device and method thereof for seeking distance measuring starting point
US11460328B2 (en) 2013-11-21 2022-10-04 Ecovacs Robotics Co., Ltd. Distance measuring device and method thereof for seeking distance measuring starting point

Similar Documents

Publication Publication Date Title
JP2826556B2 (en) Industrial robot
US4757458A (en) Zero point adjusting robot control method
JPH08313298A (en) Apparatus and method for detecting origin position
JP3800145B2 (en) Vehicle steering device
JP2983462B2 (en) Robot origin return device
JPS6122884B2 (en)
KR940000366B1 (en) Detecting method of robot location
JPH09101175A (en) Multiple rotation type absolute value encoder
JPH0996545A (en) Absolute position detection device of output rotary shaft
JPS61134801A (en) Positioning control device
JPH0454358A (en) Planetary roller speed reducer
JP2000321628A (en) Pan tilt camera device
JPH06278071A (en) Robot original point detecting device
JP2649381B2 (en) Teaching method of rotating linear unit
JP3339787B2 (en) Industrial robot arm travel detector
JP2505520B2 (en) Position detection device for eccentric planetary differential reducer
JPH05104466A (en) Return-to-origin control device for articulated robot
KR940010897B1 (en) Rotational position detector for robot
JPH04340608A (en) Method and device for controlling revolving shaft
JPH01171792A (en) Device for detecting position of linear type robot
JPH0448598B2 (en)
JPS6263302A (en) Position detecting method for mechanical origin of articulated robot
JPS61297092A (en) Rotary mechanism of robot
JPH0993993A (en) Device for detecting step-out of stepping motor
KR100224855B1 (en) Reference return device of robot

Legal Events

Date Code Title Description
A300 Withdrawal of application because of no request for examination

Free format text: JAPANESE INTERMEDIATE CODE: A300

Effective date: 20020806