JPH054183A - Robot control device - Google Patents
Robot control deviceInfo
- Publication number
- JPH054183A JPH054183A JP1643691A JP1643691A JPH054183A JP H054183 A JPH054183 A JP H054183A JP 1643691 A JP1643691 A JP 1643691A JP 1643691 A JP1643691 A JP 1643691A JP H054183 A JPH054183 A JP H054183A
- Authority
- JP
- Japan
- Prior art keywords
- workpiece
- teaching point
- target
- robot
- plate
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Landscapes
- Constituent Portions Of Griding Lathes, Driving, Sensing And Control (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
Description
【０００１】[0001]
【産業上の利用分野】本発明は、特に研磨作業を行うの
に適したロボット制御装置に関する。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a robot controller suitable for performing a polishing operation.
【０００２】[0002]
【従来の技術】従来、ロボットに加工軌跡を教示し、ロ
ウ付加工された工作物のビード部を研磨作業によって除
去する場合、次のような手段を用いていた。即ちロボッ
トの先端に砥石の押し付け量を検出するセンサを設け、
作成されたティーチングデータにより砥石を移動し、砥
石の押し付け量を検出し、所定のしきい値を越える場合
は、砥石の押し付け量が常に一定になるようにティーチ
ングデータを補正演算して砥石の移動軌跡を変更しなが
ら研磨作業を行うものである。2. Description of the Related Art Conventionally, the following means have been used in order to teach a robot a machining path and remove a bead portion of a brazed workpiece by polishing work. That is, a sensor that detects the pressing amount of the grindstone is provided at the tip of the robot,
Move the grindstone according to the created teaching data, detect the pressing amount of the grindstone, and if the threshold value is exceeded, correct the teaching data so that the pressing amount of the grindstone is always constant and move the grindstone. The polishing work is performed while changing the locus.
【０００３】[0003]
【発明が解決しようとする課題】かかる従来の技術のよ
うな、ティーチングデータの補正によるロボットの制御
装置では、自動車ボディのルーフとピラーの接合部の様
な高い仕上がり状態が要求される加工では十分に対応で
きなかった。この理由は、図８に示すように工作物５０
の上板５０ａと下板５０ｂをビード部５１によって接合
する場合、（ａ）に示すように上板５０ａの方が下板５
０ｂよりも上側に板合わせされている場合と、（ｃ）に
示すように上板５０ａの方が下板５０ｂよりも下側に板
合わせされている場合が生じる。ビード部５１の除去作
業において工作物表面を傷付けないように（ａ）のよう
な場合では、（ｂ）に示すように上板５０ａの高さを基
準としてビード部５１を除去し、（ｃ）のような場合で
は、（ｄ）に示すように下板５０ｂの高さを基準として
ビード部５１を除去することが望ましい。即ち、接合さ
れる２枚の工作物の中から上側に板合わせされた板の高
さを基準としてビード部の除去を行う必要がある。In the robot control device based on the correction of teaching data as in the prior art, it is sufficient for machining which requires a high finished state such as the joint between the roof of the automobile body and the pillar. Couldn't handle. The reason for this is as shown in FIG.
When the upper plate 50a and the lower plate 50b are joined by the bead portion 51, the upper plate 50a is lower than the lower plate 5 as shown in (a).
There is a case where the plate is aligned above 0b and a case where the upper plate 50a is aligned below the lower plate 50b as shown in (c). In the case of (a) so as not to damage the surface of the work in the removal work of the bead portion 51, as shown in (b), the bead portion 51 is removed based on the height of the upper plate 50a, and (c). In such a case, it is desirable to remove the bead portion 51 based on the height of the lower plate 50b as shown in (d). That is, it is necessary to remove the bead portion based on the height of the plate that is plate-matched to the upper side from the two workpieces to be joined.
【０００４】しかし、上述したような技術ではこのよう
に工作物の板合わせ状態を判断することはできず、例え
ば上板５０ａを基準としてビード部５１の除去を行う
と、上記（ｃ）の場合では工作物を傷付けてしまうとい
う問題点があった。However, the above-described technique cannot judge the plate alignment state of the workpiece in this way. For example, if the bead portion 51 is removed with the upper plate 50a as a reference, Then, there was a problem that the work was damaged.
【０００５】[0005]
【課題を解決するための手段】本発明は、上述した問題
点を解決するためになされたものであり、図１に示すよ
うにあらかじめ記憶された教示点から形成される加工軌
跡に従ってロボット１０の手首部の先端に取り付けられ
た工具２７を制御して２つの部材からなる工作物の接合
部のバリ取り加工を行うロボット制御装置において、基
準工作物６３および目的工作物５０のそれぞれを構成す
る２つの部材の接合部の上下関係を検出する変位センサ
１と、前記基準工作物６３上に設定された基準教示点を
記憶する基準教示点記憶手段２と、前記変位センサ１に
より前記基準工作物６３を形成する２つの部材の位置を
測定する基準位置測定手段３と、この基準位置測定手段
３における前記基準工作物６３の測定位置に対応した前
記目的工作物５０上の位置を前記変位センサ１により測
定しこの目的工作物５０を形成する２つの部材の位置を
測定する目的位置測定手段４と、前記基準位置測定手段
３と前記目的位置測定手段４から得た値を比較すること
によって前記目的工作物５０を形成する２つの部材の板
合わせ状態を判断する板合わせ状態判断手段５と、この
板合わせ状態判断手段５によって判断された板合わせ状
態に従って前記基準教示点記憶手段２によって記憶され
た基準教示点を補正する教示点補正手段６と、この教示
点補正手段６によって得た教示点に従って前記目的工作
物５０の加工を実行する加工実行手段７とを備えたもの
である。The present invention has been made to solve the above-mentioned problems, and as shown in FIG. 1, the robot 10 follows a machining locus formed from pre-stored teaching points. In a robot control device that controls a tool 27 attached to the tip of a wrist to deburr a joint portion of a workpiece composed of two members, each of a reference workpiece 63 and a target workpiece 50 is configured. A displacement sensor 1 for detecting the vertical relationship of the joints of two members, a reference teaching point storage means 2 for storing a reference teaching point set on the reference workpiece 63, and the reference workpiece 63 by the displacement sensor 1. Reference position measuring means 3 for measuring the positions of the two members forming the object, and the target workpiece 50 corresponding to the measurement position of the reference workpiece 63 in the reference position measuring means 3. Position measured by the displacement sensor 1 to measure the positions of two members forming the target workpiece 50, values obtained from the reference position measuring unit 3 and the target position measuring unit 4. And the reference teaching point according to the plate alignment state determined by the plate alignment state determination unit 5 and the plate alignment state determination unit 5 for determining the plate alignment state of the two members forming the target workpiece 50. The teaching point correction means 6 for correcting the reference teaching point stored by the storage means 2 and the machining execution means 7 for machining the target workpiece 50 according to the teaching points obtained by the teaching point correction means 6 are provided. It is a thing.
【０００６】[0006]
【作用】上記のように構成されたロボット制御装置で
は、ロボット１０は最初に基準教示点記憶手段２によっ
て基準教示点を記憶するとともに変位センサ１を用いて
基準位置測定手段３により基準工作物６３を形成する２
つの部材の位置を測定する。次に目的工作物５０上にお
ける基準工作物６３上での測定位置に対応した位置を変
位センサ１により測定し、この目的工作物５０を形成す
る２つの部材の位置を目的位置測定手段４によって測定
する。板合わせ状態判断手段５は基準位置測定手段３と
目的位置測定手段４から得た値を比較することによって
目的工作物５０を形成する２つの部材の板合わせ状態を
判断し、この結果に基づいて教示点補正手段６は基準教
示点を補正する。加工実行手段７はこの補正された教示
点に従ってロボット１０を制御して目的工作物５０の加
工を実行する。In the robot controller constructed as described above, the robot 10 first stores the reference teaching point by the reference teaching point storage means 2 and uses the displacement sensor 1 by the reference position measuring means 3 to form the reference workpiece 63. Forming 2
Measure the position of one member. Next, the position corresponding to the measurement position on the reference workpiece 63 on the target workpiece 50 is measured by the displacement sensor 1, and the positions of the two members forming the target workpiece 50 are measured by the target position measuring means 4. To do. The plate alignment state determining means 5 determines the plate alignment state of the two members forming the target workpiece 50 by comparing the values obtained from the reference position measuring means 3 and the target position measuring means 4, and based on this result. The teaching point correction means 6 corrects the reference teaching point. The machining execution means 7 controls the robot 10 according to the corrected teaching points to execute the machining of the target workpiece 50.
【０００７】[0007]
【実施例】本発明の実施例について図面を参照して説明
する。図２は、ロボット１０を示す斜視図である。この
ロボット１０は６軸型のロボットであり、アームの先端
に取付けられた作業操作装置２０の回転砥石２７により
研磨作業を行う。工作物は自動車用フレームであり、ピ
ラーとルーフとをロウ付によって接合したロウ付溶接部
分を滑らかに仕上げる研磨作業を行うものである。Embodiments of the present invention will be described with reference to the drawings. FIG. 2 is a perspective view showing the robot 10. The robot 10 is a 6-axis type robot and performs a polishing work by a rotary grindstone 27 of a work operation device 20 attached to the tip of an arm. The work piece is a frame for automobiles, and is used for performing a polishing work for smoothly finishing a brazed welded portion in which a pillar and a roof are joined by brazing.
【０００８】図３（ａ），（ｂ）は作業操作装置２０を
示す図である。作業操作装置２０にはロボット１０の手
首部１７の先端には基板６０を介してシリンダ２１が取
付けられている。シリンダ２１にはピストン２５が嵌挿
され、圧縮空気によりピストンロッド２３を押し出す方
向に付勢している。ピストンロッド２３の一端には、中
間板６２を介して工具ヘッド２６およびブラケット７０
が固定されている。工具ヘッド２６には、回転砥石から
なる工具２７が取付けられており、ブラケット７０には
接触子７１，７２，７３が並列に取り付けられている。
この接触子７１，７２，７３の先端にはローラ８１，８
２，８３が回転可能に取り付けられている。接触子７
２，７３は中間板６２に対して上述したピストン２５摺
動方向と同じ方向に移動変位可能に取り付けられてお
り、接触子７１はブラケット７０を介して中間板６２に
固定されている。3 (a) and 3 (b) are views showing the work operating device 20. FIG. A cylinder 21 is attached to the tip of the wrist 17 of the robot 10 in the work operation device 20 via a substrate 60. A piston 25 is inserted into the cylinder 21 and urges the piston rod 23 in a direction to push it out by compressed air. The tool head 26 and the bracket 70 are attached to one end of the piston rod 23 via the intermediate plate 62.
Is fixed. A tool 27 made of a rotary grindstone is attached to the tool head 26, and contacts 71, 72, 73 are attached in parallel to the bracket 70.
The rollers 81, 8 are attached to the tips of the contacts 71, 72, 73.
2, 83 are rotatably attached. Contact 7
2, 73 are attached to the intermediate plate 62 so as to be movable and displaceable in the same direction as the sliding direction of the piston 25 described above, and the contacts 71 are fixed to the intermediate plate 62 via the bracket 70.
【０００９】上述した基板６０には変位センサ９１が取
り付けられ、レーザ光４１を中間板６２に対して照射
し、反射波を入力することにより中間板６２の変位、即
ち、工具２７および接触子７１の変位を測定できるよう
になっている。また、上述した中間板６２には変位セン
サ９１と同様の変位センサ９２，９３が取り付けられ、
レーザ光４２，４３を接触子７２，７３に固定された測
定板１２，１３に対して照射することにより接触子７
２，７３の中間板６２に対する変位を測定できるように
なっている。A displacement sensor 91 is attached to the above-described substrate 60, the intermediate plate 62 is irradiated with the laser beam 41, and a reflected wave is input to the intermediate plate 62 for displacement, that is, the tool 27 and the contact 71. The displacement of can be measured. Further, displacement sensors 92 and 93 similar to the displacement sensor 91 are attached to the above-mentioned intermediate plate 62,
By irradiating the measurement plates 12 and 13 fixed to the contacts 72 and 73 with the laser beams 42 and 43, the contacts 7
The displacement of 2, 73 with respect to the intermediate plate 62 can be measured.
【００１０】作業工具装置２０は、自由状態では圧縮空
気の付勢力によりシリンダ２１のピストンロッド２３が
押し出されたストローク端にある。工具（回転砥石）２
７が加工物に押し付けられると、圧縮空気の付勢力に抗
してピストン２５およびピストンロッド２３が移動す
る。即ち、工具２７が工作物を押圧する押圧力は圧縮空
気の付勢力で決定する。またシリンダ２１は、工具２７
が工作物を押圧した時の衝撃や、研磨作業中の振動を吸
収する作用を有する。In the free state, the work tool device 20 is at the stroke end where the piston rod 23 of the cylinder 21 is pushed out by the urging force of compressed air. Tool (rotary grindstone) 2
When 7 is pressed against the workpiece, the piston 25 and piston rod 23 move against the biasing force of the compressed air. That is, the pressing force with which the tool 27 presses the workpiece is determined by the urging force of the compressed air. Further, the cylinder 21 is a tool 27
Has the function of absorbing the shock when the work is pressed and the vibration during the polishing work.
【００１１】図４は制御装置３０を示すブロック図であ
る。制御装置３０は、主にロボットコントローラ３５と
パーソナルコンピュータ３９とからなる。ロボットコン
トローラ３５は、ＣＰＵ（中央処理装置）３１、メモリ
３２、オペレーティングボックス３４、工具駆動ユニッ
ト３７、および各軸のサーボ駆動ユニットＤ１〜Ｄ６か
らなる。これらの構成によりなるロボットコントローラ
３５は主にロボットの動作軌跡を制御する部分であり、
ＣＰＵ３１ではオペレーティングボックス３４により教
示された基準工作物上の基準教示点をメモリ３２に記憶
し、それらの情報とパーソナルコンピュータ３９から伝
送される補正量に基づいて補間演算等を行ってロボット
１０の目標位置を算出し各軸のサーボ駆動ユニットＤ１
〜Ｄ６に目標位置θ１〜θ６を出力する。各軸のサーボ
駆動ユニットＤ１〜Ｄ６はそれぞれサーボ制御用のＣＰ
Ｕを備え、パルスエンコーダＥ１〜Ｅ６からの位置信号
を検出して目標位置θ１〜θ６を実現すべく各軸駆動す
るサーボモータＭ１〜Ｍ６をフィードバック制御する。
また、ＣＰＵ３１は工具駆動ユニット３７の制御を行
う。FIG. 4 is a block diagram showing the control device 30. The control device 30 mainly includes a robot controller 35 and a personal computer 39. The robot controller 35 includes a CPU (central processing unit) 31, a memory 32, an operating box 34, a tool drive unit 37, and servo drive units D1 to D6 for each axis. The robot controller 35 having these configurations is a part that mainly controls the movement trajectory of the robot,
The CPU 31 stores the reference teaching point on the reference workpiece taught by the operating box 34 in the memory 32, performs interpolation calculation and the like based on the information and the correction amount transmitted from the personal computer 39, and the target of the robot 10 is obtained. Calculate the position and servo drive unit D1 for each axis
The target positions θ1 to θ6 are output to D6. Servo drive units D1 to D6 for each axis are CPs for servo control.
The servo motors M1 to M6, which are provided with U, detect the position signals from the pulse encoders E1 to E6 and drive the respective axes to realize the target positions θ1 to θ6.
Further, the CPU 31 controls the tool driving unit 37.
【００１２】パーソナルコンピュータ３９は、ディスプ
レイ３３、キーボード２８、メモリ２４、および変位セ
ンサ９１，９２，９３の出力から変位量を演算する計測
制御部９４からなり、ロボット制御用のＣＰＵ３１との
間で基準教示点の補正量の演算を行うとともにデータの
授受を行う。以上の構成に基づき本実施例の作用を説明
する。The personal computer 39 comprises a display 33, a keyboard 28, a memory 24, and a measurement control section 94 for calculating the amount of displacement from the outputs of the displacement sensors 91, 92, 93, and a reference with the CPU 31 for robot control. The amount of correction of the teaching point is calculated and data is exchanged. The operation of this embodiment will be described based on the above configuration.
【００１３】図５（ａ），（ｂ），（ｃ），（ｄ）は基
準工作物６３を示した図であり、（ａ），（ｃ）は平面
図、（ｂ），（ｄ）は断面図である。図５（ｅ），
（ｆ）は実際に加工を行う目的工作物５０を示した断面
図である。基準工作物６３および目的工作物５０は曲面
形状を有する板金部材であり、基準工作物６３は上板６
３ａと下板６３ｂの表面が完全に一致した理想状態で接
合されており、目的工作物５０はロウ付溶接工程での加
工誤差により上板６３ａと下板６３ｂの接合部に高低差
が生じ、ロウ付溶接によるビード部５１を残している。
このビード部５１を工具（回転砥石）２７による研磨作
業を行うことにより、目的工作物５０に傷を生じさせな
いように除去し、滑らかな曲面を得ようというものであ
る。5 (a), 5 (b), 5 (c) and 5 (d) are views showing the reference workpiece 63, FIGS. 5 (a) and 5 (c) are plan views, and 5 (b) and 5 (d). Is a sectional view. FIG. 5 (e),
(F) is a cross-sectional view showing a target workpiece 50 to be actually machined. The reference workpiece 63 and the target workpiece 50 are sheet metal members having a curved surface shape, and the reference workpiece 63 is the upper plate 6.
3a and the surface of the lower plate 63b are joined in an ideal state in which the surfaces of the upper plate 63a and the lower plate 63b are perfectly matched with each other. The bead portion 51 formed by brazing is left.
By polishing the bead portion 51 with a tool (rotary grindstone) 27, the target workpiece 50 is removed so as not to cause scratches, and a smooth curved surface is obtained.
【００１４】図５（ａ）に示すようにあらかじめ基準工
作物６３上には、上板６３ａと下板６３ｂの接合部６３
ｃ上にＮ個の仮想教示点ＭＰ（１）〜ＭＰ（Ｎ）が設定
してあり、これらの点を直線補間で結ぶことによって加
工軌跡が形成されている。接合部６３ｃは目的工作物５
０上ではロウ付溶接されビード部５１となる。目的工作
物５０のビード部５１を研磨する前処理として、図５
（ｂ）のようにまず、作業者がオペレーティングボック
ス３４によってロボット１０を操作しながら、作業工具
装置２０のシリンダ２１がストロークエンドとなるよう
に、工具２７を基準工作物６３に接触させる。作業者が
工具２７の接触を確認すると、仮想教示点ＭＰ（ｋ）
（１≦ｋ≦Ｎ）の位置座標ＭＰ（ｋ）＝（Ｘmpk,Ｙmpk,
Ｚmpk ）を記憶する。この作業をＭＰ（１）からＭＰ
（Ｎ）までのＮ個の点で繰り返すことによって、加工軌
跡を設定する。この仮想教示点ＭＰ（１）〜ＭＰ（Ｎ）
は仮のものであり、作業者が目測により工具２７と基準
工作物６３との接触を確認しているために、各仮想教示
点毎に工具２７の基準工作物６３への押しつけ力に幾ら
かの誤差を包含している。従って、次に行う作業では、
仮想教示点ＭＰ（１）〜ＭＰ（Ｎ）から加工時の基準と
なる基準教示点ＭＴ（１）〜ＭＴ（Ｎ）を求める。As shown in FIG. 5 (a), a joint 63 between an upper plate 63a and a lower plate 63b is previously formed on the reference work 63.
N virtual teaching points MP (1) to MP (N) are set on c, and a machining locus is formed by connecting these points by linear interpolation. The joint 63c is the target workpiece 5
On 0, the bead portion 51 is welded by brazing. As a pretreatment for polishing the bead portion 51 of the target workpiece 50, FIG.
As shown in (b), first, while the operator operates the robot 10 by the operating box 34, the tool 27 is brought into contact with the reference workpiece 63 so that the cylinder 21 of the work tool device 20 reaches the stroke end. When the operator confirms the contact of the tool 27, the virtual teaching point MP (k)
(1 ≦ k ≦ N) position coordinates MP (k) = (Xmpk, Ympk,
Zmpk) is stored. Perform this work from MP (1) to MP
The processing locus is set by repeating at N points up to (N). This virtual teaching point MP (1) to MP (N)
Is a temporary one, and the operator confirms the contact between the tool 27 and the reference workpiece 63 by visual inspection. Therefore, the pressing force of the tool 27 against the reference workpiece 63 at each virtual teaching point is somewhat The error of is included. Therefore, in the next work,
From the virtual teaching points MP (1) to MP (N), reference teaching points MT (1) to MT (N) that serve as a reference at the time of processing are obtained.
【００１５】以下、基準教示点ＭＴ（１）〜ＭＴ（Ｎ）
を求める過程について述べる。作業者はロボット１０を
自動運転とすることにより、仮想教示点ＭＰ（１）〜Ｍ
Ｐ（Ｎ）から形成された加工軌跡上を沿って工具２７が
移動するようにロボット１０を作動させる。ロボット１
０はこの加工軌跡上を工具２７が移動する間に一定時間
間隔で工具２７先端の座標を取り込み記憶する（この時
取り込まれるデータの数は仮想教示点の数より遙かに多
い）。これらのデータをスムージングすることにより補
正し、これらの補正データから形成された加工軌跡を求
める。次にこの加工軌跡を基準教示点ＭＴの個数Ｎ個で
等分した距離を１ピッチとして、この１ピッチ毎に加工
軌跡を形成する点のデータを算出してこれらのデータを
基準教示点ＭＴ（１）〜ＭＴ（Ｎ）とする。Hereinafter, reference teaching points MT (1) to MT (N)
The process of finding The operator automatically operates the robot 10 to generate virtual teaching points MP (1) to M (M).
The robot 10 is operated so that the tool 27 moves along the machining locus formed by P (N). Robot 1
0 captures and stores the coordinates of the tip of the tool 27 at fixed time intervals while the tool 27 moves on this machining trajectory (the number of data captured at this time is much larger than the number of virtual teaching points). These data are corrected by smoothing and the processing locus formed from these correction data is obtained. Next, assuming that a distance obtained by equally dividing the machining locus by the number N of the reference teaching points MT is one pitch, data of points forming the machining locus is calculated for each pitch, and these data are used as the reference teaching points MT ( 1) to MT (N).
【００１６】以上のようにして求めた基準教示点ＭＴ
（１）〜ＭＴ（Ｎ）が適切な値であるか否かを判断する
方策として、基準教示点が存在するべき範囲をあらかじ
め設定しておく。即ち、下式に示すように基準教示点Ｍ
Ｔ（ｋ）が取り得る最小の値ＭＴ(min) と最大の値ＭＴ
(max) の範囲内に基準教示点ＭＴ（１）〜ＭＴ（Ｎ）の
全てが含まれる場合のみ、求められた基準教示点ＭＴ
（１）〜ＭＴ（Ｎ）が適切な値であると判断する。Reference teaching point MT obtained as described above
As a measure to determine whether (1) to MT (N) are appropriate values, a range in which the reference teaching point should exist is set in advance. That is, as shown in the following equation, the reference teaching point M
Minimum value MT (min) and maximum value MT that T (k) can take
Only when all of the reference teaching points MT (1) to MT (N) are included in the range of (max), the obtained reference teaching point MT
It is determined that (1) to MT (N) are appropriate values.
【００１７】ＭＴ(min) ≦ＭＴ（ｋ）≦ＭＴ(max) もし、求めた値が１つでもこの条件に含まれない場合
は、仮想教示点ＭＰ（１）〜ＭＰ（Ｎ）上を再び工具２
７を移動させ、データの再入力を行い、求めた基準教示
点ＭＴの全てが先に述べた設定範囲内に適合するまで繰
り返す。このようにして求められた基準教示点ＭＴ
（１）〜ＭＴ（Ｎ）はロボットコントーラ３５中のメモ
リ３２に記憶される。MT (min) ≦ MT (k) ≦ MT (max) If any of the obtained values is not included in this condition, the virtual teaching points MP (1) to MP (N) are re-examined. Tool 2
7 is moved, data is re-input, and it is repeated until all the obtained reference teaching points MT are within the setting range described above. The reference teaching point MT thus obtained
(1) to MT (N) are stored in the memory 32 in the robot controller 35.
【００１８】次に図５（ｃ），（ｄ）に示すように、作
業者がオペレーティングボックス３４によってロボット
１０を操作しながら接触子７１，７２，７３を基準工作
物６３上を移動させ、上板６３ａ、下板６３ｂ、および
この２つの板の接合部６３ｃの変位量を記憶する。即
ち、接合部６３ｃ上に設定された仮想教示点ＭＰ（１）
〜ＭＰ（Ｎ）からなる加工軌跡上を接触子７２を移動さ
せ、これにともなって、接触子７１，７３をそれぞれ上
板６３ａおよび下板６３ｂ上を移動させる。この時、作
業者は接触子７２が仮想教示点ＭＰ上を通過する毎に接
触子７１，７２，７３にそれぞれ対応する変位センサ９
１，９２，９３からの変位データをロボット１０に記憶
させていく。即ち、図５（ｃ）で示すように変位センサ
９２は仮想教示点ＭＰ（ｋ）（ｋ＝１〜Ｎ）と同じ位置
にある点ＨＢ（ｋ）（ｋ＝１〜Ｎ）の変位量Ｄｍａ
（１）〜Ｄｍａ（Ｎ）を検出し、変位センサ９１は仮想
教示点ＭＰ（ｋ）（ｋ＝１〜Ｎ）から接触子７１と接触
子７２との間隔だけ上板６３ａ側にオフセットした点Ｈ
Ａ（ｋ）（ｋ＝１〜Ｎ）の変位量Ｄｍｂ（１）〜Ｄｍｂ
（Ｎ）を検出する。変位センサ９３は変位センサ９１と
同様に仮想教示点ＭＰ（ｋ）（ｋ＝１〜Ｎ）から接触子
７３と接触子７２との間隔だけ下板６３ｂ側にオフセッ
トした点ＨＣ（ｋ）（ｋ＝１〜Ｎ）の変位量Ｄｍｃ
（１）〜Ｄｍｃ（Ｎ）を検出する。これらの変位量はパ
ーソナルコンピュータ３９中のメモリ２４に記憶され
る。また、この時ロボット１０は上述した仮想教示点Ｍ
Ｐ（ｋ）（ｋ＝１〜Ｎ）と同じ位置にある点ＨＢ（ｋ）
（ｋ＝１〜Ｎ）の位置座標をメモリ３２に記憶する。Next, as shown in FIGS. 5 (c) and 5 (d), an operator moves the contacts 71, 72, 73 on the reference workpiece 63 while operating the robot 10 with the operating box 34, and The displacement amounts of the plate 63a, the lower plate 63b, and the joint portion 63c of the two plates are stored. That is, the virtual teaching point MP (1) set on the joint 63c
The contact 72 is moved on the machining path consisting of MP (N) to MP (N), and the contacts 71 and 73 are moved on the upper plate 63a and the lower plate 63b, respectively. At this time, each time the operator passes the contact 72 over the virtual teaching point MP, the displacement sensor 9 corresponding to the contact 71, 72, 73, respectively.
The displacement data from 1, 92 and 93 is stored in the robot 10. That is, as shown in FIG. 5C, the displacement sensor 92 has the displacement amount Dma of the point HB (k) (k = 1 to N) at the same position as the virtual teaching point MP (k) (k = 1 to N).
(1) to Dma (N) are detected, and the displacement sensor 91 is offset from the virtual teaching point MP (k) (k = 1 to N) to the upper plate 63a side by the distance between the contact 71 and the contact 72. H
Displacement amounts Dmb (1) to Dmb of A (k) (k = 1 to N)
(N) is detected. Similar to the displacement sensor 91, the displacement sensor 93 is offset from the virtual teaching point MP (k) (k = 1 to N) to the lower plate 63b side by the distance between the contact 73 and the contact 72, and the point HC (k) (k). = 1 to N) displacement amount Dmc
(1) to Dmc (N) are detected. These displacement amounts are stored in the memory 24 in the personal computer 39. In addition, at this time, the robot 10 uses the virtual teaching point M described above.
Point HB (k) at the same position as P (k) (k = 1 to N)
The position coordinates of (k = 1 to N) are stored in the memory 32.
【００１９】以下、図６，図７に示すフローチャートに
より、実際に加工を行う目的工作物５０の目的教示点Ｍ
Ｓ（１）〜ＭＳ（Ｎ）の算出方法および研削回数の設定
方法について説明する。ステップ１００では、図５
（ｅ）に示すように基準工作物６３の時と同様に接触子
７１，７２，７３を目的工作物５０上を移動させ、上板
５０ａ、下板５０ｂおよび基準工作物６３上の接合部６
３ｃに対応するビード部５１の変位量を記憶する。即
ち、ロボット１０はメモリ３２に記憶された点ＨＢ
（ｋ）（ｋ＝１〜Ｎ）を参照して接触子７１，７２，７
３を目的工作物５０上に移動させる。この時、変位セン
サ９１，９２，９３からはそれぞれＮ個の変位データＤ
a1（１）〜Ｄa1（Ｎ），Ｄb1（１）〜Ｄb1（Ｎ），Ｄc1
（１）〜Ｄc1（Ｎ）が検出され、ロボット１０はこれら
の値をパーソナルコンピュータ３９中のメモリ２４に記
憶する。The target teaching point M of the target workpiece 50 to be actually machined will be described below with reference to the flowcharts shown in FIGS.
A method of calculating S (1) to MS (N) and a method of setting the number of grindings will be described. In step 100, FIG.
As shown in (e), as in the case of the reference workpiece 63, the contacts 71, 72, 73 are moved on the target workpiece 50 to join the upper plate 50a, the lower plate 50b and the joint 6 on the reference workpiece 63.
The displacement amount of the bead portion 51 corresponding to 3c is stored. That is, the robot 10 has the point HB stored in the memory 32.
(K) (k = 1 to N) with reference to the contacts 71, 72, 7
3 is moved onto the target workpiece 50. At this time, the displacement sensors 91, 92, 93 output N displacement data D respectively.
a1 (1) to Da1 (N), Db1 (1) to Db1 (N), Dc1
(1) to Dc1 (N) are detected, and the robot 10 stores these values in the memory 24 in the personal computer 39.
【００２０】ステップ１０２では、ステップ１００にお
いて記憶した変位データＤa1（ｋ）と前述した前処理過
程において記憶した基準工作物６３の変位データＤｍａ
（ｋ）より目的工作物５０と基準工作物６３の誤差、即
ち仮想教示点ＭＰの補正量Ｓａ（ｋ）（ｋ＝１〜Ｎ）を
以下のようにして求める。 Ｓａ（ｋ）＝Ｄｍａ（ｋ）−Ｄa1（ｋ） ステップ１０４では、目的工作物５０の上板５０ａが下
板５０ｂよりも上側に板合わせされているか、または上
板５０ａが下板５０ｂよりも下側に板合わせされている
かを判断する。即ち、ステップ１０２と同様に変位デー
タＤc1と基準工作物６３の変位データＤｍｃより目的工
作物５０の下板５０ｂと基準工作物６３の下板６３ｂの
位置誤差Ｓｃ（ｋ）（ｋ＝１〜Ｎ）を以下のようにして
求める。In step 102, the displacement data Da1 (k) stored in step 100 and the displacement data Dma of the reference workpiece 63 stored in the above-mentioned pre-processing process.
The error between the target workpiece 50 and the reference workpiece 63, that is, the correction amount Sa (k) (k = 1 to N) of the virtual teaching point MP is obtained from (k) as follows. Sa (k) = Dma (k) −Da1 (k) In step 104, the upper plate 50a of the target workpiece 50 is plate-aligned above the lower plate 50b, or the upper plate 50a is lower than the lower plate 50b. Determine if the bottom side is fitted. That is, similar to step 102, the positional error Sc (k) (k = 1 to N) between the lower plate 50b of the target workpiece 50 and the lower plate 63b of the reference workpiece 63 is calculated from the displacement data Dc1 and the displacement data Dmc of the reference workpiece 63. ) Is calculated as follows.
【００２１】Ｓｃ（ｋ）＝Ｄｍｃ（ｋ）−Ｄc1（ｋ） 上式において、工具２７が基準工作物６３または目的工
作物５０に接近するほど変位センサ９３が値がプラス方
向に変化すると仮定すると、Ｓｃ（ｉ）≦０ならば上板
５０ａが下板５０ｂよりも上側に板合わせされているこ
とを示し、Ｓｃ（ｉ）＞０ならば上板５０ａが下板５０
ｂよりも下側に板合わせされていることを示している。Sc (k) = Dmc (k) -Dc1 (k) In the above equation, it is assumed that the value of the displacement sensor 93 changes in the positive direction as the tool 27 approaches the reference workpiece 63 or the target workpiece 50. , Sc (i) ≦ 0 indicates that the upper plate 50a is aligned above the lower plate 50b, and if Sc (i)> 0, the upper plate 50a is lower plate 50a.
It is shown that the plate is aligned below b.
【００２２】ステップ１０６では、ステップ１０４で上
板５０ａが下板５０ｂよりも下側に板合わせされている
と判断された位置の補正量Ｓａに修正を加える。これは
ロボット１０が加工を行う時、上板５０ａを基準として
加工するためである。従って、下式に示すようにＳｃ
（ｉ）＞０ （１≦ｉ≦Ｎ）となる位置の基準教示点Ｍ
Ｔ（ｉ）の補正量Ｓａ（ｉ）にＳｃ（ｉ）の値を加え、
この位置においては下板５０ｂを基準として加工を行う
ようにする。In step 106, the correction amount Sa at the position where it is determined in step 104 that the upper plate 50a is positioned below the lower plate 50b is corrected. This is because when the robot 10 performs processing, the upper plate 50a is used as a reference for processing. Therefore, as shown in the following equation, Sc
(I)> 0 (1 ≦ i ≦ N) at the reference teaching point M
The value of Sc (i) is added to the correction amount Sa (i) of T (i),
At this position, the lower plate 50b is used as a reference for processing.
【００２３】Ｓａ（ｉ）＝Ｓａ（ｉ）＋Ｓｃ（ｉ） ステップ１０８では、基準教示点ＭＴ（ｋ）（ｋ＝１〜
Ｎ）に対応したビード部５１の位置のビード体積を次の
ようにして求める。即ち、まず最初にステップ１０４に
おいて上板５０ａが下板５０ｂよりも上側に板合わせさ
れていると判断された場合は、ステップ１００において
記憶した変位データＤb1と前述した前処理過程において
記憶した基準工作物６３の変位データＤｍｂよりビード
部５１の高さＨb1（ｋ）（ｋ＝１〜Ｎ）を下式のように
して求める。Sa (i) = Sa (i) + Sc (i) In step 108, the reference teaching point MT (k) (k = 1 to 1)
The bead volume at the position of the bead portion 51 corresponding to N) is obtained as follows. That is, first, when it is determined in step 104 that the upper plate 50a is plate-aligned above the lower plate 50b, the displacement data Db1 stored in step 100 and the reference work stored in the above-described preprocessing process are stored. The height Hb1 (k) (k = 1 to N) of the bead portion 51 is obtained from the displacement data Dmb of the object 63 by the following equation.
【００２４】Ｈb1（ｋ）＝Ｄｍｂ（ｋ）−Ｄb1（ｋ） また、ステップ１０４において基準教示点ＭＴ（ｉ）の
位置の上板５０ａが下板５０ｂよりも下側に板合わせさ
れていると判断された場合は、ステップ１０４で求めた
目的工作物５０の下板５０ｂと基準工作物６３の下板６
３ｂの位置誤差Ｓｃを考慮してビード部５１の高さＨb1
（ｉ）（１≦ｉ≦Ｎ）を下式のようにして求める。Hb1 (k) = Dmb (k) -Db1 (k) In step 104, the upper plate 50a at the reference teaching point MT (i) is aligned below the lower plate 50b. If determined, the lower plate 50b of the target workpiece 50 and the lower plate 6 of the reference workpiece 63 obtained in step 104
The height Hb1 of the bead portion 51 in consideration of the position error Sc of 3b
(I) (1 ≦ i ≦ N) is calculated by the following equation.
【００２５】Ｈb1（ｉ）＝Ｄｍｂ（ｉ）−Ｄb1（ｉ）−
Ｓｃ（ｉ） このようにして求めたビード部５１の高さＨb1（ｋ）よ
り各基準教示点ＭＴ（ｋ）に対応したビード部５１の断
面積ＳＨb1（ｋ）（ｋ＝１〜Ｎ）を経験的に下式で近似
する（ｒは定数）。 ＳＨb1（ｋ）＝ｒ×Ｈb1（ｋ）2 上式より求めた各基準教示点ＭＴ（ｋ）のビード部５１
の断面積ＳＨb1（ｋ）を総和し、平均を求めることによ
りビード部５１の平均断面積ＳＨbm1が決定される。Hb1 (i) = Dmb (i) -Db1 (i)-
Sc (i) From the height Hb1 (k) of the bead portion 51 thus obtained, the cross-sectional area SHb1 (k) (k = 1 to N) of the bead portion 51 corresponding to each reference teaching point MT (k) is calculated. Empirically, the following formula is used (r is a constant). SHb1 (k) = r × Hb1 (k) 2 Bead portion 51 of each reference teaching point MT (k) obtained from the above equation
The average cross-sectional area SHbm1 of the bead portion 51 is determined by summing the cross-sectional areas SHb1 (k) of the above and obtaining the average.
【００２６】ステップ１１０では、必要研削回数Ｊ１を
求める。必要研削回数はビード部５１を研削加工するた
めに工具２７を加工軌跡に従って走らせる回数である。
必要研削回数Ｊ１は、ステップ１０８にて求めたビード
部５１の平均断面積ＳＨbm1〔mm2 〕と工具２７に使用
する回転砥石の種類によって経験的に設定された砥石研
削能力値δ１〔mm2/PASS〕により下式のように求められ
る。At step 110, the required number of times of grinding J1 is obtained. The required number of times of grinding is the number of times the tool 27 is run in accordance with the processing locus for grinding the bead portion 51.
It requires grinding times J1 has an average cross-sectional area SHbm1 [mm 2] and empirically set grinding wheel grinding capacity depending on the type of grinding wheel used in the tool 27 value δ1 of the bead portion 51 obtained in step 108 [mm 2 / It is calculated by the following formula by PASS].
【００２７】Ｊ１＝ＳＨbm1 ／δ１ 〔PASS〕 以上のステップ１０２からステップ１１０までの演算過
程は全てパーソナルコンピータ３９内で行われる。ステ
ップ１１２では、これらの演算過程で求まった値の内、
基準教示点ＭＴ（ｋ）の補正量Ｓａ（ｋ）および必要研
削回数Ｊ１をロボットコントーラ３５に転送し、ロボッ
トコントーラ３５では転送された必要研削回数がＪ１＝
０であるかを判断し、Ｊ１＝０ならばビード部５１のロ
ウ付加工状態に不具合があるとしてステップ１１４に移
行して加工を開始しないよう処理を終了する。J1 = SHbm1 / δ1 [PASS] All the above-described calculation processes from step 102 to step 110 are performed in the personal computer 39. In step 112, among the values obtained in these calculation processes,
The correction amount Sa (k) of the reference teaching point MT (k) and the required grinding count J1 are transferred to the robot controller 35, and the robot controller 35 transfers the transferred necessary grinding count J1 =
If J1 = 0, it is determined that there is a problem with the brazing processing state of the bead portion 51, and the process proceeds to step 114 to end the processing so as not to start the processing.
【００２８】ステップ１１２においてＪ１≠０と判断さ
れた場合は、ステップ１１５に移行して基準教示点ＭＴ
（ｋ）と補正量Ｓａ（ｋ）より目的加工物５０に適する
ように基準教示点ＭＴ（ｋ）を補正し、目的教示点ＭＭ
（ｋ）（ｋ＝１〜Ｎ）を求める。この目的教示点ＭＭ
（ｋ）を求める方法は、工具２７を目的加工物５０に接
近させる方向に基準教示点ＭＴ（ｋ）を補正量Ｓａ
（ｋ）だけシフトさせればよい。即ち、工具２７を目的
加工物５０に接近させる方向を示すアプローチベクトル
Ａv をＡv ＝（ａ，ｂ，ｃ）（ただし、ａ2 ＋ｂ2 ＋ｃ
2 ＝１）とすると、目的教示点ＭＭ（ｉ）＝（Ｘmmi,Ｙ
mmi,Ｚmmi ）は基準教示点ＭＴ（ｉ）＝（Ｘmti,Ｙmti,
Ｚmti ）と補正量Ｓａ（ｉ）より以下のように表され
る。When J1 ≠ 0 is determined in step 112, the process proceeds to step 115 and the reference teaching point MT is set.
Based on (k) and the correction amount Sa (k), the reference teaching point MT (k) is corrected to suit the target workpiece 50, and the target teaching point MM is corrected.
(K) (k = 1 to N) is calculated. This target teaching point MM
The method of obtaining (k) is performed by correcting the reference teaching point MT (k) in the direction in which the tool 27 approaches the target workpiece 50.
It is sufficient to shift by (k). That is, the approach vector A v indicating the direction in which the tool 27 approaches the target workpiece 50 is A v = (a, b, c) (where a 2 + b 2 + c
2 = 1), the target teaching point MM (i) = (Xmmi, Y
mmi, Zmmi) is the reference teaching point MT (i) = (Xmti, Ymti,
Zmti) and the correction amount Sa (i) are expressed as follows.
【００２９】ＭＭ（ｉ）＝（Ｘmmi,Ｙmmi,Ｚmmi ） ＝（Ｘmti ＋Ｓａ（ｉ）×ａ， Ｙmti ＋Ｓａ（ｉ）×ｂ， Ｚmti ＋Ｓａ（ｉ）×ｃ） ステップ１１６では、ステップ１１５において算出した
目的教示点ＭＭに従って目的加工物５０の加工を実行す
る。この時、ロボット１０は必要研削回数Ｊ１の値だけ
工具２７を加工軌跡上に走らせてビード部５１の除去加
工を行う。MM (i) = (Xmmi, Ymmi, Zmmi) = (Xmti + Sa (i) × a, Ymti + Sa (i) × b, Zmti + Sa (i) × c) In step 116, the value calculated in step 115 The target workpiece 50 is processed according to the target teaching point MM. At this time, the robot 10 removes the bead portion 51 by moving the tool 27 on the machining locus by the value of the required number of times of grinding J1.
【００３０】以上、ステップ１００からステップ１１６
までの過程により１サイクル目の加工を終了する。以下
に示す過程は、この１サイクル目の加工によっ残ったビ
ード部５１を除去する２サイクル目の過程である。ステ
ップ１１８では、ステップ１００と同様に接触子７１，
７２，７３を目的工作物５０上を移動させる。この時記
憶される変位量はビード部５１の変位量、即ち変位セン
サ９２から検出される変位データＤb2（１）〜Ｄb2
（Ｎ）のみである。As described above, from step 100 to step 116
The processing of the first cycle is completed by the above process. The process described below is the process of the second cycle in which the bead portion 51 remaining after the machining of the first cycle is removed. In step 118, the contacts 71,
72 and 73 are moved on the target workpiece 50. The displacement amount stored at this time is the displacement amount of the bead portion 51, that is, the displacement data Db2 (1) to Db2 detected by the displacement sensor 92.
(N) only.
【００３１】ステップ１２０では、ステップ１１８で求
めた変位データＤb2（１）〜Ｄb2（Ｎ）を使用してビー
ド部５１の高さＨb2を求める。即ちステップ１０８と同
様に上板５０ａが下板５０ｂよりも上側に板合わせされ
ていると判断された場合は、 Ｈb2（ｉ）＝Ｄｍｂ（ｉ）−Ｄb2（ｉ） 上板５０ａが下板５０ｂよりも下側に板合わせされてい
ると判断された場合は、ステップ１０４で求めた位置誤
差Ｓｃ（ｉ）を用いて Ｈb2（ｉ）＝Ｄｍｂ（ｉ）−Ｄb2（ｉ）−Ｓｃ（ｉ） よりビード部５１の高さＨb2を求める。At step 120, the height Hb2 of the bead portion 51 is obtained using the displacement data Db2 (1) to Db2 (N) obtained at step 118. That is, if it is determined that the upper plate 50a is aligned above the lower plate 50b as in step 108, Hb2 (i) = Dmb (i) -Db2 (i) upper plate 50a is lower plate 50b. When it is determined that the plate is aligned lower than Hb2 (i) = Dmb (i) -Db2 (i) -Sc (i), the position error Sc (i) obtained in step 104 is used. Then, the height Hb2 of the bead portion 51 is obtained.
【００３２】ステップ１２２では、ステップ１２０で求
めたビード部５１の高さＨb2（ｋ）よりビード部５１の
断面積ＳＨb2（ｋ）（ｋ＝１〜Ｎ）を求めることによ
り、現在の砥石研削能力値δ２を求める。即ち、ビード
部５１の断面積ＳＨb2（ｋ）はステップ１０８と同様に
下式より算出される。 ＳＨb2（ｋ）＝ｒ×Ｈb2（ｋ）2 次にこのＳＨb2（ｋ）とステップ１０８にて求めたＳＨ
b1（ｋ）との差ＳＨb1（ｋ）−ＳＨb2（ｋ）を算出し、
これらＮ個の断面積の差から１サイクル目の加工で除去
された平均面積ＳＨbm2 を求める。この平均面積ＳＨbm
2 を下式のように１サイクル目の必要研削回数Ｊ１で除
算することにより２サイクル目の砥石研削能力値δ２を
求める。In step 122, the present grinding wheel grinding ability is obtained by obtaining the cross-sectional area SHb2 (k) (k = 1 to N) of the bead portion 51 from the height Hb2 (k) of the bead portion 51 obtained in step 120. Determine the value δ2. That is, the cross-sectional area SHb2 (k) of the bead portion 51 is calculated by the following equation as in step 108. SHb2 (k) = r × Hb2 (k) 2 Next, this SHb2 (k) and the SH obtained in step 108
The difference from b1 (k) SHb1 (k) -SHb2 (k) is calculated,
The average area SHbm2 removed by the machining in the first cycle is calculated from the difference between these N cross-sectional areas. This average area SHbm
2 is divided by the required number of times of grinding J1 in the first cycle as in the following formula to obtain the grinding wheel grinding ability value δ2 in the second cycle.
【００３３】δ２＝ＳＨbm2 ／Ｊ１ ステップ１２４では、２サイクル目の必要研削回数Ｊ２
を求める。このためには、まずステップ１２０にて求め
たＮ個のビード部５１の高さＨb2（ｋ）（ｋ＝１〜Ｎ）
が設定値の範囲内に有るか否かを判断する（例えば０≦
Ｈb2（ｋ）≦０．１〔mm〕）。この設定値の範囲内にＨ
b2（ｉ）（１≦ｉ≦Ｎ）の値が有る場合は、Ｈb2（ｉ）
に対応した目的教示点ＭＭ（ｉ）では加工が完了してい
るものと判断し、設定値の範囲内にＨb2（ｋ）の値が無
い場合は、対応した目的教示点ＭＭ（ｋ）では加工が完
了していないものと判断する。この加工が完了していな
いものと判断されたものの中から最も値の大きいものを
選び出し、これをＨb2(max) とする。この値よりビード
部５１の残りの部分の最大断面積ＳＳmax を経験的に下
式で近似する（ｓは定数）。Δ2 = SHbm2 / J1 In step 124, the required number of grindings J2 in the second cycle is J2.
Ask for. To this end, first, the height Hb2 (k) of the N bead portions 51 obtained in step 120 (k = 1 to N)
Is within the set value range (for example, 0 ≦
Hb2 (k) ≦ 0.1 [mm]). H within the range of this set value
If there is a value of b2 (i) (1 ≦ i ≦ N), then Hb2 (i)
When it is determined that the machining is completed at the target teaching point MM (i) corresponding to, and there is no value of Hb2 (k) within the set value range, the machining is performed at the corresponding target teaching point MM (k). Judge that it has not been completed. The one having the largest value is selected from those judged to have not been processed, and this is designated as Hb2 (max). From this value, the maximum cross-sectional area SSmax of the remaining portion of the bead portion 51 is empirically approximated by the following equation (s is a constant).
【００３４】ＳＳmax ＝ｓ×Ｈb2(max) このようにして算出したＳＳmax より２サイクル目の必
要研削回数Ｊ２を下式より求める。 Ｊ２＝ＳＳmax ／δ２ ステップ１２６では、ステップ１２４にて加工が完了し
たと判断された目的教示点ＭＭ（ｋ）は、２サイクル目
で加工を行う必要がないため、工具２７が目的工作物５
０から遠ざかるように１サイクル目のステップ１０２，
１０６で算出された基準教示点ＭＴ（ｉ）の補正量Ｓａ
（ｉ）に経験値ｕを加算してＳａ（ｉ）＝Ｓａ（ｉ）＋
ｕとして、２サイクル目の加工時には加工が完了したと
判断された目的教示点ＭＭ（ｉ）に対しては加工を行わ
ないようにする。また、加工が完了していないと判断さ
れた目的教示点ＭＭ（ｉ）に対しては１サイクル目の補
正量Ｓａ（ｉ）をそのまま２サイクル目でも用いる。SSmax = s × Hb2 (max) From SSmax thus calculated, the required number of grindings J2 in the second cycle is obtained from the following formula. J2 = SSmax / δ2 In step 126, since the target teaching point MM (k) determined to have been machined in step 124 does not need to be machined in the second cycle, the tool 27 sets the target workpiece 5
Step 102 of the first cycle to move away from 0,
Correction amount Sa of the reference teaching point MT (i) calculated in 106
The experience value u is added to (i) and Sa (i) = Sa (i) +
As u, the processing is not performed on the target teaching point MM (i) determined to be completed during the processing in the second cycle. Further, for the target teaching point MM (i) determined to have not been processed, the correction amount Sa (i) in the first cycle is used as it is in the second cycle.
【００３５】ステップ１２８では、これら２サイクル目
の演算過程で求まった値の内、基準教示点ＭＴ（ｋ）の
補正量Ｓａ（ｋ）および必要研削回数Ｊ２をロボットコ
ントーラ３５に転送し、ロボットコントーラ３５では転
送された必要研削回数がＪ２＝０であるかを判断するこ
とによりビード部５１の加工が完了しているかを再確認
する。Ｊ２＝０ならばビード部５１の加工が完了してい
るとしてステップ１３０に移行して加工を終了する。In step 128, the correction amount Sa (k) of the reference teaching point MT (k) and the required number of grindings J2 are transferred to the robot controller 35 from the values obtained in the calculation process of the second cycle, and the robot controller 35 is transferred. At 35, it is reconfirmed whether the processing of the bead portion 51 is completed by determining whether the transferred required number of grindings is J2 = 0. If J2 = 0, it is determined that the machining of the bead portion 51 is completed, and the process proceeds to step 130 and the machining is finished.
【００３６】また、Ｊ２≠０と判断された場合は、ステ
ップ１３２に移行して上述したステップ１１５と同様の
計算方法により基準教示点ＭＴ（ｋ）、補正量Ｓａ
（ｋ）およびアプローチベクトルＡV から目的加工物５
０に適するように基準教示点ＭＴ（ｋ）を補正し、目的
教示点ＭＭ（ｋ）（ｋ＝１〜Ｎ）を求める。ステップ１
３４では、ステップ１３２において算出した目的教示点
ＭＭに従って目的工作物５０の加工を実行する。この
時、ロボット１０は必要研削回数Ｊ２の値だけ工具２７
を加工軌跡上に走らせてビード部５１の除去加工を行
う。以上の２サイクル目の加工が終了した後は、ステッ
プ１３０に移行して全ての作業を終了する。If J2 ≠ 0 is determined, the process proceeds to step 132 and the reference teaching point MT (k) and the correction amount Sa are calculated by the same calculation method as in step 115 described above.
Target workpiece 5 from (k) and approach vector A V
The target teaching point MM (k) (k = 1 to N) is calculated by correcting the reference teaching point MT (k) so as to be suitable for 0. Step 1
At 34, the target workpiece 50 is machined according to the target teaching point MM calculated at step 132. At this time, the robot 10 moves the tool 27 by the value of the required number of grindings J2.
Is run on the processing locus to remove the bead portion 51. After the processing of the second cycle is completed, the process proceeds to step 130 and all the operations are completed.
【００３７】以上説明したように本実施例のロボット制
御装置は、目的工作物５０の上板５０ａと下板５０ｂの
板合わせ状態を検出するとともに、ビード部５１の盛り
付け量に応じた必要研削回数を設定して加工を行うため
に、目的工作物５０毎に変化する上板５０ａと下板５０
ｂの板合わせ状態、設置位置のずれ、ビード部５１の盛
り付け量のばらつき、目的工作物５０の形状の誤差等に
影響されることなくビード部５１の研磨加工を行うこと
ができる。As described above, the robot controller of the present embodiment detects the plate alignment state of the upper plate 50a and the lower plate 50b of the target workpiece 50, and the required number of grindings depending on the amount of the bead portion 51 to be mounted. The upper plate 50a and the lower plate 50 that change for each target workpiece 50 in order to set the
The bead portion 51 can be polished without being affected by the plate alignment state of b, the deviation of the installation position, the variation in the amount of the bead portion 51, the shape error of the target workpiece 50, and the like.
【００３８】なお上述した実施例では、加工サイクルを
２つに分割して行っているが加工サイクルの数はこの２
回に限られたものではない。また、本実施例では接触子
７１，７２，７３とこれらの接触子の変位量を検出する
変位センサ９１，９２，９３を用いて目的工作物５０の
上板５０ａと下板５０ｂの板合わせ状態を検出する構成
としているが、図８に示すようにレーザスキャン方式等
の変位センサ９４を上板５０ａから下板５０ｂへとビー
ド部５１を横切る形で走査することにより上板５０ａと
下板５０ｂの高さの違いを検出する構成としても良い。In the embodiment described above, the machining cycle is divided into two, but the number of machining cycles is two.
It is not limited to times. Further, in this embodiment, the contact plates 71, 72, 73 and the displacement sensors 91, 92, 93 for detecting the displacement amounts of these contact members are used to align the upper plate 50a and the lower plate 50b of the target workpiece 50 with each other. However, as shown in FIG. 8, a displacement sensor 94 such as a laser scanning system scans from the upper plate 50a to the lower plate 50b across the bead portion 51 to scan the upper plate 50a and the lower plate 50b. It may be configured to detect a difference in height of the.
【００３９】[0039]
【発明の効果】以上述べたように本発明は、目的工作物
の上板と下板の板合わせ状態を検出して、上側に板合わ
せされている板の高さを基準として加工を行うようにし
たために、目的工作物を傷つけることなく良好な加工を
行うことができる。As described above, according to the present invention, it is possible to detect the plate alignment state of the upper plate and the lower plate of the target workpiece, and perform the machining with reference to the height of the plate that is aligned on the upper side. As a result, good processing can be performed without damaging the target workpiece.
【図１】本発明のクレーム対応図である。FIG. 1 is a diagram corresponding to a claim of the present invention.
【図２】本実施例のロボットの全体構成図である。FIG. 2 is an overall configuration diagram of a robot of this embodiment.
【図３】本実施例の作業操作装置を示す図である。FIG. 3 is a diagram showing a work operating device of the present embodiment.
【図４】本実施例の制御装置の構成図である。FIG. 4 is a configuration diagram of a control device of the present embodiment.
【図５】本実施例の作用を説明するための図である。FIG. 5 is a diagram for explaining the operation of the present embodiment.
【図６】本実施例の作用を説明するためのフローチャー
トである。FIG. 6 is a flow chart for explaining the operation of this embodiment.
【図７】本実施例の作用を説明するためのフローチャー
トである。FIG. 7 is a flow chart for explaining the operation of the present embodiment.
【図８】本実施例の応用変形例を説明するための図であ
る。FIG. 8 is a diagram for explaining an application modification example of the present embodiment.
【図９】従来技術を説明するための図である。FIG. 9 is a diagram for explaining a conventional technique.
１，９１，９２，９３ 変位センサ ２ 基準教示点記憶手段 ３ 基準位置測定手段 ４ 目的位置測定手段 ５ 板合わせ状態判断手段 ６ 教示点補正手段 ７ 加工実行手段 １０ ロボット ２７ 工具 ５０ 目的工作物 ６３ 基準工作物 ７１，７２，７３ 接触子 ＭＴ 基準教示点 1, 91, 92, 93 Displacement sensor 2 Reference teaching point storage means 3 Reference position measuring means 4 Target position measuring means 5 Plate alignment state determining means 6 Teaching point correcting means 7 Machining executing means 10 Robot 27 Tool 50 Target workpiece 63 Reference Work piece 71, 72, 73 Contact MT Reference teaching point
───────────────────────────────────────────────────── フロントページの続き (51)Int.Cl.5 識別記号 庁内整理番号 ＦＩ 技術表示箇所 Ｂ２５Ｊ 13/08 Ａ 9147−3Ｆ Ｇ０５Ｂ 19/18 Ｈ 9064−3Ｈ (72)発明者 本多 里志 愛知県豊田市トヨタ町１番地 トヨタ自動 車株式会社内─────────────────────────────────────────────────── ─── Continuation of the front page (51) Int.Cl. 5 Identification code Office reference number FI technical display location B25J 13/08 A 9147-3F G05B 19/18 H 9064-3H (72) Inventor Satoshi Honda 1 Toyota Town, Toyota City, Aichi Prefecture Toyota Motor Corporation
Claims (1)
れる加工軌跡に従ってロボットの手首部の先端に取り付
けられた工具を制御して２つの部材からなる工作物の接
合部のバリ取り加工を行うロボット制御装置において、
基準工作物および目的工作物のそれぞれを構成する２つ
の部材の接合部の上下関係を検出する変位センサと、前
記基準工作物上に設定された基準教示点を記憶する基準
教示点記憶手段と、前記変位センサにより前記基準工作
物を形成する２つの部材の位置を測定する基準位置測定
手段と、この基準位置測定手段における前記基準工作物
の測定位置に対応した前記目的工作物上の位置を前記変
位センサにより測定しこの目的工作物を形成する２つの
部材の位置を測定する目的位置測定手段と、前記基準位
置測定手段と前記目的位置測定手段から得た値を比較す
ることによって前記目的工作物を形成する２つの部材の
板合わせ状態を判断する板合わせ状態判断手段と、この
板合わせ状態判断手段によって判断された板合わせ状態
に従って前記基準教示点記憶手段によって記憶された基
準教示点を補正する教示点補正手段と、この教示点補正
手段によって得た教示点に従って前記目的工作物の加工
を実行する加工実行手段とを備えたことを特徴とするロ
ボット制御装置。Claim: What is claimed is: 1. A tool attached to the tip of a wrist of a robot is controlled according to a machining locus formed from pre-stored teaching points to control the joint of a workpiece made of two members. In a robot controller that performs deburring,
A displacement sensor for detecting the vertical relationship of the joints of two members constituting each of the reference workpiece and the target workpiece; reference teaching point storage means for storing the reference teaching point set on the reference workpiece; The reference position measuring means for measuring the positions of the two members forming the reference workpiece by the displacement sensor, and the position on the target workpiece corresponding to the measurement position of the reference workpiece in the reference position measuring means are described above. The target workpiece by comparing the values obtained from the reference position measuring means and the target position measuring means with the target position measuring means for measuring the positions of two members forming the target workpiece by the displacement sensor. The plate matching state judging means for judging the plate matching state of the two members forming the base, and the reference according to the plate matching state judged by the plate matching state judging means. The teaching point correction means for correcting the reference teaching point stored by the point storage means, and the machining execution means for machining the target workpiece according to the teaching point obtained by the teaching point correction means are provided. Robot control device.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP01643691A JP3171450B2 (en) | 1991-02-07 | 1991-02-07 | Robot controller |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP01643691A JP3171450B2 (en) | 1991-02-07 | 1991-02-07 | Robot controller |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH054183A true JPH054183A (en) | 1993-01-14 |
| JP3171450B2 JP3171450B2 (en) | 2001-05-28 |
Family
ID=11916186
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP01643691A Expired - Fee Related JP3171450B2 (en) | 1991-02-07 | 1991-02-07 | Robot controller |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3171450B2 (en) |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108161633A (en) * | 2018-03-14 | 2018-06-15 | 天津智通信息***集成有限公司 | A kind of high ferro side wall weld seam milling combination unit |
| JP2020131375A (en) * | 2019-02-21 | 2020-08-31 | 新明工業株式会社 | High accuracy processing system and high accuracy processing method |
| CN113370235A (en) * | 2021-07-07 | 2021-09-10 | 南京工程学院 | Automatic milling device for weld reinforcement, path generation method and using method |
| KR20230093134A (en) * | 2021-12-17 | 2023-06-27 | 주식회사 호원 | Apparatus for flattening of welding part and control method thereof |
-
1991
- 1991-02-07 JP JP01643691A patent/JP3171450B2/en not_active Expired - Fee Related
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108161633A (en) * | 2018-03-14 | 2018-06-15 | 天津智通信息***集成有限公司 | A kind of high ferro side wall weld seam milling combination unit |
| CN108161633B (en) * | 2018-03-14 | 2023-07-25 | 天津智通信息***集成有限公司 | High-speed railway side wall welding seam mills grinds composite set |
| JP2020131375A (en) * | 2019-02-21 | 2020-08-31 | 新明工業株式会社 | High accuracy processing system and high accuracy processing method |
| CN113370235A (en) * | 2021-07-07 | 2021-09-10 | 南京工程学院 | Automatic milling device for weld reinforcement, path generation method and using method |
| KR20230093134A (en) * | 2021-12-17 | 2023-06-27 | 주식회사 호원 | Apparatus for flattening of welding part and control method thereof |
Also Published As
| Publication number | Publication date |
|---|---|
| JP3171450B2 (en) | 2001-05-28 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US5711697A (en) | Robot control system | |
| JP4168123B2 (en) | Processing equipment | |
| JPH08505091A (en) | System and method for tracking features on an object using redundant axes | |
| US20150111471A1 (en) | Method and apparatus for smoothing welded member | |
| US4777769A (en) | System and method of automated grinding | |
| CN114769988A (en) | Welding control method and system, welding equipment and storage medium | |
| US4864777A (en) | Method of automated grinding | |
| JP3654586B2 (en) | Welded part finishing method and apparatus | |
| JPH054183A (en) | Robot control device | |
| JP2773917B2 (en) | Work positioning device for bending equipment | |
| JP3337448B2 (en) | Positioning method of spot welding gun | |
| EP0359822B1 (en) | Orbit controlling method of robot | |
| JP4264778B2 (en) | Working robot and teaching point position / posture data measuring method | |
| JPH06155036A (en) | Device for positioning welding gun of welding robot | |
| JP2552743B2 (en) | Robot controller | |
| JPH03256682A (en) | Robot control device | |
| JP3541151B2 (en) | Spot welding robot | |
| JPS60127987A (en) | Method and device for controlling profiling | |
| CN109986238B (en) | Robot linear flexible operation vision fuzzy profiling control method | |
| JP2001038660A (en) | Teaching end effector, and robot teaching method | |
| JP7035467B2 (en) | Processing equipment | |
| JP2000061778A (en) | Welded part finishing method and device | |
| JP3359011B2 (en) | Spot welding robot | |
| JPH0760641A (en) | Grinding robot and welding bead end point part grinding method | |
| JPH09267282A (en) | Work object position detector of multiarticulated robot |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| LAPS | Cancellation because of no payment of annual fees |