[go: up one dir, main page]

JPH06222829A - Robot teaching position correcting method - Google Patents

Robot teaching position correcting method

Info

Publication number
JPH06222829A
JPH06222829A JP5024965A JP2496593A JPH06222829A JP H06222829 A JPH06222829 A JP H06222829A JP 5024965 A JP5024965 A JP 5024965A JP 2496593 A JP2496593 A JP 2496593A JP H06222829 A JPH06222829 A JP H06222829A
Authority
JP
Japan
Prior art keywords
teaching
correction
robot
program
work
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.)
Pending
Application number
JP5024965A
Other languages
Japanese (ja)
Inventor
Atsushi Watanabe
淳 渡辺
Akira Nihei
亮 二瓶
Masayuki Hamura
雅之 羽村
Kenji Azuma
賢治 東
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.)
Fanuc Corp
Original Assignee
Fanuc Corp
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 Fanuc Corp filed Critical Fanuc Corp
Priority to JP5024965A priority Critical patent/JPH06222829A/en
Priority to PCT/JP1994/000057 priority patent/WO1994017462A1/en
Publication of JPH06222829A publication Critical patent/JPH06222829A/en
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/42Recording and playback systems, i.e. in which the programme is recorded from a cycle of operations, e.g. the cycle of operations being manually controlled, after which this record is played back on the same machine
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/36Nc in input of data, input key till input tape
    • G05B2219/36054Modify offset for whole sections collectively, different offsets for sections
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/36Nc in input of data, input key till input tape
    • G05B2219/36089Machining parameters, modification during operation
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/36Nc in input of data, input key till input tape
    • G05B2219/36091Modification, override as function of conditions, distance
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/50Machine tool, machine tool null till machine tool work handling
    • G05B2219/50116Select approach path out of plurality
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02PCLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Numerical Control (AREA)
  • Manipulator (AREA)

Abstract

PURPOSE:To safely and effectively correct the teaching position of a robot by preparing several types of common position correcting offset value for each teaching point and executing selectively the correcting conditions for batch correction of teaching positions. CONSTITUTION:When a burr removing blade 3A is pressed onto the machining surfaces 1 and 2, the burr parts 1B and 2B of the surfaces 1 and 2 are cut up to the finishing surfaces 1A and 2A and then removed. A locus of P1 P2-P9 is presumed as that of a tool point 3B when a program produced in an off-line state is directly reproduced. Then, several correcting conditions are prepared for designation of the offset correction value of an application section and the approximation/separation of machining surface. Then, the proper correcting conditions are selectively carried out in a reproduction mode of program to correct the tracks. At the same time, the correcting conditions are retrieved for a better track. Then, the production of correcting conditions and the execution of program reproduction/position correcting conditions are repeated as necessary. In such a way, an optimum teaching position is fixed.

Description

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

【0001】[0001]

【産業上の利用分野】本発明は、教示されたプログラム
に従って動作する産業用等のロボットにおける位置教示
修正方法に関し、特に、ロボットを用いて機械加工ある
いは鋳物加工を行ったワークの仕上げ過程におけるバリ
取り作業等を実行するに際して、作成済みの教示プログ
ラムに含まれる教示位置を修正する為の、ロボットの教
示位置修正方法に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a position teaching correction method for an industrial robot or the like which operates according to a taught program, and more particularly to a burr in a finishing process of a workpiece machined or cast using the robot. The present invention relates to a teaching position correcting method of a robot for correcting a teaching position included in a created teaching program when performing a taking operation or the like.

【0002】[0002]

【従来の技術】オフラインでプログラムを作成した場合
のように、実際にプログラム通りの再生運転を行った場
合の動作が未確認あるいは不明な場合には、そのプログ
ラムの試験的再生運転を行い、必要に応じてオフライン
プログラムの修正を行うことが一般的である。
2. Description of the Related Art As in the case of creating a program off-line, if the operation when actually performing a regenerating operation according to the program is unconfirmed or unknown, perform a trial regenerating operation of the program and It is common to modify the offline program accordingly.

【0003】このようなプログラムの確認作業において
は、先ず作業対象となるワークを退避させた状態でプロ
グラム再生運転を行い、大まかな再生動作確認を行った
上で、実際にワークを作業位置に配置し、再度プログラ
ムを再生しつつロボット軌道を確認する方式が基本とな
っている。
In such a program confirmation work, first, a program reproduction operation is performed in a state where the work to be worked is evacuated, a rough reproduction operation is confirmed, and then the work is actually placed at the work position. The basic method is to confirm the robot trajectory while playing the program again.

【0004】そして、ワークを配置した状態でプログラ
ム再生と必要な修正を行う際には、プログラムを順次再
生しながらロボットを運転し、修正が必要な個所に達し
た時点でロボットを一旦停止させ、修正に必要な諸作業
を実行した上で運転を再開することを繰り返すことが行
われていた。
When the program is reproduced and necessary corrections are made with the work placed, the robot is operated while sequentially reproducing the program, and the robot is once stopped when the position where the correction is necessary is reached. It has been repeated to carry out various work necessary for correction and then restart the operation.

【0005】教示位置の修正が必要なケースは、(1)
ツールをワークに近付ける方向への修正が求められる場
合と、(2)ツールをワークから引き離す方向に教示位
置を修正する必要がある場合に大別される。例えば、バ
リ取り作業においてツール先端がワーク面に届いていな
い場合が上記ケース(1)にあたり、逆に、プログラム
通りの再生運転ではツール先端がワークに過剰に押し付
けられてしまう状況にある場合がケース(2)に相当す
る。
The case where the teaching position needs to be corrected is (1)
It is roughly divided into a case where a correction in a direction of bringing a tool closer to a work is required, and (2) a case where it is necessary to correct a teaching position in a direction of separating a tool from a work. For example, the case (1) above is the case where the tool tip does not reach the work surface during deburring work, and conversely, the case where the tool tip is excessively pressed against the work during the regenerative operation according to the program. It corresponds to (2).

【0006】ケース(1)では、ロボットを停止させた
後に、ワークはそのままにした状態でロボットを手動ジ
ョグ送りによって適正な位置まで近付け、位置データの
修正を実行する。これに対して、ケース(2)の場合に
は、先ず、ワークを適当な位置まで退避させてから、プ
ログラムに指定された通りの位置を一旦とらせる。その
上で、ロボットを手動ジョグ送りで十分な距離退避さ
せ、再度ワークを元の位置に戻し、しかる後にロボット
を手動ジョグ送りでワークに近付けて適正な位置で停止
させ、位置データの修正を実行するという手順を踏むの
が通常である。
In case (1), after the robot is stopped, the work is left as it is and the robot is brought close to an appropriate position by manual jog feed to correct the position data. On the other hand, in case (2), the work is first evacuated to an appropriate position, and then temporarily moved to the position specified by the program. After that, the robot is retracted a sufficient distance by manual jog feed, the work is returned to the original position again, and then the robot is brought close to the work by manual jog feed and stopped at an appropriate position, and the position data is corrected. The usual procedure is to

【0007】[0007]

【発明が解決しようとする課題】上記したように、プロ
グラムの確認時に教示位置を修正する際には、修正が必
要な教示位置毎にロボットを一旦停止させるが、一般
に、1個の教示点が要修正である場合には、その前後の
相当数の教示点についても修正が必要な場合が多いと考
えられる。従って、そのロボットの停止、修正作業、ロ
ボットの再起動を何度にもわたって繰り返すことが多く
なり、作業効率を低下させる原因となる。
As described above, when the teaching position is corrected when checking the program, the robot is temporarily stopped for each teaching position that needs to be corrected. When the correction is required, it is considered that it is often necessary to correct a considerable number of teaching points before and after the correction. Therefore, the stop of the robot, the correction work, and the restart of the robot are often repeated over and over, which causes a decrease in work efficiency.

【0008】特に、上記(2)のケースのように、修正
作業に付帯してワークの退避と再配置の作業が加わった
場合には、作業全体が極めて煩雑で非効率的なものとな
り、バリ取り加工等の対象となっているワークを退避さ
せる際などに、ツール先端部、ツール取付部、ワーク加
工面、作業従事者の身体の手指等を損傷する事故を招く
恐れもある。
In particular, when the work of retreating and rearranging work is added to the correction work as in the case of (2), the whole work becomes extremely complicated and inefficient, and the burr When retracting the work that is the target of machining, etc., there is a possibility of causing an accident that damages the tool tip, the tool mounting portion, the work machining surface, the fingers of the worker's body, or the like.

【0009】本発明は、主として教示プログラムの確認
の為に行われる再生運転時に必要となる教示位置修正作
業における上記従来技術の問題点を克服し、安全かつ効
率的に教示位置修正作業を実行し得るロボットの教示位
置修正方法を提供することを企図するものであり、特
に、ロボットを利用したバリ取り加工を含む作業の為の
プログラムに対して教示位置の修正を行う場合に有利な
ロボットの教示位置修正方法を提供せんとするものであ
る。
The present invention overcomes the above-mentioned problems of the prior art in the teaching position correcting work which is required during the reproduction operation mainly for confirming the teaching program, and executes the teaching position correcting work safely and efficiently. It is an object of the present invention to provide a method for correcting a teaching position of a robot, and particularly, a teaching method of a robot which is advantageous when a teaching position is corrected for a program for work including deburring using the robot. It is intended to provide a position correction method.

【0010】[0010]

【課題を解決するための手段】本発明は、例えばオフラ
インで作成済みの教示プログラムに対し、作業対象面の
区分に関連させて指定した教示点区間内の各教示点につ
いて共通した位置修正オフセット量Δを定めた複数の位
置修正条件を作成しておき、教示プログラムの再生開始
時またはそれ以降に前記修正条件を選択的に実効化させ
て教示点位置を一括修正して、作業面に指定オフセット
量だけ接近させるか、あるいは作業面から指定オフセッ
ト量だけ離隔させる形でロボットの教示位置修正を行う
ことにより、上記課題を解決したものである。
According to the present invention, for example, a position correction offset amount common to each teaching point in a teaching point section designated in association with a section of a work target surface with respect to a teaching program created offline. Create a plurality of position correction conditions that set Δ, and make the correction conditions selectively effective at or after the start of the playback of the teaching program to collectively correct the teaching point position and specify the specified offset on the work surface. The above problem is solved by correcting the teaching position of the robot in such a manner that the robot is moved closer by a predetermined amount or is separated from the work surface by a designated offset amount.

【0011】また、より実際的な本発明の1つ形態とし
て、少なくとも1つの教示点区間については、その教示
点区間を包含する教示点区間を前記指定教示点区間とす
る修正条件を複数個用意しておくことにより、1つの教
示点区間についての修正内容を複数の修正条件の中から
選択し得るようにした構成(請求項2の構成)を提供す
ると共に、その際に、作業面に対する接近/離隔のいず
れか一方を選択し得るように修正条件を用意することに
よって、同じ教示点区間についてロボットが作業面から
離れ過ぎる場合と、過剰接近あるいは食い込み状態とな
る場合の双方に対して臨機応変に対処出来るようにした
ものである(請求項3の構成)。
Further, as a more practical form of the present invention, for at least one teaching point section, a plurality of correction conditions are prepared in which a teaching point section including the teaching point section is the designated teaching point section. This provides a configuration (configuration according to claim 2) in which the correction content for one teaching point section can be selected from a plurality of correction conditions, and at that time, approaches the work surface. By preparing the correction condition so that either one of the following can be selected, it is possible to flexibly respond to both the case where the robot is too far from the work surface and the case where the robot is excessively approaching or biting into the same teaching point section. The present invention can deal with the above (configuration of claim 3).

【0012】更に、作業全体をより慎重に進めつつ、よ
り完全なものに近付ける為には、一度の教示位置修正で
は不十分であることが考えられるので、プログラム再生
/教示位置修正の段階を複数回数繰り返し実行する方式
を提供して、実用性を更に高めた教示位置修正方法を提
供したものである(請求項4の構成)。
Further, it is considered that one teaching position correction is not enough to bring the work closer to a perfect one while proceeding more carefully with the whole work. Therefore, there are a plurality of steps of program reproduction / teaching position correction. A teaching position correcting method is provided which is further improved in practicability by providing a method of repeatedly executing a number of times (configuration of claim 4).

【0013】そして、上述したように、機械加工あるい
は鋳物加工後の仕上げ工程に必要なバリ取り作業にロボ
ットを利用した場合に従来技術の問題点が特に深刻であ
ったことに鑑み、教示位置修正の対象となるプログラム
をバリ取り作業を含む作業の為のものに特定したもので
ある(請求項5の構成)。
As described above, when the robot is used for the deburring work required for the finishing process after machining or casting, the teaching position is corrected in view of the fact that the problems of the prior art are particularly serious. The target program of (1) is specified for work including deburring work (configuration of claim 5).

【0014】[0014]

【作用】図1は、バリ取り作業の為にオフラインで作成
された教示プログラムに対して本発明の教示位置修正方
法を適用する場合を例にとって、本発明の原理を説明す
る為の図である。図中、ロボットのツール取付部5のフ
ェース面5Aにバリ取り用ツール3が、フローティング
機構(図示省略)を備えたツールホルダ4を介して取り
付けられている。バリ取り用ツール3の先端部にはバリ
取り用の刃3Aが設けられている。
FIG. 1 is a diagram for explaining the principle of the present invention, taking as an example the case where the teaching position correcting method of the present invention is applied to a teaching program created offline for deburring work. . In the figure, a deburring tool 3 is attached to a face surface 5A of a tool attaching portion 5 of a robot via a tool holder 4 having a floating mechanism (not shown). A deburring blade 3A is provided at the tip of the deburring tool 3.

【0015】1及び2はバリ部分1B、2Bを各々有す
るワーク加工面(作業面)であり、ワールド座標系O―
XYZのY軸方向に沿って延在し、バリ部分1B、2B
はX軸方向に図示したように突出しているものとする。
バリ取り用の刃3Aを、図示しないモータ及び伝動機構
によって駆動した状態でこれら加工面1あるいは2に押
し付けると、各加工面のバリ部分1B、2Bが仕上げ面
1A、2Aまで切削除去される。ツール3はフローティ
ング機構によって弾力的に支持されているから、通常の
ケースでは、バリ取り作業を的確に行う為に、刃3Aが
加工面1、2に適度に押し付けられる位置にツールポイ
ント3Bが存在するようにロボットが制御される。
Numerals 1 and 2 are work surfaces (working surfaces) having burrs 1B and 2B, respectively, which are world coordinate system O-
The burr portions 1B and 2B extend along the Y-axis direction of XYZ.
Is projected in the X-axis direction as shown in the figure.
When the deburring blade 3A is pressed against the machined surface 1 or 2 while being driven by a motor and a transmission mechanism (not shown), the burr portions 1B and 2B of each machined surface are cut and removed to the finished surfaces 1A and 2A. Since the tool 3 is elastically supported by the floating mechanism, in a normal case, the tool point 3B exists at a position where the blade 3A is appropriately pressed against the machining surfaces 1 and 2 in order to perform deburring work properly. The robot is controlled to do so.

【0016】図1において、オフラインで作成されたプ
ログラムをそのまま再生した場合のツールポイント3B
の描く軌跡として、P1 →P2 →P3 →P4 →P5 →P
6 →P7 →P8 →P9 を想定する。P6 〜P8 は、加工
面2に過剰に押し付けられており、ワークを退避させな
ければ実際には実現困難な軌道である。これに対して、
P2 〜P4 は、加工面1から離れ過ぎており、このまま
では十分なバリ取り加工が行われない状態にある。
In FIG. 1, a tool point 3B when a program created offline is reproduced as it is
As the locus drawn by, P1 → P2 → P3 → P4 → P5 → P
6 → P7 → P8 → P9 is assumed. P6 to P8 are excessively pressed against the machining surface 2 and are actually difficult to achieve unless the work is retracted. On the contrary,
P2 to P4 are too far from the machined surface 1, and in this state, sufficient deburring is not performed.

【0017】本発明においては、このような事態が生じ
る可能性を予め想定し、適用区間と加工面接近/離隔の
オフセット修正量を指定した修正条件を幾つか用意して
おき、プログラムの再生運転中に適宜修正条件を選択的
に実効化させて軌道修正を行うと共に、より好ましい軌
道を得る為の修正条件を探索しておき、必要に応じて修
正条件作成、プログラムの再生/位置修正条件実効化の
作業を繰り返す。
In the present invention, assuming that such a situation may occur in advance, some correction conditions that specify the offset correction amount of the applied section and the machining surface approach / separation are prepared, and the program reproduction operation is performed. Correct the correction conditions selectively and perform trajectory correction while searching for correction conditions to obtain a more preferable trajectory, create correction conditions as necessary, program playback / position correction condition execution Repeat the process of conversion.

【0018】ここでは、第1回目のプログラム再生/修
正プロセスの為に、次の2つの修正条件C1 、C2 を用
意しておくものとする。
Here, the following two correction conditions C1 and C2 are prepared for the first program reproduction / correction process.

【0019】 修正条件C1 ;Δ1 =―10mm、適用区間P2 〜P8 修正条件C2 ;Δ2 =+30mm、適用区間P2 〜P8 各修正条件におけるオフセット量Δは、加工面1、2へ
の接近/離隔に対応させて、X軸方向のシフト量として
に定義する。従って、修正条件C1 を実効化すれば、加
工面1、2に接近乃至食い込む方向へ10mmだけ教示点
がシフトされ、修正条件C2 を実効化すれば加工面1、
2から離隔する方向へ30mmだけ教示点がシフトされる
ことになる。一般に、ツールの不用意な押し付けを優先
的に防止して作業をより慎重に進める観点から、特に初
回の試験再生運転に対しては、加工面に接近する方向の
オフセット量を離隔する方向のオフセット量よりも小さ
く設定した修正条件を用意しておくことが好ましい。
Correction condition C1; Δ1 = -10 mm, applicable section P2 to P8 Correction condition C2; Δ2 = + 30 mm, applicable section P2 to P8 Offset amount Δ in each correction condition is set to approach / separate to the machining surfaces 1 and 2. Correspondingly, it is defined as the shift amount in the X-axis direction. Therefore, if the correction condition C1 is made effective, the teaching point is shifted by 10 mm in the direction approaching or biting into the processed surfaces 1, 2, and if the correction condition C2 is made effective, the processed surface 1,
The teaching point is shifted by 30 mm in the direction away from 2. Generally, from the viewpoint of preventing the careless pressing of the tool by priority and advancing the work more carefully, especially for the first test regeneration operation, the offset amount in the direction that separates the offset amount that approaches the machining surface It is preferable to prepare a correction condition that is set smaller than the amount.

【0020】上記修正条件C1 、C2 を用意した上で、
オフラインで作成されたプログラムの第1回目の再生を
開始する。ツール3は既に装着済みとする。ロボットの
ツールポイント3B(以下、単にロボットと呼ぶことに
する。)は先ず最初の教示点P1 を通過し、2番目の教
示点P2 へ向かう軌道に入る。オペレータは、移動中の
刃3A先端部分と加工面1の仕上げ面1Aとの距離を目
測し、「ツールが加工面1から離れ過ぎており、且つ、
10mmだけ加工面1に接近するようにロボットの軌道を
修正しても、ツールが加工面1に過剰接近した状態に陥
ることがない」、と判断した時点で修正条件C1 を実効
化する指令を発する。修正処理に要する時間後、直ちに
ロボットはP1 からP2 へ向かう軌道から外れ、Q2 へ
向かう。この軌道変更位置をS1 とする。
After preparing the above correction conditions C1 and C2,
Start the first playback of the program created offline. The tool 3 is already attached. The tool point 3B (hereinafter, simply referred to as a robot) of the robot first passes through the first teaching point P1 and enters a trajectory toward the second teaching point P2. The operator visually measures the distance between the tip of the moving blade 3A and the finishing surface 1A of the machining surface 1 and says, "The tool is too far from the machining surface 1, and
Even if the trajectory of the robot is corrected so that it approaches the machining surface 1 by 10 mm, the tool will not fall into the state of being excessively close to the machining surface 1. " Emit. Immediately after the time required for the correction process, the robot deviates from the trajectory from P1 to P2 and heads to Q2. This trajectory change position is S1.

【0021】修正条件C1 の実効化により、以後この修
正条件C1 を無効化するかあるいは指定された教示点区
間(ここでは、P2 〜P8 )を通り過ぎるまで、ロボッ
トの軌道は、当初の教示プログラムで指定されている教
示位置を辿るものから、それを10mm加工面1に接近さ
せるように平行シフトさせたものに修正される。
After the correction condition C1 is implemented, the correction condition C1 is invalidated or the trajectory of the robot passes through the designated teaching point section (here, P2 to P8) until the original teaching program. It is corrected from the one that follows the designated teaching position to the one that is parallel-shifted so that it approaches the machining surface 1 by 10 mm.

【0022】即ち、ロボットは、図中破線で示したよう
に、S1 →Q2 という軌道をとった後、Q2 →Q3 →Q
4 →・・・・で示された軌道に乗る。
That is, the robot takes a trajectory of S1 → Q2 and then Q2 → Q3 → Q, as shown by the broken line in the figure.
4 → ・ ・ ・ ・ Take the orbit indicated by.

【0023】この間にオペレータは、バリ取りに最適な
軌道を実現するに必要な修正条件(区間とオフセット
量)を目視等による観測によって探索しておく。そし
て、オペレータは、ロボットが点Q4 を通過後、で修正
条件C1 を無効化し、ロボットを位置S2 から修正条件
実効化以前のプログラムに指定された教示位置P5 へ向
かう軌道へ戻す。図中のQ5 は、P5 をX軸の負の方向
へ10mmだけシフトさせた位置を表しているが、Q5 に
ロボットが到達する前に修正条件C1 の無効化による軌
道変更を行えば、実際にロボットがQ5 を通過すること
はない。
In the meantime, the operator searches for the correction conditions (section and offset amount) necessary to realize the optimum trajectory for deburring by visual observation or the like. After the robot passes the point Q4, the operator invalidates the correction condition C1 and returns the robot from the position S2 to the teaching position P5 designated in the program before the correction condition was activated. Q5 in the figure represents the position where P5 is shifted by 10 mm in the negative direction of the X-axis, but if the trajectory is changed by invalidating the modified condition C1 before the robot reaches Q5, it will actually change. The robot never crosses Q5.

【0024】ロボットは、プログラムで指定されている
教示位置P5 を通過し、更にP6 へ向かって移動を開始
するが、教示点位置P6 は、前述したように加工面2の
内部に食い込む状態にあるから、これを放置してそのま
まプログラム再生運転を続行すると、ツール3が加工面
2に過剰に押し付けられて、バリ2Bに食い込み過ぎた
状態となる。そこで、オペレータは、「ロボット軌道を
加工面2から離隔する方向へシフトする必要がある」、
と判断した時点で修正条件C2 を実効化する。修正条件
C2 の実効化による軌道変更位置をS3 とする。
The robot passes the teaching position P5 designated by the program and further starts moving toward P6, but the teaching point position P6 is in a state of biting into the machining surface 2 as described above. Therefore, if the tool 3 is left as it is and the program regeneration operation is continued as it is, the tool 3 is excessively pressed against the machined surface 2 and excessively digs into the burr 2B. Therefore, the operator "needs to shift the robot trajectory in a direction away from the processing surface 2",
When it is determined that the correction condition C2 is put into effect. Let S3 be the trajectory change position due to the implementation of the correction condition C2.

【0025】教示点区間P6 〜P8 におけるロボットの
軌道は、その間に修正条件C2 を無効化しない限り、加
工面2から離隔する方向に30mmシフトした軌道(Q6
〜Q8 )に修正され、S2 →Q6 →Q7 →Q8 で示され
た軌道を辿る。
The trajectory of the robot in the teaching point section P6 to P8 is shifted by 30 mm in the direction away from the machining surface 2 (Q6 unless the correction condition C2 is invalidated during that time).
It is corrected to ~ Q8), and follows the trajectory shown by S2 → Q6 → Q7 → Q8.

【0026】修正条件C2 におけるオフセット量は、+
30mmと比較的大きくとってあるので、軌道Q6 〜Q8
は加工面2から相当離隔したものとなる。オペレータ
は、加工面1(軌道P2 〜P4 )の場合と同様に、加工
面2についてバリ取りを最適軌道で実行するのに必要な
P6 〜P8 についての修正条件(区間とオフセット量)
を目視による観測によって探索しておく。ロボットが点
Q8 を通過すると、修正条件C2 の指定区間(P2 〜P
8 )を離脱するので、プログラム指定の教示位置である
P9 へ移動し、再生運転の1サイクルを終了する。修正
条件C2 は、点Q8 通過後の適宜の時点で無効化してお
く。
The offset amount under the correction condition C2 is +
Since it is relatively large at 30 mm, the orbit Q6 to Q8
Is considerably separated from the processed surface 2. As in the case of the machining surface 1 (trajectory P2 to P4), the operator needs to correct the conditions (section and offset amount) for P6 to P8 required to execute deburring on the machining surface 2 on the optimum trajectory.
Is searched by visual observation. When the robot passes the point Q8, the specified section of the correction condition C2 (P2 to P
8) is released, the robot moves to P9, which is the teaching position specified by the program, and ends one cycle of regenerative operation. The correction condition C2 is invalidated at an appropriate time after passing the point Q8.

【0027】オペレータは、以上の第1回目のプログラ
ム再生運転における探索結果に基づいて、バリ取り作業
の為に最適と思われる修正条件を新たに作成するか、あ
るいは、予め多数の修正条件を作成しておいた中から最
も好ましいと判断されるものを選択する。ここでは、次
のように、区間P2 〜P4 を20mm加工面1に接近する
方向へシフトさせる修正条件(C3 )と、区間P6 〜P
8 を20mm加工面2から離れる方向にシフトさせる修正
条件(C4 )とを新たに作成することとする。
Based on the search result in the first program regeneration operation described above, the operator newly creates a correction condition that is considered to be optimal for the deburring work, or creates a large number of correction conditions in advance. The most preferable one is selected from the above. Here, the correction condition (C3) for shifting the sections P2 to P4 toward the working surface 1 by 20 mm and the sections P6 to P are as follows.
A correction condition (C4) for shifting 8 in the direction away from the machined surface 2 by 20 mm is newly created.

【0028】 修正条件C3 ;Δ3 =―20mm、適用区間P2 〜P4 修正条件C4 ;Δ4 =+20mm、適用区間P6 〜P8 そして、修正条件C3 と修正条件C4 を初めから有効化
した状態で第2回目の再生運転を行う。修正条件C3 、
C4 は上記の通りの内容を有しているので、各教示点位
置P2 〜P4 及びP6 〜P8 を各々R2 〜R4 及びR6
〜R8 に修正した軌道が実現される。従って、第2回目
の再生運転におけるロボット軌道は、P1 →R2 →R3
→R4 →P5 →R6 →R7 →R8 →P9 となる。
Modification condition C3; Δ3 = −20 mm, applicable section P2 to P4 Modification condition C4; Δ4 = + 20 mm, applicable section P6 to P8 Then, the modification condition C3 and the modification condition C4 are valid from the second time. The regenerative driving is performed. Correction condition C3,
Since C4 has the contents as described above, the teaching point positions P2 to P4 and P6 to P8 are set to R2 to R4 and R6, respectively.
The orbit modified to ~ R8 is realized. Therefore, the robot trajectory in the second regenerative operation is P1 → R2 → R3
→ R4 → P5 → R6 → R7 → R8 → P9

【0029】実際にツール先端のバリ取り刃3Aを駆動
させた状態でこの第2回目の再生運転を行った場合に、
満足すべき結果が得られたならば、修正作業は完了した
ことになる。即ち、同種同形の要バリ取りワークが同じ
作業位置に次々に供給される型の製造ラインを想定すれ
ば、以後はこの修正条件C3 及びC4 を実効化した状態
でプログラム再生運転を繰り返すことによって、的確な
バリ取り作業が各ワークについて実行されることにな
る。
When the second regenerating operation is actually performed with the deburring blade 3A at the tip of the tool being driven,
If satisfactory results are obtained, the correction work is completed. That is, assuming a manufacturing line of a type in which deburring required works of the same kind and the same shape are successively supplied to the same work position, thereafter, by repeating the program regeneration operation in a state in which the correction conditions C3 and C4 are put into effect, Precise deburring work will be executed for each work.

【0030】もし、第2回目の再生運転で満足すべき結
果が得られなかった場合には、再度修正条件を作成(例
えば、C5 ;Δ5 =―22mm、適用区間P2 〜P4 、修
正条件C6 ;Δ6 =+17mm、適用区間P6 〜P8 )
し、その修正条件を有効化した状態で再度再生運転を行
って教示位置の適否を確認する。以後、このようなプロ
セスを必要回数繰り返して最適の教示位置を確定するこ
とが出来る。
If a satisfactory result is not obtained in the second regeneration operation, a correction condition is created again (for example, C5; Δ5 = -22 mm, applicable section P2 to P4, correction condition C6; Δ6 = +17 mm, applicable section P6 to P8)
Then, the reproduction operation is performed again with the correction condition being valid, and the adequacy of the teaching position is confirmed. After that, such a process can be repeated as many times as necessary to determine the optimum teaching position.

【0031】上記説明では、オペレータによる目測によ
って軌道修正の必要性の判断や最適修正条件の探索を行
うこととしたが、本発明は、ツール加工面間距離を検知
することの出来るなんらかのセンサ手段を取り入れ、オ
ペレータの作業の一部または全部を自動化することを何
等排除するものではない。例えば、ツールの過剰接近乃
至食い込み状態を視覚センサ、圧力センサ、あるいはロ
ボットの駆動モータの過負荷信号等で検知し、離隔方向
の修正条件を自動的に有効化したり、あるいは、再生運
転時のツール加工面間隔をセンサ計測して、より好まし
い修正条件作成の為のデータを得る等のことが考えられ
る。
In the above description, the necessity of the trajectory correction and the search for the optimum correction condition are determined by the visual observation by the operator. However, the present invention provides some sensor means capable of detecting the distance between the tool processing surfaces. It does not preclude the incorporation and automation of some or all of the operator's work. For example, the state of excessive approach or bite of the tool is detected by a visual sensor, a pressure sensor, or an overload signal of the drive motor of the robot, and the correction condition in the separating direction is automatically validated, or the tool during regenerative operation is used. It is conceivable to measure the machining surface distance with a sensor and obtain data for more preferable correction condition creation.

【0032】[0032]

【実施例】本発明の実施例として、上記作用の説明の欄
で例示したプロセスに従って教示位置修正方法を実行す
る際の、より具体的な手順を、図2〜図5を参照図に加
えて説明する。
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS As an embodiment of the present invention, a more specific procedure for executing the teaching position correcting method in accordance with the process exemplified in the section of the above description of operation will be described with reference to FIGS. explain.

【0033】図2は、本発明に従った教示位置修正方法
を実施する際に使用するロボットコントローラの一例を
示した要部ブロック図である。図中、ロボットコントロ
ーラ10は、中央演算装置(以下,CPUという。)1
1を有し、該CPU11には、ROMからなるメモリ1
2、RAMからなるメモリ13、不揮発性メモリ14、
液晶表示装置15を備えた教示操作盤16、補間器等を
含みロボットの各軸を制御するロボット軸制御部17、
及び図示しないオフラインプログラム作成装置のI/O
ポートに接続されたインターフェイス19がバス20を
介して接続されている。ロボット軸制御部17は更にサ
ーボ回路18を経由してロボット本体30に接続されて
いる。
FIG. 2 is a principal block diagram showing an example of a robot controller used when the teaching position correcting method according to the present invention is carried out. In the figure, a robot controller 10 is a central processing unit (hereinafter referred to as CPU) 1
1 and the CPU 11 has a memory 1 including a ROM.
2, a memory 13 including a RAM, a non-volatile memory 14,
A teaching operation panel 16 having a liquid crystal display device 15; a robot axis control unit 17 including an interpolator and controlling each axis of the robot;
And I / O of an off-line program creation device (not shown)
The interface 19 connected to the port is connected via the bus 20. The robot axis controller 17 is further connected to the robot body 30 via a servo circuit 18.

【0034】ROM12には、CPU11がロボット2
0及びロボットコントローラ10自身の制御の為に実行
する各種のプログラムが格納されている。RAM13は
デ−タの一時記憶や演算の為に利用されるメモリであ
る。不揮発性メモリ14には、教示操作盤16から、あ
るいはオフラインプログラム作成装置からインタフェイ
ス19を介して、各種パラメータ設定値やオフラインで
作成されたプログラム(教示デ−タを含む)が格納され
得るようになっている。
In the ROM 12, the CPU 11 stores the robot 2
0 and various programs executed for controlling the robot controller 10 itself are stored. The RAM 13 is a memory used for temporary storage of data and calculation. The nonvolatile memory 14 can store various parameter setting values and programs (including teaching data) created offline via the interface 19 from the teaching operation panel 16 or the off-line program creating device. It has become.

【0035】上述の構成は、従来のロボットコントロー
ラと基本的に変わるところはないが、次の(1)、
(2)に記した点で従来と相異している。 (1)教示操作盤16からの指令により、図3に示され
たような修正条件設定画面をLCD15に表示させ、画
面を見ながら教示位置の修正区間とオフセット量を指定
した修正条件を不揮発性メモリ14に格納する為のプロ
グラムがROM12あるいは不揮発性メモリ14に格納
されていること。
Although the above-mentioned configuration is basically the same as that of the conventional robot controller, the following (1),
The point described in (2) is different from the conventional one. (1) In response to a command from the teaching operation panel 16, a correction condition setting screen as shown in FIG. 3 is displayed on the LCD 15, and the correction condition in which the correction section of the teaching position and the offset amount are designated while viewing the screen is non-volatile. The program to be stored in the memory 14 is stored in the ROM 12 or the non-volatile memory 14.

【0036】(2)教示操作盤16から教示位置修正条
件有効化/無効化指令が発せられると、指定区間内の位
置データにオフセット量Δを加算/減算する修正/復元
を行うと共に、軌道変更を実行する補間点を決定し、そ
の補間点の位置データと修正/復帰させた教示位置デー
タに基づいて新たな軌道を算出(補間計算)し、ロボッ
トを軌道変更実行補間点位置から新たな軌道に乗せる為
のプログラムが、ROM12あるいは不揮発性メモリ1
4に格納されていること。
(2) When a teaching position correction condition validation / invalidation command is issued from the teaching operation panel 16, correction / restoration is performed by adding / subtracting the offset amount Δ to / from the position data in the designated section, and the trajectory is changed. Determine the interpolation point to execute, and calculate a new trajectory (interpolation calculation) based on the position data of the interpolation point and the corrected / returned teaching position data, and change the robot to a new trajectory from the interpolation point position. The program for loading on the ROM 12 or the non-volatile memory 1
Be stored in 4.

【0037】以上の構成と機能を有するロボットコント
ローラ10を使用し、本発明の方法に従って教示位置を
修正した場合の処理を、[1]準備、[2]第1回再生
運転(プログラム確認/修正と最適修正条件探索)、
[3]修正条件再作成と第2回再生運転に分けて、図3
〜図8を参照図に加えて説明する。図3、図4は、各々
第1回目及び第2回目の再生運転に先だって修正条件を
作成する為の画面を表したものであり、図5は、第1回
目の再生運転の為の準備手順の概略をフローチャートで
示したものである。また、図6及び図7は、第1回目の
再生運転における処理手順の概略を表したフローチャー
トである。そして、図8は、第1回目の再生運転終了後
に再度修正条件を作成し、第2回目の再生運転を実行す
る手順の概略を説明する為のフローチャートである。
Using the robot controller 10 having the above structure and function, the processing when the teaching position is corrected according to the method of the present invention is [1] preparation, [2] first reproduction operation (program confirmation / correction). And search for optimum correction conditions),
[3] FIG. 3 is divided into re-correction condition re-creation and second regeneration operation.
8 will be described in addition to the reference diagram. FIGS. 3 and 4 show screens for creating correction conditions prior to the first and second regeneration operations, respectively, and FIG. 5 shows a preparatory procedure for the first regeneration operation. Is a flowchart. Further, FIGS. 6 and 7 are flowcharts showing the outline of the processing procedure in the first regeneration operation. Then, FIG. 8 is a flow chart for explaining the outline of the procedure for creating the correction condition again after the completion of the first regeneration operation and executing the second regeneration operation.

【0038】[1]準備 本発明の教示位置修正方法を実施する対象となる教示プ
ログラムは、ワークに関するCADデータ等に基づいて
オフラインプログラム作成装置で既に作成済みであると
して、図1、図3及び図5を特に参照して準備作業の手
順について述べる。
[1] Preparation Assuming that the teaching program which is the target for carrying out the teaching position correcting method of the present invention has already been created by the offline program creating device based on the CAD data and the like regarding the workpiece, the teaching program shown in FIGS. The procedure of the preparatory work will be described with particular reference to FIG.

【0039】先ず、ロボットコントローラ10を起動し
て、上記作成済みの教示プログラムを図示しないオフラ
インプログラム作成装置のI/Oポートからロボットコ
ントローラ10のインターフェース19を介して不揮発
性メモリ14に入力する(オフラインティーチング;図
5、ステップST1)。オフラインティーチングが終了
したら、教示操作盤16からの指令により、図3に示さ
れたような教示位置修正条件作成・設定画面を教示操作
盤16に付設されたLCD15に表示させる(ステップ
ST2)。
First, the robot controller 10 is activated, and the above-mentioned created teaching program is input to the non-volatile memory 14 through the interface 19 of the robot controller 10 from the I / O port of the offline program creating apparatus (not shown) (offline. Teaching; FIG. 5, step ST1). After the off-line teaching is completed, a teaching position correction condition creation / setting screen as shown in FIG. 3 is displayed on the LCD 15 attached to the teaching operation panel 16 by a command from the teaching operation panel 16 (step ST2).

【0040】オペレータはLCD15の画面を見なが
ら、第1回目の修正条件を作成する(ステップST
3)。まず、「カコウメン1」〜「カコウメン4」の欄
に、加工面の区分と対応する教示点区間を番号Pi 〜P
j を入力しておく。□印は画面入力なしの空欄を表して
いる。ここでは、図1に示した例に合わせて、加工面1
に対して区間P2 〜P4 、加工面2に対して区間P6 〜
P8 を入力する。以後、加工面区分の変更等による書換
えを行わない限り、教示位置修正条件設定画面でこの表
示内容が保持される。オペレータは、この表示が保持さ
れることにより加工面の区分と教示点区間の関係を確認
しながら修正条件の内容を指定することが出来る。
The operator creates the first correction condition while looking at the screen of the LCD 15 (step ST
3). First, in the columns of "Kakoumen 1" to "Kakoumen 4", the teaching point sections corresponding to the sections of the machining surface are numbered Pi to P.
Enter j. The □ mark represents a blank field without screen input. Here, in accordance with the example shown in FIG.
For section P2 to P4, and for processing surface 2 section P6 to
Enter P8. After that, this display content is held on the teaching position correction condition setting screen unless rewriting is performed by changing the machining surface classification or the like. By holding this display, the operator can specify the content of the correction condition while confirming the relationship between the section of the machining surface and the teaching point section.

【0041】本実施例では修正条件C1 及びC2 を設定
するから、入力画面は図3に示した通りのものとなる。
前述したように、各修正条件C1 、C2 におけるオフセ
ットは、各々X軸に沿って―10mm及び+30mmの位置
シフトを行うものであり、Y軸及びZ軸方向の位置シフ
トは無い。従って、修正条件C1 についてΔx =―10
mm、修正条件C2 についてΔx =+30mmを画面入力
し、他の欄はすべて空欄のままとする。
In this embodiment, since the correction conditions C1 and C2 are set, the input screen is as shown in FIG.
As described above, the offset in each of the correction conditions C1 and C2 causes a position shift of −10 mm and +30 mm along the X axis, and there is no position shift in the Y axis and Z axis directions. Therefore, for the correction condition C1, Δx = -10
mm, correction condition C2, Δx = + 30 mm is input on the screen, and the other columns are left blank.

【0042】最後に、オペレータによって画面入力内容
が確認され、Y/Nに対して教示操作盤16のYキーが
選択押下されると、画面入力された通りの修正条件C1
及びC2 が設定され(ステップST4)、準備作業が完
了する(終了)。
Finally, when the operator confirms the screen input contents and selects and presses the Y key of the teaching operation panel 16 for Y / N, the correction condition C1 as input on the screen is displayed.
And C2 are set (step ST4), and the preparation work is completed (end).

【0043】[2]第1回再生運転(プログラム確認/
修正と最適修正条件探索) ロボットコントローラ10を起動させ、再生運転モード
画面をLCD15に呼び出し、上記オフラインで作成さ
れたプログラムを指定して、第1回目の再生運転を開始
する(以下、図6、図7及び図1を特に参照)。先ず、
プログラムの1ブロックを読み込んで(ステップSF
1)、図示しない待機位置から教示位置P1 へロボット
を移動をさせる(ステップSF2)。続いて、プログラ
ムの1ブロックを読み込んで(ステップSF3)、P2
への移動を開始する(ステップSF4)。オペレータに
より修正条件C1 に従った軌道修正が必要と判断される
と、教示操作盤16のキーボードが操作され修正条件C
1 有効化の指令が発せられる(ステップSF5)。
[2] First regeneration operation (program confirmation /
Correction and Search for Optimal Correction Conditions) The robot controller 10 is activated, the reproduction operation mode screen is called up on the LCD 15, the program created offline is specified, and the first reproduction operation is started (hereinafter, FIG. 6, 7 and 1 in particular). First,
Read one block of the program (step SF
1) The robot is moved from a standby position (not shown) to the teaching position P1 (step SF2). Then, read one block of the program (step SF3), P2
To move to (step SF4). When the operator judges that the trajectory correction according to the correction condition C1 is necessary, the keyboard of the teaching operation panel 16 is operated to correct the correction condition C1.
1 A command for activation is issued (step SF5).

【0044】すると、教示点P2 〜P8 の位置データに
対して、修正条件C1 で指定されたオフセット量−10
mmを加算する書き換え処理が実行される(ステップSF
6)。この時点では、ロボットはP1 からP2 へ向かう
軌道上を走行しており、軌道変更はなされていない。
Then, with respect to the position data of the teaching points P2 to P8, the offset amount specified by the correction condition C1-10
A rewriting process of adding mm is executed (step SF
6). At this point, the robot is traveling on the track from P1 to P2, and the track has not been changed.

【0045】そこで、修正条件C1 の実効化指令がCP
U11によって受け付けられた時点以降の適宜のタイミ
ングで、補間点単位でみたロボットの位置データを取り
込み、それを基準にして軌道変更を実際に開始する位置
S1 を決定する。例えば、ステップSF6終了時点で通
過済みの最後の補間点を基準として数個後の補間点を軌
道変更点S1 と定める(ステップSF7)。なお、修正
条件C1 実効化の指令が遅れ、位置P2 到着寸前に出さ
れた場合には、軌道変更点S1 は位置P2 通過直後のP
2 P3 間軌道上に定められる。
Therefore, the execution command for the correction condition C1 is CP
At a proper timing after the time point accepted by U11, the position data of the robot in terms of interpolation points is taken in, and the position S1 at which the trajectory change is actually started is determined based on the position data. For example, the interpolation point after several points is set as the trajectory change point S1 with reference to the last interpolation point which has been passed at the end of step SF6 (step SF7). If the command to implement the correction condition C1 is delayed and is issued just before the arrival of the position P2, the trajectory change point S1 is set to P immediately after passing the position P2.
It is set on the orbit between 2 and P3.

【0046】補間点S1 のデータと修正された教示点位
置データ(Q2 の位置データ)に基づいて直ちにS1 〜
Q2 間の補間計算が開始され、ロボットが位置S1 に到
達するまでに幾つかの補間点が求められてRAM13に
一時記憶される(ステップSF8)。ロボットは、軌道
変更点として定められた位置S1 に到達すると、停止す
ることなくS1 からQ2 へ向かう軌道に乗る(ステップ
SF9)。
Based on the data of the interpolation point S1 and the corrected teaching point position data (position data of Q2), S1 ...
Interpolation calculation between Q2 is started, and some interpolation points are obtained by the time the robot reaches the position S1 and are temporarily stored in the RAM 13 (step SF8). When the robot reaches the position S1 defined as the trajectory change point, the robot takes the trajectory from S1 to Q2 without stopping (step SF9).

【0047】位置Q2 にロボットが到達する前に教示プ
ログラムの次の1ブロックが読み込まれ(ステップSF
10)、Q2 通過後、修正された教示点Q3 へ向かう
(ステップSF11)。以下、同様に教示プログラム1
ブロックの読み込みと移動を相前後して繰り返し、位置
Q4 を通過して位置P5 を修正したQ5 へ向かう軌道に
入る(ステップSF12〜ステップSF15)。
Before the robot reaches the position Q2, the next one block of the teaching program is read (step SF
10) After passing through Q2, head for the corrected teaching point Q3 (step SF11). Similarly, teaching program 1
Block reading and movement are repeated one after another, and the orbit is passed through the position Q4 to the corrected position P5 toward Q5 (steps SF12 to SF15).

【0048】この時点で、ロボットは既に加工面1のバ
リ取りを行う位置から外れているので、オペレータは教
示操作盤適宜のタイミングで修正条件C1 を無効化する
指令を適宜のタイミングで発する(ステップSF1
6)。これにより、修正条件C1に従って10mmのオフ
セット減算がなされていたP2 〜P8 の位置データのオ
フセット分が加算され、当初の位置データが復元される
(ステップSF17)。
At this point, the robot is already out of the position for deburring the machining surface 1, so the operator issues a command to invalidate the correction condition C1 at an appropriate timing on the teaching operation panel (step). SF1
6). As a result, the offset amount of the position data of P2 to P8, which has been offset subtracted by 10 mm according to the correction condition C1, is added to restore the initial position data (step SF17).

【0049】そして、ステップSF7〜ステップSF9
と同様の処理手順に従って、軌道変更点S2 の決定(ス
テップSF18)、S2 〜P5 間の補間計算の開始(ス
テップSF19)、S2 における軌道変更(ステップS
F20)が行われる(ここまで図6参照、以後図7参
照)。
Then, step SF7 to step SF9
According to the same processing procedure as the above, the trajectory change point S2 is determined (step SF18), the interpolation calculation between S2 and P5 is started (step SF19), and the trajectory change at S2 (step S18).
F20) is performed (up to here, refer to FIG. 6, and thereafter refer to FIG. 7).

【0050】ロボットがP5に到着する前に、教示プロ
グラムの次の1ブロックが読み込まれ(ステップSF2
1)、ロボットはP5 を通過して教示位置P6 へ向かう
軌道に入る(ステップSF22)。ロボットがP6 に接
近する行程において、P6 が加工面2側に寄り過ぎてい
ることがオペレータによって認識されると、教示操作盤
16から修正条件C2 実効化指令が出される(ステップ
SF23)。これにより、P2 〜P8 の教示位置データ
が再び修正されるが、修正条件C2 のオフセット量は+
30mmなので、P2 〜P8 各々の位置データに30mmが
加算されることになる(ステップSF24)。続いて、
ステップSF7あるいはステップSF18と同様の処理
手順に従って、軌道変更点S3 が決定され(ステップS
F25)、区間S3 〜Q6 の補間計算が開始される(ス
テップSF26)。位置S3 にロボットが到達すると、
補間計算により計算された補間点を順次通過して修正さ
れた教示位置Q6 へ向かう軌道へ軌道変更がなされる
(ステップSF27)。
Before the robot arrives at P5, the next one block of the teaching program is read (step SF2
1), the robot passes through P5 and enters a trajectory toward the teaching position P6 (step SF22). When the operator recognizes that P6 is too close to the machining surface 2 in the process of the robot approaching P6, the teaching operation panel 16 issues a correction condition C2 enabling command (step SF23). As a result, the teaching position data of P2 to P8 is corrected again, but the offset amount of the correction condition C2 is +
Since it is 30 mm, 30 mm is added to the position data of each of P2 to P8 (step SF24). continue,
The trajectory change point S3 is determined according to the same processing procedure as step SF7 or step SF18 (step S
F25), the interpolation calculation of the sections S3 to Q6 is started (step SF26). When the robot reaches position S3,
The trajectory is changed to a trajectory toward the corrected teaching position Q6 by sequentially passing through the interpolation points calculated by the interpolation calculation (step SF27).

【0051】以後、教示プログラム1ブロックの読み込
み(ステップSF28、30、32)と修正された教示
位置間の移動(ステップSF29、31)を相前後して
繰り返し、位置Q8 を通過し、修正条件C2 で指定され
た区間(P2 〜P5 )から外れ、最終教示位置P9 へ向
かう軌道に乗る(ステップSF33)。
After that, the reading of one block of the teaching program (steps SF28, 30, 32) and the movement between the corrected teaching positions (steps SF29, 31) are repeated one after another, passing through the position Q8, and the correction condition C2. The vehicle departs from the section (P2 to P5) designated by and goes on the trajectory toward the final teaching position P9 (step SF33).

【0052】最終教示位置P9 への到着に前後して、修
正条件C2 を無効化する指令を教示操作盤16から出し
(ステップSF34)、P2 〜P8 の位置データを復元
して(ステップSF35)、第1回目の再生運転を終了
する。
Around the arrival at the final teaching position P9, a command to invalidate the correction condition C2 is issued from the teaching operation panel 16 (step SF34), and the position data of P2 to P8 are restored (step SF35). The first regeneration operation is ended.

【0053】以上のプロセスにおいて、ロボットが加工
面1に対するバリ取り作業を行う為の区間(P2 〜P4
)及び加工面2に対するバリ取り作業を行う為の区間
(P6〜P8 )を走行中には、各加工面1、2に対する
バリ取り作業にとって最適な軌道を与えると思われる修
正条件(教示点区間とオフセット量)を探索しておき、
第2回目の再生運転に備える。
In the above process, the section (P2 to P4) for the robot to deburr the machining surface 1 is used.
) And a section (P6 to P8) for performing deburring work on the machining surface 2 and a correction condition (teaching point section) that is considered to give an optimum trajectory for deburring work on each machining surface 1 and 2. And offset amount),
Prepare for the second regeneration operation.

【0054】[3]修正条件再作成と第2回再生運転 第1回目の再生運転における探索によって最適と判断さ
れた修正条件が、作用の説明の欄で述べた修正条件C3
及びC4 であるとして、修正条件再作成と第2回再生運
転の処理手順について、図4及び図8を特に参照にして
説明する。
[3] Re-creation of correction condition and second regeneration operation The correction condition determined to be optimum by the search in the first regeneration operation is the correction condition C3 described in the section of description of action.
And C4, the processing procedure of the modified condition re-creation and the second regeneration operation will be described with particular reference to FIGS. 4 and 8.

【0055】先ず、修正条件C1 、C2 作成時と同様
に、教示操作盤16からの指令により、図4に示された
ような教示位置修正条件設定画面をLCD15に表示さ
せる(ステップSS1)。
First, as in the case of creating the correction conditions C1 and C2, a teaching position correction condition setting screen as shown in FIG. 4 is displayed on the LCD 15 by a command from the teaching operation panel 16 (step SS1).

【0056】オペレータはLCD15の画面を見なが
ら、第2回目の修正条件C3 及びC4を作成する(ステ
ップSS2)。「カコウメン1」〜「カコウメン4」の
欄には、第1回目の修正条件作成時に入力された、加工
面区分と教示点区間との対応を表す番号表示が保持され
ている。
The operator creates the second correction conditions C3 and C4 while looking at the screen of the LCD 15 (step SS2). In the fields of "Kakoumen 1" to "Kakoumen 4", the number displays indicating the correspondence between the machining surface section and the teaching point section input at the time of creating the first correction condition are held.

【0057】前述したように、各修正条件C3 、C4 に
おけるオフセットは、各々X軸に沿って―20mm及び+
20mmの位置シフトを行うものであり、Y軸及びZ軸方
向の位置シフトは無い。従って、修正条件C3 について
はΔx =―20mm、修正条件C4 についてはΔx =+2
0mmを画面入力し、他の欄はすべて空欄のままとする。
As described above, the offsets under the respective correction conditions C3 and C4 are -20 mm and + along the X axis, respectively.
The position shift is performed by 20 mm and there is no position shift in the Y-axis and Z-axis directions. Therefore, the correction condition C3 is Δx = −20 mm, and the correction condition C4 is Δx = + 2.
Enter 0 mm on the screen and leave all other fields blank.

【0058】最後に、オペレータによって画面入力内容
が確認され、Y/Nに対して教示操作盤16のYキーが
選択押下されると、画面入力された通りの修正条件C3
及びC4 が設定される(ステップSS3)。
Finally, when the operator confirms the screen input contents and selects and presses the Y key of the teaching operation panel 16 for Y / N, the correction condition C3 as input on the screen is displayed.
And C4 are set (step SS3).

【0059】修正条件C3 、C4 の作成・設定が終了し
たら、第2回目の再生運転を開始する前に、これら両修
正条件を順次実効化して、P2 〜P4 、P6 〜P8 の位
置データを書き換える(ステップSS4〜ステップSS
7)。これにより、加工面1に対応する教示点P2 、P
3 、P4 の位置データには―20mmのオフセット値が加
算され、P6 、P7 、P8 の位置データには+20mmの
オフセット値が加算される。
After the correction conditions C3 and C4 are created and set, both of these correction conditions are sequentially executed to rewrite the position data of P2 to P4 and P6 to P8 before starting the second regeneration operation. (Step SS4 to Step SS
7). As a result, the teaching points P2, P corresponding to the machining surface 1
An offset value of -20 mm is added to the position data of 3 and P4, and an offset value of +20 mm is added to the position data of P6, P7 and P8.

【0060】この状態で、第2回目の再生運転を実行す
ると(ステップSS8)、図1において、P2 、P3 、
P4 に代えてR2 、R3 、R4 が、また、P6 、P7 、
P8に代えてR6 、R7 、R8 が各々教示位置として設
定されているので、ロボットの軌道は、P1 →R2 →R
3 →R4 →P5 →R6 →R7 →R8 →P9 となる。この
時、バリ取り作業が良好に遂行されることを確認する為
に、バリ取りツール3を作動させた状態で再生運転を行
う。バリ取り作業が良好に行われたことを確認して(ス
テップSS9)、教示位置修正作業を終了する。
When the second regeneration operation is executed in this state (step SS8), P2, P3,
Instead of P4, R2, R3, and R4 are replaced by P6, P7, and
Instead of P8, R6, R7, and R8 are set as teaching positions, respectively, so the trajectory of the robot is P1 → R2 → R
3 → R4 → P5 → R6 → R7 → R8 → P9. At this time, in order to confirm that the deburring work is successfully performed, the regenerating operation is performed with the deburring tool 3 being operated. After confirming that the deburring work is performed well (step SS9), the teaching position correcting work is finished.

【0061】もし、更なる軌道修正が必要であれば、修
正条件C3 、C4 を無効化して修正条件C5 、C6 ・・
・等を作成し直して、再度再生運転を行う。以下、適宜
回数の修正条件再作成/再生運転のプロセスを繰り返す
ことで、逐次的により理想的な軌道を探ることが出来
る。
If further trajectory correction is necessary, the correction conditions C3 and C4 are invalidated and the correction conditions C5 and C6 ...
・ Recreate the above and perform the regeneration operation again. Hereinafter, by repeating the process of reconditioning / regeneration operation for an appropriate number of times, it is possible to sequentially find an ideal trajectory.

【0062】[0062]

【発明の効果】本発明の教示位置修正方法によれば、オ
フラインでプログラムが作成されるケースのように、プ
ログラム再生運転時の実際のロボット軌道が未確認であ
る場合に必要なプログラム確認/教示修正作業が著しく
効率化される。
According to the teaching position correcting method of the present invention, the program confirmation / teaching correction necessary when the actual robot trajectory during the program reproduction operation is not confirmed, as in the case where the program is created offline. The work is remarkably streamlined.

【0063】即ち、プログラムの再生運転を継続したま
ま、必要に応じて作業面への過剰接近や過剰離隔を軌道
修正により作業面区分単位で回避しつつ最適修正条件を
探ることが出来るので、ロボットの運転停止やワークの
退避、エフェクタの取り外し/再装着等、従来技術にお
いて作業効率を低下させていた要因から解放される。
That is, the optimum correction condition can be sought while avoiding the excessive approach or the excessive separation to the work surface by the trajectory correction by the work surface division unit while the program reproducing operation is continued, so that the robot can be searched. The above-mentioned factors such as operation stop, work evacuation, effector removal / reattachment, etc., which have reduced the work efficiency in the prior art, are released.

【0064】特に、バリ取り作業等において従来トラブ
ルの原因となっていたエフェクタの加工面への過剰接近
がリアルタイムの軌道修正で事前に回避されるので、作
業の効率化の効果が大きいだけでなく、安全対策上も極
めて有意義である。また、修正された軌道を評価するこ
とによって、より理想的な軌道を探ることが容易とな
り、その評価に基づいて再作成された修正条件を織り込
んだ軌道の確認と評価を、プログラムの通常の再生運転
によって極めて簡単に行うことが出来るので、これまで
のように多大な時間と煩雑な作業を伴うことなく、修正
条件作成/再生運転を適宜回数繰り返してより高精度の
プログラムを得ることが可能となる。
In particular, the excessive approach of the effector to the machined surface, which has conventionally been a cause of troubles in deburring work, etc., is avoided in advance by real-time trajectory correction, so that not only the effect of improving work efficiency is great. Also, it is extremely meaningful in terms of safety measures. In addition, by evaluating the modified trajectory, it becomes easier to search for a more ideal trajectory, and the confirmation and evaluation of the trajectory that incorporates the modified conditions recreated based on the evaluation can be performed by normal reproduction of the program. Since it can be performed extremely easily by operation, it is possible to obtain a highly accurate program by repeating the correction condition creation / reproduction operation as many times as necessary without requiring a lot of time and complicated work as before. Become.

【0065】また、事前に教示点区間と対作業面の接近
/離隔オフセット量を指定しておき、一括して有効化/
無効化するという明快な手段を採用したので、教示位置
修正処理を実行するに際してオペレータがミスを犯す危
険が少ない。
Further, the approach / separation offset amounts of the teaching point section and the work surface are designated in advance, and they are collectively validated /
Since the clear means of invalidation is adopted, there is less risk of the operator making a mistake when executing the teaching position correction processing.

【0066】更に、教示位置修正に関して作業面区分毎
に接近/離隔量を指定出来る修正方法は、バリ取り作業
に限らず一般のロボットを利用した作業における実態に
良く適合しているので、種々の用途に使用されるロボッ
トへの応用可能性の面から見ても、本発明の教示位置修
正方法は極めて優れたものであるということが出来る。
Further, the correction method capable of designating the approaching / separating amount for each work surface section with respect to the correction of the teaching position is well suited to the actual condition not only in the deburring work but also in the work using a general robot. It can be said that the teaching position correction method of the present invention is extremely excellent in terms of the applicability to a robot used for various purposes.

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

【図1】本発明の教示位置修正方法の原理を説明する為
の作業例を模式的に表した図。
FIG. 1 is a diagram schematically showing a working example for explaining the principle of a teaching position correcting method of the present invention.

【図2】本発明の教示位置修正方法を実施する際に使用
されるロボットコントローラの要部ブロック図。
FIG. 2 is a block diagram of a main part of a robot controller used when implementing the teaching position correction method of the present invention.

【図3】本発明の実施例中の準備段階において、LCD
画面に表示される教示位置修正条件設定画面を説明する
図。
FIG. 3 shows an LCD at the preparation stage in the embodiment of the present invention.
The figure explaining the teaching position correction condition setting screen displayed on a screen.

【図4】本発明の実施例中の第2回目の再生運転に先立
って行われる教示位置修正条件設定段階において、LC
D画面に表示される教示位置修正条件設定画面を説明す
る図。
FIG. 4 is a graph showing an LC at a teaching position correction condition setting stage which is performed prior to the second regeneration operation in the embodiment of the present invention.
The figure explaining the teaching position correction condition setting screen displayed on D screen.

【図5】本発明の実施例中の準備段階における処理手順
の概略を説明する為のフローチャート。
FIG. 5 is a flowchart for explaining an outline of a processing procedure at a preparation stage in the embodiment of the present invention.

【図6】本発明の実施例中の第1回再生運転段階(プロ
グラム確認/修正と最適修正条件探索)における処理手
順の前半部分の概略を説明する為のフローチャート。
FIG. 6 is a flowchart for explaining the outline of the first half of the processing procedure in the first regeneration operation stage (program confirmation / correction and optimum correction condition search) in the embodiment of the present invention.

【図7】本発明の実施例中の第1回再生運転段階(プロ
グラム確認/修正と最適修正条件探索)における処理手
順の後半部分の概略を説明する為のフローチャート。
FIG. 7 is a flow chart for explaining the outline of the latter half of the processing procedure in the first regeneration operation stage (program confirmation / correction and optimum correction condition search) in the embodiment of the present invention.

【図8】本発明の実施例中の修正条件再作成と第2回再
生運転の段階における処理手順の概略を説明する為のフ
ローチャート。
FIG. 8 is a flow chart for explaining the outline of the processing procedure in the stage of the modified condition re-creation and the second regeneration operation in the embodiment of the present invention.

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

1、2 加工面 1A、2A 加工面仕上げ面 1B、2B バリ部分 3 ツール 3A バリ取り刃 3B ツールポイント 4 ツールホルダ 5 ツール取付部 5A フェース面 10 ロボットコントローラ 11 中央演算装置(CPU) 12 メモリ(ROM) 13 メモリ(RAM) 14 不揮発性メモリ 15 LCD(液晶表示装置) 16 教示操作盤 17 ロボット軸制御部 18 サーボ回路 19 インターフェース 20 バス 30 ロボット本体 1, 2 Machining surface 1A, 2A Machining surface Finishing surface 1B, 2B Burr part 3 Tool 3A Burr removing blade 3B Tool point 4 Tool holder 5 Tool mounting part 5A Face surface 10 Robot controller 11 Central processing unit (CPU) 12 Memory (ROM) ) 13 memory (RAM) 14 non-volatile memory 15 LCD (liquid crystal display) 16 teaching operation panel 17 robot axis control unit 18 servo circuit 19 interface 20 bus 30 robot body

───────────────────────────────────────────────────── フロントページの続き (72)発明者 羽村 雅之 山梨県南都留郡忍野村忍草字古馬場3580番 地 ファナック株式会社内 (72)発明者 東 賢治 山梨県南都留郡忍野村忍草字古馬場3580番 地 ファナック株式会社内 ─────────────────────────────────────────────────── ─── Continuation of the front page (72) Inventor Masayuki Hamura 3580 Koshinoba, Oshinomura, Minamitsuru-gun, Yamanashi Prefecture FANUC Co., Ltd. Local FANUC Co., Ltd.

Claims (5)

【特許請求の範囲】[Claims] 【請求項1】 作成済みの教示プログラムに対し、作業
対象面の区分に関連させて指定した教示点区間内の各教
示点について共通した位置修正オフセット量Δを定めた
複数の位置修正条件を作成する段階と、前記教示プログ
ラムの再生開始時またはそれ以降に前記修正条件を選択
的に実効化させて該実効化された修正条件に従って教示
点位置を一括修正する段階とを含み、前記教示点位置修
正オフセット量Δは、前記作業面に接近する方向へのシ
フト量を指定するオフセットデータまたは前記作業面か
ら離隔する方向へのシフト量を指定するオフセットデー
タのいずれか一方によって特定されるものであることを
特徴とするロボットの教示位置修正方法。
1. A plurality of position correction conditions that define a common position correction offset amount Δ for each teaching point within a teaching point section designated in association with a section of a work target surface for a created teaching program. And a step of selectively enabling the correction condition at the start of the reproduction of the teaching program or thereafter to collectively correct the teaching point position in accordance with the modified correction condition. The corrected offset amount Δ is specified by either offset data that specifies a shift amount in a direction approaching the work surface or offset data that specifies a shift amount in a direction away from the work surface. A method for correcting a teaching position of a robot characterized by the above.
【請求項2】 少なくとも1つの教示点区間について、
その教示点区間を包含する教示点区間を前記指定教示点
区間とする前記修正条件が複数個作成されることを特徴
とする請求項1に記載されたロボットの教示位置修正方
法。
2. At least one teaching point section,
2. The teaching position correcting method for a robot according to claim 1, wherein a plurality of the correction conditions are created so that the designated teaching point section includes the teaching point section including the teaching point section.
【請求項3】 前記複数の修正条件には、前記接近方向
シフト量を定めたものと前記離隔方向シフト量Δを定め
たものの双方が含まれていることを特徴とする請求項2
に記載されたロボットの教示位置修正方法。
3. The plurality of correction conditions include both one that defines the approach direction shift amount and one that defines the separation direction shift amount Δ.
A method for correcting the teaching position of the robot described in.
【請求項4】 前記プログラム再生が複数回繰り返さ
れ、その都度実効化される修正条件が選択されることを
特徴とする請求項1から請求項3のいずれかに記載され
たロボットの教示位置修正方法。
4. The teaching position correction of the robot according to claim 1, wherein the program reproduction is repeated a plurality of times, and a correction condition that is made effective each time is selected. Method.
【請求項5】 前記教示プログラムがバリ取り作業を含
む作業の為に作成されたものであるとを特徴とする請求
項1から請求項4のいずれかに記載されたロボットの教
示位置修正方法。
5. The teaching position correcting method for a robot according to claim 1, wherein the teaching program is created for work including deburring work.
JP5024965A 1993-01-21 1993-01-21 Robot teaching position correcting method Pending JPH06222829A (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP5024965A JPH06222829A (en) 1993-01-21 1993-01-21 Robot teaching position correcting method
PCT/JP1994/000057 WO1994017462A1 (en) 1993-01-21 1994-01-17 Method for modifying taught position of robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP5024965A JPH06222829A (en) 1993-01-21 1993-01-21 Robot teaching position correcting method

Publications (1)

Publication Number Publication Date
JPH06222829A true JPH06222829A (en) 1994-08-12

Family

ID=12152692

Family Applications (1)

Application Number Title Priority Date Filing Date
JP5024965A Pending JPH06222829A (en) 1993-01-21 1993-01-21 Robot teaching position correcting method

Country Status (2)

Country Link
JP (1) JPH06222829A (en)
WO (1) WO1994017462A1 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2001023149A1 (en) * 1999-09-27 2001-04-05 Matsushita Electric Industrial Co. Ltd. Robot controller

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6055280B2 (en) * 1981-04-30 1985-12-04 リヒト産業株式会社 Office drilling machine
JPS58155189A (en) * 1982-03-10 1983-09-14 新明和工業株式会社 Position control device for industrial robots
JPS62231313A (en) * 1986-03-31 1987-10-09 Shin Meiwa Ind Co Ltd robot control device

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2001023149A1 (en) * 1999-09-27 2001-04-05 Matsushita Electric Industrial Co. Ltd. Robot controller
US6522949B1 (en) 1999-09-27 2003-02-18 Matsushita Electric Industrial Co., Ltd. Robot controller

Also Published As

Publication number Publication date
WO1994017462A1 (en) 1994-08-04

Similar Documents

Publication Publication Date Title
WO2011074064A1 (en) Numerical control machine tool
JPS6332586B2 (en)
JP4505295B2 (en) NC machining simulation method and NC machining simulation apparatus
JPH01246045A (en) Setting control of machining coordinate system in machine tool
JPS6365469B2 (en)
JPH06348318A (en) Method and device for controlling deburring robot
JPH06222829A (en) Robot teaching position correcting method
JPS619705A (en) Numerically controlled machine tool
JP2791733B2 (en) Tool change method
JPS61173842A (en) Numerical control device
JPS5870314A (en) Sequence resetting system
JPH05305540A (en) Tool exchange method for working device
WO1995000890A1 (en) Method for teaching position to robot, and control apparatus
JPH07152416A (en) Numerical controller having program restarting function
JP2624174B2 (en) Automatic operation method of numerical controller
JP2813079B2 (en) Numerical control unit
JPS62130412A (en) Numerical control method
JP3439500B2 (en) Control method and control device for manual operation of robot
JP2949730B2 (en) Tool interference check device of numerical control processing machine
JP3215485B2 (en) Screw processing equipment
KR100221564B1 (en) Processing method and device to determine the optimum processing condition
JP2965171B2 (en) Interactive programming device
JPH03144806A (en) Composite controller
JPH0428497B2 (en)
JPH04306704A (en) Deburring and chamfering method for force control robot