Deprecated: The each() function is deprecated. This message will be suppressed on further calls in /home/zhenxiangba/zhenxiangba.com/public_html/phproxy-improved-master/index.php on line 456
JP3738982B2 - Robot origin return method, origin return device and component mounting device - Google Patents
[go: Go Back, main page]

JP3738982B2 - Robot origin return method, origin return device and component mounting device - Google Patents

Robot origin return method, origin return device and component mounting device Download PDF

Info

Publication number
JP3738982B2
JP3738982B2 JP2001322405A JP2001322405A JP3738982B2 JP 3738982 B2 JP3738982 B2 JP 3738982B2 JP 2001322405 A JP2001322405 A JP 2001322405A JP 2001322405 A JP2001322405 A JP 2001322405A JP 3738982 B2 JP3738982 B2 JP 3738982B2
Authority
JP
Japan
Prior art keywords
origin
moving body
dog
robot
detection sensor
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
JP2001322405A
Other languages
Japanese (ja)
Other versions
JP2003131711A (en
Inventor
啓史 小原
直人 三村
秀俊 佐々木
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.)
Panasonic Corp
Panasonic Holdings Corp
Original Assignee
Panasonic Corp
Matsushita Electric Industrial Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Panasonic Corp, Matsushita Electric Industrial Co Ltd filed Critical Panasonic Corp
Priority to JP2001322405A priority Critical patent/JP3738982B2/en
Publication of JP2003131711A publication Critical patent/JP2003131711A/en
Application granted granted Critical
Publication of JP3738982B2 publication Critical patent/JP3738982B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Images

Landscapes

  • Numerical Control (AREA)
  • Manipulator (AREA)
  • Supply And Installment Of Electrical Components (AREA)

Description

【0001】
【発明の属する技術分野】
本発明は、ロボットを原点位置に復帰させるための原点復帰方法及び原点復帰装置並びに部品実装装置に関する。
【0002】
【従来の技術】
近年、電子機器は高密度実装が行われ、回路基板(プリント基板)には各種ICはもとより多数の抵抗やコンデンサ等の電子部品が実装される。これら電子部品の実装は、部品実装数が多いこと、正確さが要求されること、生産効率の向上等の理由から部品実装装置により行われている。
以下、従来の部品実装装置の一例を説明する。
図13に斜視図で示すように、部品実装装置100は、その基台10の上部にローダ部16、基板固定部18、アンローダ部20、回路基板12を搬送する一対のガイドレール14が設けられ、一対のガイドレール14に設けた搬送ベルトを同期駆動することによって、回路基板12をローダ部16から電子部品を実装する位置に設けた基板固定部18に、更に基板固定部18からアンローダ部20に搬送するようになっている。
【0003】
また、基台10の上方両側部にはY軸ロボット22,24がそれぞれ設けられ、2つのY軸ロボット22,24間にはX軸ロボット26が懸架されて、Y軸ロボット22,24を駆動することにより、X軸ロボット26がY軸方向に進退するように構成されている。X軸ロボット26には、移載ヘッド28がX軸方向に進退可能に取り付けられている。これにより移載ヘッド28は、Y軸ロボット22,24とX軸ロボット26とを駆動することで、X−Y平面内を自在に移動することができる。
各ロボットは、例えばモータによりボールネジを正逆回転させ、前記ボールネジに螺合したナット部材が軸方向に沿って進退するように構成すると共に、前記ナット部材に進退させるべき部材を固定した構造になっている。
【0004】
移載ヘッド28は、前記のようにX軸ロボット26,Y軸ロボット22,24からなるXYロボット上に載置され、X−Y平面(例えば、水平面または基台10の上面に大略平行な面)上を自在に移動する。移載ヘッド28は、例えば抵抗チップやチップコンデンサ等の電子部品が供給される部品供給部として例示した複数のパーツフィーダ30、又はSOP(「SOP」はSmall Outline Packageの略)やQFP(「QFP」はQuad Flat Packageの略)等のICやコネクタのように比較的大型の電子部品が供給される部品供給部として例示したパーツトレイ32から、吸着ノズル34により所望の電子部品を吸着し、回路基板12の部品装着位置に装着できるように構成されている。
前記電子部品の実装動作は、制御部36の記憶部に記憶され予め設定された実装プログラムに基づいて、制御部36によって制御される。
【0005】
ところで、前記した部品実装装置100によって部品実装を行う場合、実装に先立って移載ヘッド28を原点位置に復帰させておき、原点位置からスタートさせる必要がある。このような原点復帰動作は、図1に概念的に示した原点復帰装置1により行われる。
なお、原点復帰装置1は、前記部品実装装置100におけるY軸ロボット22,24、或いはX軸ロボット26の何れにも適用できるものであり、移動体2は移載ヘッド28に相当するものである。
【0006】
次に、上記の原点復帰動作について図14、図15に基づいて説明する。
図1に示すように移動体2が原点検出センサ8から離れた位置にいるとき、ドグ6と原点検出センサ8との位置も図14(a)に示すように離れている。この状態では、原点検出センサ8はドグ6を検出しないので、原点位置検出信号Sの出力レベルはLoとなる(図15のT1)。そして、移動体2は制御部5によってモータMが高速回転駆動されることで、図中A方向に高速に移動される。
【0007】
移動体2が原点検出センサ8に接近し、図14(b)に示すようにドグ6の一端となる突起部(検出部)6aが原点検出センサ8の直上位置に差し掛かると(図15のT2)、原点位置検出信号SがLoからHiに変化する。このとき、モータMが高速回転から低速回転駆動に移行して、移動体2はA方向に低速移動する。
そして、図14(c)に示すようにドグ6の凹部(検出部間)6cが原点検出センサ8の直上位置に差し掛かったとき(図15のT3)、原点位置検出信号SがHiからLoに変化する。さらに、ドグ6は矢印A方向に低速移動し続けているので、図14(d)に示すようにドグ6の他方の突起部6bが原点検出センサ8の直上位置に到達する(図15のT4)。この時、原点位置検出信号SはLoからHiに変化する。この出力レベルの変化に応じてモータMは一旦回転停止になり、次いで図14(e)に示すように回転駆動方向を逆方向に変化させる。
【0008】
すると、図14(e)に示すようにドグ6は図中B方向に低速で移動し、ドグ6の凹部6cが図14(f)に示すように再び原点検出センサ8の直上位置に差し掛かるようになる(図15のT5)。このとき、原点位置検出信号SはHiからLoに変化し、これを受けてモータMを回転停止させる。これにより、移動体2は惰走動作の後に停止する。この停止位置が原点位置となり、この原点位置を始点として部品実装位置等へ駆動されるようになる。
【0009】
なお、原点復帰動作を行う場合、移動体2が原点検出センサ8を通過して反転センサ9側に位置していることもある。この場合は、反転センサ9によりドグ6を検出し、移動体2の移動方向をA方向からB方向に変換する。そして、移動体2が原点検出センサ8上に移動した時点で、前記同様にドグ6と原点検出センサ8との位置関係によって、移動体2を原点位置に位置決めする。
【0010】
【発明が解決しようとする課題】
このような原点復帰装置では、確実にドグ6の凹部6cを検出するために、原点検出センサ8上を一旦凹部6cが通過した後、モータMを反転駆動して再度凹部6cを検出しなければならず、原点復帰の動作に長い時間を要することになる。仮に、最初に凹部6cを検出したときに原点とすると、電源投入時等にはドグ6の現在位置は不定であるため、原点検出センサ8がドグの凹部を検出しても、これが確実にドグ6の凹部なのか、ドグ6外の範囲であるのかを判別できない。従って、原点位置を誤って設定するおそれが生じる。
このため、複数のロボットを有する部品実装装置等では、部品実装に先立って行われる原点復帰動作に多大な時間を要し、部品実装作業の効率を低下させていた。
【0011】
本発明はこのような状況に鑑みてなされたものであり、ロボットの原点復帰動作を高速に且つ正確に行い得るロボットの原点復帰方法及び原点復帰装置並びに部品実装装置を提供することを目的とする。
【0012】
【課題を解決するための手段】
上記目的達成のため本発明に係る請求項1のロボットの原点復帰方法は、位置検出用のドグが取り付けられた移動体を軸方向に移動自在に構成したロボットに対し、前記ドグを検出する原点検出センサを設け、この原点検出センサの出力に基づいて前記移動体を原点位置に復帰させるロボットの原点復帰方法であって、前記移動体を所定の一定量移動させたときの前記原点検出センサからの出力の変化状態から、前記移動体のドグと前記原点検出センサとの相対位置を判定し、この判定された相対位置に応じた原点復帰動作手順を選択的に実行し、前記原点復帰動作手順が、前記移動体を所定の一定量移動させている間に、前記原点検出センサが、2つの検出部を一定の間隔で配置してなる前記ドグの検出部を検出しなかった場合に、前記移動体の移動を続行して、最初に前記ドグの検出部を検出し、その後検出部間を検出したときに前記移動体を停止させて、前記移動体が静止した位置を原点位置に設定する一方、前記原点検出センサが前記ドグの検出部を検出した場合に、前記移動体を前記ロボットの一端側まで移動させて移動方向を反転させてから、最初に前記ドグの検出部を検出し、その後検出部間を検出したときに前記移動体を停止させて、前記移動体が静止した位置を原点位置に設定する手順であることを特徴とする
【0015】
このロボットの原点復帰方法では、移動体が所定の一定量を移動している間に原点検出センサによるドグの検出が無かった場合は、そのまま移動を続行してドグの検出を行う。その際は、最初にドグの検出部を検出し、その後、続けてドグの検出部間を検出したときに移動体を停止させて、移動体が静止した位置を原点位置として設定する。また、所定の一定量を移動する間にドグを検出した場合は、移動を継続した後に反転させてからドグの検出を行う。その際は、移動体をロボットの一端側まで移動させて移動方向を反転させてから、最初にドグの検出部を検出し、その後、続けてドグの検出部間を検出したときに移動体を停止させて、移動体が静止した位置を原点位置として設定する。これにより、移動体が原点検出センサの位置から離れている場合に、いち早く移動体を原点検出センサに近づけることができ、また、確実且つ正確に移動体の位置を把握できる。
【0016】
請求項2のロボットの原点復帰方法は、位置検出用のドグが取り付けられた移動体を軸方向に移動自在に構成したロボットに対し、前記ドグを検出する原点検出センサを設け、この原点検出センサの出力に基づいて前記移動体を原点位置に復帰させるロボットの原点復帰方法であって、前記移動体を所定の一定量移動させたときの前記原点検出センサからの出力の変化状態から、前記移動体のドグと前記原点検出センサとの相対位置を判定し、この判定された相対位置に応じた原点復帰動作手順を選択的に実行し、前記原点復帰動作手順が、前記移動体の移動開始時と所定の一定量移動させた後とで、前記原点検出センサが、2つの検出部を一定の間隔で配置してなる前記ドグの検出部を検出しなかった場合に、前記移動体の移動を続行して、最初に前記ドグの検出部を検出し、その後検出部間を検出したときに前記移動体を停止させて、前記移動体が静止した位置を原点位置に設定する一方、前記原点検出センサが前記ドグの検出部を検出した場合に、前記移動体を前記ロボットの一端側まで移動させて移動方向を反転させてから、最初に前記ドグの検出部を検出し、その後検出部間を検出したときに前記移動体を停止させて、前記移動体が静止した位置を原点位置に設定する手順であることを特徴とする。
【0017】
このロボットの原点復帰方法では、移動体の移動開始時と所定の一定量移動させた後とで原点検出センサの出力を検出する。その際、原点検出センサがドグの検出部を検出しなかった場合には、移動体の移動を続行して、最初に前記ドグの検出部を検出し、その後にドグの検出部間を続けて検出したときに移動体を停止させて、移動体が静止した位置を原点位置として設定する。また、原点検出センサがドグの検出部を検出した場合には、移動体をロボットの一端側まで移動させて移動方向を反転させてから、最初にドグの検出部を検出し、その後、続けて検出部間を検出したときに移動体を停止させて、移動体が静止した位置を原点位置として設定する。このように、所定距離を隔てた2点で原点検出センサの出力を検出し、移動体の位置を判定するため、その判定処理が簡略化され、原点復帰動作に要する時間をより短縮することができる。
【0018】
請求項記載のロボットの原点復帰方法は、前記ロボットに移動体の移動量を検出するエンコーダを接続し、前記移動体を前記エンコーダからのパルス信号と同期した位置で停止させて原点位置に設定することを特徴とする。
【0019】
このロボットの原点復帰方法では、移動体をエンコーダからのパルス信号と同期した位置で停止させて原点位置を設定することにより、移動体の位置管理が容易となり、正確な原点復帰を行うことができる。
【0020】
請求項記載のロボットの原点復帰装置は、2つの検出部を一定の間隔で配置してなるドグを取り付けた移動体と、該移動体を軸方向に移動自在に支持するガイド部材と、前記ガイド部材に対して前記移動体を移動させる駆動源と、前記移動体のドグを検出する原点検出センサとを備えたロボットの原点復帰装置であって、前記移動体を所定の一定量移動させたときの前記原点検出センサからの出力の変化状態から、前記移動体のドグと前記原点検出センサとの相対位置を判定し、この判定された相対位置に応じた原点復帰動作手順を選択的に実行する制御部を備えたことを特徴とする。
【0021】
このロボットの原点復帰装置では、制御部が、移動体を所定の一定量に移動させたときの原点検出センサからの出力の変化状態を検出し、この変化状態から移動体と原点検出センサとの相対位置関係を判定する。この判定結果に応じて、制御部がそれぞれの相対位置に応じた原点復帰動作手順を選択的に実行することで、ロボットを原点位置に復帰させる。これにより、移動体の位置によらずにロボットの原点復帰動作を高速に且つ正確に行うことができる。
【0022】
請求項記載のロボットの原点復帰装置は、前記制御部が、請求項〜請求項のいずれか1項記載のロボットの原点復帰方法に基づいて原点復帰動作を制御することを特徴とする。
【0023】
このロボットの原点復帰装置では、制御部が前述のロボットの原点復帰方法に基づいて原点復帰動作を制御することで、高速に且つ確実に移動体を原点位置に復帰させることが可能となる。
【0024】
請求項記載の部品実装装置は、基板への実装部品を移載する移載ヘッドを、請求項又は請求項記載のロボットの原点復帰装置を用いて駆動することを特徴とする。
【0025】
この部品実装装置では、部品実装装置に搭載されるロボットが、請求項又は請求項記載のロボットの原点復帰装置から構成されることで、各ロボットの原点復帰時間を大幅に短縮することが可能となる。これにより、移載ヘッドによる電子部品の実装や生産準備動作が迅速に行われ、タクトアップに寄与することができ、生産効率が飛躍的に向上する。
【0026】
【発明の実施の形態】
以下、図面を参照して本発明に係るロボットの原点復帰方法及び原点復帰装置の好適な実施の形態を詳細に説明する。
ここで、図1は本発明に係るロボットの原点復帰装置の構成を概念的に示す構成図、図2はロボットの原点復帰方法を示すフローチャート、図3は詳細を後述する原点検出センサがエリア判定距離内にない場合の原点復帰動作を説明するタイミングチャート、図4は原点検出センサ及び反転センサがエリア判定距離内にある場合の原点復帰動作を説明するタイミングチャートである。
【0027】
本実施形態における原点復帰装置1は、図1に示すように、移動体2が、駆動源であるモータMによって回転駆動されるガイド部材としての回転シャフト4に螺合され、回転シャフト4の回転方向の切り換えによって矢印A,B方向に移動するようになっている。移動体2の一部には、移動体2の位置を検出するための、2つの検出部を一定の間隔で配置してなる凹字型のドグ6が取り付けられている。そして、回転シャフト4の一方の端部近傍には原点検出センサ8が配設され、移動体2が原点検出センサ8に接近したとき、ドグ6の凹字形形状に対応して出力レベルが変化する原点位置検出信号Sを発生し、制御部5に供給するようになっている。制御部5は、原点位置検出信号Sの出力レベルの変化に対応して、モータMの回転方向(正逆方向)や回転速度(高速・低速)等を制御する。
【0028】
また、原点検出センサ8のさらに回転シャフト4端部側には反転センサ9が配設されている。反転センサ9は、移動体2が検出されたときに、移動体2の移動方向を反転させるためのものであり、反転信号Rは原点位置検出信号Sと共に制御部5に供給される。なお、この反転センサ9は、原点検出センサ8からは、ドグ6の幅よりもやや距離をおいた位置に配設されている。
【0029】
次に、原点復帰方法を図2を参照しつつ説明する。
原点復帰動作は、原点検出センサ8の位置と移動体2の位置との関係を判定するエリア判定動作から開始される。このエリア判定動作は、ドグ6の突起部(検出部)6a,6bの幅wa,wb(ここではwa=wbとする)と、凹み部分(検出部間)6cの幅wcに応じて行われる。ここで、wa+wc(又はwb+wc)の間隔をエリア判定距離Eとする。なお、エリア判定距離Eは、幅wc以上で、且つ、ドグ6の突起部6a,6bのうちいずれか短い方の幅とwcとの和以下に設定する。
まず、移動体2を高速でエリア判定距離Eを移動させる(ステップ1、以降はS1と略記する)。移動を完了するまでの間に、移動体2のドグ6が原点検出センサ8に到達しない場合、即ち、原点検出センサ8からの出力レベルがLoのままであるときには、移動体2が原点検出センサ8から所定の距離以上離れていると判定し、高速移動を継続するように制御する。
【0030】
これに対し、移動体2がエリア判定距離E移動する間に原点検出センサ8の位置に到達した場合、即ち、原点検出センサ8からの出力レベルがLoからHiに変化したときには、移動体2が原点検出センサ8の近傍に在るものと判定し、その移動速度を低速にする。
【0031】
さらに、図3を参照して説明すると、スタート時点T11では、図3(c),(d)に示すようにモータMが高速で動作する。これにより、移動体2はドグ6と一体に図1の矢印A方向に高速移動し、エリア判定距離Eを移動するまでの間(T11〜T12の間)にエリア判定動作が行われる。この場合、図3(a)に示すように原点位置検出信号SはLoのままであるから、移動体2は原点検出センサ8の近傍にないものと判定し、矢印A方向への高速移動が継続される(S3)。
【0032】
そして、図1に点線で示したようにドグ6が原点検出センサ8に到達すると、図3のT13の時点に示したように原点位置検出信号Sの出力レベルがLoからHiに変化する(S4)。この時点から、図3(c)に示すようにモータMの回転速度が高速から低速に制御され(S5)、ドグ6が低速で原点検出センサ8上を移動するようになる(S6)。このとき、ドグ6の凹み部分6cが原点検出センサ8上に差し掛かると、図3(a)のT14時点に示すように原点位置検出信号Sの出力レベルがHiからLoに変化する(S7)。これを受けて、制御部5は図3(c)に示すようにモータMを回転停止させる(S8)。すると、回転シャフト4が回転停止され、移動体2が惰走後に停止する。この停止位置が原点位置となる(S9)。このとき、モータMの回転を低速にしておくことにより、原点を検出したときから数パルス以内に移動体2を確実に停止させることができる。なお、このときの原点検出センサ8直上のドグ6の位置は、領域aからT13の時点で領域bとなり、T14の時点で領域cとなる。以上のようにして原点復帰動作が完了する。
【0033】
次に、上記S2において、移動体2のドグ6がエリア判定距離E内に在ると判定した場合の動作について図4を用いて説明する。
この場合、図4のT21の時点に示したように、エリア判定距離E内で原点位置検出信号Sの出力レベルがLoからHiに変化すると、この出力レベルの変化を受けて、図4(d)に示すようにモータMを高速回転から低速回転に切り換え(S10)、移動体2を反転センサ9の位置まで低速で移動させ、移動方向を反転させる(S11)。即ち、ドグ6の一方の突起部6aが反転センサ9の直上に差し掛かり、反転センサ9からの反転信号Rが図4(e)に示すようにLoからHoへと変化すると、この出力レベルの変化を受けて、図4(b)に示すようにモータMの回転方向を正方向から逆方向に切り換える。
【0034】
モータMの回転方向を切り換えると、回転シャフト4の回転方向が切り換わり、移動体2のドグ6が矢印B方向、即ち原点検出センサ8の方向へと復動する。そして、T22の時点で原点検出センサ8の直上にドグ6の一方の突起部6aが差し掛かると、原点位置検出信号SがLoからHiとなり、さらに、T23の時点で原点検出センサ8の直上に凹み部分6cが到達すると、原点位置検出信号Sは再びHiからLoに変化する。このHiからLoへの変化を受けて、図4(c)に示すようにモータMを回転停止させる。これにより、移動体2は惰走の後、停止する。この停止位置が原点位置となる。なお、このときの原点検出センサ8直上のドグ6の位置は、領域cからT21の時点で領域dとなり、T12の時点で領域eとなり、T22の時点で領域dとなり、T23の時点で領域cとなる。以上のようにして原点復帰動作が完了する。
【0035】
以上のように、本実施形態のロボットの原点復帰装置1によれば、原点復帰時における移動体2の初期位置が、原点位置から所定の距離離れているか否かのエリア判定を行い、その結果に応じて異なる原点復帰動作を選択的に切り換えて実行することにより、効率よく原点復帰が行える。即ち、移動体2がエリア判定距離より離れているときには、高速でしかも原点位置の近傍での往復動なしに原点位置に復帰させることができる一方、移動体2がエリア判定距離以内に在るときには、移動体2を確実に原点位置へ復帰させることができる。従って、移動体2の原点復帰時間を大幅に短縮することができ、ロボットの作業効率を向上させることができる。
【0036】
次に、本発明に係るロボットの原点復帰装置の第2の実施形態を説明する。
図5は本実施形態におけるロボットの原点復帰方法を示すフローチャート、図6は原点検出センサがエリア判定距離内にない場合の原点復帰動作を説明するタイミングチャート、図7は反転センサがエリア判定距離内にある場合の原点復帰動作を説明するタイミングチャート、図8は原点検出センサがエリア判定距離内にあり、且つ、ドグの一方の突起が原点検出センサを通過している場合の原点復帰動作を説明するタイミングチャートである。
【0037】
本実施形態の原点復帰方法では、前述のエリア判定距離を隔てた2点で移動体のエリア判定を行っている。なお、原点復帰装置の構成は前述の構成と同様であるため、ここではその説明は省略する。
図5及び図6に示すように、まず、スタート時点T31とエリア判定距離Eを隔てた時点T32の2点において、それぞれ各センサからの出力信号を検出する(S21)。原点検出センサ8からの出力がLoのままで(S22)、反転センサ9の出力もLoのままで(S23)あるときは、ドグ6を高速で移動させ(S24)、原点検出センサ8からの出力がHiになるまで移動を続ける(S25)。そして、図6(a)に示すようにT33の時点にて原点検出センサ8からの出力がHiに変化したことを受けて、図6(d)に示すようにモータMを低速回転に切り換える(S26)。さらに、図6(a)に示すT34の時点にて原点検出センサ8からの出力がHiからLoに変化したときに、図6(c)に示すようにモータMの回転を停止する(S28)。これにより、移動体2は惰走の後、停止する。この停止位置が原点位置となる(S29)。なお、このときの原点検出センサ8直上のドグ6の位置は、領域aからT33の時点で領域bとなり、T34の時点で領域cとなる。
【0038】
一方、S23において、図7(e)に示すようにT32の時点にて反転センサ9の出力がLoからHiに変化していたときは、図7(b)に示すようにモータMの回転方向を反転させる(S30)。その後は、上記のS24〜S29のステップが同様にして実行される。
【0039】
また、S22において、図8(a)に示すようにT32の時点にて原点検出センサ8の出力がLoからHiに変化したとき、即ち、ドグの一方の突起が原点検出センサ8を通過しているときには、図8(d)に示すようにモータMを低速回転に切り換え(S31)、ドグ6を反転センサ9の位置まで移動させる。そして、T35の時点にて反転センサ9の出力がLoからHiに変化したことを受けて、図8(b)に示すようにモータMの回転方向を反転させる(S32)。さらに、ドグ6を低速で移動させると(S33)、図8(a)に示すT33の時点にて原点検出センサ8からの出力がLoからHiとなり、その後、T34の時点にてHiからLoに変化する(S34)。このときに、図8(c)に示すようにモータMの回転を停止する(S28)。これにより、移動体2は惰走の後、停止する。この停止位置が原点位置となる(S29)。なお、このときの原点検出センサ8直上のドグ6の位置は、領域cからT32の時点で領域dとなり、T36の時点で領域eとなり、T33の時点で領域dとなり、T34の時点で領域cとなる。
【0040】
以上のように、本実施形態の原点復帰方法では、エリア判定距離Eを隔てた2点で移動体2のエリア判定を行うため、判定処理が簡略化されて制御部の処理負担が軽減される。また、この場合も移動体2を常に往復動させることがなくなり、原点復帰動作に要する時間を短縮することができる。
【0041】
次に、本発明に係るロボットの原点復帰装置の第3実施形態を説明する。
図9は本実施形態の原点復帰装置の概念的な構成図、図10は原点検出センサ8がエリア判定距離内にない場合の原点復帰動作を説明するタイミングチャート、図11は反転センサ9がエリア判定距離内にある場合の原点復帰動作を説明するタイミングチャート、図12は原点検出センサがエリア判定距離内にあり、且つ、ドグの一方の突起が原点検出センサを通過している場合の原点復帰動作を説明するタイミングチャートである。なお、前述の実施形態と同一の機能を有する部材等に対しては同一の符号を付与することで、その説明は省略するものとする。
【0042】
本実施形態の原点復帰装置3は、モータMの回転を検出するエンコーダ7が取り付けられており、エンコーダ7から出力されるパルス信号Pを、制御部5に入力している。一般に、エンコーダ7からのパルス信号Pには、所定角度の位相差を有するA相とB相の2つの信号と、1回転当たり1パルスのZ相パルス信号とがあるが、ここでは、Z相パルス信号を用いて原点復帰動作を行っている。
【0043】
以下、この原点復帰装置3による原点復帰方法を説明する。本実施形態においては、第2実施形態の原点復帰方法におけるモータMの停止させるタイミングをエンコーダ7からのパルス信号Pに同期させる点以外は、第2実施形態と同一の手順で原点復帰を行うので、ここでは、モータMを停止させるタイミングについて詳細に説明する。
【0044】
まず、原点検出センサ8がエリア判定距離内にない場合の原点復帰動作では、図10(a)に示すように、原点検出センサ8の出力がHiからLoへ変化するT34の時点から、図10(f)に示す最初に出力のあったパルス信号Pを受けて、図10(c)に示すモータMの動作を停止させる。これにより、モータMはエンコーダ7のパルス信号Pに同期して回転停止され、パルス信号Pの生じた位置に略一致して原点位置が設定される。
【0045】
また、反転センサ9がエリア判定距離内にある場合の原点復帰動作では、図11(a)に示すように、原点検出センサ8の出力がHiからLoへ変化するT34の時点から、図11(f)に示す最初に出力のあったパルス信号Pを受けて、図11(c)に示すモータMの動作を停止させる。
さらに、原点検出センサ8がエリア判定距離内にあり、且つ、ドグの一方の突起が原点検出センサ8を通過している場合の原点復帰動作では、図12(a)に示すように、原点検出センサ8の出力がHiからLoへ変化するT34の時点から、図12(f)に示す最初に出力のあったパルス信号Pを受けて、図12(c)に示すモータMの動作を停止させる。
このようにして、それぞれ原点位置がパルス信号Pの生じた位置に略一致して設定される。
【0046】
本実施形態の原点復帰装置3による原点復帰方法によれば、モータMや回転シャフト4の回転に対応してエンコーダ7から出力されるパルス信号Pに同期して原点位置が設定されるため、移動体2の位置管理が容易となり、正確な原点復帰を行うことができる。このため、より高精度に位置決めが必要な軸に対しても、この原点復帰装置3を適用することができる。
【0047】
以上説明した各実施形態のロボットの原点復帰装置は、図13に示すような部品実装装置100におけるY軸ロボット22,24、或いはX軸ロボット26の何れにも適用できるものであり、各ロボットの原点復帰時間を大幅に短縮することが可能となる。これにより、移載ヘッドによる電子部品の実装や生産準備動作が迅速に行われ、タクトアップに寄与することができ、生産効率が飛躍的に向上する。
【0048】
特に、搬送される基板の幅に応じてコンベヤの搬送幅が可変となる構成においては、このコンベヤの搬送幅を変更するロボットに好適に適用できる。具体的には、このコンベヤの搬送幅切り換えは、生産準備中にのみ行われるため稼動回数が低く、コストを極力抑えて実現することが必須とされている。従って、小容量のモータで駆動されることが多く、また、減速開始点検出用のセンサを取り付けられない等、他の軸とは異なった構成となっている。このように、コンベヤの搬送幅切り換え動作は、減速開始点検出用のセンサがないために、減速の開始を原点検出で代用せざるを得ず、その動作に時間がかかっていた。そこで、本発明のロボットの原点復帰装置をこのコンベヤに適用することで、上記した問題が解消され、高速で且つ正確な搬送幅切り換え動作が可能となる。
【0049】
なお、上記の各実施形態においては、凹字型のドグを用いて説明したが、本発明はこれに限らず、2つの検出部が一定の間隔で配置してなるドグであれば、どのような形状のドグであっても同様に適用することができる。
【0050】
【発明の効果】
本発明に係るロボットの原点復帰方法によれば、移動体を所定の一定量移動させたときの原点検出センサからの出力の変化状態から、移動体のドグと原点検出センサとの相対位置を判定し、この判定された相対位置に応じた原点復帰動作手順を選択的に実行することで、移動体の位置によらずにロボットの原点復帰動作を高速に且つ正確に行うことができる。
また、本発明に係るロボットの原点復帰装置によれば、移動体を所定の一定量移動させたときの原点検出センサからの出力の変化状態から、移動体のドグと原点検出センサとの相対位置を判定し、この判定された相対位置に応じた原点復帰動作手順を選択的に実行する制御部を備えることで、移動体の位置によらずにロボットの原点復帰動作を高速に且つ正確に行うことができる。
さらに、本発明に係る部品実装装置によれば、上記ロボットの原点復帰装置を適用することにより、各ロボットの原点復帰時間を大幅に短縮することが可能となり、これにより、移載ヘッドによる電子部品の実装が迅速に行われ、タクトアップに寄与することができる。
【図面の簡単な説明】
【図1】本発明に係るロボットの原点復帰装置の第1実施形態における構成を概念的に示す構成図である。
【図2】第1実施形態におけるロボットの原点復帰方法を示すフローチャートである。
【図3】原点検出センサがエリア判定距離内にない場合の原点復帰動作を説明するタイミングチャートである。
【図4】原点検出センサ及び反転センサがエリア判定距離内にある場合の原点復帰動作を説明するタイミングチャートである。
【図5】第2実施形態におけるロボットの原点復帰方法を示すフローチャートである。
【図6】原点検出センサがエリア判定距離内にない場合の原点復帰動作を説明するタイミングチャートである。
【図7】反転センサがエリア判定距離内にある場合の原点復帰動作を説明するタイミングチャートである。
【図8】原点検出センサがエリア判定距離内にあり、且つ、ドグの一方の突起が原点検出センサを通過している場合の原点復帰動作を説明するタイミングチャートである。
【図9】第3実施形態におけるロボットの原点復帰装置の概念的な構成図である。
【図10】原点検出センサがエリア判定距離内にない場合の原点復帰動作を説明するタイミングチャートである。
【図11】反転センサがエリア判定距離内にある場合の原点復帰動作を説明するタイミングチャートである。
【図12】原点検出センサがエリア判定距離内にあり、且つ、ドグの一方の突起が原点検出センサを通過している場合の原点復帰動作を説明するタイミングチャートである。
【図13】部品実装装置の構成を示す斜視図である。
【図14】従来の原点復帰動作を示す原点検出センサとドグとの位置関係を示す説明図である。
【図15】従来の原点復帰動作を説明するためのタイミングチャートである。
【符号の説明】
1,3 原点復帰装置
2 移動体
4 回転シャフト
5 制御部
6 位置合わせドグ
7 エンコーダ
8 原点検出センサ
9 反転センサ
M モータ
A,B 移動方向
[0001]
BACKGROUND OF THE INVENTION
The present invention relates to an origin return method, an origin return apparatus, and a component mounting apparatus for returning a robot to an origin position.
[0002]
[Prior art]
2. Description of the Related Art In recent years, electronic devices have been mounted with high density, and a large number of electronic components such as resistors and capacitors as well as various ICs are mounted on a circuit board (printed board). The mounting of these electronic components is performed by a component mounting apparatus for reasons such as a large number of components mounted, accuracy required, and improvement in production efficiency.
Hereinafter, an example of a conventional component mounting apparatus will be described.
As shown in a perspective view in FIG. 13, the component mounting apparatus 100 is provided with a loader unit 16, a substrate fixing unit 18, an unloader unit 20, and a pair of guide rails 14 for conveying the circuit board 12 on the base 10. By synchronously driving the conveying belts provided on the pair of guide rails 14, the circuit board 12 is moved from the loader part 16 to the board fixing part 18 provided at the position where the electronic component is mounted, and further from the board fixing part 18 to the unloader part 20 It is designed to be transported.
[0003]
Further, Y-axis robots 22 and 24 are respectively provided on both upper sides of the base 10, and an X-axis robot 26 is suspended between the two Y-axis robots 22 and 24 to drive the Y-axis robots 22 and 24. By doing so, the X-axis robot 26 is configured to advance and retract in the Y-axis direction. A transfer head 28 is attached to the X-axis robot 26 so as to be movable back and forth in the X-axis direction. As a result, the transfer head 28 can freely move in the XY plane by driving the Y-axis robots 22 and 24 and the X-axis robot 26.
Each robot has a structure in which, for example, a ball screw is rotated forward and backward by a motor so that a nut member screwed to the ball screw advances and retreats along an axial direction, and a member to be advanced and retracted is fixed to the nut member. ing.
[0004]
The transfer head 28 is placed on the XY robot including the X-axis robot 26 and the Y-axis robots 22 and 24 as described above, and is an XY plane (for example, a horizontal plane or a plane substantially parallel to the upper surface of the base 10). ) Move freely on the top. The transfer head 28 includes a plurality of parts feeders 30 exemplified as a component supply unit to which electronic components such as a resistor chip and a chip capacitor are supplied, or SOP (“SOP” is an abbreviation of Small Outline Package) or QFP (“QFP”). "Is an abbreviation for" Quad Flat Package "), and a desired electronic component is picked up by a suction nozzle 34 from a part tray 32 exemplified as a component supply unit to which a relatively large electronic component is supplied, such as an IC or a connector. It is configured so that it can be mounted at the component mounting position of the substrate 12.
The mounting operation of the electronic component is controlled by the control unit 36 based on a preset mounting program stored in the storage unit of the control unit 36.
[0005]
By the way, when component mounting is performed by the component mounting apparatus 100 described above, it is necessary to return the transfer head 28 to the origin position and start from the origin position before mounting. Such an origin return operation is performed by the origin return device 1 conceptually shown in FIG.
The origin return device 1 can be applied to any of the Y-axis robots 22 and 24 or the X-axis robot 26 in the component mounting apparatus 100, and the moving body 2 corresponds to the transfer head 28. .
[0006]
Next, the origin return operation will be described with reference to FIGS.
As shown in FIG. 1, when the moving body 2 is at a position away from the origin detection sensor 8, the positions of the dog 6 and the origin detection sensor 8 are also separated as shown in FIG. In this state, since the origin detection sensor 8 does not detect the dog 6, the output level of the origin position detection signal S becomes Lo (T in FIG. 15). 1 ). The moving body 2 is moved at a high speed in the direction A in FIG.
[0007]
When the moving body 2 approaches the origin detection sensor 8 and the projection (detection unit) 6a that is one end of the dog 6 approaches the position immediately above the origin detection sensor 8 as shown in FIG. T 2 ), The origin position detection signal S changes from Lo to Hi. At this time, the motor M shifts from high-speed rotation to low-speed rotation drive, and the moving body 2 moves at a low speed in the A direction.
Then, as shown in FIG. 14 (c), when the concave portion (between detection portions) 6c of the dog 6 reaches the position immediately above the origin detection sensor 8 (T in FIG. 15). Three ), The origin position detection signal S changes from Hi to Lo. Furthermore, since the dog 6 continues to move at a low speed in the direction of arrow A, the other protrusion 6b of the dog 6 reaches a position directly above the origin detection sensor 8 as shown in FIG. 14 (d) (T in FIG. 15). Four ). At this time, the origin position detection signal S changes from Lo to Hi. In response to the change in the output level, the motor M temporarily stops rotating, and then the rotational drive direction is changed in the reverse direction as shown in FIG.
[0008]
Then, as shown in FIG. 14 (e), the dog 6 moves at a low speed in the direction B in the figure, and the recess 6c of the dog 6 reaches the position immediately above the origin detection sensor 8 again as shown in FIG. 14 (f). (T in FIG. 15 Five ). At this time, the origin position detection signal S changes from Hi to Lo, and in response to this, the motor M stops rotating. Thereby, the mobile body 2 stops after the coasting operation. This stop position becomes an origin position, and the origin position is used as a starting point to drive to a component mounting position or the like.
[0009]
Note that when the origin return operation is performed, the moving body 2 may pass through the origin detection sensor 8 and be positioned on the reverse sensor 9 side. In this case, the dog 6 is detected by the reversing sensor 9, and the moving direction of the moving body 2 is changed from the A direction to the B direction. Then, when the moving body 2 moves on the origin detection sensor 8, the moving body 2 is positioned at the origin position by the positional relationship between the dog 6 and the origin detection sensor 8 as described above.
[0010]
[Problems to be solved by the invention]
In such an origin return device, in order to reliably detect the recess 6c of the dog 6, after the recess 6c once passes over the origin detection sensor 8, the motor M is driven reversely to detect the recess 6c again. In other words, it takes a long time to return to the origin. If the origin is set when the recess 6c is detected for the first time, the current position of the dog 6 is undefined when the power is turned on. Therefore, even if the origin detection sensor 8 detects the recess of the dog, this is ensured. It is not possible to determine whether it is a recess 6 or a range outside the dog 6. Therefore, there is a risk that the origin position is set erroneously.
For this reason, in a component mounting apparatus or the like having a plurality of robots, a great amount of time is required for the return to origin operation performed prior to component mounting, thereby reducing the efficiency of component mounting work.
[0011]
The present invention has been made in view of such a situation, and an object of the present invention is to provide a robot home position return method, home position return device, and component mounting device that can perform a home position return operation of a robot quickly and accurately. .
[0012]
[Means for Solving the Problems]
To achieve the above object, the robot origin return method according to the first aspect of the present invention provides an origin for detecting the dog with respect to a robot configured such that a moving body to which a position detection dog is attached is movable in the axial direction. A robot origin return method for providing a detection sensor and returning the movable body to the origin position based on the output of the origin detection sensor, wherein the origin detection sensor when the movable body is moved a predetermined amount The relative position between the dog of the moving body and the origin detection sensor is determined from the change state of the output, and the origin return operation procedure corresponding to the determined relative position is selectively executed. While the origin return operation procedure moves the movable body by a predetermined amount, the origin detection sensor detects the dog detection unit in which two detection units are arranged at regular intervals. If not, the movement of the moving body is continued, the detection unit of the dog is first detected, and then the moving body is stopped when the gap between the detection units is detected. While the position is set to the origin position, when the origin detection sensor detects the dog detection unit, the moving body is moved to one end side of the robot to reverse the moving direction, and then the dog first. This is a procedure for detecting the detection unit, and then stopping the moving body when detecting between the detecting units and setting the position where the moving body is stationary as the origin position. .
[0015]
In this robot origin return method, if no dog is detected by the origin detection sensor while the moving body is moving a predetermined amount, the dog continues to move and detects the dog. In this case, the dog detection unit is first detected, and then the moving body is stopped when the interval between the dog detection units is subsequently detected, and the position where the moving body is stationary is set as the origin position. In addition, when a dog is detected while moving a predetermined amount, the dog is reversed after continuing the movement, and then the dog is detected. In that case, after moving the moving body to one end of the robot and reversing the moving direction, first detect the detection part of the dog, and then detect the moving object when detecting between the detection parts of the dog. Stop and set the position where the moving body is stationary as the origin position. As a result, when the moving body is away from the position of the origin detection sensor, the moving body can be quickly brought closer to the origin detection sensor, and the position of the moving body can be grasped reliably and accurately.
[0016]
According to another aspect of the robot origin return method of the present invention, an origin detection sensor for detecting the dog is provided for a robot configured such that a moving body to which a position detection dog is attached is movable in the axial direction. A return-to-origin method for the robot that returns the moving body to the origin position based on the output of the moving object from a change state of the output from the origin detection sensor when the movable body is moved a predetermined amount. The relative position between the body dog and the origin detection sensor is determined, and the origin return operation procedure according to the determined relative position is selectively executed. The dog detection section in which the origin detection sensor has two detection sections arranged at regular intervals when the moving object starts moving and after a predetermined amount of movement. Is not detected, the movement of the moving body is continued, the detection unit of the dog is first detected, and then when the detection unit is detected, the moving body is stopped. While the stationary position is set as the origin position, when the origin detection sensor detects the dog detection unit, the moving body is moved to one end side of the robot and the moving direction is reversed. It is a procedure for detecting the dog detection unit, and then stopping the moving body when detecting between the detection units, and setting the position where the moving body is stationary as the origin position.
[0017]
In this robot origin return method, the output of the origin detection sensor is detected when the moving body starts moving and after a predetermined amount of movement. At that time, if the origin detection sensor does not detect the dog detection unit, the moving body continues to move, first detects the dog detection unit, and then continues between the dog detection units. When detected, the moving body is stopped, and the position where the moving body is stationary is set as the origin position. Also, when the origin detection sensor detects the dog detection part, first move the moving body to one end of the robot and reverse the direction of movement, then detect the dog detection part first, then continue The moving body is stopped when the detection unit is detected, and the position where the moving body is stationary is set as the origin position. Thus, since the output of the origin detection sensor is detected at two points separated by a predetermined distance and the position of the moving body is determined, the determination process is simplified, and the time required for the origin return operation can be further shortened. it can.
[0018]
Claim 3 In the robot origin return method described above, an encoder for detecting the amount of movement of the moving body is connected to the robot, and the moving body is stopped at a position synchronized with a pulse signal from the encoder and set to the origin position. Features.
[0019]
In this robot home position return method, the moving body is stopped at a position synchronized with the pulse signal from the encoder and the home position is set, so that the position management of the moving body becomes easy and accurate home position return can be performed. .
[0020]
Claim 4 The robot home position return device described above includes a moving body to which a dog formed by arranging two detectors at regular intervals, a guide member for supporting the moving body in an axially movable manner, and the guide member. An origin return device for a robot comprising a drive source for moving the moving body and an origin detection sensor for detecting dogs of the moving body, wherein the moving body is moved by a predetermined amount. A control unit that determines a relative position between the dog of the moving body and the origin detection sensor from a change state of an output from the origin detection sensor, and selectively executes an origin return operation procedure according to the determined relative position. It is provided with.
[0021]
In this robot origin return device, the control unit detects a change state of the output from the origin detection sensor when the movable body is moved to a predetermined amount, and from this change state, the movement body and the origin detection sensor are detected. The relative positional relationship is determined. In accordance with the determination result, the control unit selectively executes an origin return operation procedure corresponding to each relative position, thereby returning the robot to the origin position. As a result, the return to origin operation of the robot can be performed quickly and accurately regardless of the position of the moving body.
[0022]
Claim 5 The robot origin return device according to claim 1, wherein the controller 1 ~ Claim 3 The home position return operation is controlled based on the robot home position return method described in any one of the above.
[0023]
In this robot home position return device, the control unit controls the home position return operation based on the above-described robot home position return method, whereby the moving body can be returned to the home position at high speed and reliably.
[0024]
Claim 6 The component mounting apparatus described in claim 1 further includes a transfer head for transferring a mounting component onto a substrate. 4 Or claim 5 The robot is driven using the robot origin return device described above.
[0025]
In this component mounting apparatus, the robot mounted on the component mounting apparatus is claimed in claim 4 Or claim 5 By comprising the robot home position return device described, the home position return time of each robot can be greatly shortened. As a result, the mounting of electronic parts and the production preparation operation by the transfer head are performed quickly, which can contribute to a tact-up, and the production efficiency is dramatically improved.
[0026]
DETAILED DESCRIPTION OF THE INVENTION
Preferred embodiments of a robot origin return method and origin return device according to the present invention will be described below in detail with reference to the drawings.
Here, FIG. 1 is a block diagram conceptually showing the configuration of the robot origin return device according to the present invention, FIG. 2 is a flowchart showing the robot origin return method, and FIG. FIG. 4 is a timing chart illustrating the origin return operation when the origin detection sensor and the reverse sensor are within the area determination distance.
[0027]
In the origin return device 1 according to the present embodiment, as shown in FIG. 1, the moving body 2 is screwed into a rotating shaft 4 as a guide member that is rotationally driven by a motor M that is a driving source, and the rotating shaft 4 rotates. It moves in the directions of arrows A and B by switching the direction. A concave dog 6 formed by arranging two detection units at a predetermined interval for detecting the position of the moving body 2 is attached to a part of the moving body 2. An origin detection sensor 8 is disposed in the vicinity of one end of the rotary shaft 4, and when the moving body 2 approaches the origin detection sensor 8, the output level changes corresponding to the concave shape of the dog 6. An origin position detection signal S is generated and supplied to the control unit 5. The controller 5 controls the rotation direction (forward / reverse direction), the rotation speed (high speed / low speed), etc. of the motor M in response to the change in the output level of the origin position detection signal S.
[0028]
Further, a reversing sensor 9 is disposed on the end side of the rotation shaft 4 of the origin detection sensor 8. The reversing sensor 9 is for reversing the moving direction of the moving body 2 when the moving body 2 is detected, and the reversing signal R is supplied to the control unit 5 together with the origin position detection signal S. The reversing sensor 9 is disposed at a position slightly away from the origin detection sensor 8 than the width of the dog 6.
[0029]
Next, the origin return method will be described with reference to FIG.
The origin return operation is started from an area determination operation for determining the relationship between the position of the origin detection sensor 8 and the position of the moving body 2. This area determination operation is performed using the width w of the protrusions (detectors) 6a and 6b of the dog 6. a , W b (Where a = W b And the width w of the recessed portion (between detection portions) 6c c Is done according to. Where w a + W c (Or w b + W c ) Is an area determination distance E. The area determination distance E is the width w c The width and w of the shorter one of the protrusions 6a and 6b of the dog 6 are as described above. c Set to less than or equal to.
First, the moving object 2 is moved by the area determination distance E at a high speed (step 1; hereinafter abbreviated as S1). When the dog 6 of the moving body 2 does not reach the origin detection sensor 8 until the movement is completed, that is, when the output level from the origin detection sensor 8 remains Lo, the movement body 2 is detected by the origin detection sensor. It is determined that the predetermined distance is more than a predetermined distance from 8, and control is performed so as to continue high-speed movement.
[0030]
On the other hand, when the moving body 2 reaches the position of the origin detection sensor 8 while moving the area determination distance E, that is, when the output level from the origin detection sensor 8 changes from Lo to Hi, It determines with existing in the vicinity of the origin detection sensor 8, and makes the moving speed low.
[0031]
Further, with reference to FIG. 11 Then, as shown in FIGS. 3C and 3D, the motor M operates at a high speed. Thereby, the moving body 2 moves at a high speed in the direction of arrow A in FIG. 1 integrally with the dog 6 until it moves the area determination distance E (T 11 ~ T 12 Area determination operation is performed. In this case, since the origin position detection signal S remains Lo as shown in FIG. 3A, it is determined that the moving body 2 is not in the vicinity of the origin detection sensor 8, and high-speed movement in the direction of arrow A is performed. Continue (S3).
[0032]
When the dog 6 reaches the origin detection sensor 8 as shown by the dotted line in FIG. 13 As shown at the point in time, the output level of the origin position detection signal S changes from Lo to Hi (S4). From this point of time, as shown in FIG. 3C, the rotational speed of the motor M is controlled from a high speed to a low speed (S5), and the dog 6 moves on the origin detection sensor 8 at a low speed (S6). At this time, if the recessed portion 6c of the dog 6 reaches the origin detection sensor 8, T in FIG. 14 As shown at the time, the output level of the origin position detection signal S changes from Hi to Lo (S7). In response to this, the controller 5 stops the rotation of the motor M as shown in FIG. 3C (S8). Then, the rotation shaft 4 stops rotating, and the moving body 2 stops after coasting. This stop position becomes the origin position (S9). At this time, by keeping the rotation of the motor M at a low speed, the moving body 2 can be surely stopped within a few pulses from when the origin is detected. Note that the position of the dog 6 immediately above the origin detection sensor 8 at this time is from the region a to T 13 Becomes region b at time T 14 It becomes area | region c at the time of. The origin return operation is completed as described above.
[0033]
Next, an operation when it is determined in S2 that the dog 6 of the moving body 2 is within the area determination distance E will be described with reference to FIG.
In this case, T in FIG. twenty one As shown in FIG. 4D, when the output level of the origin position detection signal S changes from Lo to Hi within the area determination distance E, the change in the output level is received and the motor M as shown in FIG. Is switched from high speed rotation to low speed rotation (S10), the moving body 2 is moved to the position of the reversing sensor 9 at low speed, and the moving direction is reversed (S11). That is, when one projection 6a of the dog 6 reaches directly above the reversing sensor 9, and the reversing signal R from the reversing sensor 9 changes from Lo to Ho as shown in FIG. In response, the rotation direction of the motor M is switched from the forward direction to the reverse direction as shown in FIG.
[0034]
When the rotation direction of the motor M is switched, the rotation direction of the rotary shaft 4 is switched, and the dog 6 of the moving body 2 moves backward in the direction of arrow B, that is, in the direction of the origin detection sensor 8. And T twenty two When one of the protrusions 6a of the dog 6 reaches immediately above the origin detection sensor 8, the origin position detection signal S changes from Lo to Hi, and T twenty three When the recessed portion 6c reaches just above the origin detection sensor 8 at the time of, the origin position detection signal S changes from Hi to Lo again. In response to the change from Hi to Lo, the motor M stops rotating as shown in FIG. Thereby, the mobile body 2 stops after coasting. This stop position is the origin position. At this time, the position of the dog 6 immediately above the origin detection sensor 8 is changed from the region c to T twenty one Becomes region d at time T and 12 Becomes region e at time T twenty two Becomes region d at time T and twenty three It becomes area | region c at the time of. The origin return operation is completed as described above.
[0035]
As described above, according to the robot origin return device 1 of the present embodiment, an area determination is performed as to whether or not the initial position of the moving body 2 at the time of origin return is a predetermined distance away from the origin position. The origin return can be performed efficiently by selectively switching and executing different origin return operations according to the operation. That is, when the moving body 2 is away from the area determination distance, it can be returned to the origin position at a high speed and without reciprocation in the vicinity of the origin position, while when the moving body 2 is within the area determination distance. The moving body 2 can be reliably returned to the origin position. Therefore, the origin return time of the moving body 2 can be greatly shortened, and the working efficiency of the robot can be improved.
[0036]
Next, a second embodiment of the robot origin return device according to the present invention will be described.
FIG. 5 is a flowchart showing the robot origin return method in this embodiment, FIG. 6 is a timing chart for explaining the origin return operation when the origin detection sensor is not within the area determination distance, and FIG. 7 is the reverse sensor within the area determination distance. FIG. 8 is a timing chart for explaining the origin return operation when the origin detection sensor is within the area determination distance and one projection of the dog passes through the origin detection sensor. It is a timing chart to do.
[0037]
In the origin return method of the present embodiment, the area determination of the moving object is performed at two points separated by the area determination distance described above. Since the configuration of the origin return device is the same as that described above, description thereof is omitted here.
As shown in FIGS. 5 and 6, first, the start time T 31 At time T separated from the area determination distance E 32 The output signals from the respective sensors are detected at the two points (S21). When the output from the origin detection sensor 8 remains Lo (S22) and the output from the reversing sensor 9 also remains Lo (S23), the dog 6 is moved at a high speed (S24). The movement is continued until the output becomes Hi (S25). Then, as shown in FIG. 33 In response to the fact that the output from the origin detection sensor 8 has changed to Hi at the point of time, the motor M is switched to low speed rotation as shown in FIG. 6D (S26). Further, T shown in FIG. 34 When the output from the origin detection sensor 8 changes from Hi to Lo at the point of time, the rotation of the motor M is stopped as shown in FIG. 6C (S28). Thereby, the mobile body 2 stops after coasting. This stop position becomes the origin position (S29). Note that the position of the dog 6 immediately above the origin detection sensor 8 at this time is from the region a to T 33 Becomes region b at time T 34 It becomes area | region c at the time of.
[0038]
On the other hand, in S23, as shown in FIG. 32 If the output of the reversing sensor 9 has changed from Lo to Hi at the time of, the direction of rotation of the motor M is reversed as shown in FIG. 7B (S30). Thereafter, the above steps S24 to S29 are executed in the same manner.
[0039]
In S22, as shown in FIG. 32 When the output of the origin detection sensor 8 changes from Lo to Hi at the point of time, that is, when one protrusion of the dog passes through the origin detection sensor 8, the motor M is turned on as shown in FIG. Switching to low speed rotation (S31), the dog 6 is moved to the position of the reverse sensor 9. And T 35 In response to the fact that the output of the reversing sensor 9 has changed from Lo to Hi at the point of time, the rotational direction of the motor M is reversed as shown in FIG. 8B (S32). Further, when the dog 6 is moved at a low speed (S33), T shown in FIG. 33 The output from the origin detection sensor 8 changes from Lo to Hi at the time of 34 It changes from Hi to Lo at the time of (S34). At this time, the rotation of the motor M is stopped as shown in FIG. 8C (S28). Thereby, the mobile body 2 stops after coasting. This stop position becomes the origin position (S29). At this time, the position of the dog 6 immediately above the origin detection sensor 8 is changed from the region c to T 32 Becomes region d at time T and 36 Becomes region e at time T 33 Becomes region d at time T and 34 It becomes area | region c at the time of.
[0040]
As described above, in the origin return method according to the present embodiment, the area determination of the moving body 2 is performed at two points separated by the area determination distance E. Therefore, the determination process is simplified and the processing load on the control unit is reduced. . Also in this case, the moving body 2 is not always reciprocated, and the time required for the origin return operation can be shortened.
[0041]
Next, a third embodiment of the robot origin return device according to the present invention will be described.
FIG. 9 is a conceptual configuration diagram of the origin return device of the present embodiment, FIG. 10 is a timing chart for explaining the origin return operation when the origin detection sensor 8 is not within the area determination distance, and FIG. FIG. 12 is a timing chart for explaining the origin return operation when it is within the judgment distance. FIG. 12 shows the origin return when the origin detection sensor is within the area judgment distance and one of the protrusions of the dog passes the origin detection sensor. It is a timing chart explaining operation. In addition, the description which abbreviate | omits the member etc. which have the same function as the above-mentioned embodiment by providing the same code | symbol.
[0042]
The origin return device 3 of the present embodiment is equipped with an encoder 7 that detects the rotation of the motor M, and inputs a pulse signal P output from the encoder 7 to the control unit 5. In general, the pulse signal P from the encoder 7 includes two signals of A phase and B phase having a phase difference of a predetermined angle, and one Z-phase pulse signal per rotation. Origin return operation is performed using a pulse signal.
[0043]
Hereinafter, the origin return method by the origin return device 3 will be described. In this embodiment, the origin return is performed in the same procedure as in the second embodiment except that the timing for stopping the motor M in the origin return method of the second embodiment is synchronized with the pulse signal P from the encoder 7. Here, the timing for stopping the motor M will be described in detail.
[0044]
First, in the origin return operation when the origin detection sensor 8 is not within the area determination distance, the output of the origin detection sensor 8 changes from Hi to Lo as shown in FIG. 34 From the point of time, the first output pulse signal P shown in FIG. 10 (f) is received, and the operation of the motor M shown in FIG. 10 (c) is stopped. As a result, the motor M stops rotating in synchronization with the pulse signal P of the encoder 7, and the origin position is set substantially coincident with the position where the pulse signal P is generated.
[0045]
Further, in the origin return operation when the reverse sensor 9 is within the area determination distance, as shown in FIG. 11A, the output of the origin detection sensor 8 changes from Hi to Lo. 34 From the point of time, the first output pulse signal P shown in FIG. 11 (f) is received, and the operation of the motor M shown in FIG. 11 (c) is stopped.
Further, in the origin return operation when the origin detection sensor 8 is within the area determination distance and one protrusion of the dog passes through the origin detection sensor 8, as shown in FIG. T at which the output of the sensor 8 changes from Hi to Lo 34 From the point of time, the first output pulse signal P shown in FIG. 12 (f) is received, and the operation of the motor M shown in FIG. 12 (c) is stopped.
In this way, the origin position is set substantially coincident with the position where the pulse signal P is generated.
[0046]
According to the origin return method by the origin return device 3 of the present embodiment, the origin position is set in synchronization with the pulse signal P output from the encoder 7 in response to the rotation of the motor M and the rotary shaft 4, so that the movement The position management of the body 2 is facilitated, and accurate return to origin can be performed. For this reason, the origin return device 3 can be applied to an axis that needs to be positioned with higher accuracy.
[0047]
The robot origin return device of each embodiment described above can be applied to any of the Y-axis robots 22 and 24 or the X-axis robot 26 in the component mounting apparatus 100 as shown in FIG. The return to origin time can be greatly shortened. As a result, the mounting of electronic parts and the production preparation operation by the transfer head are performed quickly, which can contribute to a tact-up, and the production efficiency is dramatically improved.
[0048]
In particular, in a configuration in which the conveyance width of the conveyor is variable according to the width of the substrate to be conveyed, the invention can be suitably applied to a robot that changes the conveyance width of the conveyor. Specifically, the conveyor width switching is performed only during production preparation, so the number of operations is low, and it is essential to realize it with the lowest possible cost. Therefore, the motor is often driven by a small capacity motor, and the configuration is different from other shafts such that a sensor for detecting a deceleration start point cannot be attached. Thus, since there is no sensor for detecting the deceleration start point in the conveyor transport width switching operation, the start of deceleration must be replaced by the origin detection, and the operation takes time. Therefore, by applying the robot origin return device of the present invention to this conveyor, the above-mentioned problems can be solved, and high-speed and accurate conveyance width switching operation can be performed.
[0049]
In each of the above-described embodiments, the description has been made using the concave-shaped dog. However, the present invention is not limited to this, and any dog may be used as long as the two detection units are arranged at regular intervals. Even a dog having a simple shape can be similarly applied.
[0050]
【The invention's effect】
According to the robot origin return method of the present invention, the relative position between the dog of the moving body and the origin detection sensor is determined from the change state of the output from the origin detection sensor when the movable body is moved a predetermined amount. Then, by selectively executing the origin return operation procedure according to the determined relative position, the origin return operation of the robot can be performed at high speed and accurately regardless of the position of the moving body.
Further, according to the origin return device of the robot according to the present invention, the relative position between the dog of the moving body and the origin detection sensor is determined from the change state of the output from the origin detection sensor when the movable body is moved a predetermined amount. And a control unit that selectively executes the home position return operation procedure according to the determined relative position, so that the home position return operation of the robot can be performed quickly and accurately regardless of the position of the moving body. be able to.
Furthermore, according to the component mounting apparatus according to the present invention, by applying the above-described robot origin return device, it is possible to greatly shorten the origin return time of each robot. Can be implemented quickly and contribute to tact-up.
[Brief description of the drawings]
FIG. 1 is a configuration diagram conceptually showing the configuration of a robot origin return device according to a first embodiment of the present invention.
FIG. 2 is a flowchart showing a robot origin return method in the first embodiment.
FIG. 3 is a timing chart for explaining an origin return operation when an origin detection sensor is not within an area determination distance.
FIG. 4 is a timing chart for explaining an origin return operation when an origin detection sensor and a reverse sensor are within an area determination distance.
FIG. 5 is a flowchart showing a robot origin return method according to the second embodiment.
FIG. 6 is a timing chart for explaining an origin return operation when the origin detection sensor is not within the area determination distance.
FIG. 7 is a timing chart for explaining an origin return operation when the reversing sensor is within an area determination distance.
FIG. 8 is a timing chart illustrating an origin return operation when the origin detection sensor is within the area determination distance and one of the dog protrusions passes through the origin detection sensor.
FIG. 9 is a conceptual configuration diagram of a robot origin return device according to a third embodiment.
FIG. 10 is a timing chart for explaining an origin return operation when the origin detection sensor is not within the area determination distance.
FIG. 11 is a timing chart for explaining an origin return operation when the reversing sensor is within an area determination distance.
FIG. 12 is a timing chart for explaining an origin return operation when the origin detection sensor is within the area determination distance and one of the protrusions of the dog passes through the origin detection sensor.
FIG. 13 is a perspective view showing a configuration of a component mounting apparatus.
FIG. 14 is an explanatory diagram showing a positional relationship between an origin detection sensor and a dog showing a conventional origin return operation.
FIG. 15 is a timing chart for explaining a conventional origin return operation.
[Explanation of symbols]
1,3 Origin return device
2 moving objects
4 Rotating shaft
5 Control unit
6 Positioning dog
7 Encoder
8 Origin detection sensor
9 Reverse sensor
M motor
A, B Movement direction

Claims (6)

位置検出用のドグが取り付けられた移動体を軸方向に移動自在に構成したロボットに対し、前記ドグを検出する原点検出センサを設け、この原点検出センサの出力に基づいて前記移動体を原点位置に復帰させるロボットの原点復帰方法であって、
前記移動体を所定の一定量移動させたときの前記原点検出センサからの出力の変化状態から、前記移動体のドグと前記原点検出センサとの相対位置を判定し、この判定された相対位置に応じた原点復帰動作手順を選択的に実行し、
前記原点復帰動作手順が、
前記移動体を所定の一定量移動させている間に、
前記原点検出センサが、2つの検出部を一定の間隔で配置してなる前記ドグの検出部を検出しなかった場合に、前記移動体の移動を続行して、最初に前記ドグの検出部を検出し、その後検出部間を検出したときに前記移動体を停止させて、前記移動体が静止した位置を原点位置に設定する一方、
前記原点検出センサが前記ドグの検出部を検出した場合に、前記移動体を前記ロボットの一端側まで移動させて移動方向を反転させてから、最初に前記ドグの検出部を検出し、その後検出部間を検出したときに前記移動体を停止させて、前記移動体が静止した位置を原点位置に設定する手順であることを特徴とするロボットの原点復帰方法
An origin detection sensor for detecting the dog is provided for a robot configured to be movable in the axial direction with a movable body to which a position detection dog is attached, and the movable body is set to the origin position based on the output of the origin detection sensor. The method of returning to the origin of the robot
The relative position between the dog of the moving body and the origin detection sensor is determined from the change state of the output from the origin detection sensor when the movable body is moved a predetermined amount, and the determined relative position is determined. Selectively perform the corresponding home return operation procedure ,
The origin return operation procedure is as follows:
While moving the movable body a predetermined amount,
When the origin detection sensor does not detect the dog detection unit in which two detection units are arranged at regular intervals, the movement of the moving body is continued, and the dog detection unit is Detecting, then stopping the moving body when detecting between the detection units, and setting the position where the moving body is stationary as the origin position,
When the origin detection sensor detects the dog detection unit, the moving body is moved to one end side of the robot to reverse the moving direction, and then the dog detection unit is first detected and then detected. A method for returning to the origin of a robot, comprising: a step of stopping the moving body when detecting a space between the parts, and setting a position where the moving body is stationary as an origin position .
位置検出用のドグが取り付けられた移動体を軸方向に移動自在に構成したロボットに対し、前記ドグを検出する原点検出センサを設け、この原点検出センサの出力に基づいて前記移動体を原点位置に復帰させるロボットの原点復帰方法であって、
前記移動体を所定の一定量移動させたときの前記原点検出センサからの出力の変化状態から、前記移動体のドグと前記原点検出センサとの相対位置を判定し、この判定された相対位置に応じた原点復帰動作手順を選択的に実行し、
前記原点復帰動作手順が、
前記移動体の移動開始時と所定の一定量移動させた後とで、
前記原点検出センサが、2つの検出部を一定の間隔で配置してなる前記ドグの検出部を検出しなかった場合に、前記移動体の移動を続行して、最初に前記ドグの検出部を検出し、その後検出部間を検出したときに前記移動体を停止させて、前記移動体が静止した位置を原点位置に設定する一方、
前記原点検出センサが前記ドグの検出部を検出した場合に、前記移動体を前記ロボットの一端側まで移動させて移動方向を反転させてから、最初に前記ドグの検出部を検出し、その後検出部間を検出したときに前記移動体を停止させて、前記移動体が静止した位置を原点位置に設定する手順であることを特徴とするロボットの原点復帰方法
An origin detection sensor for detecting the dog is provided for a robot configured to be movable in the axial direction with a movable body to which a position detection dog is attached, and the movable body is set to the origin position based on the output of the origin detection sensor. The method of returning to the origin of the robot
The relative position between the dog of the moving body and the origin detection sensor is determined from the change state of the output from the origin detection sensor when the movable body is moved a predetermined amount, and the determined relative position is determined. Selectively perform the corresponding home return operation procedure,
The origin return operation procedure is as follows:
At the start of movement of the moving body and after a predetermined amount of movement,
When the origin detection sensor does not detect the dog detection unit in which two detection units are arranged at regular intervals, the movement of the moving body is continued, and the dog detection unit is Detecting, then stopping the moving body when detecting between the detection units, and setting the position where the moving body is stationary as the origin position,
When the origin detection sensor detects the dog detection unit, the moving body is moved to one end side of the robot to reverse the moving direction, and then the dog detection unit is first detected and then detected. A method for returning to the origin of a robot , comprising: a step of stopping the moving body when detecting a space between the parts, and setting a position where the moving body is stationary as an origin position.
前記ロボットに移動体の移動量を検出するエンコーダを接続し、前記移動体を前記エンコーダからのパルス信号と同期した位置で停止させて原点位置に設定することを特徴とする請求項又は請求項記載のロボットの原点復帰方法。Connect the encoder for detecting the amount of movement of the moving body to the robot, according to claim 1 or claim wherein the moving body is stopped by a pulse signal synchronized with the position from the encoder and sets the origin position 2. The method for returning the origin of the robot according to 2 . 2つの検出部を一定の間隔で配置してなるドグを取り付けた移動体と、該移動体を軸方向に移動自在に支持するガイド部材と、前記ガイド部材に対して前記移動体を移動させる駆動源と、前記移動体のドグを検出する原点検出センサとを備えたロボットの原点復帰装置であって、
前記移動体を所定の一定量移動させたときの前記原点検出センサからの出力の変化状態から、前記移動体のドグと前記原点検出センサとの相対位置を判定し、この判定された相対位置に応じた原点復帰動作手順を選択的に実行する制御部を備えたことを特徴とするロボットの原点復帰装置。
A moving body to which a dog formed by arranging two detection units at regular intervals, a guide member that supports the moving body in an axial direction, and a drive that moves the moving body with respect to the guide member An origin return device of a robot comprising a source and an origin detection sensor for detecting a dog of the moving body,
The relative position between the dog of the moving body and the origin detection sensor is determined from the change state of the output from the origin detection sensor when the movable body is moved a predetermined amount, and the determined relative position is determined. An origin return device for a robot, comprising a controller that selectively executes a corresponding origin return operation procedure.
前記制御部が、請求項〜請求項のいずれか1項記載のロボットの原点復帰方法に基づいて原点復帰動作を制御することを特徴とする請求項記載のロボットの原点復帰装置。Wherein the control unit is, claims 1 to 4 homing device of the robot, wherein the controlling the homing operation based on homing method according to any one of the robot according to claim 3. 基板への実装部品を移載する移載ヘッドを、請求項又は請求項記載のロボットの原点復帰装置を用いて駆動することを特徴とする部品実装装置。6. A component mounting apparatus, wherein a transfer head for transferring a mounted component onto a substrate is driven by using the robot origin return device according to claim 4 or 5 .
JP2001322405A 2001-10-19 2001-10-19 Robot origin return method, origin return device and component mounting device Expired - Fee Related JP3738982B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2001322405A JP3738982B2 (en) 2001-10-19 2001-10-19 Robot origin return method, origin return device and component mounting device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2001322405A JP3738982B2 (en) 2001-10-19 2001-10-19 Robot origin return method, origin return device and component mounting device

Publications (2)

Publication Number Publication Date
JP2003131711A JP2003131711A (en) 2003-05-09
JP3738982B2 true JP3738982B2 (en) 2006-01-25

Family

ID=19139460

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2001322405A Expired - Fee Related JP3738982B2 (en) 2001-10-19 2001-10-19 Robot origin return method, origin return device and component mounting device

Country Status (1)

Country Link
JP (1) JP3738982B2 (en)

Also Published As

Publication number Publication date
JP2003131711A (en) 2003-05-09

Similar Documents

Publication Publication Date Title
US8196295B2 (en) Component mounting method
JP4100557B2 (en) Motor drive device, motor drive control method, and component mounting apparatus using the same
US20020138977A1 (en) Mounting apparatus of electronic parts and mounting methods of the same
JP2000114787A (en) Electronic part mounter and mounting method
JP5740233B2 (en) Electronic component mounting equipment
JP2004228326A (en) Method and device for controlling substrate stop position
JP2000114787A5 (en)
JP3738982B2 (en) Robot origin return method, origin return device and component mounting device
JP5800614B2 (en) Trigger generator
JPH11102936A (en) Component supply apparatus and method
KR20120098497A (en) Electronic component mounting apparatus, and electronic component mounting method
JP4342914B2 (en) Position detection device and single axis robot, surface mounter, component testing device, SCARA robot equipped with the same
JP4408068B2 (en) Component recognition apparatus and surface mounter equipped with the same
JP3564191B2 (en) Positioning method and device for mounting machine
JP3596250B2 (en) Electronic component mounting method
JP2006073960A (en) Component recognition device, surface mounter and component testing device
JP3564209B2 (en) Mounting machine acceleration control method and apparatus
JP3961280B2 (en) POSITIONING CONTROL DEVICE, POSITIONING CONTROL METHOD, AND COMPONENT MOUNTING DEVICE
JP4025048B2 (en) Application method of viscous material
JP2011142350A (en) Apparatus and method for mounting component
JP3094655B2 (en) Chip mounting method
JP7316581B2 (en) PARTS SUPPLY DEVICE AND CONTROL METHOD FOR PARTS SUPPLY DEVICE
JPH07105623B2 (en) Parts mounting device
JPH08181495A (en) Component recognition device for mounting machine
JP3127577B2 (en) Electronic component pickup device and pickup method

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20040915

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20050725

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20050803

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20051003

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20051026

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20051027

R150 Certificate of patent (=grant) or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

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

Free format text: PAYMENT UNTIL: 20091111

Year of fee payment: 4

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

Free format text: PAYMENT UNTIL: 20091111

Year of fee payment: 4

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

Free format text: PAYMENT UNTIL: 20101111

Year of fee payment: 5

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

Free format text: PAYMENT UNTIL: 20111111

Year of fee payment: 6

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

Free format text: PAYMENT UNTIL: 20121111

Year of fee payment: 7

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

Free format text: PAYMENT UNTIL: 20121111

Year of fee payment: 7

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

Free format text: PAYMENT UNTIL: 20131111

Year of fee payment: 8

LAPS Cancellation because of no payment of annual fees