[go: up one dir, main page]

JPH08171409A - Robot controller - Google Patents

Robot controller

Info

Publication number
JPH08171409A
JPH08171409A JP31731294A JP31731294A JPH08171409A JP H08171409 A JPH08171409 A JP H08171409A JP 31731294 A JP31731294 A JP 31731294A JP 31731294 A JP31731294 A JP 31731294A JP H08171409 A JPH08171409 A JP H08171409A
Authority
JP
Japan
Prior art keywords
teaching data
robot
trajectory
teaching
point
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Withdrawn
Application number
JP31731294A
Other languages
Japanese (ja)
Inventor
Yusuke Akami
裕介 赤見
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.)
Hitachi Ltd
Original Assignee
Tokico Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Tokico Ltd filed Critical Tokico Ltd
Priority to JP31731294A priority Critical patent/JPH08171409A/en
Priority to US08/573,951 priority patent/US5949683A/en
Publication of JPH08171409A publication Critical patent/JPH08171409A/en
Withdrawn legal-status Critical Current

Links

Landscapes

  • Numerical Control (AREA)
  • Manipulator (AREA)
  • Spray Control Apparatus (AREA)

Abstract

(57)【要約】 【目的】 教示データの再生中に、ロボットの動作を止
めることなく、その教示データの修正をリアルタイムで
行うことのできるロボットの制御装置を提供すること。 【構成】 制御演算装置31は、ROM32に記憶され
た制御プログラムに従って、RAM33を用いて処理を
行い、制御装置3の各部を制御する。サーボ制御部34
は、制御演算装置31の制御の下、サーボモータドライ
バ35に対し速度指令信号を供給する。サーボモータド
ライバ35は、速度指令信号からサーボモータ動作信号
Sを生成し、サーボモータを回転させる。教示データ
修正装置36は、制御演算装置31の教示データ再生中
に、タイマ37から所定のサンプリング間隔で出力され
たパルス信号を受信し、その度に、RAM33内の教示
データを修正する教示データ修正処理を行う。
(57) [Abstract] [Purpose] To provide a controller for a robot capable of correcting the teaching data in real time without stopping the operation of the robot during the reproduction of the teaching data. [Configuration] The control arithmetic unit 31 performs processing using the RAM 33 in accordance with a control program stored in the ROM 32, and controls each unit of the control unit 3. Servo control unit 34
Supplies a speed command signal to the servo motor driver 35 under the control of the control arithmetic unit 31. The servo motor driver 35 generates a servo motor operation signal S S from the speed command signal and rotates the servo motor. The teaching data correction device 36 receives the pulse signal output from the timer 37 at a predetermined sampling interval during the teaching data reproduction of the control arithmetic device 31, and each time the teaching data correction device 36 corrects the teaching data in the RAM 33. Perform processing.

Description

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

【0001】[0001]

【産業上の利用分野】本発明はティーチングプレイバッ
ク(教示再生方式)型のロボットの制御に用いられるロ
ボットの制御装置に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a robot controller used for controlling a teaching playback type robot.

【0002】[0002]

【従来の技術】図11は従来のロボットの制御装置を用
いた塗装用ロボットシステムの構成例を示す斜視図であ
る。マニピュレータ1は、アーム1aおよび1bを有
し、アーム1bの先端に把持された塗装ガン2をマニピ
ュレータ1の動作範囲内において任意の位置に移動さ
せ、塗装作業を行う。マニピュレータ1は、4つの回転
軸1c〜1fを有し、各回転軸1c〜1fを回転させる
サーボモータと、各回転軸1c〜1fの角度を検出する
エンコーダを内蔵している。
2. Description of the Related Art FIG. 11 is a perspective view showing a configuration example of a coating robot system using a conventional robot controller. The manipulator 1 has arms 1a and 1b, and a coating gun 2 held at the tip of the arm 1b is moved to an arbitrary position within the operating range of the manipulator 1 to perform a coating operation. The manipulator 1 has four rotary shafts 1c to 1f, and has a built-in servo motor that rotates each rotary shaft 1c to 1f and an encoder that detects an angle of each rotary shaft 1c to 1f.

【0003】制御装置103は、CPU(中央処理装
置),ROM(リードオンリメモリ),RAM(ランダ
ムアクセスメモリ)等からなる。制御装置103は、上
記エンコーダが検出した各回転軸1c〜1fの角度から
塗装ガン2先端の座標およびマニピュレータ1の姿勢を
求め、塗装ガン2先端が教示によって与えられた座標を
通過するように、マニピュレータ1の動作を制御する。
手元操作装置104は、オペレータがマニピュレータ1
に対する動作指令等を制御装置103に入力するときに
用いられる。図12は手元操作装置104の一例であ
り、この手元操作装置104は、入力用キー105,非
常停止ボタン106および表示部107を有する。
The control device 103 comprises a CPU (central processing unit), a ROM (read only memory), a RAM (random access memory) and the like. The controller 103 obtains the coordinates of the tip of the coating gun 2 and the attitude of the manipulator 1 from the angles of the rotary shafts 1c to 1f detected by the encoder, and the tip of the coating gun 2 passes through the coordinates given by the teaching. Controls the operation of the manipulator 1.
The operator of the hand-held operating device 104 is the manipulator 1
It is used when inputting an operation command or the like to the control device 103. FIG. 12 shows an example of the hand operating device 104. The hand operating device 104 has an input key 105, an emergency stop button 106, and a display 107.

【0004】次に、上記構成の塗装用ロボットシステム
における教示作業の手順について述べる。図13は、塗
装作業時に塗装ガン2先端が移動する軌道(以下、塗装
軌道と称する)およびワーク6の位置を示す斜視図であ
る。この図に示すように、塗装作業時に塗装ガン2は、
X−Y平面上に置かれた長方形の網5の上に並べられた
ワーク6の上を、塗料を噴射しながら、点P1から点P
2まで移動し、次に塗料の噴射を停止して点P2から点
P3まで移動する。以下、同様にして、塗装ガン2は、
X軸方向への移動時のみ塗料を噴射しながら、図13に
示すような軌道で点P3から点P8まで移動する。以下
に述べる4点教示と呼ばれるワーク6の4つの端点を教
示する方法でオペレータが教示を行うと、制御装置10
3は、塗装ガン2先端の移動する軌道(以下、塗装ガン
2先端の軌道と称する)を図13に示すような上記軌道
として生成する。
Next, a procedure of teaching work in the coating robot system having the above structure will be described. FIG. 13 is a perspective view showing the orbit along which the tip of the coating gun 2 moves during the painting operation (hereinafter referred to as the painting orbit) and the position of the work 6. As shown in this figure, the painting gun 2
While spraying the paint on the work 6 arranged on the rectangular net 5 placed on the XY plane, from the point P1 to the point P.
2. Then, the spraying of the paint is stopped and the process moves from point P2 to point P3. Similarly, the coating gun 2
While spraying the paint only when moving in the X-axis direction, the paint moves from the point P3 to the point P8 in a trajectory as shown in FIG. When the operator teaches by a method of teaching the four end points of the workpiece 6 called four-point teaching described below, the control device 10
3 generates a trajectory along which the tip of the coating gun 2 moves (hereinafter referred to as a trajectory of the tip of the coating gun 2) as the trajectory as shown in FIG.

【0005】まず、オペレータは、手元操作装置104
を用いて制御装置103の動作モードを教示モードにセ
ットし、網5の頂点A〜Dと、マニピュレータ1が待機
姿勢をとったときの塗装ガン2先端の位置である待機位
置P0(以下、頂点A〜Dおよび待機位置P0を教示点
と称する)を制御装置103に教示する。具体的には、
オペレータは、図12に示す手元操作装置4に設けられ
た入力用キー105の「X」キー,「Y」キー,「Z」
キーの座標軸指定キーと、「+」キー,「−」キーの動
作方向指定キーとを用いて、実際に塗装ガン2先端を各
頂点A〜Dおよび待機位置P0へ移動させてから「決
定」キーを押してその座標値を教示する。
First, the operator operates the hand-held operating device 104.
Is used to set the operation mode of the control device 103 to the teaching mode, and the vertexes A to D of the net 5 and the standby position P0 (hereinafter referred to as the vertex), which is the position of the tip of the coating gun 2 when the manipulator 1 is in the standby posture. A to D and the standby position P0 are referred to as teaching points) are taught to the control device 103. In particular,
The operator operates the "X" key, "Y" key, "Z" of the input keys 105 provided on the handheld operation device 4 shown in FIG.
By using the coordinate axis designation keys of the keys and the movement direction designation keys of the "+" and "-" keys, the tip of the coating gun 2 is actually moved to each of the vertices A to D and the standby position P0, and then "OK". Press the key to teach the coordinate value.

【0006】その後、オペレータが、手元操作装置10
4を用いて、塗装ガン2の移動速度,図13に示すX軸
方向への軌道(以下、パスと称する)の数,オーバース
プレー幅W,塗料の噴射量,再生スタートのタイミング
等の塗装条件を設定した後、教示データ名を入力する
と、制御装置103はそれらのデータに基づいて教示デ
ータを完成させる。教示データが完成すると、オペレー
タは、制御装置103の動作モードを再生モードにセッ
トし、教示データを再生させ、マニピュレータ1に実際
に塗装作業を行わせてみる。このとき、オペレータは、
塗装軌道,ワーク6に対する塗料の付着量や塗りむら等
の塗装品質などを確認し、これらに問題がなければ、教
示作業を終了する。
After that, the operator operates the local operating device 10
4, the moving speed of the coating gun 2, the number of trajectories in the X-axis direction shown in FIG. 13 (hereinafter referred to as "passes"), the overspray width W, the amount of paint sprayed, the coating conditions such as the regeneration start timing, etc. When the teaching data name is input after setting, the control device 103 completes the teaching data based on those data. When the teaching data is completed, the operator sets the operation mode of the control device 103 to the reproduction mode, reproduces the teaching data, and causes the manipulator 1 to actually perform the painting work. At this time, the operator
The coating orbit, the amount of coating on the work 6, the coating quality such as uneven coating, and the like are confirmed. If there is no problem with these, the teaching work is ended.

【0007】しかしながら、1度目の教示で、オペレー
タが意図した通りの塗装軌道や塗装品質が得られること
は希であり、教示点はもちろんのこと、塗装ガン2先端
からワーク6までの距離やオーバースプレー幅W(図1
3参照)等の僅かな狂いによって塗装軌道や塗装品質に
問題が生じることが多い。このような場合、オペレータ
は、マニピュレータ1の動作終了後、制御装置103の
動作モードを再び教示モードにセットし、教示点の教示
および塗装条件の設定をやり直す。このように通常は
「教示→塗装軌道および塗装品質を確認するために再生
→教示データを修正するために再教示」といった手順を
何度か繰り返さなければ、満足のいく塗装品質が得られ
ない場合が多い。
However, it is rare for the operator to obtain the coating trajectory and the coating quality as intended by the first teaching, and not only the teaching point but also the distance from the tip of the coating gun 2 to the work 6 and the excess. Spray width W (Fig. 1
A slight deviation such as (see 3) often causes problems in the coating trajectory and coating quality. In such a case, after the operation of the manipulator 1 is completed, the operator sets the operation mode of the control device 103 to the teaching mode again, and teaches the teaching point and sets the painting condition again. In this way, when the satisfactory coating quality is not obtained unless the procedure of "Teach → Replay to confirm coating trajectory and coating quality → Re-teaching to correct teaching data" is repeated several times. There are many.

【0008】[0008]

【発明が解決しようとする課題】上述したように、満足
のいく塗装軌道および塗装品質を得るためには、オペレ
ータは教示データの修正および再生による確認を数回繰
り返して行う必要がある。しかし、教示データを修正す
る際には、オペレータは、教示データの保存/選択およ
び読み込み,塗装ガン2の待機位置P0への退避/復
帰,動作速度の設定など、モード切り換えに伴ういくつ
かの煩雑な操作を行う必要があった。この結果、オペレ
ータは教示データの修正に多くの工数を必要とすると共
に、そのことによって個々の操作に対する注意力が散漫
となり、誤操作によって、教示データの誤消去や修正ミ
ス等を引き起こしてしまう恐れがあった。
As described above, in order to obtain a satisfactory coating trajectory and coating quality, it is necessary for the operator to repeat the correction and the confirmation of the teaching data several times. However, when modifying the teaching data, the operator needs to save / select and read the teaching data, withdraw / restore the coating gun 2 to the standby position P0, set the operating speed, and perform some complications associated with mode switching. It was necessary to carry out various operations. As a result, the operator needs a lot of man-hours to correct the teaching data, which distracts the attention to each operation, which may cause an erroneous deletion or correction error of the teaching data due to an erroneous operation. there were.

【0009】また、従来のロボットの制御装置を用いた
塗装用ロボットシステムでは、オペレータは、教示デー
タの再生中にマニピュレータの動作を実際に観察しなが
ら、リアルタイムに教示データの修正を行うことはでき
なかった。このため、オペレータは、塗装軌道上におい
て修正を必要とする座標をつかみにくく、また、マニピ
ュレータが作業ラインで使用されている場合には、作業
ライン全体を停止させなくてはならないという欠点があ
った。この発明は、このような背景の下になされたもの
で、教示データの再生中に、ロボットの動作を停止させ
ることなく、その教示データの修正をリアルタイムで行
うことのできるロボットの制御装置を提供することを目
的とする。
Further, in the conventional coating robot system using the robot controller, the operator can correct the teaching data in real time while actually observing the operation of the manipulator during the reproduction of the teaching data. There wasn't. For this reason, the operator has a drawback that it is difficult to grasp the coordinates that need correction on the painting trajectory, and when the manipulator is used in the work line, the entire work line must be stopped. . The present invention has been made under such a background, and provides a robot control device capable of correcting the teaching data in real time without stopping the operation of the robot during the reproduction of the teaching data. The purpose is to do.

【0010】[0010]

【課題を解決するための手段】請求項1記載の発明は、
ロボットの教示データを生成する教示データ生成手段
と、前記教示データ生成手段が生成した前記教示データ
を記憶する記憶手段と、前記記憶手段に記憶された前記
教示データに基づいて前記ロボットを制御する制御手段
と、前記教示データの修正の指示に用いられる指示手段
と、前記制御手段が前記ロボットを制御している間に、
前記指示手段の指示に従って、前記記憶手段に記憶され
た前記教示データを修正する教示データ修正手段とを具
備することを特徴としている。請求項2記載の発明は、
請求項1記載のロボットの制御装置において、前記制御
手段は、前記ロボットの所定部位が所定の複数の座標点
である軌道定義点を所定の順番で通過するように、前記
ロボットを制御し、前記指示手段は、1つの前記軌道定
義点と該軌道定義点の移動先となる座標値とを指示する
のに用いられ、前記教示データ修正手段は、前記制御手
段が前記ロボットを制御している間に、前記指示手段で
指示された前記軌道定義点の座標値を前記指示手段で指
示された前記座標値に修正することを特徴としている。
According to the first aspect of the present invention,
Teaching data generation means for generating teaching data of the robot, storage means for storing the teaching data generated by the teaching data generation means, and control for controlling the robot based on the teaching data stored in the storage means Means, an instruction means used for instructing the correction of the teaching data, and the control means while controlling the robot,
Teaching data modifying means for modifying the teaching data stored in the storage means in accordance with an instruction from the instructing means. The invention according to claim 2 is
2. The robot control device according to claim 1, wherein the control means controls the robot so that a predetermined portion of the robot passes a trajectory definition point, which is a plurality of predetermined coordinate points, in a predetermined order, The instructing means is used to instruct one of the trajectory definition points and the coordinate values to which the trajectory definition points are to be moved, and the teaching data correction means is provided while the control means controls the robot. In addition, the coordinate value of the trajectory definition point designated by the designating means is corrected to the coordinate value designated by the designating means.

【0011】請求項3記載の発明は、請求項1記載のロ
ボットの制御装置において、前記指示手段は、前記ロボ
ットの所定部位の移動速度を指示するのに用いられ、前
記教示データ修正手段は、前記制御手段が前記ロボット
を制御している間に、前記所定部位の移動速度を前記指
示手段で指示された前記移動速度に修正することを特徴
としている。請求項4記載の発明は、請求項1記載のロ
ボットの制御装置において、前記指示手段は、前記ロボ
ットが行う作業量を指示するのに用いられ、前記教示デ
ータ修正手段は、前記制御手段が前記ロボットを制御し
ている間に、前記ロボットが行う作業量を前記指示手段
で指示された前記作業量に修正することを特徴としてい
る。
According to a third aspect of the present invention, in the robot controller according to the first aspect, the instructing means is used to instruct a moving speed of a predetermined portion of the robot, and the teaching data correcting means, The moving speed of the predetermined part is corrected to the moving speed instructed by the instructing means while the control means controls the robot. According to a fourth aspect of the present invention, in the robot control apparatus according to the first aspect, the instructing means is used to instruct the amount of work performed by the robot, and the teaching data correcting means is the control means. It is characterized in that the amount of work performed by the robot is corrected to the amount of work instructed by the instructing means while the robot is being controlled.

【0012】請求項5記載の発明は、請求項2ないし4
記載のロボットの制御装置において、前記教示データ
は、前記軌道定義点のそれぞれについて、該軌道定義点
の座標値、または前記所定部位が該軌道定義点にあると
きの前記移動速度、または前記所定部位が該軌道定義点
にあるときの前記作業量のそれぞれを示す教示データ構
成要素から成り、前記指示手段は、複数の前記軌道定義
点と1種類の前記教示データ構成要素と該教示データ構
成要素の修正値とを指示するのに用いられ、前記教示デ
ータ修正手段は、前記制御手段が前記ロボットを制御し
ている間に、前記指示手段で指示された複数の前記軌道
定義点のそれぞれについて、前記教示データ構成要素を
前記修正値に一括して修正することを特徴としている。
The invention according to claim 5 is the invention according to claims 2 to 4.
In the robot controller described above, the teaching data is, for each of the trajectory definition points, coordinate values of the trajectory definition point, or the moving speed when the predetermined site is at the trajectory definition point, or the predetermined site. Is a teaching data constituent element indicating each of the work amounts when the trajectory definition point is present, the instructing means includes a plurality of the trajectory definition points, one type of the teaching data constituent element, and the teaching data constituent element. The teaching data correction means is used for instructing a correction value, and for each of the plurality of trajectory definition points instructed by the instructing means, while the control means controls the robot. It is characterized in that the teaching data constituent elements are collectively corrected to the correction value.

【0013】[0013]

【作用】請求項1記載の発明によれば、制御手段は記憶
手段に記憶された教示データに基づいてロボットを制御
し、指示手段は教示データの修正の指示に用いられ、教
示データ修正手段は、制御手段がロボットを制御してい
る間に、指示手段の指示に従って、記憶手段に記憶され
た教示データを修正する。請求項2記載の発明によれ
ば、制御手段は、ロボットの所定部位が所定の複数の座
標点である軌道定義点を所定の順番で通過するように、
ロボットを制御する。指示手段は1つの前記軌道定義点
と該軌道定義点の移動先となる座標値とを指示するのに
用いられ、教示データ修正手段は、制御手段がロボット
を制御している間に、指示手段で指示された軌道定義点
の座標値を指示手段で指示された座標値に修正する。
According to the invention described in claim 1, the control means controls the robot based on the teaching data stored in the storage means, the instructing means is used for instructing the correction of the teaching data, and the teaching data correcting means is While the control means controls the robot, the teaching data stored in the storage means is corrected according to the instruction of the instruction means. According to the second aspect of the present invention, the control means causes the predetermined portion of the robot to pass the trajectory definition points, which are a plurality of predetermined coordinate points, in a predetermined order.
Control the robot. The instructing means is used for instructing one of the trajectory defining points and the coordinate value to which the trajectory defining point is moved, and the teaching data correcting means is used for instructing the robot while the controlling means controls the robot. The coordinate value of the trajectory definition point designated by is corrected to the coordinate value designated by the indicating means.

【0014】請求項3記載の発明によれば、指示手段は
ロボットの所定部位の移動速度を指示するのに用いら
れ、教示データ修正手段は、制御手段がロボットを制御
している間に、所定部位の移動速度を指示手段で指示さ
れた移動速度に修正する。請求項4記載の発明によれ
ば、指示手段はロボットが行う作業量を指示するのに用
いられ、教示データ修正手段は、制御手段がロボットを
制御している間に、ロボットが行う作業量を指示手段で
指示された作業量に修正する。請求項5記載の発明によ
れば、教示データは、軌道定義点のそれぞれについて、
該軌道定義点の座標値、または所定部位が該軌道定義点
にあるときの移動速度、または所定部位が該軌道定義点
にあるときの作業量のそれぞれを示す教示データ構成要
素から成る。指示手段は複数の軌道定義点と1種類の教
示データ構成要素と該教示データ構成要素の修正値とを
指示するのに用いられ、教示データ修正手段は、制御手
段がロボットを制御している間に、指示手段で指示され
た複数の軌道定義点のそれぞれについて、教示データ構
成要素を修正値に一括して修正する。
According to the third aspect of the present invention, the instructing means is used to instruct the moving speed of the predetermined portion of the robot, and the teaching data correcting means is provided while the control means controls the robot. The moving speed of the part is corrected to the moving speed instructed by the instructing means. According to the invention of claim 4, the instructing means is used to instruct the amount of work performed by the robot, and the teaching data correction means indicates the amount of work performed by the robot while the control means controls the robot. The work amount is corrected by the instruction means. According to the invention of claim 5, the teaching data is
It is composed of teaching data constituent elements showing the coordinate value of the trajectory definition point, the moving speed when the predetermined portion is at the trajectory definition point, or the work amount when the predetermined portion is at the trajectory definition point. The instructing means is used to instruct a plurality of trajectory definition points, one type of teaching data constituent element and a correction value of the teaching data constituent element, and the teaching data correcting means is provided while the control means controls the robot. Then, the teaching data constituent elements are collectively corrected to the correction values for each of the plurality of trajectory definition points designated by the indicating means.

【0015】[0015]

【実施例】以下、図面を参照して、この発明の実施例に
ついて説明する。図1はこの発明の一実施例によるロボ
ットの制御装置の構成を示すブロック図である。制御演
算装置31は、ROM32に記憶された制御プログラム
に従って、RAM33を用いて処理を行うことにより、
制御装置3の各部を制御する。サーボ制御部34は、制
御演算装置31の制御の下、マニピュレータ1の各回転
軸1c〜1fに内蔵されたエンコーダから出力されサー
ボモータドライバ35を介して入力されたフィードバッ
ク値SFに基づいて、サーボモータドライバ35に対し
速度指令信号を供給する。サーボモータドライバ35
は、速度指令信号からサーボモータ動作信号SSを生成
し、各回転軸1c〜1fに内蔵されたサーボモータを回
転させる。また、上記位置フィードバック信号SFは、
サーボモータドライバ35およびサーボ制御部34を介
して制御演算装置31にも供給される。
Embodiments of the present invention will be described below with reference to the drawings. FIG. 1 is a block diagram showing the configuration of a robot controller according to an embodiment of the present invention. The control arithmetic unit 31 performs processing by using the RAM 33 in accordance with the control program stored in the ROM 32,
Each part of the control device 3 is controlled. The servo control unit 34, under the control of the control arithmetic unit 31, based on the feedback value S F output from the encoder built in each of the rotary shafts 1 c to 1 f of the manipulator 1 and input via the servo motor driver 35, A speed command signal is supplied to the servo motor driver 35. Servo motor driver 35
Generates a servo motor operation signal S S from the speed command signal and rotates the servo motor built in each of the rotary shafts 1c to 1f. Further, the position feedback signal S F is
It is also supplied to the control arithmetic unit 31 via the servo motor driver 35 and the servo control unit 34.

【0016】教示データ修正装置36は、制御演算装置
31の教示データ再生中に、タイマ37から所定のサン
プリング間隔で出力されたパルス信号を受信する度に、
RAM33内の教示データを修正する教示データ修正処
理(図6〜図8参照)を行う。尚、図6〜図8の詳細に
ついての説明は後述する。尚、タイマ37は、複数の装
置に対して複数の時間間隔でパルス信号を供給すること
が可能であり、本実施例では、教示データ修正装置36
に対しては10msec間隔で、また、制御演算装置3
1に対しては1msec間隔でパルス信号を供給する。
The teaching data correction device 36 receives the pulse signal output from the timer 37 at a predetermined sampling interval during the reproduction of the teaching data of the control arithmetic device 31, each time.
Teaching data correction processing (see FIGS. 6 to 8) for correcting the teaching data in the RAM 33 is performed. The details of FIGS. 6 to 8 will be described later. The timer 37 is capable of supplying pulse signals to a plurality of devices at a plurality of time intervals, and in this embodiment, the teaching data correction device 36.
For 10 msec intervals, and the control arithmetic unit 3
For 1, a pulse signal is supplied at 1 msec intervals.

【0017】図2は制御装置3を用いた塗装用ロボット
システムの構成例を示す斜視図である。この図におい
て、図11の各部に対応する部分には同一の符号を付
け、その説明を省略する。この図に示す塗装用ロボット
システムにおいては、制御装置103に代えて制御装置
3が、手元操作装置104に代えて手元操作装置4が新
たに設けられている。また、この塗装用ロボットシステ
ムの塗装作業時の塗装軌道およびワークの位置は、図1
3に示す塗装軌道およびワークの位置と同じである。
FIG. 2 is a perspective view showing a configuration example of a coating robot system using the control device 3. In this figure, parts corresponding to those in FIG. 11 are assigned the same reference numerals and explanations thereof are omitted. In the coating robot system shown in this figure, a control device 3 is newly provided in place of the control device 103, and a hand operation device 4 is newly provided in place of the hand operation device 104. In addition, the painting trajectory and the position of the work during the painting work of this painting robot system are shown in Fig. 1.
It is the same as the coating orbit and the position of the work shown in FIG.

【0018】図3は手元操作装置4の一例であり、この
手元操作装置4は入力用キー41,非常停止ボタン4
2,および表示部43を有する。この手元操作装置4が
従来の手元操作装置104と異なる点は、入力用キー4
1のうちの「再生」キーが、その押される強さの違いに
よって、押された方向へ2段階のストロークを持って押
し下げられる点である。上記「再生」キーは、通常の強
さで押された場合には、通常のストロークで押し下げら
れ、制御装置3の動作モードは従来の制御装置103の
再生モードと同様の再生モード(以下、通常再生モード
と称する)となる。一方、強く押された場合には、上記
「再生」キーは通常より長いストロークで押し下げら
れ、制御装置3の動作モードは教示データの再生中にそ
の修正が可能となる再生モード(以下、修正再生モード
と称する)となる。
FIG. 3 shows an example of the hand-held operating device 4. The hand-held operating device 4 includes an input key 41 and an emergency stop button 4.
2, and a display unit 43. This hand operating device 4 is different from the conventional hand operating device 104 in that the input key 4 is used.
The point is that the "play" key of 1 is pushed down with a two-step stroke in the pushed direction due to the difference in the pushing strength. When the "play" key is pressed with a normal strength, it is pushed down with a normal stroke, and the operation mode of the control device 3 is the same as the reproduction mode of the conventional control device 103 (hereinafter, referred to as normal mode). It will be referred to as a reproduction mode). On the other hand, when the key is pressed strongly, the "reproduction" key is pressed down with a stroke longer than usual, and the operation mode of the control device 3 is a reproduction mode in which the correction can be made during the reproduction of the teaching data (hereinafter referred to as correction reproduction). Mode).

【0019】尚、修正再生モードは通常再生モードが有
している再生機能を全て有する上位モードであり、その
動作モードが修正再生モードである制御装置3は、通常
再生モードで行うことのできる全ての再生処理に加えて
上記教示データ修正処理(図6〜図8参照)を行うこと
ができる。このように、2種類の再生モードを設けるこ
とによって、オペレータは、初めから教示データの修正
を目的とする場合には修正再生モードを選択し、また単
に教示データの確認を目的とする場合には通常再生モー
ドを選択して制御演算装置31に再生処理を行わせるこ
とができる。これにより、オペレータは上記教示データ
修正処理の作動しない通常再生モードも選択できるの
で、不注意や操作ミス等によってオペレータの意に反し
て教示データの修正を行ってしまうことを防ぐことがで
きる。
The modified reproduction mode is a higher-level mode having all the reproduction functions of the normal reproduction mode, and the control device 3 whose operation mode is the modified reproduction mode can perform all of the normal reproduction modes. In addition to the reproduction process of (1), the teaching data correction process (see FIGS. 6 to 8) can be performed. In this way, by providing two kinds of reproduction modes, the operator selects the correction reproduction mode from the beginning when the purpose is to correct the teaching data, and when the purpose is simply to confirm the teaching data. The normal arithmetic mode can be selected to cause the control arithmetic unit 31 to perform the reproducing process. As a result, the operator can select the normal reproduction mode in which the teaching data correction processing does not operate, so that it is possible to prevent the teaching data from being corrected against the operator's intentions due to carelessness or operation error.

【0020】このような構成において、オペレータが、
従来の技術において制御装置103を用いて行われる教
示操作と同じ手順で、図13に示す網5の頂点A〜Dと
待機位置P0とを教示し、上記塗装条件(塗装ガン2の
移動速度,オーバースプレー幅W,塗料の噴射量等)を
設定した後、手元操作装置4に設けられた「終了」キー
を押すと、図1に示す制御演算装置31は、教示点の座
標値および塗装条件より、図4に示す軌道ポイントP1
〜P8の座標値を算出し、その値をRAM33に格納す
る。この時、制御演算装置31は、それぞれの軌道ポイ
ントごとに、その座標値と一緒に教示データ構成要素と
呼ばれるデータをRAM33へ格納する。ここで教示デ
ータ構成要素とは、教示時に設定された塗装条件のうち
塗装ガン2の塗料噴射量,移動速度,塗料噴射開始/停
止,塗装ガン2先端からワーク6までの距離等を示す個
々のデータを指す。
In such a configuration, the operator
In the same procedure as the teaching operation performed using the control device 103 in the conventional technique, the vertices A to D of the net 5 and the standby position P0 shown in FIG. 13 are taught, and the above-mentioned coating conditions (moving speed of the coating gun 2, After setting the overspray width W, the amount of paint sprayed, etc.), when the "end" key provided on the handheld operation device 4 is pressed, the control calculation device 31 shown in FIG. Therefore, the trajectory point P1 shown in FIG.
The coordinate values of P8 to P8 are calculated and the values are stored in the RAM 33. At this time, the control arithmetic unit 31 stores, for each trajectory point, data called a teaching data constituent element in the RAM 33 together with the coordinate values thereof. Here, the teaching data constituent elements are individual ones that indicate the paint spraying amount, the moving speed, the paint spraying start / stop, the distance from the tip of the coating gun 2 to the work 6, etc. of the coating gun 2 among the coating conditions set at the time of teaching. Refers to data.

【0021】その後、制御演算装置31は、各軌道ポイ
ントが塗装ガン2先端の動作範囲(以下、塗装範囲と称
する)内にあるか、塗装ガン2の移動速度がマニピュレ
ータ1の仕様によって決定されるアーム1b先端の最大
移動速度を越えていないか等、各軌道ポイントの教示デ
ータが必ず満たさなくてはならない最低条件をクリアし
ているか否かをチェックする。教示データがこれらの最
低条件を満たしていない場合には、制御装置3はスピー
カや回転灯など図1に図示しない報知装置を用いて、こ
のことをオペレータに報知する。これにより、オペレー
タは教示点の教示または塗装条件の設定をやり直し、教
示データを修正する。
Thereafter, the control arithmetic unit 31 determines whether each trajectory point is within the operation range of the tip of the coating gun 2 (hereinafter referred to as the coating range) or the moving speed of the coating gun 2 is determined by the specifications of the manipulator 1. It is checked whether the teaching data of each trajectory point has cleared the minimum condition that must be satisfied, such as whether the maximum moving speed of the tip of the arm 1b is exceeded. When the teaching data does not satisfy these minimum conditions, the control device 3 informs the operator of this by using a notifying device such as a speaker or a rotating light not shown in FIG. As a result, the operator redoes the teaching of teaching points or the setting of coating conditions and corrects the teaching data.

【0022】教示データが上記最低条件を満たし、制御
演算装置31が該教示データの再生を行える状態とな
り、オペレータが手元操作装置4の「再生」キーを通常
より強く押すと、制御装置3の動作モードは修正再生モ
ードとなり、制御演算装置31は再生処理を開始する。
制御装置3の動作モードが修正再生モードになると、タ
イマ37は教示データ修正装置36に対して10mse
c間隔でパルス信号の供給を開始する。次に、オペレー
タが図3に示す手元操作装置4の「スタート」キーを押
すと、制御演算装置31は、タイマ37から1msec
間隔で出力されるパルス信号を受信する度に、塗装ガン
2先端が直前に通過した(または、現在通過中の)軌道
ポイントと次に通過する予定の軌道ポイント(以下、目
標軌道ポイントと称する)とを結ぶ軌道を算出し、その
結果を図1に示すサーボ制御部34へ供給する。具体的
には、塗装ガン2先端が図4に示すR1の位置にある場
合には、制御演算装置31は軌道ポイントP3とP4と
を結ぶ軌道を算出し、R2の位置にある場合には、軌道
ポイントP5とP6とを結ぶ軌道を算出する。
When the teaching data satisfies the above-mentioned minimum condition, the control arithmetic unit 31 is ready to replay the teaching data, and when the operator presses the "play" key of the handheld operating unit 4 harder than usual, the operation of the control unit 3 is performed. The mode becomes the modified reproduction mode, and the control arithmetic unit 31 starts the reproduction processing.
When the operation mode of the control device 3 is changed to the correction reproduction mode, the timer 37 sets the teaching data correction device 36 to 10 mse
The supply of pulse signals is started at intervals of c. Next, when the operator presses the “start” key of the handheld operating device 4 shown in FIG. 3, the control arithmetic unit 31 causes the timer 37 to operate for 1 msec.
Each time a pulse signal output at an interval is received, the orbit point that the tip of the coating gun 2 has just passed through (or is currently passing through) and the orbit point scheduled to pass next (hereinafter referred to as the target orbit point) The orbit connecting to and is calculated, and the result is supplied to the servo control unit 34 shown in FIG. Specifically, when the tip of the coating gun 2 is at the position of R1 shown in FIG. 4, the control arithmetic unit 31 calculates a trajectory connecting the trajectory points P3 and P4, and when it is at the position of R2, A trajectory connecting the trajectory points P5 and P6 is calculated.

【0023】サーボ制御部34は、制御演算装置31が
算出した上記軌道を構成する各点の座標値とフィードバ
ック値SFから算出された塗装ガン2先端の座標値とを
比較し、その誤差を所定の値以内に保ちながら速度指令
信号を生成し、サーボモータドライバ35へ供給する。
ここで、速度指令信号とは、上記目標軌道ポイントへ向
かって塗装ガン2先端が移動するようにマニピュレータ
1の各回転軸1c〜1fを回転させる指令信号である。
サーボモータドライバ35は、上記速度指令信号をサー
ボモータ動作信号SSへ変換し、各回転軸1c〜1fに
内蔵されたサーボモータへ供給する。
The servo control unit 34 compares the coordinate value of each point forming the trajectory calculated by the control arithmetic unit 31 with the coordinate value of the tip of the coating gun 2 calculated from the feedback value S F , and the error is compared. The speed command signal is generated while being kept within a predetermined value and supplied to the servo motor driver 35.
Here, the speed command signal is a command signal for rotating each rotary shaft 1c to 1f of the manipulator 1 so that the tip of the coating gun 2 moves toward the target trajectory point.
The servo motor driver 35 converts the speed command signal into a servo motor operation signal S S and supplies the servo motor operation signal S S to the servo motors incorporated in the rotary shafts 1c to 1f.

【0024】次に、上記教示データ再生中に、教示デー
タ修正装置36が教示データを修正する処理について、
図5〜図10を参照して説明する。いま、制御演算装置
31は教示処理の終了後、図5に示すように軌道ポイン
トP1〜P8の座標値を求め、教示データを再生してい
る最中であるとする。また、各軌道ポイントP1〜P8
は塗装範囲7の内側にあるとする。さらに、教示データ
の再生によって、塗装ガン2先端は図5に示すように軌
道ポイントP5を通過した後、目標軌道ポイントP6へ
向かって移動中であり、塗装ガン2先端と目標軌道ポイ
ントP6との距離Rは300mmであるとする。
Next, regarding the processing in which the teaching data correction device 36 corrects the teaching data during reproduction of the teaching data,
This will be described with reference to FIGS. Now, it is assumed that the control arithmetic unit 31 is in the middle of reproducing the teaching data after obtaining the coordinate values of the trajectory points P1 to P8 as shown in FIG. In addition, each track point P1 to P8
Is inside the painting area 7. Further, by reproducing the teaching data, the tip of the coating gun 2 is moving toward the target trajectory point P6 after passing the trajectory point P5 as shown in FIG. 5, and the tip of the coating gun 2 and the target trajectory point P6 are separated from each other. It is assumed that the distance R is 300 mm.

【0025】教示データ修正装置36は、制御演算装置
31の教示データ再生中に、タイマ37から10mse
c間隔で供給されるパルス信号を受信する度に、教示デ
ータ修正処理を行うため図6に示すステップSP1へ進
む。ステップSP1では、手元操作装置4の入力用キー
41のうち、どのキーが押されているかを判断する。こ
こで、オペレータが、塗装軌道を修正するために、図5
に示す軌道ポイントP1〜P8のうちP2,P3,P6
およびP7をX軸の正の方向へ移動させたいと考え、手
元操作装置4の「X」キーと「+」キーを同時に押して
いると、図7に示すステップSP2へ進む。ステップS
P2では、図5に示す軌道ポイントP2,P3,P6お
よびP7を選択軌道ポイントとして選択し、それぞれの
座標値をRAM33のワーク領域へ書き出した後、ステ
ップSP3へ進む。本実施例では、このワーク領域に書
き出された座標値を仮位置データと称する。ステップS
P3では、それぞれの仮位置データのX座標値にΔXを
加えた後、ステップSP4へ進む。尚、本実施例ではΔ
Xは1mmとする。ステップSP3に示す処理により、
選択軌道ポイントP2,P3,P6およびP7の仮位置
データが示す座標点は、それぞれ図9に示すP2’,P
3’,P6’およびP7’となる。ステップSP4で
は、教示データ修正装置36の修正対象が軌道ポイント
の座標値である事を記憶させるため、RAM33のワー
ク領域に保持された変数FLAGに1を代入する。
The teaching data correction device 36 uses the timer 37 for 10 mse while the teaching data of the control arithmetic device 31 is being reproduced.
Each time the pulse signal supplied at the interval c is received, the process proceeds to step SP1 shown in FIG. 6 in order to perform the teaching data correction process. At step SP1, it is determined which one of the input keys 41 of the handheld operation device 4 is being pressed. Here, in order for the operator to correct the coating trajectory, FIG.
P2, P3, P6 of the trajectory points P1 to P8 shown in
If it is desired to move P7 and P7 in the positive direction of the X-axis and the "X" key and "+" key of the hand-held operation device 4 are simultaneously pressed, the process proceeds to step SP2 shown in FIG. Step S
At P2, the trajectory points P2, P3, P6, and P7 shown in FIG. 5 are selected as the selected trajectory points, the coordinate values of each are written to the work area of the RAM 33, and then the process proceeds to step SP3. In this embodiment, the coordinate values written in this work area are called temporary position data. Step S
In P3, after adding ΔX to the X coordinate value of each temporary position data, the process proceeds to step SP4. In this example, Δ
X is 1 mm. By the processing shown in step SP3,
The coordinate points indicated by the temporary position data of the selected trajectory points P2, P3, P6 and P7 are P2 ′ and P shown in FIG. 9, respectively.
3 ', P6' and P7 '. At step SP4, 1 is assigned to the variable FLAG held in the work area of the RAM 33 in order to store that the correction target of the teaching data correction device 36 is the coordinate value of the trajectory point.

【0026】一方、ステップSP1で、オペレータが、
図5に示す軌道ポイントP1,P4,P5およびP8を
X軸の負の方向へ移動させたいと考え、手元操作装置4
の「X」キーと「−」キーを同時に押していると、図7
に示すステップSP6へ進む。ステップSP6〜SP9
で行われる処理は、図5に示すP1,P4,P5および
P8が選択軌道ポイントとして選択されることと、それ
ぞれの選択軌道ポイントの仮位置データのX座標値から
ΔXを引くことを除くと、ステップSP2〜SP5で行
われる処理と同じものであるので、その説明を省略す
る。
On the other hand, in step SP1, the operator
Since it is desired to move the trajectory points P1, P4, P5 and P8 shown in FIG. 5 in the negative direction of the X axis, the hand control device 4
When the "X" key and the "-" key of are pressed at the same time,
Go to step SP6 shown in. Steps SP6 to SP9
Except that P1, P4, P5 and P8 shown in FIG. 5 are selected as the selected trajectory points, and ΔX is subtracted from the X coordinate value of the temporary position data of each selected trajectory point, Since it is the same as the processing performed in steps SP2 to SP5, its explanation is omitted.

【0027】一方、ステップSP1で、オペレータが、
図5に示す全ての軌道ポイントP1〜P8をX軸の正の
方向へ移動させたいと考え、手元操作装置4の「X」キ
ーと「+」キーに加えて「シフト」キーも同時に押して
いると、図7に示すステップSP10へ進む。ステップ
SP10〜SP12で行われる処理は、図5に示す全て
の軌道ポイントP1〜P8が選択軌道ポイントとして選
択されることを除くと、ステップSP2〜SP5で行わ
れる処理と同じものであるので、その説明を省略する。
上記ステップSP10〜SP12の処理により、選択軌
道ポイントP1〜P8の仮位置データが示す座標点は、
それぞれ図10に示すP1’〜P8’となる。
On the other hand, in step SP1, the operator
Since it is desired to move all the trajectory points P1 to P8 shown in FIG. 5 in the positive direction of the X-axis, the “shift” key is simultaneously pressed in addition to the “X” key and the “+” key of the hand-held operating device 4. Then, the process proceeds to step SP10 shown in FIG. The processing performed in steps SP10 to SP12 is the same as the processing performed in steps SP2 to SP5 except that all the trajectory points P1 to P8 shown in FIG. 5 are selected as the selected trajectory points. The description is omitted.
By the processing of steps SP10 to SP12, the coordinate points indicated by the temporary position data of the selected trajectory points P1 to P8 are
These are P1 'to P8' shown in FIG. 10, respectively.

【0028】一方、ステップSP1で、オペレータが、
図5に示す全ての軌道ポイントP1〜P8をX軸の負の
方向へ移動させたいと考え、手元操作装置4の「X」キ
ー,「−」キーと「シフト」キーを同時に押している
と、図7に示すステップSP13へ進む。ステップSP
13〜SP15で行われる処理は、図5に示す全ての軌
道ポイントP1〜P8が選択軌道ポイントとして選択さ
れることを除くと、ステップSP6〜SP9で行われる
処理と同じものであるので、その説明を省略する。
On the other hand, in step SP1, the operator
When it is desired to move all the trajectory points P1 to P8 shown in FIG. 5 in the negative direction of the X axis, and the “X” key, the “−” key and the “shift” key of the hand operation device 4 are simultaneously pressed, It progresses to step SP13 shown in FIG. Step SP
The processing performed in steps 13 to SP15 is the same as the processing performed in steps SP6 to SP9, except that all the trajectory points P1 to P8 shown in FIG. 5 are selected as the selected trajectory points. Is omitted.

【0029】一方、ステップSP1で、オペレータが塗
装ガン2の塗料噴射量を増やしたいと考え、手元操作装
置4の「スプレー」キーと「+」キーを同時に押してい
ると、ステップSP16へ進む。ステップSP16で
は、塗装ガン2の現在の塗料噴射量をRAM33のワー
ク領域へ書き出す。本実施例では、このワーク領域に書
き出された塗装ガン2の現在の塗料噴射量を仮噴射量と
称する。更に、その仮噴射量に所定の増減噴射量ΔSを
加えた後、ステップSP17へ進む。尚、本実施例では
ΔSは1cc/secとする。ステップSP17では、
教示データ修正装置36の修正対象が塗装ガン2の塗料
噴射量である事を記憶させるため、RAM33のワーク
領域に保持された変数FLAGに2を代入する。
On the other hand, if the operator wants to increase the amount of paint sprayed from the coating gun 2 in step SP1 and simultaneously presses the "spray" key and "+" key of the hand-held operating device 4, the process proceeds to step SP16. At step SP16, the current paint injection amount of the coating gun 2 is written in the work area of the RAM 33. In the present embodiment, the current paint injection amount of the coating gun 2 written in this work area is called a temporary injection amount. Further, after adding a predetermined increase / decrease injection amount ΔS to the temporary injection amount, the process proceeds to step SP17. In this embodiment, ΔS is 1 cc / sec. In step SP17,
In order to store that the correction target of the teaching data correction device 36 is the paint injection amount of the coating gun 2, 2 is substituted for the variable FLAG held in the work area of the RAM 33.

【0030】一方、ステップSP1で、オペレータが塗
装ガン2の塗料噴射量を減らしたいと考え、手元操作装
置4の「スプレー」キーと「−」キーを同時に押してい
ると、ステップSP19へ進む。ステップSP19〜S
P21で行われる処理は、仮噴射量から所定の増減噴射
量ΔSを引くことを除くと、ステップSP16〜SP1
8で行われる処理と同じものであるので、その説明を省
略する。
On the other hand, if the operator wants to reduce the amount of paint sprayed from the coating gun 2 in step SP1 and simultaneously presses the "spray" key and the "-" key of the hand-held operating device 4, the process proceeds to step SP19. Steps SP19-S
The process performed in P21 is, except for subtracting the predetermined increase / decrease injection amount ΔS from the temporary injection amount, steps SP16 to SP1
Since it is the same as the process performed in 8, the description thereof will be omitted.

【0031】一方、ステップSP1で、オペレータが塗
装ガン2の移動速度を大きくしたいと考え、手元操作装
置4の「速度」キーと「+」キーを同時に押している
と、ステップSP22へ進む。ステップSP22では、
塗装ガン2の現在の移動速度をRAM33のワーク領域
へ書き出す。本実施例では、このワーク領域に書き出さ
れた塗装ガン2の現在の移動速度を仮速度と称する。更
に、その仮速度に所定の増減速度ΔVを加えた後、ステ
ップSP23へ進む。尚、本実施例ではΔVは0.1m
/secとする。ステップSP23では、教示データ修
正装置36の修正対象が塗装ガン2の移動速度である事
を記憶させるため、RAM33のワーク領域に保持され
た変数FLAGに3を代入する。
On the other hand, if the operator wants to increase the moving speed of the coating gun 2 in step SP1 and simultaneously presses the "speed" key and the "+" key of the hand-held operation device 4, the process proceeds to step SP22. In step SP22,
The current movement speed of the coating gun 2 is written in the work area of the RAM 33. In the present embodiment, the current moving speed of the coating gun 2 written in this work area is referred to as a temporary speed. Further, after adding a predetermined increase / decrease speed ΔV to the temporary speed, the process proceeds to step SP23. In this embodiment, ΔV is 0.1 m
/ Sec. In step SP23, in order to store that the correction target of the teaching data correction device 36 is the moving speed of the coating gun 2, 3 is assigned to the variable FLAG held in the work area of the RAM 33.

【0032】一方、ステップSP1で、オペレータが塗
装ガン2の移動速度を小さくしたいと考え、手元操作装
置4の「速度」キーと「−」キーを同時に押している
と、ステップSP25へ進む。ステップSP25〜SP
27で行われる処理は、仮速度から所定の増減速度ΔV
を引くことを除くと、ステップSP22〜SP24で行
われる処理と同じものであるので、その説明を省略す
る。ステップSP1で、上記以外の組み合わせで手元操
作装置4の入力キー41が押されている場合、または何
も押されていない場合には、ステップSP28へ進む。
ステップSP28では、教示データ修正装置36の修正
対象となる教示データ構成要素が指示されなかった事を
記憶させるため、RAM33のワーク領域に保持された
変数FLAGに0を代入する。
On the other hand, if the operator wants to reduce the moving speed of the coating gun 2 in step SP1 and simultaneously presses the "speed" key and the "-" key of the hand-operated device 4, the process proceeds to step SP25. Step SP25 to SP
The process performed in 27 is the increase / decrease speed ΔV from the provisional speed.
Since the processing is the same as the processing performed in steps SP22 to SP24, except for subtracting, the description thereof will be omitted. If it is determined in step SP1 that the input key 41 of the handheld operation device 4 has been pressed with a combination other than the above, or if no key has been pressed, the process proceeds to step SP28.
In step SP28, 0 is substituted into the variable FLAG held in the work area of the RAM 33 in order to store the fact that the teaching data component to be corrected by the teaching data correction device 36 has not been designated.

【0033】仮位置データ,仮噴射量,仮速度のいずれ
かの値の算出が終了すると、図8に示すステップSP3
0へ進む。ステップSP30では、ステップSP30の
後に続く処理について、軌道ポイントの座標値の修正処
理(ステップSP31〜SP33),塗装ガン2の塗料
噴射量の修正処理(ステップSP34,SP35),塗
装ガン2の移動速度の修正処理(ステップSP36,S
P37)のうちから、教示データ修正装置36の現在の
修正対象に対応した処理を選択するため変数FLAGの
値を判断する。
When the calculation of any of the temporary position data, the temporary injection amount, and the temporary speed is completed, step SP3 shown in FIG.
Go to 0. In step SP30, regarding the processing subsequent to step SP30, the correction processing of the coordinate value of the trajectory point (steps SP31 to SP33), the correction processing of the paint injection amount of the coating gun 2 (steps SP34 and SP35), the moving speed of the coating gun 2 are performed. Correction process (steps SP36, S
From P37), the value of the variable FLAG is determined in order to select the process corresponding to the current correction target of the teaching data correction device 36.

【0034】ステップSP30で、FLAG=1の場合
には、ステップSP31へ進む。ステップSP31で
は、仮位置データの示す座標点が塗装範囲内にあるか否
かを判断する。図9に示す動作例では、仮位置データの
示す座標点P2’,P3’,P6’およびP7’はいず
れも塗装範囲7の内側にあるので、ステップSP32へ
進む。同様に、図10に示す動作例でも、仮位置データ
の示す座標点P1’〜P8’は全て塗装範囲7の内側に
あるので、ステップSP32へ進む。ステップSP32
では、目標軌道ポイントが選択軌道ポイントとして選択
されており、かつ、塗装ガン2先端と上記目標軌道ポイ
ントとの距離Rが所定の距離ΔRより小さいか否かを判
断する。尚、本実施例ではΔRは100mmとする。ス
テップSP32の処理は、目標軌道ポイントは軌道算出
時に制御演算装置31によって参照されるので、塗装ガ
ン2先端と目標軌道ポイントとの距離が小さいときに、
目標軌道ポイントの座標値を修正することにより、マニ
ピュレータ1の動作がぎくしゃくするのを防ぐために行
われる。
If FLAG = 1 at step SP30, the process proceeds to step SP31. In step SP31, it is determined whether or not the coordinate point indicated by the temporary position data is within the coating range. In the operation example shown in FIG. 9, since the coordinate points P2 ′, P3 ′, P6 ′ and P7 ′ indicated by the temporary position data are all inside the coating range 7, the process proceeds to step SP32. Similarly, also in the operation example shown in FIG. 10, since the coordinate points P1 ′ to P8 ′ indicated by the temporary position data are all inside the coating range 7, the process proceeds to step SP32. Step SP32
Then, it is determined whether the target trajectory point is selected as the selected trajectory point and the distance R between the tip of the coating gun 2 and the target trajectory point is smaller than the predetermined distance ΔR. In this embodiment, ΔR is 100 mm. In the process of step SP32, the target trajectory point is referred to by the control arithmetic unit 31 when the trajectory is calculated, so when the distance between the tip of the coating gun 2 and the target trajectory point is small,
By correcting the coordinate value of the target trajectory point, the operation of the manipulator 1 is performed to prevent the operation of the manipulator 1 from being jerky.

【0035】図9および図10に示す本動作例では、塗
装ガン2先端と目標軌道ポイントP6との距離Rは30
0mmであり、ΔRより大きいので、ステップSP33
へ進む。ステップSP33では、各選択軌道ポイントの
座標値をそれぞれの仮位置データが示す座標値へ変更す
る。これにより、図9に示す動作例では、選択軌道ポイ
ントP2,P3,P6およびP7の座標値は、それぞれ
P2’,P3’,P6’およびP7’の座標値に修正さ
れる。同様に、図10に示す動作例では、選択軌道ポイ
ントP1〜P8の座標値は、それぞれP1’〜P8’の
座標値に修正される。
In the present operation example shown in FIGS. 9 and 10, the distance R between the tip of the coating gun 2 and the target trajectory point P6 is 30.
Since it is 0 mm and is larger than ΔR, step SP33.
Go to. In step SP33, the coordinate value of each selected trajectory point is changed to the coordinate value indicated by each temporary position data. As a result, in the operation example shown in FIG. 9, the coordinate values of the selected trajectory points P2, P3, P6 and P7 are corrected to the coordinate values of P2 ′, P3 ′, P6 ′ and P7 ′, respectively. Similarly, in the operation example shown in FIG. 10, the coordinate values of the selected trajectory points P1 to P8 are corrected to the coordinate values of P1 ′ to P8 ′, respectively.

【0036】一方、ステップSP30で、FLAG=2
の場合には、ステップSP34へ進む。ステップSP3
4では、先に求めた仮噴射量が、塗装ガン2が噴射する
事のできる最大塗料噴射量以下であるか否かを判断す
る。この判断結果が「YES」の場合には、ステップS
P35へ進む。ステップSP35では、塗装ガン2の塗
料噴射量を上記仮噴射量に修正する。
On the other hand, in step SP30, FLAG = 2
In the case of, it progresses to step SP34. Step SP3
In step 4, it is determined whether or not the temporary injection amount obtained previously is less than or equal to the maximum paint injection amount that the coating gun 2 can inject. If the result of this determination is "YES", then step S
Go to P35. In step SP35, the paint injection amount of the coating gun 2 is corrected to the temporary injection amount.

【0037】一方、ステップSP30で、FLAG=3
の場合には、ステップSP36へ進む。ステップSP3
6では、先に求めた仮速度が、マニピュレータ1の性能
によって決定される塗装ガン2の最大移動速度以下であ
るか否かを判断する。この判断結果が「YES」の場合
には、ステップSP37へ進む。ステップSP37で
は、塗装ガン2の移動速度を上記仮速度に修正する。上
記の教示データ修正装置36の修正対象に対応した処理
を終了後、一例の処理を終了する。尚、教示データ修正
装置36は、タイマ37から10msec間隔でパルス
信号が入力される度に以上の処理を行うので、オペレー
タが上記の入力用キー41を上記の組み合わせで押し続
けている限り、それに対応する教示データの修正を連続
して行う。
On the other hand, in step SP30, FLAG = 3
In the case of, it progresses to step SP36. Step SP3
At 6, it is determined whether or not the provisional speed obtained previously is less than or equal to the maximum moving speed of the coating gun 2 determined by the performance of the manipulator 1. If the result of this determination is "YES", the flow proceeds to step SP37. At step SP37, the moving speed of the coating gun 2 is corrected to the temporary speed. After the processing corresponding to the correction target of the teaching data correction device 36 is finished, the example processing is finished. Note that the teaching data correction device 36 performs the above processing every time a pulse signal is input from the timer 37 at intervals of 10 msec. Therefore, as long as the operator continues to press the input key 41 in the above combination, The corresponding teaching data is continuously corrected.

【0038】以上、この発明の実施例を図面を参照して
詳述してきたが、具体的な構成はこの実施例に限られる
ものではなく、この発明の要旨を逸脱しない範囲の設計
の変更等があってもこの発明に含まれる。たとえば、上
述した一実施例においては、制御演算装置31の教示デ
ータの再生中に、リアルタイムで選択軌道ポイントをX
軸に沿った正負の方向へ移動させたが、同様の処理を行
って選択軌道ポイントをY軸方向またはZ軸方向へ移動
させることも考えられる。
The embodiment of the present invention has been described in detail above with reference to the drawings. However, the specific structure is not limited to this embodiment, and changes in design within the scope not departing from the gist of the present invention. Even this is included in this invention. For example, in the above-described embodiment, the selected trajectory point is X-selected in real time while the teaching data of the control arithmetic unit 31 is being reproduced.
Although it is moved in the positive and negative directions along the axis, it is also possible to perform the same process to move the selected trajectory point in the Y-axis direction or the Z-axis direction.

【0039】また、同実施例では、図9のP2,P3,
P6およびP7に示したように一列に並んだ複数の軌道
ポイントを選択軌道ポイントとして選択したが、手元操
作装置4に、1つの軌道ポイントを指定するための「ポ
イント設定」キー,パスを指定するための「パス設定」
キーを設け、「X」キーおよび「+」キー(または
「−」キー)と上記「ポイント設定」キー(または「パ
ス設定」キー)を同時に押すことによって、任意の軌道
ポイント(またはパス)の座標値をリアルタイムで修正
することも考えられる。さらに、上記「ポイント設定」
キー(または「パス設定」キー)を、「スプレー」キー
(または「速度」キー)および「+」キー(または
「−」キー)と同時に押すことによって、任意の軌道ポ
イント(またはパス)における塗装ガン2の塗料噴射量
(または移動速度)をリアルタイムで修正することも考
えられる。
Further, in the same embodiment, P2, P3 of FIG.
As shown in P6 and P7, a plurality of orbital points arranged in a line are selected as selected orbital points, but a "point setting" key and a path for designating one orbital point are specified in the hand-held operation device 4. For "path setting"
By providing a key and pressing the "X" key and "+" key (or "-" key) and the above "point setting" key (or "pass setting" key) at the same time, any trajectory point (or path) It is also possible to modify the coordinate values in real time. In addition, "Point setting" above
Painting at any trajectory point (or pass) by pressing the key (or "pass setting" key) at the same time as the "spray" key (or "speed" key) and the "+" key (or "-" key) It is also conceivable to correct the paint injection amount (or moving speed) of the gun 2 in real time.

【0040】また、同実施例では、塗装条件について塗
装ガン2の塗料噴射量および移動速度をリアルタイムで
修正したが、オーバースプレー幅Wなど他の塗装条件を
修正することも考えられる。また、オペレータは、軌道
ポイントの移動量ΔX,塗装ガン2の塗料噴射量の増減
噴射量ΔS,塗装ガン2の移動速度の増減速度ΔVおよ
び塗装ガン2先端と選択軌道ポイントとの間の距離ΔR
を、それぞれ任意の値に設定が可能である。また、タイ
マ37が制御演算装置31および教示データ修正装置3
6に対して供給するパルス信号の間隔は、実施例中に示
した1msecおよび10msecに限られるわけでは
なく、他の値でも構わない。
Further, in this embodiment, the paint injection amount and the moving speed of the coating gun 2 were corrected in real time with respect to the coating conditions, but other coating conditions such as the overspray width W may be modified. Further, the operator is required to determine the movement amount ΔX of the trajectory point, the increase / decrease amount ΔS of the paint injection amount of the coating gun 2, the increase / decrease velocity ΔV of the movement speed of the coating gun 2, and the distance ΔR between the tip of the coating gun 2 and the selected trajectory point.
Can be set to arbitrary values. Further, the timer 37 controls the control calculation device 31 and the teaching data correction device 3.
The intervals of the pulse signals supplied to 6 are not limited to 1 msec and 10 msec shown in the embodiment, and other values may be used.

【0041】また、同実施例では、塗装用ロボットシス
テムを例にとって教示装置3の構成および動作を説明し
たが、教示装置3は他の用途(溶接,組立等)のマニピ
ュレータ1の制御に使用することも可能である。また、
図11において、4点教示における教示点A〜Dは網5
の頂点であるとしたが、4つの教示点は必ずしも網5の
頂点である必要はなく、網5の辺上の任意の4点であっ
ても構わない。また、同実施例では、4点教示によって
作成された教示データを、教示データの再生中に修正す
る例について説明したが、修正の対象となる教示データ
は必ずしも4点教示で作成されたものである必要はな
く、Point to PointやContinuousPass等、他の方法で生
成されたものであっても構わない。
Further, in this embodiment, the configuration and operation of the teaching device 3 have been described by taking the painting robot system as an example, but the teaching device 3 is used for controlling the manipulator 1 for other purposes (welding, assembly, etc.). It is also possible. Also,
In FIG. 11, the teaching points A to D in the four-point teaching are the mesh 5
Although the four teaching points do not necessarily have to be the vertices of the net 5, they may be arbitrary four points on the sides of the net 5. Further, in the embodiment, the example in which the teaching data created by the 4-point teaching is corrected during the reproduction of the teaching data has been described. However, the teaching data to be corrected is not necessarily created by the 4-point teaching. It does not need to exist, and may be generated by another method such as Point to Point or Continuous Pass.

【0042】[0042]

【発明の効果】以上説明したように、本発明によれば、
制御手段が教示データに基づいてロボットを制御してい
る間に、同時に教示データの修正ができるので、教示デ
ータ修正のために該ロボットを含む作業ラインを停止さ
せる必要がなくなり、また、教示データ修正に必要な工
数を減らすことができる。さらに、教示時における作業
者の操作回数が減少するので、誤操作を起こす恐れが少
なくなる。
As described above, according to the present invention,
Since the teaching data can be simultaneously corrected while the control unit controls the robot based on the teaching data, it is not necessary to stop the work line including the robot for the teaching data correction, and the teaching data correction It is possible to reduce the man-hours required for. Furthermore, since the number of operations by the operator at the time of teaching is reduced, the risk of erroneous operation is reduced.

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

【図1】本発明の一実施例によるロボットの教示装置3
の構成を示すブロック図である。
FIG. 1 is a robot teaching device 3 according to an embodiment of the present invention.
FIG. 3 is a block diagram showing the configuration of FIG.

【図2】同実施例におけるロボットの教示装置3が設け
られた塗装用ロボットの構成を示す斜視図である。
FIG. 2 is a perspective view showing the configuration of a painting robot provided with a robot teaching device 3 according to the embodiment.

【図3】同実施例における手元操作装置4の外観を示す
説明図である。
FIG. 3 is an explanatory diagram showing an outer appearance of a hand operating device 4 in the embodiment.

【図4】同実施例における塗装軌道と軌道ポイントP1
〜P8との関係を示す平面図である。
FIG. 4 is a coating track and track point P1 in the same embodiment.
It is a top view showing the relation with ~ P8.

【図5】同実施例において教示データを修正する動作例
の初期条件を示す平面図である。
FIG. 5 is a plan view showing initial conditions of an operation example of correcting teaching data in the same embodiment.

【図6】同実施例における教示データ修正装置36の処
理の流れを示すPAD図である。
FIG. 6 is a PAD diagram showing a processing flow of a teaching data correction device in the embodiment.

【図7】同実施例における教示データ修正装置36の処
理の流れを示すPAD図である。
FIG. 7 is a PAD diagram showing a processing flow of the teaching data correction device in the embodiment.

【図8】同実施例における教示データ修正装置36の処
理の流れを示すPAD図である。
FIG. 8 is a PAD showing a processing flow of a teaching data correction device in the embodiment.

【図9】同実施例において軌道ポイントの座標を修正す
る動作例を示す平面図である。
FIG. 9 is a plan view showing an operation example of correcting the coordinates of a trajectory point in the same embodiment.

【図10】同実施例において軌道ポイントの座標を修正
する動作例を示す平面図である。
FIG. 10 is a plan view showing an operation example of correcting the coordinates of a trajectory point in the embodiment.

【図11】従来のロボットの教示装置103が設けられ
た塗装用ロボットの構成を示す斜視図である。
FIG. 11 is a perspective view showing a configuration of a coating robot provided with a conventional robot teaching device 103.

【図12】従来の手元操作装置104の外観を示す説明
図である。
FIG. 12 is an explanatory diagram showing an appearance of a conventional hand-held operating device 104.

【図13】教示作業時の塗装軌道およびワークの位置を
示す斜視図である。
FIG. 13 is a perspective view showing a coating trajectory and a position of a work during teaching work.

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

1……マニピュレータ、 2……塗装ガン、 3,10
3……制御装置、4……手元操作装置、 31……制御
演算装置、 32……ROM、33……RAM、 34
……サーボ制御部、35……サーボモータドライバ、
36……教示データ修正装置、37……タイマ
1 ... Manipulator, 2 ... Painting gun, 3,10
3 ... Control device, 4 ... Hand operation device, 31 ... Control arithmetic device, 32 ... ROM, 33 ... RAM, 34
...... Servo controller, 35 …… Servo motor driver,
36 ... Teaching data correction device, 37 ... Timer

Claims (5)

【特許請求の範囲】[Claims] 【請求項1】 ロボットの教示データを生成する教示デ
ータ生成手段と、 前記教示データ生成手段が生成した前記教示データを記
憶する記憶手段と、 前記記憶手段に記憶された前記教示データに基づいて前
記ロボットを制御する制御手段と、 前記教示データの修正の指示に用いられる指示手段と、 前記制御手段が前記ロボットを制御している間に、前記
指示手段の指示に従って、前記記憶手段に記憶された前
記教示データを修正する教示データ修正手段とを具備す
ることを特徴とするロボットの制御装置。
1. A teaching data generating means for generating teaching data of a robot, a storing means for storing the teaching data generated by the teaching data generating means, and the teaching data based on the teaching data stored in the storing means. Control means for controlling the robot; instruction means used for instructing correction of the teaching data; and, while the control means controls the robot, stored in the storage means in accordance with the instruction of the instruction means. A controller for a robot, comprising: a teaching data correction unit that corrects the teaching data.
【請求項2】 請求項1記載のロボットの制御装置にお
いて、 前記制御手段は、前記ロボットの所定部位が所定の複数
の座標点である軌道定義点を所定の順番で通過するよう
に、前記ロボットを制御し、 前記指示手段は、1つの前記軌道定義点と該軌道定義点
の移動先となる座標値とを指示するのに用いられ、 前記教示データ修正手段は、前記制御手段が前記ロボッ
トを制御している間に、前記指示手段で指示された前記
軌道定義点の座標値を前記指示手段で指示された前記座
標値に修正することを特徴とするロボットの制御装置。
2. The robot control device according to claim 1, wherein the control means causes the predetermined portion of the robot to pass a trajectory definition point, which is a plurality of predetermined coordinate points, in a predetermined order. The instructing means is used to instruct one of the trajectory defining points and a coordinate value which is a movement destination of the trajectory defining point, and the teaching data correcting means is configured such that the control means controls the robot. A controller for a robot, characterized in that, during control, the coordinate value of the trajectory definition point designated by the pointing means is corrected to the coordinate value designated by the pointing means.
【請求項3】 請求項1記載のロボットの制御装置にお
いて、 前記指示手段は、前記ロボットの所定部位の移動速度を
指示するのに用いられ、 前記教示データ修正手段は、前記制御手段が前記ロボッ
トを制御している間に、前記所定部位の移動速度を前記
指示手段で指示された前記移動速度に修正することを特
徴とするロボットの制御装置。
3. The robot controller according to claim 1, wherein the instruction means is used to instruct a moving speed of a predetermined portion of the robot, and the teaching data correction means is configured such that the control means controls the robot. A controller for a robot, wherein the moving speed of the predetermined portion is corrected to the moving speed instructed by the instructing means while controlling the.
【請求項4】 請求項1記載のロボットの制御装置にお
いて、 前記指示手段は、前記ロボットが行う作業量を指示する
のに用いられ、 前記教示データ修正手段は、前記制御手段が前記ロボッ
トを制御している間に、前記ロボットが行う作業量を前
記指示手段で指示された前記作業量に修正することを特
徴とするロボットの制御装置。
4. The robot controller according to claim 1, wherein the instructing unit is used to instruct a work amount of the robot, and the teaching data correcting unit controls the robot by the controlling unit. A controller for a robot, wherein the amount of work performed by the robot is corrected to the amount of work instructed by the instructing means while the robot is operating.
【請求項5】 請求項2ないし4記載のロボットの制御
装置において、 前記教示データは、前記軌道定義点のそれぞれについ
て、該軌道定義点の座標値、または前記所定部位が該軌
道定義点にあるときの前記移動速度、または前記所定部
位が該軌道定義点にあるときの前記作業量のそれぞれを
示す教示データ構成要素から成り、 前記指示手段は、複数の前記軌道定義点と1種類の前記
教示データ構成要素と該教示データ構成要素の修正値と
を指示するのに用いられ、 前記教示データ修正手段は、前記制御手段が前記ロボッ
トを制御している間に、前記指示手段で指示された複数
の前記軌道定義点のそれぞれについて、前記教示データ
構成要素を前記修正値に一括して修正することを特徴と
するロボットの制御装置。
5. The robot controller according to any one of claims 2 to 4, wherein, in the teaching data, for each of the trajectory definition points, the coordinate value of the trajectory definition point or the predetermined portion is at the trajectory definition point. And a teaching data component indicating each of the work amount when the predetermined portion is at the trajectory definition point, and the instructing means includes a plurality of the trajectory definition points and one type of the teaching. It is used to instruct a data component and a correction value of the teaching data component, and the teaching data correcting means is a plurality of instructing means instructed by the instructing means while the control means controls the robot. The controller for a robot, wherein the teaching data constituent elements are collectively corrected to the correction values for each of the trajectory definition points of.
JP31731294A 1994-12-20 1994-12-20 Robot controller Withdrawn JPH08171409A (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP31731294A JPH08171409A (en) 1994-12-20 1994-12-20 Robot controller
US08/573,951 US5949683A (en) 1994-12-20 1995-12-19 Robot control apparatus

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP31731294A JPH08171409A (en) 1994-12-20 1994-12-20 Robot controller

Publications (1)

Publication Number Publication Date
JPH08171409A true JPH08171409A (en) 1996-07-02

Family

ID=18086810

Family Applications (1)

Application Number Title Priority Date Filing Date
JP31731294A Withdrawn JPH08171409A (en) 1994-12-20 1994-12-20 Robot controller

Country Status (1)

Country Link
JP (1) JPH08171409A (en)

Cited By (4)

* 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
WO2004109414A1 (en) * 2003-06-09 2004-12-16 Kabushiki Kaisha Yaskawa Denki Teach pendant control method and device
CN102371220A (en) * 2011-10-12 2012-03-14 中国一拖集团有限公司 Flexible high-efficiency automatic spray-coating system and spray-coating process of big wheel tractor chassis
WO2018181229A1 (en) * 2017-03-29 2018-10-04 日本電産サンキョー株式会社 Work description creating device for industrial robot, and work description creating method for industrial robot

Cited By (7)

* 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
WO2004109414A1 (en) * 2003-06-09 2004-12-16 Kabushiki Kaisha Yaskawa Denki Teach pendant control method and device
US7337014B2 (en) 2003-06-09 2008-02-26 Kabushiki Kaisha Yaskawa Denki Teach pendant control method and device
CN102371220A (en) * 2011-10-12 2012-03-14 中国一拖集团有限公司 Flexible high-efficiency automatic spray-coating system and spray-coating process of big wheel tractor chassis
WO2018181229A1 (en) * 2017-03-29 2018-10-04 日本電産サンキョー株式会社 Work description creating device for industrial robot, and work description creating method for industrial robot
JPWO2018181229A1 (en) * 2017-03-29 2020-02-20 日本電産株式会社 Industrial robot work description creation device and industrial robot work description creation method

Similar Documents

Publication Publication Date Title
US5327058A (en) Method of control for an industrial robot
WO1989008878A1 (en) Method of controlling tool attitude of a robot
JPH02161503A (en) Method of correcting and regenerating teaching position data for robot
JPH08171409A (en) Robot controller
JP2008137143A (en) Teaching method of painting robot
WO1989006181A1 (en) Method and robot system for repair painting of motorcars
CN112423947A (en) Robot system
JP3801264B2 (en) Industrial robot teaching method and apparatus
JP2664476B2 (en) Industrial robot
JPH02310706A (en) Articulated robot controller
JPH08229863A (en) Industrial robot controller
JP2003165079A (en) Industrial robot
JPH0425905A (en) Robot teach/reproduction system
JPS60147810A (en) Welding robot controller
JP3191341B2 (en) Robot controller
Zaki et al. Spray painting of a general three-dimensional surface
JP2000308990A (en) Industrial robot
JP3500739B2 (en) Robot teaching device
JP3644551B2 (en) Robot control method
JP2992962B2 (en) Robot teaching device by computer simulation
JPH02303779A (en) How to control industrial robots
JPH11188686A (en) Robot controller
JPH10260712A (en) Operation program preparing method for robot
JPH0416272B2 (en)
JP2563193Y2 (en) Automatic coating equipment

Legal Events

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

Free format text: JAPANESE INTERMEDIATE CODE: A300

Effective date: 20020305