JPH1080768A - Control method for fillet multi-layer welding robot system - Google Patents

Control method for fillet multi-layer welding robot system

Info

Publication number
JPH1080768A
JPH1080768A JP25527496A JP25527496A JPH1080768A JP H1080768 A JPH1080768 A JP H1080768A JP 25527496 A JP25527496 A JP 25527496A JP 25527496 A JP25527496 A JP 25527496A JP H1080768 A JPH1080768 A JP H1080768A
Authority
JP
Japan
Prior art keywords
shift amount
fillet
robot
welding
control method
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP25527496A
Other languages
Japanese (ja)
Other versions
JP3483713B2 (en
Inventor
Akihiro Terada
彰弘 寺田
Mitsuhiro Okuda
満廣 奥田
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Fanuc Corp
Original Assignee
Fanuc Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Fanuc Corp filed Critical Fanuc Corp
Priority to JP25527496A priority Critical patent/JP3483713B2/en
Publication of JPH1080768A publication Critical patent/JPH1080768A/en
Application granted granted Critical
Publication of JP3483713B2 publication Critical patent/JP3483713B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Abstract

PROBLEM TO BE SOLVED: To move a robot while applying real time tracking and also changing aimed position in accordance with the thermal deformation of a work in a fillet multi-layer welding. SOLUTION: By using a laser beam sensor mounted to a robot and detecting work faces H1, H2 thermally deformed, its intersecting point (fillet position) Oob is obtained as a reference point of tracking. A reference object position Qob =Δ(Δx-Δy) set for work faces H1, H2 before thermal deforming is changed to Qob corresponding to a thermally deformed quantity. The position of Qob , by converting a reference position shift data (Δx, Δy) to the data on the oblique coordinate in which lines yob , xob showing the faces H1, H2 are taken for the coordinate, are obtained as remaining apexes of a parallelogram having three points Oob , Vob , Uob for apexes. Further, a point Qob (γ) or a point Qob , at which the point is slightly corrected based on an appropriate rule, may be set to be the object position in consideration of thermal deformation.

Description

【発明の詳細な説明】DETAILED DESCRIPTION OF THE INVENTION

【0001】[0001]

【発明の属する技術分野】本発明は、手先部にレーザセ
ンサとアーク溶接用のトーチを搭載したロボット(以
下、溶接ロボットあるいは単にロボットと言う。)とロ
ボット制御装置を備えたシステムを用いて隅肉溶接部の
多層盛り溶接を行なうための技術に関し、更に詳しく言
えば、レーザセンサを用いて多層盛時の継ぎ手の変形を
考慮に入れたトラッキング動作を溶接ロボットに行わせ
るための前記技術に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a robot equipped with a laser sensor and an arc welding torch at a hand (hereinafter referred to as a welding robot or simply a robot) and a system provided with a robot controller. More specifically, the present invention relates to a technique for causing a welding robot to perform a tracking operation in consideration of deformation of a joint at the time of multi-layer welding using a laser sensor using a laser sensor.

【0002】[0002]

【従来の技術】アーク溶接用のトーチとともにレーザセ
ンサをロボットに搭載し、溶接線を先行的にセンシング
して得られるデータを利用してロボットに溶接線のトラ
ッキングを行なわせる技術は、溶接ロボットのリアルタ
イムトラッキングとして広く知られている。また、リア
ルタイムトラッキング制御を多層盛り溶接を行なうロボ
ットに対して適用することも試みられている。
2. Description of the Related Art A technology in which a laser sensor is mounted on a robot together with a torch for arc welding, and the robot performs tracking of the welding line using data obtained by sensing the welding line in advance, is a technology of a welding robot. Widely known as real-time tracking. Attempts have also been made to apply real-time tracking control to a robot that performs multi-layer welding.

【0003】図1に模式的に例示したように、継ぎ手を
構成するワークW1,W2の隅肉部に対する多層盛り溶
接は、1回目、2回目、3回目・・・N回目(N;総ビ
ード層数)のロボット移動時に1層目、2層目、3層目
・・・N層目のビードA1,A2,A3・・・(3層目
まで描示)を順次重ねて形成するという順序で行なわれ
る。一般に、各ビード層形成時の狙い位置の軌跡は同じ
ではない。ここで、「狙い位置」とは、適正な溶接を行
なうために要求される溶接トーチ先端位置(通常は溶接
ロボットのツール先端点の位置と一致)のことである。
As schematically illustrated in FIG. 1, the first, second, third,..., N-th (N; total bead) (The number of layers), the first layer, the second layer, the third layer,..., The N-th layer of beads A1, A2, A3,. It is done in. Generally, the trajectory of the target position at the time of forming each bead layer is not the same. Here, the “target position” refers to the position of the tip of the welding torch required for performing appropriate welding (usually coincides with the position of the tip of the tool of the welding robot).

【0004】隅部に多層盛りを行なう場合、1層目の狙
い位置の軌跡B1〜B1’は隅肉線の位置にほぼ一致さ
せることが通例であるが、2層目以降については例えば
符号B2〜B2’,B3〜B3’で示したように、隅肉
線の位置から各ワークW1,W2の表面に沿ってほぼビ
ード厚さ相当分だけ離れた位置などが選ばれる。
In the case of performing multi-layer building at the corner, it is customary that the trajectories B1 to B1 'of the target position of the first layer substantially coincide with the position of the fillet line. As shown by B2 'and B3 to B3', a position is selected which is substantially apart from the position of the fillet line along the surface of each of the works W1 and W2 by a distance corresponding to the bead thickness.

【0005】1層目の狙い位置の軌跡B1〜B1’は、
レーザセンサを用いたリアルタイムトラッキングを溶接
ロボットの第1回目の移動サイクルについて適用するこ
とで比較的容易に実現出来る。これは1層目の溶接時に
は、レーザセンサは溶接ビード未形成の隅部をセンシン
グして隅部線位置(隅部の位置を代表する線。以下同
じ。)を検出すれば良いからである。これに対して、2
層目以降の溶接時には、隅部が先行形成された溶接ビー
ドで覆われているので、レーザセンサで隅部線位置を直
接検出することは不可能になる。
The trajectories B1 to B1 'of the target positions of the first layer are:
Applying real-time tracking using a laser sensor to the first movement cycle of the welding robot can be realized relatively easily. This is because at the time of welding the first layer, the laser sensor only has to sense the corner where no weld bead is formed and detect the corner line position (a line representing the position of the corner; the same applies hereinafter). In contrast, 2
At the time of welding after the layer, since the corner is covered with the weld bead formed in advance, it is impossible to directly detect the corner line position with the laser sensor.

【0006】そのため、隅部線位置をレーザセンサで直
接検出し、それに予め直交座標系上のシフト量として設
定されたシフト量Δ(一般には、Δx ,Δy の2成分を
持つベクトル量)を上乗せした位置をリアルタイムに決
定していくことで2層目以降の狙い位置の軌跡B2〜B
2’,B3〜B3’を実現するという方式は採用が困難
となっていた。
Therefore, the corner line position is directly detected by a laser sensor, and a shift amount Δ (generally, a vector amount having two components of Δx and Δy) previously set as a shift amount on a rectangular coordinate system is added thereto. The trajectories B2 to B of the target positions in the second and subsequent layers are determined in real time
It has been difficult to adopt the method of realizing 2 ′, B3 to B3 ′.

【0007】1層目のトラッキング時に隅部線位置のデ
ータを蓄積しておき、これを2層目以降の溶接時に利用
する手法もあるが、隅部線位置を正確に再現するには大
量のデータを記憶する必要があり、簡便なやり方とは言
えない。
There is a method of accumulating data of the corner line position during tracking of the first layer and using the data at the time of welding for the second and subsequent layers. However, a large amount of data is required to accurately reproduce the corner line position. Data must be stored, which is not a convenient method.

【0008】このような問題を解決し得る技術として、
レーザセンサを用いた隅部線位置を間接的に行なうこと
が提案されている(特開平8−16221号公報参
照)。この提案を上記の例に適用するとすれば、隅部線
位置を隅部を提供する両ワークW1,W2の面G1,G
2の交線位置として求め、それに予め直交座標系上のシ
フト量として設定されたシフト量Δ(Δx ,Δy )を上
乗せすることで狙い位置(ツール先端点の目標経路)が
決定されることになる。
As a technique that can solve such a problem,
It has been proposed to indirectly determine the corner line position using a laser sensor (see JP-A-8-16221). If this proposal were to be applied to the above example, the corner line positions would be changed to the surfaces G1, G2 of the workpieces W1, W2 providing the corners.
The target position (the target path of the tool tip point) is determined by adding the shift amount Δ (Δx, Δy) previously set as the shift amount on the orthogonal coordinate system to the obtained intersection line position. Become.

【0009】[0009]

【発明が解決しようとする課題】上記改良技術は、2層
目以降の溶接時にもレーザセンサを用いたリアルタイム
トラッキングの適用を容易にし、また、大量のデータを
記憶する必要もないという点で優れている。しかし、実
際にこれを図1に示したような隅部の多層盛り溶接に適
用すると、実際の溶接時の狙い位置に微妙なずれが生
じ、期待した溶接精度が得られないことが珍しくない。
The above-mentioned improved technique is excellent in that it makes it easy to apply real-time tracking using a laser sensor even when welding the second and subsequent layers, and that there is no need to store a large amount of data. ing. However, when this is actually applied to the multi-layer welding at the corners as shown in FIG. 1, it is not uncommon that the target position during actual welding is slightly shifted, and the expected welding accuracy cannot be obtained.

【0010】このような狙い位置のずれが生じる原因
は、アーク放電に伴って発生する熱の影響により、継ぎ
手を構成するワークW1,W2が変形を起すためである
と考えられる。図2は、図1に示した例についてこれを
説明する模式図である。同図に描かれているように、溶
接開始前に破線の位置にあったワークW1の面G1は、
多層盛り溶接の進行とともに内側に熱変形して傾斜する
性質がある(G1→H1で表示)。なお、図示は省略し
たが、ワークW2の水平面G2にも熱変形は生じ得る。
一般に、いずれのワーク面に変形が起るかはワークW
1,W2の厚さ、材質、加熱具合い等に左右され、ケー
ズ・バイ・ケースである。
[0010] It is considered that the cause of such a shift of the target position is that the works W1 and W2 constituting the joint are deformed by the influence of heat generated by the arc discharge. FIG. 2 is a schematic diagram for explaining the example shown in FIG. As shown in the figure, the surface G1 of the workpiece W1, which was located at the position indicated by the broken line before the start of welding,
It has the property of being thermally deformed inward and inclined with the progress of multi-layer welding (indicated by G1 → H1). Although not shown, thermal deformation can also occur in the horizontal plane G2 of the work W2.
Generally, which work surface is deformed depends on the work W
It is a case-by-case, depending on the thickness, material, heating condition, etc. of 1, W2.

【0011】今、例として図1に例示した2層目の溶接
時の狙い位置B2について考察して見ると、従来の技術
(上記改良技術を含む)では、この狙い位置B2は溶接
開始前の位置G1を前提に、隅部線位置B1(レーザセ
ンサで検出)を基準とした位置シフト量Δ2 で設定して
いる。例えばG1とG2の方向を各々Y軸、X軸とする
座標系が設定されている場合、狙い位置B2を指定する
位置シフト量Δ2 はベクトル量Δ2 (0,d)で指定さ
れる。ここで、dは隅部線位置B1と狙い位置B2の間
の距離である。
Considering now a target position B2 at the time of welding the second layer illustrated in FIG. 1 as an example, according to the conventional technology (including the above-mentioned improved technology), the target position B2 is determined before the start of welding. Based on the position G1, the position shift amount Δ2 is set based on the corner line position B1 (detected by the laser sensor). For example, when a coordinate system is set in which the directions of G1 and G2 are the Y axis and the X axis, respectively, the position shift amount Δ2 for specifying the target position B2 is specified by the vector amount Δ2 (0, d). Here, d is the distance between the corner line position B1 and the target position B2.

【0012】なお、同様の指定方式で、N層の多層盛り
溶接についてi層目(i=1,2,3・・・N)の狙い
位置Biを定めた場合、下記(1)式で表わされる位置
シフト量Δi の各成分Δix,Δiyが予め設定される。図
2の例では、当然Δ2x=0,Δiy=dである。
When the target position Bi of the i-th layer (i = 1, 2, 3,... N) is determined for the N-layer multi-layer welding by the same designation method, the following equation (1) is used. The components Δix and Δiy of the position shift amount Δi to be shifted are set in advance. In the example of FIG. 2, naturally, Δ2x = 0 and Δiy = d.

【0013】 Δi =(Δix,Δiy) ・・・(1) さて、図示したような熱変形が生じた場合、本来実現さ
れるべき狙い位置(トーチ先端位置)は、B2ではなく
符号C2で示したような位置に移動する。ところが、上
記のような狙い位置の定め方では熱変形があっても狙い
位置はB2のままであり、位置C2をトーチ先端が通る
ようなロボット経路を実現することが出来ない。即ち、
従来技術には熱変形に応じて狙い位置を適切に変化させ
る技術手段が備わっていないため、熱変形が大きいケー
スや、狙い位置の狂いが溶接の品質に大きく影響するケ
ースにおいて、解決困難な問題となっていた。
Δi = (Δix, Δiy) (1) When the thermal deformation as shown in the drawing occurs, the target position (torch tip position) to be originally realized is indicated by reference numeral C2 instead of B2. Move to a position like that. However, in the above-described method of determining the target position, the target position remains at B2 even if there is thermal deformation, and a robot path such that the tip of the torch passes through position C2 cannot be realized. That is,
The conventional technology does not have the technical means to change the target position appropriately according to the thermal deformation, so it is difficult to solve the problem in cases where the thermal deformation is large or where the misalignment of the target position greatly affects the quality of welding. Had become.

【0014】そこで、本発明の目的は、2層目以降の隅
肉多層盛り溶接時にもレーザセンサを用いたリアルタイ
ムトラッキングの適用を可能にする一方で、継ぎ手を構
成するワークの熱変形に応じて狙い位置を変化させなが
らロボットの移動経路を定めていくための制御方法を提
供することにある。また、そのことを通して、隅肉多層
盛り溶接の品質を向上させようとするものである。
Therefore, an object of the present invention is to make it possible to apply real-time tracking using a laser sensor even in the case of multi-layer fillet welding of the second and subsequent fillets, while responding to the thermal deformation of the work constituting the joint. It is an object of the present invention to provide a control method for determining a moving path of a robot while changing a target position. In addition, through this, the quality of fillet fillet welding is improved.

【0015】[0015]

【課題を解決するための手段】本発明は、アーク溶接ト
ーチとレーザセンサを搭載したロボットをロボット制御
装置で制御するようにしたシステムの制御方法におい
て、ロボットの溶接実行時の経路移動について、トラッ
キング動作とワーク乃至ワーク面の熱変形を考慮した移
動経路のシフト調整を並行的に実行することによって、
上記技術課題を解決したものである。
SUMMARY OF THE INVENTION The present invention relates to a control method of a system in which a robot equipped with an arc welding torch and a laser sensor is controlled by a robot controller. By performing the movement and shift adjustment of the movement path in consideration of the thermal deformation of the work or the work surface in parallel,
This is a solution to the above technical problem.

【0016】トラッキング動作は隅部線の位置を基準に
して行なわれるが、そのための隅部線の位置検出は、隅
部を提供する2つのワーク面の位置をレーザセンサを用
いて検出し、それに基づいて隅部線の位置を求めること
によって達成される。
The tracking operation is performed with reference to the position of the corner line. To detect the position of the corner line, the positions of the two work surfaces providing the corners are detected by using a laser sensor, and the tracking operation is performed. This is achieved by determining the position of the corner line based on that.

【0017】その一方、2つのワーク面の位置の検出結
果は移動経路のシフト量をワーク面の熱変形に応じて制
御するために利用される。好ましい実施形態において
は、熱変形の無いワーク面に対する移動経路のシフト量
が基準シフト量として予めシステムに設定される。設定
された基準シフト調整量は、2つのワーク面の位置の検
出結果に基づいて新たなシフト調整量に変換され、ワー
ク面の熱変形に応じて移動経路のシフト量が制御され
る。
On the other hand, the detection results of the positions of the two work surfaces are used to control the shift amount of the movement path according to the thermal deformation of the work surface. In a preferred embodiment, the shift amount of the movement path with respect to the work surface without thermal deformation is set in the system in advance as the reference shift amount. The set reference shift adjustment amount is converted into a new shift adjustment amount based on the detection results of the positions of the two work surfaces, and the shift amount of the movement path is controlled according to the thermal deformation of the work surface.

【0018】典型的な実施形態において、基準シフト調
整量は2次元基準シフト調整量として設定され、2つの
ワーク面の位置の検出結果に基づいて新たな2次元シフ
ト量に変換される。これにより、ワーク面の熱変形に応
じて移動経路のシフト量を制御することが出来る。
In a typical embodiment, the reference shift adjustment amount is set as a two-dimensional reference shift adjustment amount, and is converted into a new two-dimensional shift amount based on the detection results of the positions of the two work surfaces. Thus, the shift amount of the moving path can be controlled according to the thermal deformation of the work surface.

【0019】1つの好ましい変換方式においては、2つ
のワーク面の位置を表わす2本の直線を座標軸として構
成される斜交座標系上で表現された値として読み換える
ことにより、新たな2次元シフト量への変換が行なわれ
る。また、読み換え後、更に検出された隅部線位置から
の距離調整を含む形で修正を行なっても良い。
In a preferred conversion method, two straight lines representing the positions of two work surfaces are read as values expressed on an oblique coordinate system constituted by coordinate axes, thereby obtaining a new two-dimensional shift. Conversion to quantity is performed. Further, after the replacement, the correction may be performed in a form including a distance adjustment from the detected corner line position.

【0020】本発明の上記構成により、2層目以降の隅
肉多層盛り溶接時にもレーザセンサを用いたリアルタイ
ムトラッキングを適用しつつ、継ぎ手を構成するワーク
の熱変形に応じて狙い位置を変化させながらロボットの
移動経路を定めていくことが出来る。従って、隅部多層
盛り溶接の進行に伴って熱変形が生じても、狙い位置の
狂いが回避される。
According to the above configuration of the present invention, the target position can be changed in accordance with the thermal deformation of the work constituting the joint while applying real-time tracking using a laser sensor also in the multi-layer fillet welding of the second and subsequent fillets. It is possible to determine the movement route of the robot while doing so. Therefore, even if thermal deformation occurs with the progress of the corner multilayer welding, deviation of the target position is avoided.

【0021】[0021]

【発明の実施の形態】図3は、本発明を実施する際に使
用可能なロボット制御装置を含むシステムの全体構成を
説明する要部ブロックである。同図に示されているよう
に、システム全体を制御するロボット制御装置30は、
中央演算処理装置(以下、CPU)31を有し、該CP
U31には、ROMからなるメモリ32、RAMからな
るメモリ33、不揮発性メモリ34、ロボット軸制御器
35、LCD37を備えた教示操作盤38及び外部装置
との接続のための汎用インターフェイス39がバス結合
されている。
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS FIG. 3 is a main block diagram for explaining the overall configuration of a system including a robot controller which can be used in carrying out the present invention. As shown in the figure, the robot control device 30 for controlling the entire system includes:
A central processing unit (hereinafter referred to as a CPU) 31;
The U31 includes a memory 32 composed of a ROM, a memory 33 composed of a RAM, a nonvolatile memory 34, a robot axis controller 35, a teaching operation panel 38 having an LCD 37, and a general-purpose interface 39 for connection to an external device. Have been.

【0022】ROM32にはロボット制御装置30自身
を含むシステム全体を制御するプログラムが格納され
る。これには、後述する態様で本発明を実施するための
諸データを画面入力するために必要なプログラムが含ま
れている。RAM33の一部はCPU31が行なう処理
のためのデータの一時記憶に使用される。また、本発明
を実施するために、RAM33には、後述するセンシン
グデータ、経路補正データなどを記憶するためのいくつ
かのバッファレジスタが設定される。不揮発性メモリ3
4内には、位置データや多層盛り時の経路シフト量を定
めるためのパラメータを格納するためのレジスタが設定
されている。
The ROM 32 stores a program for controlling the entire system including the robot controller 30 itself. This includes a program necessary for inputting various data for implementing the present invention on a screen in a mode described later. A part of the RAM 33 is used for temporarily storing data for processing performed by the CPU 31. Further, in order to implement the present invention, some buffer registers for storing sensing data, path correction data, and the like, which will be described later, are set in the RAM 33. Non-volatile memory 3
In 4, a register for storing position data and a parameter for determining the path shift amount at the time of multi-layering is set.

【0023】また、ロボット軸制御器35には、サーボ
回路36を介してロボット40の各軸機構部に設けられ
た各サーボモータが接続されている。そして、汎用イン
ターフェイス39に接続される外部装置には、ロボット
40の手先部に装着されたアーク溶接トーチ2のための
電源装置50と、リアルタイムトラッキングを行なうた
めのレーザセンサ3が含まれている。
Each servo motor provided in each axis mechanism of the robot 40 is connected to the robot axis controller 35 via a servo circuit 36. The external devices connected to the general-purpose interface 39 include a power supply device 50 for the arc welding torch 2 mounted on the tip of the robot 40 and the laser sensor 3 for performing real-time tracking.

【0024】レーザセンサの構造、機能、測定原理など
は周知であるが、図4、図5を参照して概略を説明して
おく。図4は本実施形態で使用されるレーザセンサの要
部構成を例示したもので、レーザセンサ3の本体部は、
投射部10と光検出部13からなる。投射部10は、レ
ーザ発振器11とビーム走査用の揺動ミラー(ガルバノ
メータ)12を備え、光検出部13は、結像用の光学系
14と受光素子15を備えている。
Although the structure, function, measurement principle, and the like of the laser sensor are well known, the outline will be described with reference to FIGS. FIG. 4 illustrates a main configuration of a laser sensor used in the present embodiment.
It comprises a projection unit 10 and a light detection unit 13. The projection unit 10 includes a laser oscillator 11 and an oscillating mirror (galvanometer) 12 for beam scanning, and the light detection unit 13 includes an optical system 14 for imaging and a light receiving element 15.

【0025】一方、レーザセンサ制御部20は、揺動ミ
ラー12を揺動させるミラー駆動部21、レーザ発振器
11を駆動しレーザビームを発生させるレーザ駆動部2
2、受光素子15における受光位置に基づいて対象物へ
のレーザビーム5の入射位置(反射点)Sを検出する信
号検出部23が接続されている。これらは回線24を介
してロボット制御装置30の汎用インターフェイス39
(図3参照)に接続されている。
On the other hand, the laser sensor control unit 20 includes a mirror driving unit 21 for oscillating the oscillating mirror 12, and a laser driving unit 2 for driving the laser oscillator 11 to generate a laser beam.
2. A signal detection unit 23 that detects an incident position (reflection point) S of the laser beam 5 on the object based on the light receiving position of the light receiving element 15 is connected. These are connected to the general-purpose interface 39 of the robot controller 30 via the line 24.
(See FIG. 3).

【0026】レーザセンサ3が、回線24を介してロボ
ット制御装置30から動作指令を受けると、レーザ駆動
部22はレーザ発振器11を駆動し、レーザビーム5を
発生させる。これと並行して、ミラー駆動部21により
揺動ミラー12の揺動が開始される。これにより、レー
ザ発振器11から発生するレーザビームが対象物面G上
で走査される。
When the laser sensor 3 receives an operation command from the robot controller 30 via the line 24, the laser driver 22 drives the laser oscillator 11 to generate the laser beam 5. At the same time, the swing of the swing mirror 12 is started by the mirror drive unit 21. Thereby, the laser beam generated from the laser oscillator 11 is scanned on the object surface G.

【0027】対象物面G上の反射点Sで拡散反射された
レーザビームは、光学系14により反射点Sの位置に応
じて受光素子15上に像を作る。受光素子15には、分
割型素子と受光素子である一次元CCDアレイ、あるい
は非分割型・積分型素子である位置検出検出器(PS
D;Position Sensitive Detector )、あるいは二次元
CCDアレイを持つCCDカメラなどが使用される。
The laser beam diffusely reflected at the reflection point S on the object surface G forms an image on the light receiving element 15 by the optical system 14 according to the position of the reflection point S. The light receiving element 15 includes a one-dimensional CCD array which is a split type element and a light receiving element, or a position detector (PS) which is a non-division type and integrating type element.
D; Position Sensitive Detector) or a CCD camera having a two-dimensional CCD array.

【0028】ここでは、受光素子15として1次元CC
Dアレイが使用されているものとする。受光素子15の
受光面に当たった光(反射光の像)は電荷に変換され、
そのセルに蓄えられる。セルに蓄積された電荷は、信号
検出部23からのCCD走査信号に従って所定周期毎1
番端から順に出力され、信号検出部23、回線24を介
してロボット制御装置30へ送られる。
Here, a one-dimensional CC is used as the light receiving element 15.
It is assumed that a D array is used. The light (image of the reflected light) hitting the light receiving surface of the light receiving element 15 is converted into an electric charge,
It is stored in that cell. The electric charge accumulated in the cell is changed by one every predetermined period in accordance with the CCD scanning signal from the signal detector 23.
The signals are sequentially output from the end, and sent to the robot controller 30 via the signal detector 23 and the line 24.

【0029】CCDの走査周期は、搖動ミラー12の走
査周期よりも十分短く設定(例えば、数100分の1)
されており、搖動ミラー12の搖動角度の推移とCCD
素子出力状態の推移は、随時把握可能となっている。C
CD素子出力状態は、出力最大のセル位置(セル番号)
で把握され、反射光の当たったセル位置が検出される。
この位置から、反射点Sのセンサ座標系上の位置が求め
られる。
The scanning cycle of the CCD is set sufficiently shorter than the scanning cycle of the oscillating mirror 12 (for example, several hundredths).
The change of the swing angle of the swing mirror 12 and the CCD
The transition of the element output state can be grasped at any time. C
The CD element output state is the cell position (cell number) where the output is maximum
The position of the cell to which the reflected light is applied is detected.
From this position, the position of the reflection point S on the sensor coordinate system is obtained.

【0030】図5は、受光素子15における検出位置s
により、反射点Sのセンサ座標系上の位置(Xs ,Ys
)を求める方法を説明する図である。光学系14の中
心と受光素子15の中央点とを結ぶ線上にセンサ座標系
の原点(0,0)があるとし、この線をY軸、このY軸
に直交する軸をX軸とする。
FIG. 5 shows a detection position s in the light receiving element 15.
, The position (Xs, Ys) of the reflection point S on the sensor coordinate system
FIG. 7 is a diagram for explaining a method of obtaining (). It is assumed that the origin (0, 0) of the sensor coordinate system is on a line connecting the center of the optical system 14 and the center point of the light receiving element 15, and this line is defined as a Y axis, and an axis orthogonal to the Y axis is defined as an X axis.

【0031】そして、センサ座標系の原点から光学系の
中心までの距離をL1 、光学系の中心から受光素子15
の中央点までの距離をL2 、センサ原点からX軸方向へ
の揺動ミラー12の揺動中心までの距離をD、センサ原
点から揺動ミラー12の揺動中心までのY軸距離をL0
、揺動ミラー12によるレーザビームの反射光のY軸
方向に対する角度をθ、受光素子15の受光面上の受光
位置をsとする。
The distance from the origin of the sensor coordinate system to the center of the optical system is L1, and the distance from the center of the optical system to the light receiving element 15 is L1.
Is the distance from the sensor origin to the center of oscillation of the oscillating mirror 12 in the X-axis direction, and the distance from the sensor origin to the center of oscillation of the oscillating mirror 12 is L0.
The angle of the reflected light of the laser beam from the oscillating mirror 12 with respect to the Y-axis direction is θ, and the light receiving position on the light receiving surface of the light receiving element 15 is s.

【0032】すると、レーザビーム5の反射点Sの座標
位置(Xs ,Ys )は、次の各式(2),(3)の演算
で求められる。 Xs =s・[(L1 −L0 )・tan θ+D]/(xa+L2 ・tan θ) ・・・(2) Ys =[L1 ・s+L2 ・(L0 ・tan θ−D)]/(s+L2 ・tan θ) ・・・(3) センサ座標系で求められた反射点Sの位置(Xs ,Ys
)は、ロボットの姿勢データ並びにキャリブレーショ
ンデータ(センサ座標系とロボット座標系の関係を表わ
すデータ)を用いて、ロボットが認識している座標系
(ここでは、後述する図6に示したワーク座標系Σw O
−XYZ)上の3次元データに変換される。レーザビー
ム5の走査サイクル毎に得られる一連のデータ群は、ロ
ボット制御装置30内のソフトウェア処理によって解析
され、例えば面G上にレーザビーム走査軌跡の位置(複
数の反射点Sの位置から計算)が求められる。
Then, the coordinate position (Xs, Ys) of the reflection point S of the laser beam 5 can be obtained by the following equations (2) and (3). Xs = s ・ [(L1−L0) · tan θ + D] / (xa + L2 · tan θ) (2) Ys = [L1 · s + L2 · (L0 · tan θ−D)] / (s + L2 · tan θ) (3) The position (Xs, Ys) of the reflection point S obtained in the sensor coordinate system
) Is a coordinate system recognized by the robot using the posture data of the robot and the calibration data (data representing the relationship between the sensor coordinate system and the robot coordinate system). Σw O
-XYZ) is converted to three-dimensional data. A series of data obtained in each scanning cycle of the laser beam 5 is analyzed by software processing in the robot controller 30 and, for example, the position of the laser beam scanning locus on the surface G (calculated from the positions of the plurality of reflection points S) Is required.

【0033】次に、図6は本発明を図1に示した事例に
適用する際の全体配置の概略を表わす見取り図である。
同図に示したように、符号1で指示されたロボットの手
先部に、溶接トーチ2とレーザセンサ3が搭載されてい
る。符号5は、溶接トーチ2から繰り出される溶接ワイ
ヤ4の先端位置(トーチ先端)に設定されたロボットの
ツール先端点を表わしている。
Next, FIG. 6 is a sketch showing the outline of the overall arrangement when the present invention is applied to the case shown in FIG.
As shown in the figure, a welding torch 2 and a laser sensor 3 are mounted on the hand of the robot designated by reference numeral 1. Reference numeral 5 denotes a robot tool tip point set at the tip position (torch tip) of the welding wire 4 fed from the welding torch 2.

【0034】本図には2層目の溶接の進行中の状態が示
されており、2層目のビードA2が途中まで形成されて
いる。レーザセンサ3から投射されたレーザビームLB
は、トーチ先端5よりも先行した領域をセンシングする
ために、隅部を提供する一方のワークW1の面H1(G
1)、隅部線7に沿って既に形成された1層目のビード
A1、隅部を提供する他方のワークW2の面H2(G
2)の三者を繰り返し通過するような光点軌跡6a,6
b,6cを作る。なお、H1(G1)及びH2(G2)
の表記は、溶接開始前の面G1,G2が溶接開始後には
熱変形で各々移動している可能性があることを表わして
いる(以下、同様とする)。
This figure shows a state where the welding of the second layer is in progress, and the bead A2 of the second layer is formed partway. Laser beam LB projected from laser sensor 3
In order to sense a region preceding the torch tip 5, a surface H1 (G
1) A bead A1 of the first layer already formed along the corner line 7 and a surface H2 (G
Light spot trajectories 6a and 6 that repeatedly pass through the three of 2)
b, 6c. Note that H1 (G1) and H2 (G2)
Indicates that the surfaces G1 and G2 before the start of welding may move due to thermal deformation after the start of welding (the same applies hereinafter).

【0035】溶接ロボットには、矢印で示したように、
溶接トーチ2を点火した状態で隅部線7に沿って隅部始
端Pから隅部終端P’まで移動する移動経路が教示され
ているものとする。再生運転によって、ロボットはP
P’を教示経路とする移動動作を総層数に等しいN回繰
り返すが、実際に実現される毎回の移動経路は、前述し
たように狙い位置の相違によって異なったものとされ
る。ここで重要な事は、狙い位置の相違によって経路を
変える(隅部線7からシフトさせる方向と距離を変え
る)際に、熱変形の影響が考慮されることである。
As shown by the arrows, the welding robot
It is assumed that a movement path that moves from the corner start point P to the corner end point P ′ along the corner line 7 with the welding torch 2 ignited is taught. By regenerative operation, the robot
The moving operation using P 'as the teaching path is repeated N times equal to the total number of layers, but the actually realized moving path is different depending on the difference in the target position as described above. What is important here is that the influence of thermal deformation is taken into account when changing the path (changing the shift direction and distance from the corner line 7) depending on the difference in the target position.

【0036】本実施形態では、次のような方式で本発明
を実施する。 (1)不揮発性メモリ34内に、予測される最大総数N
max に見合った数のレジスタRG1,RG2・・・RG
Nmax と、レジスタ番号を指定するアドレス指定カウン
タを設定しておく。 (2)i番目のレジスタRGiには、i層目の溶接を行
なう際の基準シフト量Δi を予め格納しておく。ここ
で、基準シフト量Δi という呼称は、「熱変形が生じな
い場合に最適と考えられる狙い位置B1〜B4」(以
下、「基準狙い位置」と言う。)を隅部線7(レーザセ
ンサ3で検出)の位置を基準とする2次元のシフト量で
表現したものである。 (3)基準シフト量Δi は、ロボットに設定済みの直交
座標系Σw (ワーク座標系O−XYZ)上で、隅部線7
(教示経路)の位置を基準としたX軸方向のシフト量Δ
x と、Y軸方向のシフト量Δy を表わす値を例えばmm
単位で教示操作盤38の操作によって予め設定する。こ
こで、溶接前のワーク面G1,G2の法線方向は各々座
標系Σw のY軸、X軸と平行であるものとする。
In the present embodiment, the present invention is implemented by the following method. (1) The predicted maximum total number N in the nonvolatile memory 34
The number of registers RG1, RG2,... RG corresponding to max
Nmax and an address designation counter for designating a register number are set in advance. (2) The reference shift amount Δi for welding the i-th layer is stored in advance in the i-th register RGi. Here, the reference shift amount Δi refers to “the target positions B1 to B4 considered to be optimal when no thermal deformation occurs” (hereinafter, referred to as “reference target positions”) as the corner lines 7 (the laser sensor 3). ) Is expressed by a two-dimensional shift amount with reference to the position of (.). (3) The reference shift amount Δi is calculated based on the corner line 7 on the orthogonal coordinate system Σw (work coordinate system O-XYZ) set for the robot.
Shift amount Δ in the X-axis direction based on the position of (teaching path)
x and the value representing the shift amount Δy in the Y-axis direction are, for example, mm
It is set in advance by operating the teaching operation panel 38 in units. Here, it is assumed that the normal directions of the work surfaces G1 and G2 before welding are parallel to the Y axis and the X axis of the coordinate system Σw, respectively.

【0037】(4)一例として層総数N=4とし、ま
た、基準狙い位置B1〜B4を表わす基準シフト量Δ1
〜Δ4 を図7のように設定するものとする。各アドレス
指定カウンタ値1,2,3,4で指定されるレジスタR
G1〜RG4に記憶されるデータは次のようになる。 RG1;(0,0) RG2;(0,d) RG3;(d,0) RG4;(d,d) (5)1層目〜4層目のいずれにおいても、レーザセン
サ3を用いて隅部線7の位置を検出し、それに基づく位
置補正を伴ったリアルタイムトラッキングを実行する。
このトラッキング補正は、教示経路(隅部線予定位置)
と実際にレーザセンサ3で検出される隅部線7の位置の
ずれを補償するためのものであり、狙い位置を各層溶接
毎に変えるための位置シフトとは別趣旨のものである。
両者はトーチ先端位置の決定に際して加算される関係に
ある。
(4) As an example, the total number of layers N = 4, and the reference shift amount Δ1 representing the reference target positions B1 to B4.
.DELTA.4 are set as shown in FIG. Register R specified by each address specification counter value 1, 2, 3, 4
The data stored in G1 to RG4 is as follows. RG1; (0, 0) RG2; (0, d) RG3; (d, 0) RG4; (d, d) (5) In any of the first to fourth layers, a corner is formed by using the laser sensor 3. The position of the part line 7 is detected, and real-time tracking with position correction based on the position is executed.
This tracking correction is based on the teaching path (planned corner line position).
This is for compensating the deviation of the position of the corner line 7 actually detected by the laser sensor 3, and is different in purpose from the position shift for changing the target position for each layer welding.
The two are in a relation to be added when determining the torch tip position.

【0038】即ち、本実施形態では、「トーチ先端位
置」=「教示経路上の位置」+「トラッキング補正量」
+「狙い位置を定めるためのシフト量」、の関係を以て
ロボット移動時のトーチ先端位置を決定する。そして、
右辺第3項目の「狙い位置を定めるためのシフト量」に
ついては、本発明の技術思想を適用し、ワークの熱変形
を考慮する。
That is, in the present embodiment, “torch tip position” = “position on teaching path” + “tracking correction amount”
The position of the tip of the torch when the robot moves is determined based on the relationship of + "shift amount for determining the target position". And
Regarding the third item on the right side, “shift amount for determining target position”, the technical idea of the present invention is applied, and thermal deformation of the work is taken into consideration.

【0039】(6)上記(5)に記した隅部線7の位置
は、面H1(G1),H2(G2)の交線の位置を、レ
ーザビーム走査によって面H1(G1),H2(G2)
に形成される光点軌跡6a及び6b(図6参照)が表わ
す2本の直線の交点位置として求める。このような手法
を採用する理由は2つある。一つは2層目以降の溶接時
に隅部線7がビードで隠されいても隅部線位置を推定出
来るようにするためであり、もう一つは面H1(G
1),H2(G2)の熱変形を知るためである。後者の
検出結果は、リアルタイムで上記(5)の「狙い位置を
定めるためのシフト量」に反映される。
(6) The position of the corner line 7 described in the above (5) is obtained by changing the position of the intersection line between the surfaces H1 (G1) and H2 (G2) by laser beam scanning to the surfaces H1 (G1) and H2 ( G2)
At the intersection of two straight lines represented by the light spot trajectories 6a and 6b (see FIG. 6). There are two reasons for employing such an approach. One is to make it possible to estimate the position of the corner line even if the corner line 7 is hidden by the bead during the welding of the second and subsequent layers, and the other is to make the surface H1 (G
1), to know the thermal deformation of H2 (G2). The latter detection result is reflected in real time in the above-mentioned (5) “shift amount for determining target position”.

【0040】(7)光点軌跡6a及び6bが表わす2本
の直線の交点位置として面H1(G1),H2(G2)
の交線位置を求めるために、図8に示したように、面H
1(G1)及びH2(G2)上で隅部線7の位置から適
当な距離離れた(ビードA1等で覆われる可能性が無
い)範囲L1,L2を指定し得るパラメータを予め設定
しておく。
(7) The planes H1 (G1) and H2 (G2) are defined as intersection points of two straight lines represented by the light spot trajectories 6a and 6b.
In order to obtain the intersection line position of the surface H, as shown in FIG.
Parameters that can specify ranges L1 and L2 that are appropriate distances from the position of the corner line 7 (there is no possibility of being covered with the bead A1 or the like) on 1 (G1) and H2 (G2) are set in advance. .

【0041】パラメータとしては、例えば図示したよう
に、レーザビームの全走査角度範囲φfullの両端に一定
の角度範囲を措定するφs が採用出来る。走査角度範囲
両端到達時点から測った時間を指定することも可能せ
る。なお、図8では面G1のみがH1に熱変形した状態
を示したが、面G2が熱変形していてもこのようなやり
方で範囲L1,L2を指定する上で特に問題は生じな
い。
As the parameter, for example, as shown, φs which defines a fixed angle range at both ends of the full scanning angle range φfull of the laser beam can be adopted. It is also possible to specify the time measured from the time when both ends of the scanning angle range are reached. Note that FIG. 8 shows a state in which only the surface G1 is thermally deformed to H1, but even if the surface G2 is thermally deformed, there is no particular problem in specifying the ranges L1 and L2 in such a manner.

【0042】(8)面H1(G1),H2(G2)の熱
変形に応じて狙い位置をどのように変更するかについて
は種々考えられるが、要は熱変形の前後で狙い位置の等
価性がほぼ保たれるような位置を適当な方式で変更して
やれば良い。変更の方式には、種々のものが採用可能で
あるが、ここでは図9を参照して斜交座標系を利用する
方式について説明する。
(8) There are various ways to change the target position in accordance with the thermal deformation of the surfaces H1 (G1) and H2 (G2). The point is that the equivalence of the target position before and after the thermal deformation is important. May be changed by an appropriate method so that the position is substantially maintained. Various methods can be adopted as the change method. Here, a method using an oblique coordinate system will be described with reference to FIG.

【0043】この方式は、面H1(G1),H2(G
2)について検出された直線(6a,6bに対応)を熱
変形を表わす2次元斜交座標系の座標軸とみなして基準
ソフト量の設定値Δi を解釈し直すことで、狙い位置を
定める方式で、次のような幾何学的な計算によって狙い
位置を求める。 1.図9に示したように、基準ソフト量の任意の設定値
Δi (Δx ,Δy )を表わす基準狙い位置をQとした
時、QVを点Qから面G1に降ろした垂線、QUを点Q
から面G2に降ろした垂線とする。面G1,G2をY
軸、X軸に対応させた座標系o−xyを考えれば、Vの
y座標値はΔy 、Uのx座標値はΔx となる。
In this method, the surfaces H1 (G1), H2 (G
The straight line (corresponding to 6a and 6b) detected in 2) is regarded as a coordinate axis of a two-dimensional oblique coordinate system representing thermal deformation, and the set value Δi of the reference software amount is interpreted again to determine the target position. The target position is obtained by the following geometric calculation. 1. As shown in FIG. 9, when Q is a reference target position representing an arbitrary set value Δi (Δx, Δy) of the reference software amount, QV is a perpendicular line dropped from point Q to surface G1, and QU is point Q.
From the surface G2. Surfaces G1 and G2 are Y
Considering a coordinate system o-xy corresponding to the axis and the X axis, the y coordinate value of V is Δy and the x coordinate value of U is Δx.

【0044】2.図示(誇張描示)したように、面G
1,G2が熱変形を起して面H1,H2となった時、y
軸、x軸を面H1,H2に対応させ斜交座標系Oob−x
obyobを求める。xob軸、yob軸の位置・方向はレーザ
センサ3で検出され、更にこれからOobの位置が求めら
れる。なお、熱変形による隅部位置Oobの変位は無視出
来るほど小さい(但し、多少の変位があっても本発明の
適用は可能である)。
2. As shown (exaggerated), face G
When G1 and G2 undergo thermal deformation and become surfaces H1 and H2, y
Axis and x axis correspond to the planes H1 and H2, and the oblique coordinate system Oob-x
Ask for obyob. The position and direction of the xob axis and the yob axis are detected by the laser sensor 3, and the position of Oob is obtained from this. The displacement of the corner position Oob due to thermal deformation is so small as to be negligible (however, the present invention can be applied even if there is some displacement).

【0045】3.oobUob=oU(=Δx )となるxob
軸上の点Uobを求める。 4.oobVob=oV(=Δy )となるyob軸上の点Vob
を求める。 5.3点oob,Vob,Uobを頂点に持つ平行四辺形の残
りの頂点Qobを求め、この点を狙い位置とする。前述の
ワーク座標系O−XYZ上で表わした斜交座標系の原点
(レーザセンサで検出された隅部線位置)oob及び上記
求めた点QobのX,Y座標値を各々(pxob ,pyob
),(qxob ,qyob )とすれば、熱変形を考慮した
シフト量δi (δix,δiy)は次式(4),(5)で与
えられる。 δix=qxob −pxob ・・・(4) δiy=qyob −pyob ・・・(5) 6.なお、平行四辺形oobUobQobVobの対角線oobQ
ob上にoobQob(γ)=γoobQobとなる点Qob(γ)
を定め、これを狙い位置としても良い。ここでγは隅部
線位置oobから測った狙い位置までの距離を調整するた
めの係数で、一般に1に近いが設定される。また、対角
線oobQob上にoobQob’=|Δi |となる点Qob’を
定め、これを狙い位置としても良い。
3. xob such that oobUob = oU (= Δx)
Find the point Uob on the axis. 4. Point Vob on the yob axis such that oobVob = oV (= Δy)
Ask for. 5.3 The remaining vertices Qob of the parallelogram having the three points oob, Vob, and Uob as vertices are obtained, and these points are set as target positions. The origin (the corner line position detected by the laser sensor) oob of the oblique coordinate system expressed on the above-described work coordinate system O-XYZ and the X and Y coordinate values of the point Qob obtained above are respectively (pxob, pyob)
), (Qxob, qyob), the shift amount δi (δix, δiy) in consideration of the thermal deformation is given by the following equations (4) and (5). δix = qxob−pxob (4) δiy = qyob−pyob (5) The diagonal line oobQ of the parallelogram oobUobQobVob
Point Qob (γ) on ob where oobQob (γ) = γoobQob
May be set as the target position. Here, γ is a coefficient for adjusting the distance from the corner line position oob to the target position measured, and is generally set to a value close to 1. Alternatively, a point Qob 'where oobQob' = | Δi | is determined on the diagonal line oobQob, and this point may be set as the target position.

【0046】以下、これまでに述べた前提の下で、図1
0のフローチャートを参照して多層盛り溶接実行時の処
理内容の概略を説明する。なお、処理はレーザセンサに
よる検出動作とロボットの経路移動に関連したもののみ
を説明し、溶接トーチ等の制御に関連した処理について
は省略する。
In the following, on the premise described above, FIG.
With reference to the flowchart of FIG. It should be noted that only the processing relating to the detection operation by the laser sensor and the path movement of the robot will be described, and the processing relating to the control of the welding torch and the like will be omitted.

【0047】処理はレジスタRGiを指定するアドレス
指定カウンタ値iの初期値を1として開始される。先
ず、レーザセンサ3を起動し(ステップM1)、動作プ
ログラムの動作命令文を読み込み、教示点位置Pへ向け
てロボットを移動をさせるための処理を開始する(ステ
ップM2)。レーザセンサ3により、ワークW1,W2
が検出されたならば(ステップM3でイエス出力)、直
ちに前述した走査角度範囲φs で得たレーザセンサ3の
検出データを使って、範囲L1,L2(図8参照)に含
まれる適宜点数(少なくとも2個づつ)の位置を求め、
L1,L2が表わす直線の位置(方向情報を含む)を求
めてバッファメモリに記憶する(ステップM4)。
The process is started by setting the initial value of the address designation counter value i for designating the register RGi to 1. First, the laser sensor 3 is started (step M1), an operation command sentence of the operation program is read, and a process for moving the robot toward the teaching point position P is started (step M2). The work W1, W2
Is detected (yes output in step M3), immediately using the detection data of the laser sensor 3 obtained in the above-described scanning angle range φs, the appropriate points included in the ranges L1 and L2 (see FIG. 8) (at least 2 each))
The positions (including direction information) of the straight lines represented by L1 and L2 are obtained and stored in the buffer memory (step M4).

【0048】ステップM4で求めた直線は、図9に示し
たyob軸及びxob軸に対応するものである。なお、レー
ザセンサ3で得られたセンサデータをロボットに設定さ
れた座標系に変換する処理手順(ロボットの現在位置デ
ータと座標系変換データが利用される。)や複数点の位
置のデータからそれらの点で代表される直線を求める処
理手順等は周知なので、詳しい説明は省略する。
The straight line obtained in step M4 corresponds to the yob axis and the xob axis shown in FIG. The processing procedure of converting the sensor data obtained by the laser sensor 3 into the coordinate system set for the robot (the current position data of the robot and the coordinate system conversion data are used) and the data of the positions of a plurality of points are used. Since the processing procedure for obtaining a straight line represented by the above point is well known, a detailed description thereof will be omitted.

【0049】次に、隅部線7の位置oobをステップM4
で求めた2本の直線(yob軸及びxob軸)の交点の位置
として求める(ステップM5)。そして、求められた隅
部線7の位置oobのデータから、教示経路からのずれ量
を補償するためのトラッキング補正量を求めバッファメ
モリに記憶する(ステップM6)。
Next, the position oob of the corner line 7 is determined in step M4.
Is obtained as the position of the intersection of the two straight lines (the yob axis and the xob axis) obtained in step (step M5). Then, a tracking correction amount for compensating the deviation amount from the teaching path is obtained from the data of the obtained position oob of the corner line 7 and stored in the buffer memory (step M6).

【0050】次いで、アドレス指定カウンタ値iで指定
されるレジスタRGiに格納されている基準位置シフト
量Δi のデータを読み出す(ステップM7)。そして、
この読み出された基準位置シフト量Δi のデータ、ステ
ップM4,M5で求められたxob軸、yobの位置/方向
を表わすデータと隅部位置oobのデータを用いて、狙い
位置を定めるための位置シフト量δi を計算する(ステ
ップM8)。位置シフト量δi の計算内容は前述した通
りである。
Next, data of the reference position shift amount Δi stored in the register RGi designated by the address designation counter value i is read (step M7). And
Using the read data of the reference position shift amount Δi, the xob axis obtained in steps M4 and M5, the data representing the position / direction of yob, and the data of the corner position oob, the position for determining the target position. The shift amount δi is calculated (step M8). The calculation contents of the position shift amount δi are as described above.

【0051】位置シフト量δi が求められたならば、教
示経路位置+トラッキング補正量+位置シフト量δi に
よってロボットの移動目標位置を計算する。計算結果に
基づいて作成された移動指令はサーボ系へ出力される
(ステップM9)。
When the position shift amount δi is obtained, the robot movement target position is calculated by the teaching path position + the tracking correction amount + the position shift amount δi. The movement command created based on the calculation result is output to the servo system (Step M9).

【0052】ロボットが教示点P’に到達させるための
処理が完了していない場合には(ステップM10でノー
出力)、ステップM4へ戻り、ステップM4〜M10を
繰り返す。また、ロボットが教示点P’に到達させるた
めの処理が完了している場合には(ステップM10でイ
エス出力)、ステップM11へ進んでアドレス指定カウ
ンタ値iを1アップする。
If the process for causing the robot to reach the teaching point P 'is not completed (No output in step M10), the process returns to step M4 and repeats steps M4 to M10. If the process for the robot to reach the teaching point P 'has been completed (yes output in step M10), the process proceeds to step M11, where the address designation counter value i is incremented by one.

【0053】次いで、多層盛り溶接の層総数(ここでは
4層)分の多層盛り溶接が完了したか否かをチェックし
(テップM12)、ノー出力(多層盛り溶接未完了)で
あれば、ステップM2に戻って、上記説明した処理サイ
クルを繰り返す。4層分の多層盛り溶接が完了すると、
ステップM12でイエス出力が出されるので、レーザセ
ンサ3やロボットを停止させる処理を経て処理を終了す
る。
Next, it is checked whether or not the multi-layer welding has been completed for the total number of layers of the multi-layer welding (here, four layers) (Step M12). Returning to M2, the processing cycle described above is repeated. When the multi-layer welding of four layers is completed,
Since a yes output is issued in step M12, the process is terminated after stopping the laser sensor 3 and the robot.

【0054】以上の処理を通して、1層目〜4層目の溶
接時のロボット移動に関し、ロボットのリアルタイムト
ラッキングと並行した形でワークの熱変形を考慮した狙
い位置をリアルタイムに決定しながらロボット経路を定
めていくことが出来る。
Through the above processing, regarding the movement of the robot during welding of the first to fourth layers, the robot path is determined in real time while determining the target position in consideration of the thermal deformation of the work in parallel with the real-time tracking of the robot. You can decide.

【0055】[0055]

【発明の効果】本発明により、2層目以降の隅肉多層盛
り溶接時にもレーザセンサを用いたリアルタイムトラッ
キングを適用しつつ、継ぎ手を構成するワークの熱変形
に応じて狙い位置を変化させながらロボットの移動経路
を定めていくことが出来るようになった。また、そのこ
とを通して熱変形を起し易い条件で行なわれる隅肉多層
盛り溶接の志度を向上さることが可能になった。
According to the present invention, the real-time tracking using the laser sensor is applied to the fillet multi-layer welding of the second and subsequent fillets while changing the target position according to the thermal deformation of the work constituting the joint. You can now determine the path of the robot. In addition, through this, it is possible to improve the willingness of fillet multi-pass welding performed under conditions that easily cause thermal deformation.

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

【図1】隅肉部に対する多層盛り溶接について説明する
図である。
FIG. 1 is a diagram illustrating multi-layer welding on a fillet portion.

【図2】図1に示した例について、熱変形による狙い位
置の狂いを説明する模式図である。
FIG. 2 is a schematic diagram illustrating deviation of a target position due to thermal deformation in the example shown in FIG. 1;

【図3】本発明を実施する際に使用可能なロボット制御
装置を含むシステムの全体構成を説明する要部ブロック
である。
FIG. 3 is a main block diagram illustrating an overall configuration of a system including a robot control device that can be used when implementing the present invention.

【図4】本実施形態で使用されるレーザセンサの要部構
成を説明する図である。
FIG. 4 is a diagram illustrating a main configuration of a laser sensor used in the present embodiment.

【図5】レーザセンサの測定原理を説明する図である。FIG. 5 is a diagram illustrating a measurement principle of a laser sensor.

【図6】実施形態における全体配置の概略を表わす見取
り図である。
FIG. 6 is a perspective view schematically showing an overall arrangement in the embodiment.

【図7】実施形態における基準狙い位置B1〜B4を表
わす基準シフト量Δ1 〜Δ4 の設定内容について説明す
る図である。
FIG. 7 is a diagram for explaining setting contents of reference shift amounts Δ1 to Δ4 representing reference target positions B1 to B4 in the embodiment.

【図8】レーザセンサを用いて面H1(G1),H2
(G2)の交線位置を求めるためのパラメータ設定につ
いて説明する図である。
FIG. 8 shows planes H1 (G1) and H2 using a laser sensor.
It is a figure explaining parameter setting for calculating the intersection line position of (G2).

【図9】熱変形を考慮したシフト量δi を定める計算手
法について説明する図である。
FIG. 9 is a diagram illustrating a calculation method for determining a shift amount δi in consideration of thermal deformation.

【図10】実施形態における多層盛り溶接実行時の処理
内容の概略を説明するフローチャートである。
FIG. 10 is a flowchart illustrating an outline of processing contents when performing multi-layer welding in the embodiment.

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

1 ロボット手先部 2 溶接トーチ 3 レーザセンサ 4 溶接ワイヤ 5 トーチ先端位置(ツール先端点) 6a,6b,6c 光点軌跡 10 投射部 11 レーザ発振器 12 揺動ミラー(ガルバノメータ) 13 検出部 14 結像用の光学系 15 受光素子 20 レーザセンサ制御部 21 ミラー駆動部 22 レーザ駆動部 23 信号検出部 24 回線 30 ロボット制御装置 31 CPU 32 ROM 33 RAM 34 不揮発性メモリ 35 軸制御器 36 サーボ回路 37 LCD 38 教示操作盤 39 汎用インターフェイス 40 ロボット(本体機構部のサーボモータ) 50 電源装置 A1〜A3 溶接ビード B1〜B4 (基準)狙い位置 C2 (熱変形が考慮された)狙い位置 G1,G2 ワーク面(溶接開始前) H1,H2 ワーク面(溶接開始後) S 入射位置(反射点) W1,W2 ワーク DESCRIPTION OF SYMBOLS 1 Robot hand part 2 Welding torch 3 Laser sensor 4 Welding wire 5 Torch tip position (tool tip point) 6a, 6b, 6c Light spot locus 10 Projection unit 11 Laser oscillator 12 Oscillating mirror (galvanometer) 13 Detecting unit 14 Imaging 15 Light receiving element 20 Laser sensor control unit 21 Mirror drive unit 22 Laser drive unit 23 Signal detection unit 24 Line 30 Robot controller 31 CPU 32 ROM 33 RAM 34 Non-volatile memory 35 Axis controller 36 Servo circuit 37 LCD 38 Teaching Operation panel 39 General-purpose interface 40 Robot (servo motor of main body mechanism) 50 Power supply device A1 to A3 Welding bead B1 to B4 (Reference) Target position C2 (thermal deformation is considered) Target position G1, G2 Work surface (start welding) Before) H1, H2 Work surface (after welding start) S Incident position (reflection point) W1, W2 Work

フロントページの続き (51)Int.Cl.6 識別記号 庁内整理番号 FI 技術表示箇所 H01S 3/00 H01S 3/00 F Continued on the front page (51) Int.Cl. 6 Identification number Office reference number FI Technical display location H01S 3/00 H01S 3/00 F

Claims (5)

【特許請求の範囲】[Claims] 【請求項1】 アーク溶接トーチと、レーザセンサと、
前記アーク溶接トーチとレーザセンサを搭載したロボッ
トと、ロボット制御装置を含むシステムを用いて隅肉多
層盛り溶接を行なう隅肉多層盛り溶接ロボットシステム
における制御方法であって、 前記ロボットの隅肉多層盛り溶接実行時の経路移動が、
隅部を代表する隅部線の位置検出に基づくトラッキング
動作に並行して、前記隅肉多層盛りの各層の溶接に応じ
た前記アーク溶接トーチの狙い位置が実現されるように
前記ロボットの移動経路をシフト調整して行なわれ、 前記隅部線の位置検出が、前記隅部を提供する2つのワ
ーク面の位置を前記レーザセンサを用いて検出し、前記
検出された2つのワーク面の位置に基づいて前記隅部線
の位置を求めることによって行なわれるようにし、更
に、 前記移動経路を調整するシフト量が、前記2つのワーク
面の位置の検出結果に基づいて、前記ワーク面の熱変形
に応じて制御されるようにした、前記隅肉多層盛り溶接
ロボットシステムにおける制御方法。
An arc welding torch, a laser sensor,
A robot equipped with the arc welding torch and the laser sensor, and a control method in a fillet multilayer welding robot system for performing fillet multilayer welding using a system including a robot controller, wherein the robot has a fillet multilayer welding. The path movement during welding execution
In parallel with the tracking operation based on the detection of the position of the corner line representing the corner, the movement path of the robot so that the target position of the arc welding torch according to the welding of each layer of the fillet multilayer is realized. The position of the corner line is detected using the laser sensor to detect the position of the two work surfaces providing the corner, and the position of the two work surfaces is detected. The position of the corner line is calculated based on the position of the corner line, and the shift amount for adjusting the movement path is determined based on the detection result of the position of the two work surfaces. A control method for the fillet multi-layer welding robot system, wherein the control is performed according to the following.
【請求項2】 熱変形の無い前記ワーク面に対する前記
移動経路のシフト量が基準シフト量として予め前記シス
テムに設定されており、 前記設定された基準シフト調整量を前記2つのワーク面
の位置の検出結果に基づいて新たなシフト調整量に変換
するすることにより、前記ワーク面の熱変形に応じて前
記移動経路のシフト量が制御されるようにした、請求項
1に記載の隅肉多層盛り溶接ロボットシステムにおける
制御方法。
2. A shift amount of the movement path with respect to the work surface that is not thermally deformed is set in the system in advance as a reference shift amount, and the set reference shift adjustment amount is set to a position of the two work surfaces. 2. The fillet multi-layer fillet according to claim 1, wherein the shift amount of the moving path is controlled in accordance with thermal deformation of the work surface by converting the shift amount into a new shift adjustment amount based on a detection result. 3. Control method in welding robot system.
【請求項3】 前記基準シフト量が、前記隅部線位置を
基準とした2次元基準シフト量として予め前記システム
に設定されており、 前記設定された2次元基準シフト調整量を前記2つのワ
ーク面の位置の検出結果に基づいて新たな2次元シフト
量に変換することにより、前記ワーク面の熱変形に応じ
て前記移動経路のシフト量が制御されるようにした、請
求項1に記載の隅肉多層盛り溶接ロボットシステムにお
ける制御方法。
3. The system according to claim 2, wherein the reference shift amount is previously set in the system as a two-dimensional reference shift amount based on the corner line position, and the set two-dimensional reference shift adjustment amount is set to the two workpieces. 2. The shift amount of the moving path according to claim 1, wherein the shift amount of the moving path is controlled in accordance with a thermal deformation of the work surface by converting the shift amount into a new two-dimensional shift amount based on a detection result of the position of the surface. Control method in fillet multilayer welding robot system.
【請求項4】 前記2次元基準シフト調整量を、前記2
つのワーク面の位置を表わす2本の直線を座標軸として
構成される斜交座標系上で表現された値として読み換え
ることにより、前記新たな2次元シフト量への前記変換
が行なわれるようにした、請求項3に記載の隅肉多層盛
り溶接ロボットシステムにおける制御方法。
4. The method of claim 2, wherein the two-dimensional reference shift adjustment amount is
The conversion to the new two-dimensional shift amount is performed by reading two straight lines representing the positions of two work surfaces as values expressed on an oblique coordinate system configured as coordinate axes. The control method in the fillet multilayer welding robot system according to claim 3.
【請求項5】 前記2次元基準シフト調整量を、前記2
つのワーク面の位置を表わす2本の直線を座標軸として
構成される斜交座標系上で表現された値として読み換
え、更に前記検出された隅部線位置からの距離調整を含
むように修正することにより、前記新たな2次元シフト
量への前記変換が行なわれるようにした、請求項3に記
載の隅肉多層盛り溶接ロボットシステムにおける制御方
法。
5. The method of claim 2, wherein the two-dimensional reference shift adjustment amount is
The two straight lines representing the positions of the two work surfaces are read as values expressed on an oblique coordinate system configured as coordinate axes, and further corrected to include the distance adjustment from the detected corner line position. 4. The control method according to claim 3, wherein the conversion into the new two-dimensional shift amount is performed.
JP25527496A 1996-09-06 1996-09-06 Control method in fillet multi-layer welding robot system Expired - Fee Related JP3483713B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP25527496A JP3483713B2 (en) 1996-09-06 1996-09-06 Control method in fillet multi-layer welding robot system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP25527496A JP3483713B2 (en) 1996-09-06 1996-09-06 Control method in fillet multi-layer welding robot system

Publications (2)

Publication Number Publication Date
JPH1080768A true JPH1080768A (en) 1998-03-31
JP3483713B2 JP3483713B2 (en) 2004-01-06

Family

ID=17276481

Family Applications (1)

Application Number Title Priority Date Filing Date
JP25527496A Expired - Fee Related JP3483713B2 (en) 1996-09-06 1996-09-06 Control method in fillet multi-layer welding robot system

Country Status (1)

Country Link
JP (1) JP3483713B2 (en)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1319700C (en) * 2003-03-28 2007-06-06 中国科学院力学研究所 Method of laser synchronous processing based on robot system
US7605347B2 (en) * 2003-02-06 2009-10-20 Honda Motor Co., Ltd. Control system using working robot, and work processing method using this system
JP2013508169A (en) * 2009-10-27 2013-03-07 スマート スチール システムズ プロプリエタリー リミテッド Computer aided beam making machine
CN111558762A (en) * 2020-05-18 2020-08-21 湘潭大学 Fillet weld tracking method based on three-line laser vision sensing
CN114012323A (en) * 2021-11-30 2022-02-08 成都卡诺普机器人技术股份有限公司 Real-time box splicing edge weld joint identification method based on laser displacement sensor

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7605347B2 (en) * 2003-02-06 2009-10-20 Honda Motor Co., Ltd. Control system using working robot, and work processing method using this system
CN1319700C (en) * 2003-03-28 2007-06-06 中国科学院力学研究所 Method of laser synchronous processing based on robot system
JP2013508169A (en) * 2009-10-27 2013-03-07 スマート スチール システムズ プロプリエタリー リミテッド Computer aided beam making machine
CN111558762A (en) * 2020-05-18 2020-08-21 湘潭大学 Fillet weld tracking method based on three-line laser vision sensing
CN114012323A (en) * 2021-11-30 2022-02-08 成都卡诺普机器人技术股份有限公司 Real-time box splicing edge weld joint identification method based on laser displacement sensor

Also Published As

Publication number Publication date
JP3483713B2 (en) 2004-01-06

Similar Documents

Publication Publication Date Title
JP4578056B2 (en) Workpiece machining method by control system using work robot
US6023044A (en) Control method in multi-layer welding
US5715375A (en) Robot control system for executing multi-layer welding
EP0812662B1 (en) Composite sensor robot system
US5887122A (en) Tracking control method for robot with weaving action
JPH08150476A (en) Method for confirming weld bead shape in welding robot using real time tracking sensor
JPH10244367A (en) Welding robot system
EP0862963B1 (en) Welding robot control method
US6321139B1 (en) Operation line searching method and robot/sensor system having operation line searching function
JP3483713B2 (en) Control method in fillet multi-layer welding robot system
US5668628A (en) Detection angle control method for laser sensor
JP2895289B2 (en) Automatic welding copying machine
WO2022186054A1 (en) Teaching point generation device that generates teaching points on basis of output of sensor, and teaching point generation method
JPH08197248A (en) Tracking control method for multi-layer welding
JPH09155543A (en) Automatic welding equipment
JPH0816227A (en) Method for teaching moving route of automatic machine using position sensor
JP3596095B2 (en) Robot controller
JP2003126963A (en) Teaching route correction device for welding robot
JPH06277843A (en) Method and device for multilayer welding
JPH07106452B2 (en) Groove gap detection method for automatic welding equipment
KR20020090636A (en) Pipe Fitting's Welding Method Using Laser Vision Sensor and the Apparatus thereof
JPH0571930A (en) Device and method for detecting shut
JPH08215847A (en) Control method of welding robot
JPH10244368A (en) Method and device for detecting groove in automatic welding machine
JP2690247B2 (en) Welding line position detection method

Legal Events

Date Code Title Description
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20030909

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

Free format text: PAYMENT UNTIL: 20081017

Year of fee payment: 5

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

Free format text: PAYMENT UNTIL: 20081017

Year of fee payment: 5

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

Free format text: PAYMENT UNTIL: 20091017

Year of fee payment: 6

LAPS Cancellation because of no payment of annual fees