JPWO2017051445A1 - Teaching system for articulated robots - Google Patents

Teaching system for articulated robots Download PDF

Info

Publication number
JPWO2017051445A1
JPWO2017051445A1 JP2017541185A JP2017541185A JPWO2017051445A1 JP WO2017051445 A1 JPWO2017051445 A1 JP WO2017051445A1 JP 2017541185 A JP2017541185 A JP 2017541185A JP 2017541185 A JP2017541185 A JP 2017541185A JP WO2017051445 A1 JPWO2017051445 A1 JP WO2017051445A1
Authority
JP
Japan
Prior art keywords
teaching
articulated robot
teaching member
contact
held
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2017541185A
Other languages
Japanese (ja)
Other versions
JP6647308B2 (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.)
Individual
Original Assignee
Individual
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 Individual filed Critical Individual
Publication of JPWO2017051445A1 publication Critical patent/JPWO2017051445A1/en
Application granted granted Critical
Publication of JP6647308B2 publication Critical patent/JP6647308B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Manipulator (AREA)
  • Numerical Control (AREA)

Abstract

多関節ロボットに新たな構成を加えることなく修正ティーチングを行うためのティーチングシステムであり、駆動モータ(４７１，４７２，４７３)を備える関節機構によってアーム部材(２２，２５)が連結され、先端部に備えたロボットハンド(２８)によって相手側装置(５)との間で所定の作業を行う多関節ロボット(８)と、相手側装置に保持される第１ティーチング部材(５１)と、ロボットハンドに保持され、第１ティーチング部材に対して接触させる第２ティーチング部材(５２)と、相手側装置(５)に保持された第１ティーチング部材(５１)に対して、ロボットハンド(２８)に保持した前記２ティーチング部材(５２)を複数の方向から接触させ、当該接触により上昇する駆動モータ(４７１，４７２，４７３)のトルク値を基に接触位置を求め、ロボットハンドの位置を算出する制御装置(４０)とを有する。This is a teaching system for performing correction teaching without adding a new configuration to an articulated robot. The arm members (22, 25) are connected by a joint mechanism including drive motors (471, 472, 473) to the tip part. An articulated robot (8) that performs a predetermined operation with the counterpart device (5) by the robot hand (28) provided, a first teaching member (51) held by the counterpart device, and a robot hand The second teaching member (52) held and brought into contact with the first teaching member and the first teaching member (51) held by the counterpart device (5) are held by the robot hand (28). The two teaching members (52) are brought into contact with each other from a plurality of directions, and a contact position is obtained based on a torque value of the drive motors (471, 472, 473) that rises due to the contact. And a control unit (40) for calculating the position of Ttohando.

Description

本発明は、多関節ロボットにおける修正ティーチングを行うためのティーチングシステムに関する。   The present invention relates to a teaching system for performing correction teaching in an articulated robot.

対象物を相手側装置との間で受渡しするなど所定の作業を行う多関節ロボットは、各駆動軸に関して原点マークや位置決めピンなどを使用した原点出しが行われるほか、制御プログラムに応じた動作を記憶させるティーチングが行われる。例えば、搬送用ロボットであれば、記憶された制御プログラムの実行により、対象物を正確な位置に移送させることが求められる。しかし、ロボットの部品精度や、対象物を受け取る受取り側に誤差が生じていると、数値制御によって行う作業が正確に実行できなくなってしまう。そこで従来では、下記特許文献１にティーチングシステムが開示されている。   Articulated robots that perform predetermined tasks such as delivering objects to and from the other device perform origin search using origin marks and positioning pins for each drive axis, and perform operations according to the control program. Teaching to be memorized is performed. For example, in the case of a transfer robot, it is required to transfer an object to an accurate position by executing a stored control program. However, if there is an error in the accuracy of the parts of the robot or the receiving side that receives the object, the work performed by numerical control cannot be performed accurately. Therefore, conventionally, a teaching system is disclosed in Patent Document 1 below.

この従来例は、先端のチャックで把持したワークを目標位置へ移動させる多関節ロボットのティーチングシステムである。このシステムでは、チャックとワークとの位置が大まかに合わせられ、チャックによってワークが把持される。その際、チャックとワークとの中心位置にズレがあれば、チャック側のフローティング体が移動して両者の中心位置が一致するようになっている。そして、チャックの位置がセンサによって検出され、その位置データに基づいて真のチャック位置が演算部において算出される。   This conventional example is a teaching system for an articulated robot that moves a workpiece gripped by a tip chuck to a target position. In this system, the position of the chuck and the workpiece is roughly aligned, and the workpiece is gripped by the chuck. At this time, if the center position of the chuck and the workpiece is misaligned, the floating body on the chuck side moves so that the center positions of the two coincide. Then, the position of the chuck is detected by a sensor, and the true chuck position is calculated by the calculation unit based on the position data.

特開平７−７５９８６号公報Japanese Patent Laid-Open No. 7-75986

従来のティーチングシステムは、多関節ロボットにフローティング機構を設けるものであり、そのロボット自体に特別な構造を必要とするものであった。従って、特別な構造が付加されていることにより、多関節ロボットの価格が上がってしまうことにある。また、フローティング機構が多関節ロボットを構造的に弱いものとしてしまい、故障の原因にもなり易くなる。従って、新たな構成を加えることなく従来構造の多関節ロボットのままで、しかも作業者による負担をかけることなくティーチングできることが望ましい。   In the conventional teaching system, the articulated robot is provided with a floating mechanism, and the robot itself requires a special structure. Accordingly, the addition of a special structure increases the price of the articulated robot. In addition, the floating mechanism makes the articulated robot structurally weak, and easily causes a failure. Therefore, it is desirable that teaching can be performed without adding a new configuration and with an articulated robot having a conventional structure without any burden on the operator.

そこで、本発明は、かかる課題を解決すべく、多関節ロボットに新たな構成を加えることなく修正ティーチングを行うためのティーチングシステムを提供することを目的とする。   Accordingly, an object of the present invention is to provide a teaching system for performing correction teaching without adding a new configuration to an articulated robot in order to solve such a problem.

本発明の一態様における多関節ロボットのティーチングシステムは、駆動モータを備える関節機構によってアーム部材が連結され、先端部に備えたロボットハンドによって相手側装置との間で所定の作業を行う多関節ロボットと、前記相手側装置に保持される第１ティーチング部材と、前記ロボットハンドに保持され、前記第１ティーチング部材に対して接触させる第２ティーチング部材と、前記相手側装置に保持された前記第１ティーチング部材に対して、前記ロボットハンドに保持した前記２ティーチング部材を複数の方向から接触させ、当該接触により上昇する前記駆動モータのトルク値を基に接触位置を求め、前記ロボットハンドの位置を算出する制御装置とを有する。   An articulated robot teaching system according to an aspect of the present invention is an articulated robot in which an arm member is connected by a joint mechanism including a drive motor, and a predetermined operation is performed with a counterpart device by a robot hand provided at a distal end portion. A first teaching member held by the counterpart device, a second teaching member held by the robot hand and brought into contact with the first teaching member, and the first teaching member held by the counterpart device The two teaching members held by the robot hand are brought into contact with the teaching member from a plurality of directions, the contact position is obtained based on the torque value of the drive motor that is raised by the contact, and the position of the robot hand is calculated. And a control device.

本発明によれば、第１ティーチング部材と第２ティーチング部材を用意し、相手側装置に保持された前記第１ティーチング部材に対してロボットハンドに保持した２ティーチング部材を複数の方向から接触させ、当該接触により上昇する前記駆動モータのトルク値を基に接触位置を求め、前記ロボットハンドの位置を算出することにより誤差を補正するための修正ティーチングを行うことができる。   According to the present invention, a first teaching member and a second teaching member are prepared, and the two teaching members held in the robot hand are brought into contact with the first teaching member held by the counterpart device from a plurality of directions. Correction teaching for correcting an error can be performed by obtaining a contact position based on the torque value of the drive motor that is raised by the contact and calculating the position of the robot hand.

加工機械ラインを示した斜視図である。It is the perspective view which showed the processing machine line. 工作機械のカバー内部を示した加工部の正面図である。It is a front view of the process part which showed the inside of the cover of a machine tool. 多関節ロボットアームが伸びた状態の搬送装置を示した斜視図である。It is the perspective view which showed the conveying apparatus of the state which the articulated robot arm extended. 多関節ロボットアームが折り畳まれた状態の搬送装置を示した斜視図である。It is the perspective view which showed the conveying apparatus of the state by which the articulated robot arm was folded. 加工機械ラインに組み込まれた搬送用制御装置を表すブロック図である。It is a block diagram showing the control apparatus for conveyance integrated in the processing machine line. 修正ティーチングを実行中のチャックやロボットハンドなどを簡略化して示した断面図である。It is sectional drawing which simplified and showed the chuck | zipper, robot hand, etc. which are performing correction teaching.

次に、本発明に係る多関節ロボットのティーチングシステムについて、その一実施形態を以下に図面を参照しながら説明する。本実施形態では、加工機械ラインに搭載された搬送装置（多関節ロボット）を例に挙げて説明する。図１は、その加工機械ラインを示した斜視図である。この加工機械ライン１は、基礎となるベース２の上に６台の工作機械５が搭載されている。６台の工作機械５はいずれも同じ型のＮＣ旋盤であり、外形形状や寸法が揃えられている。各工作機械５は、外装カバー６によって覆われ、その内部には工作機械５ごとに閉じられた加工室が構成されている。そして加工室の前方には、前カバー７によって一つのワーク搬送室が構成され、その中に各工作機械５とワークの受渡しを行う搬送装置が搭載されている。   Next, an embodiment of a teaching system for an articulated robot according to the present invention will be described with reference to the drawings. In the present embodiment, a description will be given by taking as an example a transfer device (articulated robot) mounted on a processing machine line. FIG. 1 is a perspective view showing the processing machine line. In this processing machine line 1, six machine tools 5 are mounted on a base 2 as a base. The six machine tools 5 are all NC lathes of the same type, and have the same outer shape and dimensions. Each machine tool 5 is covered with an exterior cover 6, and a processing chamber closed for each machine tool 5 is formed inside the machine tool 5. In front of the processing chamber, one work transfer chamber is constituted by the front cover 7, and a transfer device for delivering the workpieces to and from each machine tool 5 is mounted therein.

工作機械５は幅寸法が小さくなるように設計されたものであり、同じ型の工作機械５が複数横並びした加工機械ライン１がコンパクトなものになっている。ここで、図２は、工作機械５のカバー内部を示した加工部の正面図である。工作機械５は、図示する幅間隔の外装カバー６内に、加工を実行する加工モジュール１０が組み込まれている。正面側から見た加工モジュール１０は、手前側に工具台１４を備えたタレット装置１３と、ワークを保持する主軸チャック１１が上下に配置されている。主軸チャック１１の中心Ｏすなわち主軸の回転軸は、外装カバー６の幅方向に見てほぼ中央に位置している   The machine tool 5 is designed to have a small width dimension, and the processing machine line 1 in which a plurality of machine tools 5 of the same type are arranged side by side is compact. Here, FIG. 2 is a front view of the machining portion showing the inside of the cover of the machine tool 5. In the machine tool 5, a processing module 10 that executes processing is incorporated in an exterior cover 6 having a width interval shown in the drawing. The machining module 10 as viewed from the front side includes a turret device 13 having a tool base 14 on the front side and a spindle chuck 11 for holding a workpiece arranged vertically. The center O of the spindle chuck 11, that is, the rotation axis of the spindle is located substantially in the center when viewed in the width direction of the exterior cover 6.

主軸チャック１１は、主軸台１２に対して回転自在に支持された主軸と一体になり、外装カバー６の後方奥に配置されたサーボモータによって回転するよう構成されている。また、前方に位置する主軸チャック１１やタレット装置１３の後方には右側にコラム１５が配置され、外装カバー６の側壁に沿って起立している。コラム１５の上部にはサーボモータ１６が設置され、タレット装置１３を上下方向に移動させるためのＸ軸駆動機構が構成されている。また、その後方奥にはサーボモータ１７が設置され、タレット装置１３を主軸と平行な方向、つまり図面を貫く水平方向に移動させるためのＺ軸駆動機構が構成されている。   The spindle chuck 11 is integrated with a spindle that is rotatably supported with respect to the spindle stock 12, and is configured to be rotated by a servo motor disposed at the rear back of the exterior cover 6. Further, a column 15 is disposed on the right side behind the spindle chuck 11 and the turret device 13 positioned in the front, and stands along the side wall of the exterior cover 6. A servo motor 16 is installed on the top of the column 15 to constitute an X-axis drive mechanism for moving the turret device 13 in the vertical direction. In addition, a servo motor 17 is installed at the back rear side, and a Z-axis drive mechanism for moving the turret device 13 in a direction parallel to the main shaft, that is, in a horizontal direction through the drawing is configured.

この工作機械５では、タレット装置１３の旋回割出しによって工具台１４に装着された切削工具が選択される。そして、Ｘ軸駆動機構やＺ軸駆動機構によって切削工具が所定の位置に移動し、回転する主軸チャック１１に保持されたワークに対して中ぐり加工などが行われる。この主軸チャック１１に保持されているワークは、加工に際して工作機械５の加工室の外側から搬送装置によって送り込まれる。   In the machine tool 5, the cutting tool mounted on the tool table 14 is selected by the turning index of the turret device 13. Then, the cutting tool is moved to a predetermined position by the X-axis drive mechanism or the Z-axis drive mechanism, and boring processing or the like is performed on the work held by the rotating spindle chuck 11. The workpiece held by the spindle chuck 11 is fed from the outside of the machining chamber of the machine tool 5 by a conveying device during machining.

図３及び図４は、搬送装置を示した斜視図である。特に図３は、工作機械との間でワークの受渡しを行うべく、多関節ロボットアーム２０が伸びた状態が示されている。そして、図４には、多関節ロボットアーム２０が工作機械の間を移動するために折り畳まれた状態が示されている。このように本実施形態の多関節ロボットアーム２０は、関節機構の駆動により、コンパクトな状態に折り畳まれ、伸びた姿勢によって遠くの位置でも作業が可能なものである。   3 and 4 are perspective views showing the transport device. In particular, FIG. 3 shows a state in which the articulated robot arm 20 is extended to deliver a workpiece to and from the machine tool. FIG. 4 shows a state in which the articulated robot arm 20 is folded to move between machine tools. As described above, the articulated robot arm 20 of the present embodiment is folded into a compact state by driving the joint mechanism, and can be operated at a distant position by the extended posture.

この多関節ロボットアーム２０を備えた搬送装置８は、横並びに配置された複数の工作機械に対し、その前方を横切って移動するように組み付けられている。具体的には、工作機械５を搭載するベース２の前部に組み付けられる。図示するベース２は、２台の工作機械を搭載する大きさのものであり、図１に示す加工機械ライン１では３台のベース２が幅方向に接近して設置されている。搬送装置８は、そのベース２に対して走行装置３０が組み付けられ、走行装置３０には多関節ロボットアーム２０が搭載され、いわゆる多関節ロボットが構成されている。   The transfer device 8 including the articulated robot arm 20 is assembled so as to move across the front of a plurality of machine tools arranged side by side. Specifically, it is assembled to the front portion of the base 2 on which the machine tool 5 is mounted. The illustrated base 2 has a size for mounting two machine tools. In the processing machine line 1 shown in FIG. 1, three bases 2 are installed close to each other in the width direction. The transport device 8 has a traveling device 30 assembled to the base 2, and the traveling device 30 is equipped with an articulated robot arm 20 to constitute a so-called articulated robot.

走行装置３０は、ベース２の前面部に固定された支持板３１に対し、水平方向にラック３２や２本のレール３３が固定されている。そして、走行台３５には走行スライダが一体に固定され、その走行スライダがレール３３を掴んで摺動するように組み付けられている。走行台３５には走行用のサーボモータ３６が設けられ、その回転軸に固定されたピニオン３７がラック３２に噛合している。従って、サーボモータ３６の駆動によって回転するピニオン３６が、噛合するラック３２を転動し、走行台３５がレール３３に沿ってベース２の前面部を移動することになる。   In the traveling device 30, a rack 32 and two rails 33 are fixed in a horizontal direction with respect to a support plate 31 fixed to the front portion of the base 2. A traveling slider is fixed integrally to the traveling platform 35, and the traveling slider is assembled so as to slide while gripping the rail 33. The traveling table 35 is provided with a traveling servo motor 36, and a pinion 37 fixed to the rotating shaft meshes with the rack 32. Accordingly, the pinion 36 rotated by the drive of the servo motor 36 rolls the meshing rack 32, and the traveling table 35 moves along the rail 33 on the front surface portion of the base 2.

走行台３５の上には、旋回テーブル３８を介して多関節ロボットアーム２０が搭載されている。この多関節ロボットアーム２０は、特に狭い幅寸法内で工作機械５とワークの受渡しを可能にするよう構成されたものである。工作機械５は、ベース２の上に敷設された２本のレール２０１に搭載するように設計されたものであり、図２に示すように幅寸法の狭い構造になっている。従って、多関節ロボットアーム２０は、横幅寸法の狭い外装カバー６の内部空間でワークの受渡しができるように設計されている。具体的には、外装カバー６の幅が約４５０ｍｍであるのに対し、外径が３００ｍｍのワークを掴んで受渡しできるようにしたものである。   The articulated robot arm 20 is mounted on the traveling table 35 via a turning table 38. The articulated robot arm 20 is configured to enable delivery of a workpiece to and from the machine tool 5 within a particularly narrow width. The machine tool 5 is designed to be mounted on two rails 201 laid on the base 2, and has a narrow structure as shown in FIG. Therefore, the articulated robot arm 20 is designed so that a workpiece can be delivered in the internal space of the exterior cover 6 having a narrow lateral width. Specifically, the outer cover 6 has a width of about 450 mm, while a workpiece having an outer diameter of 300 mm can be grasped and delivered.

その多関節ロボットアーム２０は、旋回テーブル３８に固定された支持台２１に対し、上腕部材２２が第１関節機構２３を介して連結され、更に上腕部材２２には前腕部材２５が第２関節機構２６を介して連結されている。支持台２１は、一対の支持プレート２１１が起立し、上腕部材２２は、一対の支持プレート２１１に対応する一対の上腕プレート２２１をもって形成されている。そして、各プレート２１１，２２１同士が関節軸によって連結され、上腕部材２２は、第１関節機構２３の駆動によりその角度調整が行われる。上腕部材２２には一対の上腕プレート２２１の間に空間が形成され、その中に前腕部材２５が入り込むよう構成されている。   In the articulated robot arm 20, an upper arm member 22 is connected to a support base 21 fixed to a turning table 38 via a first joint mechanism 23, and a forearm member 25 is connected to the upper arm member 22 with a second joint mechanism. 26 are connected to each other. The support base 21 has a pair of support plates 211 erected, and the upper arm member 22 is formed with a pair of upper arm plates 221 corresponding to the pair of support plates 211. The plates 211 and 221 are connected to each other by a joint shaft, and the angle of the upper arm member 22 is adjusted by driving the first joint mechanism 23. A space is formed between the pair of upper arm plates 221 in the upper arm member 22, and the forearm member 25 is configured to enter the space.

前腕部材２５は、左右に一対の平行な前腕プレート２５１をもって形成され、その前腕プレート２５１と上腕プレート２２１が関節軸によって連結されている。従って、前腕部材２５は、第２関節機構２６の駆動により、上腕部材２２に対する角度調整が行われる。前腕部材２５には、第２関節機構４６とは反対側の端部にロボットハンド２８が取り付けられている。ロボットハンド２８は、３本のチャック爪が油圧によって駆動するクランプ機構を有し、ワークの把持及び解放が可能なものである。また、ロボットハンド２８は、前腕プレート２５１に対して回転機構を介して組み付けられ、チャック爪の把持角度が調整できるようになっている。   The forearm member 25 is formed with a pair of parallel forearm plates 251 on the left and right, and the forearm plate 251 and the upper arm plate 221 are connected by a joint shaft. Therefore, the angle of the forearm member 25 relative to the upper arm member 22 is adjusted by driving the second joint mechanism 26. A robot hand 28 is attached to the forearm member 25 at the end opposite to the second joint mechanism 46. The robot hand 28 has a clamp mechanism in which three chuck claws are driven by hydraulic pressure, and can grip and release a workpiece. The robot hand 28 is assembled to the forearm plate 251 via a rotation mechanism so that the grip angle of the chuck claw can be adjusted.

こうした多関節ロボットアーム２０は、可動部である上腕部材２２、前腕部材２５及びロボットハンド２８が駆動した所定の動作によって作業が行われる。その際、第１及び第２関節機構２３，２６など各駆動部のサーボモータ４７１〜４７３（図５参照）に対する回転制御によって、ロボットハンド２８の移動位置や、ロボットハンド２８が把持したワークの向きの割出しが行われる。従って、搬送装置８が正確に作業を行うには、制御プログラムに従った各サーボモータ４７１〜４７３，３６における回転角度と、多関節ロボットアーム２０や走行装置３０の動作が対応していなければならない。   Such an articulated robot arm 20 is operated by a predetermined operation driven by the upper arm member 22, the forearm member 25 and the robot hand 28 which are movable parts. At that time, the movement position of the robot hand 28 and the direction of the work gripped by the robot hand 28 are controlled by rotation control of the drive units such as the first and second joint mechanisms 23 and 26 with respect to the servomotors 471 to 473 (see FIG. 5). Is indexed. Therefore, in order for the transport device 8 to perform work accurately, the rotation angle of each servo motor 471 to 473, 36 according to the control program must correspond to the operation of the articulated robot arm 20 and the traveling device 30. .

そこで、搬送装置８では、多関節ロボットアーム２０などに対し、基本姿勢におけるサーボモータの回転位置をゼロ度とした原点出しや、実際に工作機械５とワークの受渡し動作を行わせることで制御プログラムとして動作を記憶させるティーチングが行われる。しかしながら、加工機械ライン１の稼働が継続される中、搬送装置８の多関節ロボットアーム２０の動作などに機械的な誤差が生じることがある。つまり、ティーチングによって記憶された三次元座標の値と実際動きに狂いが生じてしまう。そこで、多関節ロボットアーム２０などの所定の動作に対して、サーボモータ４７１〜４７３，３６の回転角度を補正するための修正ティーチングが必要になる。   Therefore, in the transfer device 8, the control program can be obtained by causing the articulated robot arm 20 or the like to perform the origin search with the rotation position of the servo motor in the basic posture set to zero degree, or to actually perform the workpiece transfer operation with the machine tool 5. Teaching for storing the operation is performed. However, a mechanical error may occur in the operation of the articulated robot arm 20 of the transfer device 8 while the operation of the processing machine line 1 is continued. In other words, the value of the three-dimensional coordinate stored by teaching and the actual movement are distorted. Therefore, correction teaching for correcting the rotation angle of the servomotors 471 to 473, 36 is required for a predetermined operation of the articulated robot arm 20 or the like.

ところが加工機械ライン１では、前述したように各工作機械５の幅寸法が非常に狭いため、修正ティーチングの作業が困難であった。多関節ロボットアーム２０は、図２に示す外装カバー６のほぼ幅全体に入り込んで移動するため、主軸チャック１１とロボットハンド２８との位置関係を作業者が外から目視で確認することが難しい状況になっているからである。また、多関節ロボットアーム２０では、第１及び第２関節機構２３，２６やロボットハンド２８をサーボモータ４７１〜４７３が連動して動作させるため、仮に作業者の目視によってズレが確認できたとしても、どのサーボモータ４７１〜４７３をどの程度調整するかの判断が非常に困難である。   However, in the processing machine line 1, since the width dimension of each machine tool 5 is very narrow as described above, it is difficult to perform correction teaching. Since the articulated robot arm 20 moves in almost the entire width of the outer cover 6 shown in FIG. 2, it is difficult for the operator to visually confirm the positional relationship between the spindle chuck 11 and the robot hand 28 from the outside. Because it is. Further, in the articulated robot arm 20, the first and second joint mechanisms 23 and 26 and the robot hand 28 are operated in conjunction with the servo motors 471 to 473, so even if the deviation can be confirmed visually by the operator. It is very difficult to determine how much servo motors 471 to 473 are adjusted.

そこで、本実施形態の搬送装置８には修正ティーチングを自動で行うためのティーチングシステムが構成されている。ここで、図５は、加工機械ライン１に組み込まれた搬送装置８の搬送用制御装置を表すブロック図である。搬送用制御装置４０は、マイクロプロセッサ（ＣＰＵ）４１、ＲＯＭ４２、ＲＡＭ４３、不揮発性メモリ４４、コントローラ４５１〜４５４及びサーボアンプ４６１〜４６４からなるサーボ制御部４８などがバスライン４９を介して接続されている。ＣＰＵ４１は制御部全体を統括制御するものであり、ＲＯＭ４２にはＣＰＵ４１が実行するシステムプログラムや制御パラメータ等が格納され、ＲＡＭ４３には一時的に計算データや表示データ等が格納される。   Therefore, the conveying device 8 of this embodiment is configured with a teaching system for automatically performing correction teaching. Here, FIG. 5 is a block diagram showing a transfer control device of the transfer device 8 incorporated in the processing machine line 1. The transport control device 40 includes a microprocessor (CPU) 41, a ROM 42, a RAM 43, a nonvolatile memory 44, a servo control unit 48 including controllers 451 to 454, servo amplifiers 461 to 464, and the like connected via a bus line 49. Yes. The CPU 41 performs overall control of the entire control unit. The ROM 42 stores system programs executed by the CPU 41, control parameters, and the like, and the RAM 43 temporarily stores calculation data, display data, and the like.

また、不揮発性メモリ４４は、ＣＰＵ４１が行う処理に必要な情報を記憶し、搬送装置８におけるワークの搬送プログラムが格納されている。その搬送プログラムを実行する搬送装置８では、ティーチングによって多関節ロボットアーム２０の動作や走行装置３０の停止位置などが記憶されている。更に本実施形態では、ティーチングによって記憶された座標データと実際の動作に誤差が生じた場合に補正を行うための修正プログラムが格納されている。   The nonvolatile memory 44 stores information necessary for processing performed by the CPU 41, and stores a workpiece transfer program in the transfer device 8. In the transfer device 8 that executes the transfer program, the operation of the articulated robot arm 20 and the stop position of the traveling device 30 are stored by teaching. Furthermore, in the present embodiment, a correction program for correcting when an error occurs between the coordinate data stored by teaching and the actual operation is stored.

搬送装置８は、多関節ロボットアーム２０では第１関節機構２３、第２関節機構２６及びロボットハンド２８の各サーボモータ４７１〜４７３が、走行装置３０ではサーボモータ３６が、サーボ制御部４８を介してＣＰＵ４１に接続されている。そして、搬送装置８の各サーボモータ４７１〜４７３，３６は、ＣＰＵ４１からの回転制御指令とサーボモータ４７１〜４７３，３６に内蔵されたロータリエンコーダからの現在位置情報（現在回転角度）に基づいてフィードバック制御が実行される。サーボアンプ４６１〜４６４は、コントローラ４５１〜４５４からのトルク指令に基づき、サーボモータ４７１〜４７３，３６に電流を供給してそれらを駆動する。   The transfer device 8 includes the servo motors 471 to 473 of the first joint mechanism 23, the second joint mechanism 26, and the robot hand 28 in the multi-joint robot arm 20, and the servo motor 36 in the travel device 30 via the servo control unit 48. Connected to the CPU 41. The servo motors 471 to 473 and 36 of the transport device 8 are fed back based on the rotation control command from the CPU 41 and the current position information (current rotation angle) from the rotary encoder built in the servo motors 471 to 473 and 36. Control is executed. The servo amplifiers 461 to 464 supply current to the servo motors 471 to 473 and 36 to drive them based on torque commands from the controllers 451 to 454.

次に、図６は、修正ティーチング実行時の主軸チャック１１とロボットハンド２８、そして使用する治具を簡略化して示した断面図であり、（ａ）（ｂ）（ｃ）の順にティーチング作業が段階的に行われる。修正ティーチングでは、主軸チャック１１側に第１ティーチング部材５１が装着され、ロボットハンド２８側には第２ティーチング部材５２が装着される。第１ティーチング部材５１は、径の大きさを３段階に変化させた円柱体である。そして、最も径の大きい部分が主軸チャック１１によって把持される把持部５１１であり、更に径の異なる部分が大径計測部５１２と小径計測部５１３である。一方、第２ティーチング部材５２は、底部５２１と円筒部５２２とを有する有底円筒体である。   Next, FIG. 6 is a cross-sectional view schematically showing the spindle chuck 11, the robot hand 28, and the jig to be used at the time of executing the corrected teaching. Teaching operations are performed in the order of (a), (b) and (c). It is done in stages. In the correction teaching, the first teaching member 51 is mounted on the spindle chuck 11 side, and the second teaching member 52 is mounted on the robot hand 28 side. The first teaching member 51 is a cylindrical body whose diameter is changed in three stages. The portion with the largest diameter is the grip portion 511 gripped by the spindle chuck 11, and the portions with different diameters are the large diameter measuring portion 512 and the small diameter measuring portion 513. On the other hand, the second teaching member 52 is a bottomed cylindrical body having a bottom portion 521 and a cylindrical portion 522.

第１ティーチング部材５１の大径計測部５１２は、第２ティーチング部材５２の円筒部５２２の内径よりも僅かに小さく形成された外径の円周面を有し、小径計測部５１３は更に小さい外径の円周面を有する。従って、第１ティーチング部材５１と第２ティーチング部材５２は、図示するように嵌め合わせることが可能であり、嵌め合わせの際には径方向に隙間が生じることになる。図面では、互いの中心軸Ｏ１，Ｏ２の位置合わせに誤差が生じてしまっている場合を示している。しかし、この時のズレ量は極めて微小であるため隙間によって許容され、図示するように第１ティーチング部材５１と第２ティーチング部材５２とが嵌り合う関係がつくられる。   The large diameter measuring part 512 of the first teaching member 51 has a circumferential surface with an outer diameter formed slightly smaller than the inner diameter of the cylindrical part 522 of the second teaching member 52, and the small diameter measuring part 513 is a smaller outer diameter. It has a circumferential surface with a diameter. Therefore, the first teaching member 51 and the second teaching member 52 can be fitted as shown in the figure, and a gap is generated in the radial direction when fitting. The drawing shows a case where an error has occurred in the alignment of the central axes O1 and O2. However, since the amount of deviation at this time is extremely small, it is allowed by the gap, and a relationship is established in which the first teaching member 51 and the second teaching member 52 are fitted as shown in the figure.

続いて、修正プログラムに従った修正ティーチング処理について説明する。加工機械ライン１の所定の工作機械５との間で搬送装置８の修正ティーチングが行われる場合には、その準備として第１ティーチング部材５１が主軸チャック１１に装着され、第２ティーチング部材５２がロボットハンド２８に装着される。そして、搬送装置８は、走行装置３０の駆動により多関節ロボットアーム２０を対象とする工作機械５の位置に移動させ、そこで修正ティーチング作業が行われる。   Next, the correction teaching process according to the correction program will be described. When correction teaching of the transfer device 8 is performed with a predetermined machine tool 5 on the processing machine line 1, the first teaching member 51 is mounted on the main spindle chuck 11 and the second teaching member 52 is a robot. Mounted on the hand 28. Then, the conveying device 8 moves the articulated robot arm 20 to the position of the machine tool 5 targeted by the driving of the traveling device 30, and the correction teaching work is performed there.

修正ティーチング作業では、多関節ロボットアーム２０側の第２ティーチング部材５２を主軸チャック１１側の第１ティーチング部材５１に対して複数の個所で接触させた位置確認が行われる。先ず、第１ティーチング部材５１と第２ティーチング部材５２の中心軸Ｏ１，０２を合わせるようにして水平方向（Ｚ軸方向）に移動し、図６（ａ）に示すように両者が嵌り合った状態でＺ軸方向に突き当てられる。ことのきの第２ティーチング部材５２の位置を第１計測位置とする。   In the correction teaching work, position confirmation is performed by bringing the second teaching member 52 on the articulated robot arm 20 side into contact with the first teaching member 51 on the spindle chuck 11 side at a plurality of locations. First, the first teaching member 51 and the second teaching member 52 are moved in the horizontal direction (Z-axis direction) so that the center axes O1 and 02 of the second teaching member 52 are aligned with each other, as shown in FIG. 6A. Is abutted in the Z-axis direction. The position of the second teaching member 52 at this time is taken as the first measurement position.

そして次に、図６（ｂ）に示すように、第２ティーチング部材５２は、Ｚ軸方向であって第１ティーチング部材５１から離れる方向（図面右側）に移動した第２計測位置で停止する。第２計測位置は、円筒部５２２の先端部分が、第１ティーチング部材５１の大径計測部５１２と重なる位置である。特に、大径計測部５１２の端部に円筒部５２２の先端部分が位置するようにしている。第２計測位置では、第２ティーチング部材５２がＺ軸に直交するＸ軸方向及びＹ軸方向に移動して第２ティーチング部材５２に当てられる。その際、第２ティーチング部材５２が中心軸Ｏ２の傾いた姿勢であっても、円筒部５２２の先端部分が大径計測部５１２に当たって計測が行われるようにするためである。   Next, as shown in FIG. 6B, the second teaching member 52 stops at the second measurement position moved in the Z-axis direction and in the direction away from the first teaching member 51 (right side of the drawing). The second measurement position is a position where the tip portion of the cylindrical portion 522 overlaps the large diameter measurement portion 512 of the first teaching member 51. In particular, the tip end portion of the cylindrical portion 522 is positioned at the end portion of the large diameter measuring portion 512. At the second measurement position, the second teaching member 52 moves in the X-axis direction and the Y-axis direction orthogonal to the Z-axis and is applied to the second teaching member 52. At this time, even if the second teaching member 52 is inclined with respect to the central axis O2, the tip portion of the cylindrical portion 522 hits the large-diameter measuring portion 512 to perform measurement.

そして、第２計測位置における第２計測の後は、更に第２ティーチング部材５２がＺ軸方向に移動して図６（ｃ）に示す第３計測位置で停止する。第３計測位置は、円筒部５２２の先端部分が、第１ティーチング部材５１の小径計測部５１３と重なる位置である。ここでも第１ティーチング部材５１の端部に円筒部５２２の先端部分が位置するようにしているが、筒部５２２の先端部分が小径計測部５１３に当って計測が行われるようにするためである。なお、修正ティーチング作業中の移動は、予め記憶されている第１及び第２ティーチング部材５１，５２を使用したティーチングに基づいて制御される。   Then, after the second measurement at the second measurement position, the second teaching member 52 further moves in the Z-axis direction and stops at the third measurement position shown in FIG. The third measurement position is a position where the tip portion of the cylindrical portion 522 overlaps with the small diameter measurement portion 513 of the first teaching member 51. Again, the tip portion of the cylindrical portion 522 is positioned at the end portion of the first teaching member 51, but the tip portion of the cylindrical portion 522 hits the small diameter measuring portion 513 to perform measurement. . The movement during the correction teaching operation is controlled based on teaching using the first and second teaching members 51 and 52 stored in advance.

本実施形態の修正ティーチング作業では、第１乃至第３計測位置において第１ティーチング部材５１に第２ティーチング部材５２が３軸方向に突き当てられる。その際、Ｚ軸方向とＸ軸方向の移動は、多関節ロボットアーム２０の第１及び第２関節機構２３，２６の駆動により行われ、Ｙ軸方向の移動は、走行装置３０の駆動によって行われる。つまり、サーボモータ４７１〜４７３，３６の駆動制御によって行われる。   In the correction teaching work of this embodiment, the second teaching member 52 is abutted against the first teaching member 51 in the three-axis directions at the first to third measurement positions. At this time, the movement in the Z-axis direction and the X-axis direction is performed by driving the first and second joint mechanisms 23 and 26 of the articulated robot arm 20, and the movement in the Y-axis direction is performed by driving the traveling device 30. Is called. That is, it is performed by drive control of the servo motors 471 to 473 and 36.

サーボモータ４７１〜４７３，３６に発生するトルクは電流に比例する。従って、第２ティーチング部材５２が第１ティーチング部材５１に突き当てられると、抵抗によってトルク値が上昇し、サーボアンプ４６１〜４６４においてサーボモータ４７１〜４７３，３６に通電の電流値が上昇する。そのため、トルク値の上昇つまり電流値の上昇を検出することにより、そのタイミングで得られたエンコーダからの信号を基に各サーボモータ４７１〜４７３，３６の回転角度が求められる。そして、各サーボモータ４７１〜４７３，３６の回転角度からは、部材同士が突き当てられた接触位置の座標値が算出される。   The torque generated in the servomotors 471 to 473, 36 is proportional to the current. Accordingly, when the second teaching member 52 is abutted against the first teaching member 51, the torque value is increased by resistance, and the current values of energizing the servo motors 471 to 473 and 36 in the servo amplifiers 461 to 464 are increased. Therefore, by detecting an increase in torque value, that is, an increase in current value, the rotation angle of each of the servo motors 471 to 473, 36 is obtained based on a signal from the encoder obtained at that timing. From the rotation angles of the servo motors 471 to 473, 36, the coordinate value of the contact position where the members are brought into contact with each other is calculated.

図６（ａ）の第１計測位置では、第２ティーチング部材５２が第１ティーチング部材５１に対してＺ軸方向行に突き当てられ、その接触位置の座標値が算出される。続く図６（ｂ）の第２計測位置では、Ｘ軸方向及びＹ軸方向において中心軸Ｏ１に向かう各２方向の合計４方向から第２ティーチング部材５２が第１ティーチング部材５１に突き当てられ、各接触位置の座標値が算出される。そして、図６（ｃ）の第３計測位置でも同じように、４方向から第２ティーチング部材５２が第１ティーチング部材５１に突き当てられ、各接触位置の座標値が算出される。   6A, the second teaching member 52 is abutted against the first teaching member 51 in the Z-axis direction row, and the coordinate value of the contact position is calculated. At the second measurement position in FIG. 6B, the second teaching member 52 is abutted against the first teaching member 51 from a total of four directions in the two directions toward the central axis O1 in the X-axis direction and the Y-axis direction. The coordinate value of each contact position is calculated. Similarly, at the third measurement position in FIG. 6C, the second teaching member 52 is abutted against the first teaching member 51 from four directions, and the coordinate value of each contact position is calculated.

以上の結果から、第２計測位置と第３計測位置における第１ティーチング部材５１の中心軸０１の位置が算出される。第１ティーチング部材５１の中心軸Ｏ１の位置は、主軸チャック１１の中心位置である。一方で、第２ティーチング部材５２に関しても、図６（ａ）の第１計測位置での中心軸Ｏ２の位置が求められている。そのため、中心軸０１に対する中心軸Ｏ２のズレが算出される。すなわち、三次元座標上でのＸＹ座標面での制御誤差が算出される。一方、Ｚ軸方向に関しては、第１計測位置の接触位置から初期値との誤差が算出される。   From the above results, the position of the central axis 01 of the first teaching member 51 at the second measurement position and the third measurement position is calculated. The position of the center axis O <b> 1 of the first teaching member 51 is the center position of the spindle chuck 11. On the other hand, regarding the second teaching member 52, the position of the central axis O2 at the first measurement position in FIG. Therefore, the deviation of the central axis O2 from the central axis 01 is calculated. That is, the control error on the XY coordinate plane on the three-dimensional coordinate is calculated. On the other hand, regarding the Z-axis direction, an error from the initial value is calculated from the contact position of the first measurement position.

更に、第２計測位置及び第３計測位置では、Ｘ軸方向とＹ軸方向のそれぞれにおいて反対側との移動距離つまり隙間の比が求められる。そして、第２計測位置と第３計測位置における比の値からロボットハンド２８のＺ軸方向の移動に傾きが生じているか否かの確認が行われる。つまり、第２計測位置と第３計測位置においてＸ軸方向の比、Ｙ軸方向の比がそれぞれにおいて同じ値であれば、ロボットハンド２８は中心軸Ｏ２に沿ってＺ軸方向に真っ直ぐ移動していることが分かる。一方で、第２計測位置と第３計測位置において比の値が異なっていれば、中心軸Ｏ２に対して傾いたＺ軸方向の移動をしていることになる。その際には比の値から移動の傾きが算出される。   Further, at the second measurement position and the third measurement position, the movement distance, that is, the gap ratio between the opposite side in each of the X-axis direction and the Y-axis direction is obtained. Then, it is confirmed whether or not there is an inclination in the movement of the robot hand 28 in the Z-axis direction from the value of the ratio between the second measurement position and the third measurement position. That is, if the ratio in the X-axis direction and the ratio in the Y-axis direction are the same in the second measurement position and the third measurement position, the robot hand 28 moves straight along the central axis O2 in the Z-axis direction. I understand that. On the other hand, if the ratio value is different between the second measurement position and the third measurement position, the movement is in the Z-axis direction inclined with respect to the central axis O2. At that time, the inclination of movement is calculated from the ratio value.

搬送装置８の多関節ロボットアーム２０や走行装置３０は、工作機械５の主軸チャック１１に対してワークの受渡しを行うため、予めティーチングにより三次元座標上の位置情報に基づいた動作手順が記憶されている。よって、位置情報と実際の動作位置とに誤差が生じてしまった場合には、前述した修正ティーチング作業により誤差が算出され、多関節ロボットアーム２０や走行装置３０を動作させる各サーボモータ４７１〜４７３，３６の回転角度について自動補正が行われる。   Since the articulated robot arm 20 and the traveling device 30 of the transport device 8 deliver a workpiece to the spindle chuck 11 of the machine tool 5, an operation procedure based on position information on three-dimensional coordinates is stored in advance by teaching. ing. Therefore, if an error occurs between the position information and the actual operation position, the error is calculated by the above-described correction teaching work, and the servo motors 471 to 473 that operate the articulated robot arm 20 and the traveling device 30 are calculated. , 36 is automatically corrected.

本実施形態のティーチングシステムによれば、工作機械５に対する搬送装置８のように、狭い加工空間内で作業を行う多関節ロボットアーム２０などに対して自動補正が行われるため、作業者による目視などの作業が不要になり極めて効果的である。また、本実施形態のティーチングシステムは、第１及び第２ティーチング部材５１，５２を用意し、修正プログラムを格納することにより、特別な装置や構造を追加する必要がないため従来の搬送装置８（多関節ロボット）に採用することができる。しかも、サーボモータ４７１〜４７３，３６のトルク値の変化を基に三次元座標の座標値などを算出するようにしたため、その構成も簡易的でありコストを抑えることができる。   According to the teaching system of the present embodiment, automatic correction is performed on the articulated robot arm 20 or the like that performs work in a narrow processing space, such as the transfer device 8 for the machine tool 5, and thus visual inspection by an operator, etc. This work is unnecessary and is extremely effective. Further, the teaching system of the present embodiment prepares the first and second teaching members 51 and 52 and stores the correction program, so that it is not necessary to add a special device or structure, so that the conventional conveying device 8 ( It can be used for articulated robots). In addition, since the coordinate values of the three-dimensional coordinates and the like are calculated based on changes in the torque values of the servo motors 471 to 473, 36, the configuration is simple and the cost can be reduced.

第１及び第２ティーチング部材５１，５２は単純な形状であるため、その作成も容易でコストがかからない。そして、第１ティーチング部材５１は、大径計測部５１２と小径計測部５１３が形成されているため、多関節ロボットアーム２０によるＺ軸方向の移動の傾きを容易に求めることができる。また、第２ティーチング部材５２の中心軸Ｏ２がＺ軸に対して傾いていたとしても、大径計測部５１２と小径計測部５１３の端部に円筒部５２２の先端部分を当てることにより、ほぼ同じ突き当て状態を再現することができ、安定した計測を行うことが可能である。また、第１計測位置でＺ軸方向の突き当てを行った後にＸ軸及びＹ軸方向の計測を行う第２及び第３計測位置へとＺ軸方向に移動しているため、この点でもほぼ同じ突き当て状態を再現することができ、安定した計測を行うことが可能である。   Since the first and second teaching members 51 and 52 have a simple shape, their creation is easy and cost-effective. And since the 1st teaching member 51 is formed with the large diameter measurement part 512 and the small diameter measurement part 513, the inclination of the movement of the Z-axis direction by the articulated robot arm 20 can be calculated | required easily. Further, even if the center axis O2 of the second teaching member 52 is inclined with respect to the Z-axis, by applying the tip of the cylindrical part 522 to the ends of the large diameter measuring part 512 and the small diameter measuring part 513, substantially the same The abutting state can be reproduced, and stable measurement can be performed. Moreover, since the Z-axis direction is moved to the second and third measurement positions at which the measurement in the X-axis and the Y-axis direction is performed after the abutting in the Z-axis direction at the first measurement position, also in this respect. The same abutting state can be reproduced, and stable measurement can be performed.

第１ティーチング部材５１と第２ティーチング部材５２は、Ｚ軸方向の移動によって嵌め合わせることが可能なものであるため、その後、Ｘ軸方向とＹ軸方向の移動による計測を搬送装置８側の小さな動作によって短時間で行うことができる。なお、主軸チャック１１側のティーチング部材に対してロボットハンド２８側のティーチング部材を複数の方向から突き当てることができればよいため、第１及び第２ティーチング部材５１，５２の形状は特に限定されるものではない。しかし、嵌め合わせが可能なブロック体と筒体とすることにより上記効果が得られる。   Since the first teaching member 51 and the second teaching member 52 can be fitted together by movement in the Z-axis direction, the measurement by the movement in the X-axis direction and the Y-axis direction is subsequently performed on the side of the conveying device 8. The operation can be performed in a short time. Note that the shape of the first and second teaching members 51 and 52 is particularly limited as long as the teaching member on the robot hand 28 side can be abutted against the teaching member on the spindle chuck 11 side from a plurality of directions. is not. However, the above effect can be obtained by using a block body and a cylindrical body that can be fitted together.

以上、本発明の一実施形態について説明したが、本発明はこれらに限定されるものではなく、その趣旨を逸脱しない範囲で様々な変更が可能である。
例えば、第１ティーチング部材５１と第２ティーチング部材５２は、主軸チャック１１とロボットハンド２８との保持が逆であってもよい。また、第２ティーチング部材５２の先端部分の内周面に、第１ティーチング部材５１に突き当てられる箇所に対応して半球状の突起を形成するなどしてもよい。
本発明に係るティーチングシステムは、工作機械５に対して使用される搬送装置８において特に有効であるが、その他の多関節ロボットであってもよい。As mentioned above, although one Embodiment of this invention was described, this invention is not limited to these, A various change is possible in the range which does not deviate from the meaning.
For example, the holding of the spindle chuck 11 and the robot hand 28 may be reversed in the first teaching member 51 and the second teaching member 52. Further, a hemispherical protrusion may be formed on the inner peripheral surface of the distal end portion of the second teaching member 52 corresponding to the location where the first teaching member 51 is abutted.
The teaching system according to the present invention is particularly effective in the transfer device 8 used for the machine tool 5, but may be other articulated robots.

１…加工機械ライン ２…ベース ５…工作機械 ６…外装カバー ８…搬送装置 １０…加工モジュール １１…主軸チャック ２０…多関節ロボットアーム ２２…上腕部材 ２５…前腕部材 ２８…ロボットハンド ３０…走行装置 ３７…サーボモータ ４０…搬送用制御装置 ５１…第１ティーチング部材 ５２…第２ティーチング部材 ４７１，４７２，４７３…サーボモータ



DESCRIPTION OF SYMBOLS 1 ... Processing machine line 2 ... Base 5 ... Machine tool 6 ... Exterior cover 8 ... Conveying device 10 ... Processing module 11 ... Spindle chuck 20 ... Articulated robot arm 22 ... Upper arm member 25 ... Forearm member 28 ... Robot hand 30 ... Traveling device 37 ... Servo motor 40 ... Conveying control device 51 ... First teaching member 52 ... Second teaching member 471, 472, 473 ... Servo motor



Claims (4)

駆動モータを備える関節機構によってアーム部材が連結され、先端部に備えたロボットハンドによって相手側装置との間で所定の作業を行う多関節ロボットと、
前記相手側装置に保持される第１ティーチング部材と、
前記ロボットハンドに保持され、前記第１ティーチング部材に対して接触させる第２ティーチング部材と、
前記相手側装置に保持された前記第１ティーチング部材に対して、前記ロボットハンドに保持した前記２ティーチング部材を複数の方向から接触させ、当該接触により上昇する前記駆動モータのトルク値を基に接触位置を求め、前記ロボットハンドの位置を算出する制御装置とを有するものであることを特徴とする多関節ロボットのティーチングシステム。An articulated robot having a driving motor connected to an arm member and performing a predetermined operation with a counterpart device by a robot hand provided at a tip; and
A first teaching member held by the counterpart device;
A second teaching member held by the robot hand and brought into contact with the first teaching member;
The two teaching members held by the robot hand are brought into contact with the first teaching member held by the counterpart device from a plurality of directions, and contact is made based on the torque value of the drive motor that rises due to the contact. A teaching system for an articulated robot, comprising: a controller for obtaining a position and calculating a position of the robot hand. 前記第１ティーチング部材及び第２ティーチング部材は、一方が所定形状のブロック体であり、他方が一方向から行う相対的な移動により前記ブロック体に対して、前記一方向に直交する方向に隙間をあけて嵌り合う筒体であることを特徴とする請求項１に記載の多関節ロボットのティーチングシステム。   One of the first teaching member and the second teaching member is a block body having a predetermined shape, and the other has a gap in a direction perpendicular to the one direction with respect to the block body by relative movement performed from one direction. 2. The teaching system for an articulated robot according to claim 1, wherein the teaching system is a cylindrical body that fits open. 前記第１ティーチング部材及び第２ティーチング部材は、一方が中心軸に対して直交方向に対称的な側面を有する段付きブロックであり、他方が前記段付きブロックの側面に対応した内側面を有する筒体であることを特徴とする請求項２に記載の多関節ロボットのティーチングシステム。   One of the first teaching member and the second teaching member is a stepped block having a side surface symmetrical in a direction orthogonal to the central axis, and the other is a cylinder having an inner surface corresponding to the side surface of the stepped block. The teaching system for an articulated robot according to claim 2, wherein the system is a body. 前記制御装置は、前記第１ティーチング部材に対して前記第２ティーチング部材を、軸方向に突き当てた後、当該突き当て方向とは逆方向に移動させて、前記各段の側面端部において中心軸に直交する方向に突き当てるように、前記多関節ロボットを駆動制御させるものであることを特徴とする請求項３に記載の多関節ロボットのティーチングシステム。




The controller, after abutting the second teaching member against the first teaching member in the axial direction, moves the second teaching member in a direction opposite to the abutting direction, so that the center is located at the side end of each step. 4. The teaching system for an articulated robot according to claim 3, wherein the articulated robot is driven and controlled to abut in a direction perpendicular to the axis.




JP2017541185A 2015-09-22 2015-09-22 Teaching system of articulated robot Active JP6647308B2 (en)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2015/076821 WO2017051445A1 (en) 2015-09-22 2015-09-22 Multi-joint robot teaching system

Publications (2)

Publication Number Publication Date
JPWO2017051445A1 true JPWO2017051445A1 (en) 2018-07-12
JP6647308B2 JP6647308B2 (en) 2020-02-14

Family

ID=58386309

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017541185A Active JP6647308B2 (en) 2015-09-22 2015-09-22 Teaching system of articulated robot

Country Status (2)

Country Link
JP (1) JP6647308B2 (en)
WO (1) WO2017051445A1 (en)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2019171571A1 (en) * 2018-03-09 2019-09-12 富士機械製造株式会社 Automated work machine
CN112888533B (en) * 2018-11-01 2024-02-06 株式会社富士 Automatic workpiece conveyor
JPWO2022130495A1 (en) * 2020-12-15 2022-06-23

Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06131032A (en) * 1992-04-14 1994-05-13 Hitachi Ltd Robot device and teaching method for robot device
JPH10301609A (en) * 1997-04-28 1998-11-13 Denso Corp Position error detection method for robot and device therefor
JP2003114706A (en) * 2001-10-05 2003-04-18 Matsuura Tekkosho:Kk Display system for articulated general purpose robot model
JP2003181782A (en) * 2001-12-19 2003-07-02 Nachi Fujikoshi Corp Industrial robot
JP2007140575A (en) * 2005-10-17 2007-06-07 Shin Nippon Koki Co Ltd Parallel mechanism device, calibration method and calibration program for parallel mechanism device, and recording medium
JP2009269110A (en) * 2008-05-02 2009-11-19 Olympus Corp Assembly equipment
JP2010058235A (en) * 2008-09-04 2010-03-18 Ihi Corp Teaching method and teaching tool for robot system
CN102179538A (en) * 2010-12-27 2011-09-14 东莞市新志密封技术有限公司 Design method of clamp for processing low-hardness material and clamp device
JP2011230257A (en) * 2010-04-28 2011-11-17 Yaskawa Electric Corp Robot calibration device, and robot calibration method
JP2012232396A (en) * 2011-05-09 2012-11-29 Yaskawa Electric Corp System and method for teaching robot
JP2014176940A (en) * 2013-03-15 2014-09-25 Yaskawa Electric Corp Robot system, method for controlling robot and method for manufacturing workpiece
JP2015100863A (en) * 2013-11-22 2015-06-04 キヤノン株式会社 Teaching method for robot

Patent Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06131032A (en) * 1992-04-14 1994-05-13 Hitachi Ltd Robot device and teaching method for robot device
JPH10301609A (en) * 1997-04-28 1998-11-13 Denso Corp Position error detection method for robot and device therefor
JP2003114706A (en) * 2001-10-05 2003-04-18 Matsuura Tekkosho:Kk Display system for articulated general purpose robot model
JP2003181782A (en) * 2001-12-19 2003-07-02 Nachi Fujikoshi Corp Industrial robot
JP2007140575A (en) * 2005-10-17 2007-06-07 Shin Nippon Koki Co Ltd Parallel mechanism device, calibration method and calibration program for parallel mechanism device, and recording medium
JP2009269110A (en) * 2008-05-02 2009-11-19 Olympus Corp Assembly equipment
JP2010058235A (en) * 2008-09-04 2010-03-18 Ihi Corp Teaching method and teaching tool for robot system
JP2011230257A (en) * 2010-04-28 2011-11-17 Yaskawa Electric Corp Robot calibration device, and robot calibration method
CN102179538A (en) * 2010-12-27 2011-09-14 东莞市新志密封技术有限公司 Design method of clamp for processing low-hardness material and clamp device
JP2012232396A (en) * 2011-05-09 2012-11-29 Yaskawa Electric Corp System and method for teaching robot
JP2014176940A (en) * 2013-03-15 2014-09-25 Yaskawa Electric Corp Robot system, method for controlling robot and method for manufacturing workpiece
JP2015100863A (en) * 2013-11-22 2015-06-04 キヤノン株式会社 Teaching method for robot

Also Published As

Publication number Publication date
JP6647308B2 (en) 2020-02-14
WO2017051445A1 (en) 2017-03-30

Similar Documents

Publication Publication Date Title
JP6126067B2 (en) Collaborative system with machine tool and robot
US10773313B2 (en) Turret tool rest and machine tool
JP6787688B2 (en) Machine Tools
JP6667376B2 (en) Component press-in method and component press-in system
KR20170127361A (en) Machine tool
JP6640816B2 (en) Processing system
JP2015203567A (en) Metrology system
US11351642B2 (en) Automatic tool head placement and assembly apparatus for a boring machine
WO2014054802A1 (en) Perpendicular alignment mechanism, and machining devices and machining methods using same
KR102662204B1 (en) Machine tool
US10974361B2 (en) Method for correcting a position of a tip of a machine tool
JP6088190B2 (en) Processing system and processing method thereof
JP6647308B2 (en) Teaching system of articulated robot
EP3229089A1 (en) System for controlling the position of a tool and method of controlling the position of said tool
JP5479298B2 (en) Cutting edge position correction method
JP2020019126A (en) Automatic deburring and/or edge finishing device, and automation method of deburring and/or edge finishing
JP7204309B2 (en) Drilling system
JP4847049B2 (en) Reference point error measuring method and polar coordinate control machining center in polar coordinate machining center
WO2017042878A1 (en) Multi-joint robot arm
WO2022130495A1 (en) Teaching system for workpiece automatic conveyance device
JP2002172545A (en) Cutting edge position measuring device and cutting edge position correcting method
JP4048434B2 (en) Grooving method and numerical control device
US20230364790A1 (en) Method and system for determining a workpiece loading location in a cnc machine with a robotic arm
WO2022059748A1 (en) Machine tool, positional information correction method, and positional information correction program
TW201743150A (en) Position controller for controlling a rotation center of a tilting head

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20180706

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20190716

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20190820

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: 20200107

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20200114

R150 Certificate of patent or registration of utility model

Ref document number: 6647308

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250