JP2935600B2 - Attitude control device of welding torch using sensor - Google Patents
Attitude control device of welding torch using sensorInfo
- Publication number
- JP2935600B2 JP2935600B2 JP31135091A JP31135091A JP2935600B2 JP 2935600 B2 JP2935600 B2 JP 2935600B2 JP 31135091 A JP31135091 A JP 31135091A JP 31135091 A JP31135091 A JP 31135091A JP 2935600 B2 JP2935600 B2 JP 2935600B2
- Authority
- JP
- Japan
- Prior art keywords
- torch
- welding
- sensor
- angle
- welding line
- 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.)
- Expired - Fee Related
Links
Landscapes
- Manipulator (AREA)
Description
【０００１】[0001]
【産業上の利用分野】本発明は、溶接線の位置をリアル
タイムで検出することのできるセンサを取り付けた溶接
ロボットにおける溶接トーチ姿勢制御装置に関する。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a welding torch attitude control device for a welding robot equipped with a sensor capable of detecting the position of a welding line in real time.
【０００２】[0002]
【従来の技術】溶接ロボット等においては、ロボツトに
レーザセンサ等のセンサを取り付け、該センサによって
リアルタイムで溶接線位置を検出し、その測定結果を制
御装置に送り、溶接線を追跡するようにしている。例え
ば、図６はレーザセンサの構造を示す図で、１０は検出
部で、レーザ発振器１１，レーザビームをスキャンさせ
る揺動ミラー（ガルバノメータ）１２，反射光を捕らえ
て受光素子１４に像を作る光学系１３を有し、制御部２
０には、レーザ発振器１１を駆動しレーザビームを発生
させるレーザ駆動部２１，揺動ミラー１２を揺動させる
ミラー操作部２２，受光素子１４で受光した位置から、
検出対象物位置を検出する信号検出部２３で構成されて
いる。2. Description of the Related Art In a welding robot or the like, a sensor such as a laser sensor is attached to a robot, the position of a welding line is detected in real time by the sensor, the measurement result is sent to a control device, and the welding line is tracked. I have. For example, FIG. 6 shows the structure of a laser sensor. Reference numeral 10 denotes a detection unit, which is a laser oscillator 11, an oscillating mirror (galvanometer) 12 for scanning a laser beam, and an optical device that captures reflected light and forms an image on a light receiving element 14. A control unit 2 having a system 13
0, a laser driving unit 21 that drives the laser oscillator 11 to generate a laser beam, a mirror operating unit 22 that oscillates the oscillating mirror 12, and a position where light is received by the light receiving element 14.
It is composed of a signal detection unit 23 that detects the position of the detection target.
【０００３】レーザ駆動部２１により、レーザ発振器１
１を駆動し、レーザビームを発生させると共に、ミラー
操作部２２を駆動し揺動ミラー１２を揺動させて、レー
ザ発振器１１から発生するレーザビームをワーク３０上
に当て走査させる。ワーク３０上で拡散反射したレーザ
ビームは光学系１３により、対象物上の反射位置に応じ
て、受光素子１４上に像を作ることになる。この受光素
子１４上の位置から三角測量の原理を用いて対象物との
距離を測定する。そして、上記揺動ミラーを１回走査
（１片側揺動）させることにより、レーザビーム走査方
向の対象物の断面データを得て、この断面データより溶
接線位を求めるようにしている（詳細は特願平３−１６
５０３８号（特開平５−２６１１９号公報），特願平３
−２４０４７３号（特開平５−５２５１６号公報）等参
照）。[0003] The laser oscillator 21
1 is driven to generate a laser beam, and at the same time, the mirror operating unit 22 is driven to oscillate the oscillating mirror 12, so that the laser beam generated from the laser oscillator 11 hits the work 30 to scan. The laser beam diffusely reflected on the work 30 forms an image on the light receiving element 14 by the optical system 13 according to the reflection position on the object. From the position on the light receiving element 14, the distance to the object is measured using the principle of triangulation. The oscillating mirror is scanned once (one-side oscillating) to obtain cross-sectional data of the object in the laser beam scanning direction, and the welding line position is obtained from the cross-sectional data. Japanese Patent Application No. 3-16
No. 5038 (JP-A-5-26119) , Japanese Patent Application No. 3
-240473 (JP-A-5-52516 ).
【０００４】このようなレーザセンサを用いて溶接線位
置をリアルタイムで検出し、溶接線を追跡して溶接を行
う溶接ロボットにおいては、トーチ先端を溶接線上に位
置するように制御するだけで、トーチの姿勢は初めに教
示された状態を維持するだけである。In a welding robot that detects the position of a welding line in real time using such a laser sensor and tracks the welding line to perform welding, it is only necessary to control the tip of the torch so as to be positioned on the welding line. Only keeps the state initially taught.
【０００５】[0005]
【発明が解決しようとする課題】溶接を行う場合、最適
な溶接を得るには溶接条件に応じて、トーチを進行方
向、すなわち溶接線方向に前方向もしくは後方向に前進
角もしくは後進角（以下トーチ角度という）だけ傾ける
必要がある。しかし、従来の溶接ロボットではトーチ姿
勢は教示された姿勢を保持し、溶接線（溶接線の傾き
等）が変化しても、トーチ姿勢は変化せず上記トーチ角
度は溶接線の変化に合わせて変化することはない。例え
ば、図２に示すような曲面ワークの溶接線Ｌに対して溶
接を行う場合、トーチ姿勢が一定であるとトーチ角度は
大きく変化することになる。図２において、１はトー
チ、２はレーザセンサ、３はワイヤ、Ｌは溶接線であ
る。図２のような溶接線Ｌに対してＡ点からＢ点まで溶
接を行う場合に、Ａ点でトーチ姿勢を教示しても、溶接
線Ｌが変化し、トーチ１に対するワークの角度（トーチ
角度）も変化することになるので、溶接条件にあったト
ーチ角度をＡ点で教示していても、Ｂ点まで移動する途
中において、ワークに対する最適なトーチ角度で溶接が
行われないことになる。そのため、従来の方法では、教
示点を増加して、トーチ角度を最適な状態にする必要が
ある。When performing welding, in order to obtain optimum welding, the torch is moved forward or backward in the direction of travel, that is, forward or backward in the direction of the welding line, depending on the welding conditions. (Referred to as the torch angle). However, in the conventional welding robot, the torch posture holds the taught posture, and even if the welding line (such as the inclination of the welding line) changes, the torch posture does not change and the torch angle is adjusted according to the change of the welding line. It does not change. For example, when welding is performed on a welding line L of a curved work as shown in FIG. 2, if the torch posture is constant, the torch angle changes greatly. In FIG. 2, 1 is a torch, 2 is a laser sensor, 3 is a wire, and L is a welding line. When welding is performed from the point A to the point B with respect to the welding line L as shown in FIG. 2, even if the torch posture is taught at the point A, the welding line L changes, and the angle of the work with respect to the torch 1 (torch angle). ) Also changes, so that even if the torch angle suitable for the welding conditions is taught at point A, welding is not performed at the optimum torch angle for the workpiece while moving to point B. Therefore, in the conventional method, it is necessary to increase the number of teaching points to make the torch angle an optimum state.
【０００６】そこで本発明の目的は、溶接中トーチ角度
を常に最適トーチ角度に保持できるセンサを用いた溶接
トーチの姿勢制御装置を提供することにある。SUMMARY OF THE INVENTION It is an object of the present invention to provide a welding torch attitude control apparatus using a sensor capable of always maintaining the torch angle at an optimum torch angle during welding.
【０００７】[0007]
【課題を解決するための手段】本発明は、トーチ位置と
上記センサで検出した溶接線位置とにより溶接線に対す
るトーチ角度を求める手段と、該トーチ角度が教示トー
チ角度になるようにトーチ姿勢を制御する制御手段とを
備え、トーチ角度が教示トーチ角度になるようにトーチ
姿勢を制御する。特に、トーチ位置とセンサ間は所定距
離があり、トーチ位置とセンサで検出される溶接線位置
の間にはすでにセンサで検出した溶接線位置が複数ある
ことになる。そのため、センサで検出した溶接線位置を
順次記憶手段に記憶しておき、前記トーチ角度を求める
手段は、トーチ位置と上記記憶手段に記憶するトーチ位
置に一番近い溶接線位置によりトーチ目標位置を求める
ようにして、より精度を向上させる。また、トーチ姿勢
を急激に変えると発振する恐れがあるため、前記制御手
段は現時点のトーチ姿勢より目標トーチ姿勢に移動させ
るときには設定ゲインを掛けて徐々に移動させるように
する。According to the present invention, there is provided a means for obtaining a torch angle with respect to a welding line based on a torch position and a welding line position detected by the sensor, and a torch attitude such that the torch angle becomes a teaching torch angle. Control means to control
Equipped, the torch so that the torch angle becomes the teaching torch angle
Control your posture . In particular, there is a predetermined distance between the torch position and the sensor, and there are a plurality of welding line positions already detected by the sensor between the torch position and the welding line position detected by the sensor. Therefore, the welding line position detected by the sensor is sequentially stored in the storage means, and the torch angle is obtained.
The means obtains the torch target position from the torch position and the welding line position closest to the torch position stored in the storage means, thereby further improving accuracy. In addition, since there is a possibility of oscillation when the torch attitude is suddenly changed, the control means multiplies the set torch attitude to gradually move the torch attitude from the current torch attitude to the target torch attitude.
【０００８】[0008]
【作用】図３に示すように、ワーク（溶接線Ｌ）に対す
るトーチ１の角度（前進角または後進角）θは溶接条件
等によって最適値がある。そこで、トーチの位置（ワイ
ヤ先端点位置）Ｐｔとセンサ２で検出される溶接線位置
Ｐｗ、及びセンサ座標系の原点Ｐｓよりトーチ角度θを
求め、このトーチ角度θが教示したトーチ角度αにから
ずれると、トーチ姿勢をトーチ角度が教示角度αになる
ように（θ−α）だけ移動させトーチ角度が教示角度α
に常になるように補正するようにする。そして、センサ
で検出される溶接線位置の中からその時点におけるトー
チ位置の進行方向の一番近い位置よりトーチ目標位置を
求める。また、トーチ姿勢を変えるときには、設定ゲイ
ン（１より小さい値）を掛けて徐々に移動させる。As shown in FIG. 3, the angle (advance angle or reverse angle) θ of the torch 1 with respect to the workpiece (welding line L) has an optimum value depending on welding conditions and the like. Then, the torch angle θ is obtained from the torch position (wire tip point position) Pt, the welding line position Pw detected by the sensor 2, and the origin Ps of the sensor coordinate system. If it is shifted, the torch posture is moved by (θ−α) so that the torch angle becomes the teaching angle α, and the torch angle becomes the teaching angle α.
So that it always becomes Then, the torch target position is determined from the closest position in the traveling direction of the torch position at that time from the welding line positions detected by the sensor. When the torch attitude is changed, the torch attitude is gradually multiplied by a set gain (a value smaller than 1).
【０００９】[0009]
【実施例】図３〜図５は本発明の一実施例におけるトー
チ角度θ及びトーチ角度制御方法の説明図である。図３
において、ワーク表面（溶接線Ｌ上）に当接したトーチ
１の先端（ワイヤ先端）をＰｔ、レーザセンサ２でワー
ク表面（溶接線Ｌ上）を検出した位置をＰｗ、このレー
ザセンサ２のサンサ座標系の原点位置をＰｓとしたと
き、トーチ先端点Ｐｔとセンサ座標系原点位置Ｐｓを結
ぶ線と、トーチ先端点Ｐｔとセンサが検出したワーク位
置Ｐｗとを結ぶ線とのなす角をトーチ角度θとする。ま
た、センサ座標系（Ｘｓ，Ｙｓ，Ｚｓ）とトーチ座標系
（Ｘｔ，Ｙｔ，Ｚｔ）を本実施例では図４に示すように
定義する。すなわち、トーチ座標系の原点はトーチ先端
点（ワイヤ先端点）Ｐｔとし、トーチ座標系とセンサ座
標系の各軸は同じ方向とする。また、本実施例では、セ
ンサ座標系の原点をトーチ座標系の原点からＸ軸方向の
みシフトした点としている（必ずしも、センサ座標系原
点をこのような位置に設定する必要がないが、説明を簡
単にするためにこのように設定する）。なお、図４にお
いて、トーチ座標系及びセンサ座標系のＹ軸の方向は紙
面垂直方向で紙面裏面から表面への方向を正の方向とし
ている。そして、上記トーチ角度θはトーチ座標系のＹ
ｔ軸の右ねじ回転方向を正の方向としており、図３に示
すトーチ角度θ（＝α）は逆方向に回転した値であるの
で負の値である。3 to 5 are explanatory diagrams of a torch angle θ and a torch angle control method according to an embodiment of the present invention. FIG.
, The tip (wire tip) of the torch 1 in contact with the work surface (on the welding line L) is Pt, the position at which the work surface (on the welding line L) is detected by the laser sensor 2 is Pw, and the sensor of the laser sensor 2 is When the origin position of the coordinate system is Ps, the angle formed by the line connecting the torch tip point Pt and the sensor coordinate system origin position Ps and the line connecting the torch tip point Pt and the work position Pw detected by the sensor is the torch angle. θ. In this embodiment, a sensor coordinate system (Xs, Ys, Zs) and a torch coordinate system (Xt, Yt, Zt) are defined as shown in FIG. That is, the origin of the torch coordinate system is the torch tip point (wire tip point) Pt, and the axes of the torch coordinate system and the sensor coordinate system are in the same direction. In this embodiment, the origin of the sensor coordinate system is shifted from the origin of the torch coordinate system only in the X-axis direction (the origin of the sensor coordinate system does not necessarily need to be set at such a position. Set it this way for simplicity). In FIG. 4, the direction of the Y axis in the torch coordinate system and the sensor coordinate system is perpendicular to the plane of the paper, and the direction from the back to the front of the paper is a positive direction. The torch angle θ is Y in the torch coordinate system.
The right-hand screw rotation direction of the t axis is a positive direction, and the torch angle θ (= α) shown in FIG. 3 is a negative value because it is a value rotated in the opposite direction.
【００１０】そこで、ワーク（溶接線Ｌ）に対してトー
チ角度を図３に示すようにθ＝α（ただしα＜０であ
る）として教示しているときに、図５に示すようにワー
ク表面（溶接線Ｌ）が変化しトーチ角度がθとなり教示
トーチ角度αではなくなった場合、トーチ１をトーチ座
標系におけるＹｔ軸回りに（θ−α）だけ回転させれば
教示角度αとなる。図３及び図５においては、教示トー
チ角度θ＝αで負の値であるから、（θ−α）＝（θ＋
｜α｜）だけ回転させれば良いことになる。すなわち、
トーチ１を右ねじ方向に（図５中反時計方向に）（θ＋
｜α｜）だけ回転させれば、トーチ角度は教示角度のα
となる。Therefore, when teaching the torch angle with respect to the work (weld line L) as shown in FIG. 3 as θ = α (where α <0), as shown in FIG. If (the welding line L) changes and the torch angle becomes θ and is no longer the teaching torch angle α, the teaching angle α is obtained by rotating the torch 1 about the Yt axis in the torch coordinate system by (θ−α). 3 and 5, since the teaching torch angle θ = α is a negative value, (θ−α) = (θ +
| Α |). That is,
Turn the torch 1 clockwise (counterclockwise in FIG. 5) (θ +
| Α |), the torch angle will be the teaching angle α
Becomes
【００１１】一方、ロボットのベース座標系に対するト
ーチ座標系は次ぎの数式１で表される。On the other hand, the torch coordinate system with respect to the robot base coordinate system is expressed by the following equation (1).
【００１２】[0012]
【数１】 なお、数式１は、マニピュレータの位置、姿勢を表すた
めに一般的に採用されている変換行列であり、（ａｘ，
ａｙ，ａｚ）は図４のトーチ座標系におけるＺ軸方向に
とったアプローチベクトルＡのベース座標系のＸ，Ｙ，
Ｚ軸成分、（ｏｘ，ｏｙ，ｏｚ）はトーチ座標系におけ
るＸ軸方向にとったオリエンテーションベクトルＯのベ
ース座標系のＸ，Ｙ，Ｚ軸成分、同様に（ｎｘ，ｎｙ，
ｎｚ）はトーチ座標系のＹ軸方向にとったノーマルベク
トルＮのベース座標系のＸ，Ｙ，Ｚ軸成分である。又、
（ｐｘ，ｐｙ，ｐｚ）はベース座標系からみたトーチ座
標系の原点位置ベクトル、すなわちトーチ先端位置ベク
トルＰを表している。また、トーチ１をトーチ座標系の
Ｙｔ軸回りに（θ−α）だけ回転させたときの行列Ｔｒ
ｔは次の数式２で表される。(Equation 1) Equation 1 represents the position and orientation of the manipulator.
Is a transformation matrix generally used for (x,
ay, az) are in the Z-axis direction in the torch coordinate system of FIG.
X, Y, in the base coordinate system of the approach vector A
Z axis component, (ox, oy, oz) is in torch coordinate system
Of the orientation vector O taken in the X-axis direction
X, Y, and Z axis components of the source coordinate system, similarly (nx, ny,
nz) is the normal vector taken in the Y-axis direction of the torch coordinate system
X, Y, and Z axis components of the base coordinate system of the torque N. or,
(Px, py, pz) represents an origin position vector of the torch coordinate system viewed from the base coordinate system, that is, a torch tip position vector P. A matrix Tr when the torch 1 is rotated by (θ−α) around the Yt axis of the torch coordinate system.
t is expressed by the following equation (2).
【００１３】[0013]
【数２】 よって回転後のトーチ座標系Ｐtb´は次ぎの数式３とな
る。(Equation 2) Therefore, the torch coordinate system Ptb 'after rotation is represented by the following Equation 3.
【００１４】[0014]
【数３】 なお、上記数式３において、Ｃ＝ｃｏｓ（θ−α）、Ｓ
＝ｓｉｎ（θ−α）である。次ぎにトーチの現在位置Ｐ
（ｐｘ，ｐｙ，ｐｚ）よりトーチが移動すべき位置Ｐ´
（ｐｘ´，ｐｙ´，ｐｚ´）を求めるが、これは従来と
同様で、レーザセンサ２で検出した溶接線位置Ｐｗによ
って求める。現在位置Ｐよりレーザセンサ２がその時点
で検出している溶接線位置Ｐｗ方向にトーチを移動させ
ればよいが、トーチ先端とレーザセンサ２が検出する位
置は所定間隔離れており、その時点でレーザセンサ２で
検出した溶接線位置Ｐｗとトーチ先端位置Ｐｔ間にはす
でに検出した溶接線位置が複数存在することになる。そ
こで、レーザセンサ２が所定周期毎検出した溶接線位置
Ｐｗをバッファに記憶すると共に、該バッファに記憶す
る最も古い溶接線位置を読みだし、該バッフアからこの
読み出した溶接線位置を消去する処理を行い、現在のト
ーチ位置Ｐｔに最も近い検出溶接線位置を求める。この
溶接線位置をｗとし、指令された溶接速度をｖとする
と、次ぎにトーチが移動すべき目標位置Ｐ´は次ぎの数
式４によって求められる。(Equation 3) In the above equation 3, C = cos (θ−α), S
= Sin (θ-α). Next is the current position P of the torch
The position P 'to which the torch should move from (px, py, pz)
(Px ', py', pz ') is obtained by the same method as in the related art, based on the welding line position Pw detected by the laser sensor 2. The torch may be moved from the current position P in the direction of the welding line position Pw detected by the laser sensor 2 at that time. However, the tip of the torch and the position detected by the laser sensor 2 are separated from each other by a predetermined distance. A plurality of welding line positions already detected exist between the welding line position Pw detected by the laser sensor 2 and the torch tip position Pt. Therefore, a process for storing the welding line position Pw detected by the laser sensor 2 every predetermined period in a buffer, reading the oldest welding line position stored in the buffer, and erasing the read welding line position from the buffer is performed. Then, the detected welding line position closest to the current torch position Pt is obtained. Assuming that this welding line position is w and the commanded welding speed is v, the target position P ′ to which the torch should move next is obtained by the following equation (4).
【００１５】[0015]
【数４】 なお、数式４において「Ｐからｗへの単位ベクトル」と
は、Ｐからｗのベクトルで、その絶対値が１のベクトル
である。例えば、Ｐからｗへのベクトルが「ａ」で直交
する３つの軸の成分がａ１，ａ２，ａ３とすると、｜ａ
｜＝√（ａ１ ２ ＋ａ２ ２ ＋ａ３ ２ ）が１となるベクトル
である。その結果、現在のトーチの位置姿勢より、次の
移動位置へ移動する目標位置，姿勢は上記数式３，数式
４より次の数式５に示されるようになる。(Equation 4) In Equation 4, “unit vector from P to w”
Is a vector whose absolute value is 1 from P to w
It is. For example, the vector from P to w is "a" and orthogonal
Assuming that the components of the three axes are a1, a2, and a3, | a
| = √ (a1 2 + a2 2 + a3 2 ) is 1
It is. As a result, the target position and posture to move to the next movement position from the current position and posture of the torch are expressed by the following Expression 5 from Expressions 3 and 4.
【００１６】[0016]
【数５】 このようにしてトーチ１が次ぎに移動すべき目標位置，
姿勢が上記数式５で求まると、従来の動作制御と同様
に、逆変換を行ってロボットの各軸の移動量を計算し、
各軸を駆動すればよい。ただし、トーチ角度を（θ−
α）の値そのまま移動させると発振する恐れが生じるの
で、実際には、ゲインｇを掛けた値ｇ（θ−α）で移動
させ、徐々にトーチ角度を教示角度αに移動させるよう
にする。このゲインｇは「１」よりも小さい値で、実験
によってきめる。(Equation 5) Thus, the target position torch 1 should move next,
When the posture is obtained by the above formula 5, the amount of movement of each axis of the robot is calculated by performing an inverse transformation in the same manner as in the conventional operation control,
What is necessary is just to drive each axis. However, if the torch angle is (θ-
If the value of α) is moved as it is, oscillation may occur. In practice, therefore, the torch angle is gradually moved to the teaching angle α by moving the gain by the value g (θ−α) multiplied by the gain g. The gain g is a value smaller than “1” and is determined by an experiment.
【００１７】図１は、上述したトーチの位置姿勢制御を
行うロボット制御装置のプロセッサが実施する処理のフ
ローチャートである。なお、ロボット及びロボット制御
装置の構成は従来のレーザセンサを用いた溶接ロボット
の構成と同一であるので、そのハードウエアは省略す
る。FIG. 1 is a flowchart of a process executed by a processor of a robot controller for controlling the position and orientation of the torch described above. Since the configurations of the robot and the robot control device are the same as those of a conventional welding robot using a laser sensor, the hardware is omitted.
【００１８】まず、プロセッサはトーチ１をプログラム
で設定された姿勢及び溶接開始位置にトーチ１を移動さ
せる（ステップＳ１）。そして、レーザセンサ２によっ
て溶接線位置Ｐｗを求め溶接線開始位置Ｐｔと検出した
溶接線位置Ｐｗよりトーチ角度θを求めこの角度を教示
トーチ角度αとして記憶する（ステップＳ２，Ｓ３）。
図３，図５の例では、この教示トーチ角度は負の値であ
る。First, the processor moves the torch 1 to the posture and the welding start position set by the program (step S1). Then, the welding line position Pw is obtained by the laser sensor 2, the torch angle θ is obtained from the welding line start position Pt and the detected welding line position Pw, and this angle is stored as the teaching torch angle α (steps S2 and S3).
In the examples of FIGS. 3 and 5, the teaching torch angle is a negative value.
【００１９】次ぎに、溶接指令を出力し溶接を開始し
（ステップＳ４）、レーザセンサ２が検出した溶接線位
置Ｐｗを記憶するバッファより現時点のトーチ位置に一
番近い溶接線位置ｗを読みだし、現時点のトーチ位置
Ｐ，設定溶接速度ｖ及び読み出した溶接線位置ｗより上
記数式４の演算を行い目標移動位置Ｐ´を求める（ステ
ップＳ５）。さらに、現時点のトーチ位置と読み出した
溶接線位置ｗよりトーチ角度θを求め数式３の演算を行
うことによってトーチ姿勢を求める（ステップＳ６）。
次ぎに、求められた目標移動位置及び姿勢にトーチ１を
移動させる（ステップＳ７）。この場合トーチ姿勢の移
動量（θ−α）に対して設定ゲインｇを掛けてトーチ姿
勢を徐々に移動させる。以下、溶接終了まで（ステップ
Ｓ８）、ステップＳ５〜Ｓ８の処理を繰り返し実行す
る。Next, a welding command is output to start welding (step S4), and a welding line position w closest to the current torch position is read from a buffer storing the welding line position Pw detected by the laser sensor 2. From the torch position P, the set welding speed v, and the read welding line position w at the present time, the above equation 4 is calculated to obtain the target movement position P '(step S5). Further, the torch angle θ is obtained from the current torch position and the read welding line position w, and the calculation of Expression 3 is performed to obtain the torch attitude (step S6).
Next, the torch 1 is moved to the determined target movement position and posture (step S7). In this case, the torch posture is gradually moved by multiplying the movement amount (θ−α) of the torch posture by the set gain g. Hereinafter, the processes of steps S5 to S8 are repeatedly executed until the welding is completed (step S8).
【００２０】[0020]
【発明の効果】本発明は、溶接線位置をセンサによって
自動的に求め、かつトーチ角度も自動的に常に求め、該
求めたトーチ角度が設定トーチ角度になるようにリアル
タイムで制御するから、ワーク（溶接線）に対して教示
された最適トーチ角度に溶接中常に保持され、均一な溶
接結果を得ることができる。ワーク形状のバラツキがあ
っても、また溶接中の熱でワークが変形し溶接線が変動
しても、変動した溶接線位置はセンサでリアルタイムで
検出され、かつトーチ角度もこの検出された溶接線位置
によって求められ、設定トーチ角度になるようにリアル
タイムで制御されるから、ワーク形状のばらつきやワー
ク変形に対しても最適のトーチ角度を保持して正確に、
かつ品質良く溶接することができる。According to the present invention, the position of the welding line is determined by a sensor.
Automatically, and the torch angle is always automatically determined.
Realize the obtained torch angle to be the set torch angle
Teaching work (weld line) because it is controlled by time
The optimum torch angle maintained at all times during welding,
Interaction results can be obtained. Variation in work shape
However, the heat during welding also deforms the workpiece and the weld line fluctuates.
However, the fluctuating welding line position can be
Detected welding torch angle and detected welding line position
Determined by the real torch angle set
Because the time is controlled, variations in workpiece shape and work
Preserving the optimal torch angle for the deformation
And it can weld with good quality .
【図１】本発明の一実施例のロボット制御装置のプロセ
ッサが実施するトーチ位置・姿勢制御のフローチャート
である。FIG. 1 is a flowchart of torch position / posture control executed by a processor of a robot control device according to an embodiment of the present invention.
【図２】トーチ角度が変化することの説明図である。FIG. 2 is a diagram illustrating that a torch angle changes.
【図３】本発明の一実施例におけるトーチ角度の説明図
である。FIG. 3 is an explanatory diagram of a torch angle in one embodiment of the present invention.
【図４】本発明の一実施例におけるトーチ座標系とセン
サ座標系の説明図である。FIG. 4 is an explanatory diagram of a torch coordinate system and a sensor coordinate system in one embodiment of the present invention.
【図５】同一実施例においてトーチ角度が変化したとき
のトーチ角度補正の説明図である。FIG. 5 is an explanatory diagram of torch angle correction when the torch angle changes in the same embodiment.
【図６】同一実施例において使用するレーザセンサの概
要ブロック図である。FIG. 6 is a schematic block diagram of a laser sensor used in the same embodiment.
１ トーチ ２ レーザセンサ ３ ワイヤ Ｌ 溶接線 Ｐｔ トーチ位置（ワイヤ先端点） Ｐｗ センサによる溶接線検出位置 Ｐｓ センサ座標系の原点 θ トーチ角度 α 教示トーチ角度 Reference Signs List 1 torch 2 laser sensor 3 wire L welding line Pt torch position (wire tip point) welding line detection position by Pw sensor Ps origin of sensor coordinate system θ torch angle α teaching torch angle
───────────────────────────────────────────────────── フロントページの続き (72)発明者 脇尾 宏志 山梨県南都留郡忍野村忍草字古馬場3580 番地 ファナック株式会社 商品開発研 究所 内 (72)発明者 岩本 孝 山梨県南都留郡忍野村忍草字古馬場3580 番地 ファナック株式会社 商品開発研 究所 内 (56)参考文献 特開 昭51−151647（ＪＰ，Ａ) (58)調査した分野(Int.Cl.6，ＤＢ名) B23K 9/12 331 B23K 9/127 508 ──────────────────────────────────────────────────の Continued on the front page (72) Inventor Hiroshi Wakio 3580 Kobaba, Oshino-mura, Oshino-mura, Minamitsuru-gun, Yamanashi Prefecture Inside FANUC Co., Ltd.Product Development Laboratory (72) Inventor Takashi Iwamoto Oshino-mura, Oshino-mura, Minamitsuru-gun, Yamanashi No. 3580, Kobaba, FANUC CORPORATION Product Development Laboratory (56) References JP-A-51-151647 (JP, A) (58) Fields investigated (Int. Cl. 6 , DB name) B23K 9/12 331 B23K 9/127 508
Claims (3)
ルタイムで溶接線位置を検出して溶接を行う溶接ロボッ
トの溶接トーチの姿勢制御装置であって、トーチ位置と
上記センサで検出した溶接線位置とにより溶接線進行方
向に対するトーチ角度を求める手段と、該トーチ角度が
教示トーチ角度になるようにトーチ姿勢を制御する制御
手段を備えたことを特徴とするセンサを用いた溶接トー
チの姿勢制御装置。 A welding torch attitude control device for a welding robot for performing welding by detecting a welding line position in real time with a sensor attached to the robot , wherein the welding torch position and the welding line position detected by the sensor are used. Welding line
Means for obtaining a torch angle with respect to the direction, and control for controlling the torch attitude so that the torch angle becomes the teaching torch angle
Attitude control system of the welding torch using a sensor, comprising the means.
記憶する記憶手段を備え、上記トーチ角を求める手段は
トーチ位置と上記記憶手段に記憶する該トーチ位置に一
番近い溶接線位置により上記トーチ角度を求める請求項
１記載のセンサを用いた溶接トーチの姿勢制御装置。2. A storage means for sequentially storing welding line positions detected by said sensor , wherein said means for obtaining said torch angle is:
One is stored in the torch position and the torch position stored in the storage means.
The welding torch attitude control device using the sensor according to claim 1, wherein the torch angle is obtained from a nearest welding line position .
目標トーチ姿勢に設定ゲインをもって移動させる請求項
１または請求項２記載のセンサを用いた溶接トーチの姿
勢制御装置。3. A welding torch attitude control apparatus using a sensor according to claim 1, wherein said control means moves the current torch attitude to a target torch attitude with a set gain.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP31135091A JP2935600B2 (en) | 1991-10-31 | 1991-10-31 | Attitude control device of welding torch using sensor |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP31135091A JP2935600B2 (en) | 1991-10-31 | 1991-10-31 | Attitude control device of welding torch using sensor |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH05123866A JPH05123866A (en) | 1993-05-21 |
| JP2935600B2 true JP2935600B2 (en) | 1999-08-16 |
Family
ID=18016097
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP31135091A Expired - Fee Related JP2935600B2 (en) | 1991-10-31 | 1991-10-31 | Attitude control device of welding torch using sensor |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP2935600B2 (en) |
Families Citing this family (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2001162371A (en) * | 1999-12-09 | 2001-06-19 | Daihen Corp | Method of attitude controlling for torch and its device, and robot for arc welding |
| DE10234242B4 (en) * | 2002-07-09 | 2005-10-27 | Airbus Deutschland Gmbh | Arrangement and method for controlling the seam position of a laser-beam-applied profile |
| JP5927212B2 (en) | 2014-02-28 | 2016-06-01 | ファナック株式会社 | Welding torch detection device and welding robot system |
-
1991
- 1991-10-31 JP JP31135091A patent/JP2935600B2/en not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| JPH05123866A (en) | 1993-05-21 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US5006999A (en) | Real-time robot control system tracking based on a standard path | |
| JP3263724B2 (en) | Shape feature extraction device using two-dimensional laser pattern | |
| JPS6388612A (en) | Foreknowledge pursuing/control type robot | |
| JPH08166813A (en) | Tracking control method for robot accompanied by weaving operation | |
| JPH08150476A (en) | Method for confirming weld bead shape in welding robot using real time tracking sensor | |
| WO2007042895A2 (en) | Laser processing robot control system, control method and control program medium | |
| JPH0810949A (en) | Method for controlling welding robot system in multi-layer over laying | |
| JP5502462B2 (en) | Control apparatus and program for arc welding robot | |
| JPH07266272A (en) | Follow-up method and device for manipulator | |
| JP2007000954A (en) | Robot teaching device and method | |
| JP2935600B2 (en) | Attitude control device of welding torch using sensor | |
| CN111604589A (en) | Laser processing apparatus | |
| JP3228717B2 (en) | Laser marker device | |
| JP3424130B2 (en) | Laser processing machine | |
| JP2011062763A (en) | Robot controller | |
| JPH10175085A (en) | Method and device for controlling profiling axis in three-dimensional laser beam machine | |
| JP2727379B2 (en) | Laser robot control method | |
| JP2597368B2 (en) | Automatic welding equipment | |
| JPH11123678A (en) | Position detecting method for work | |
| JP2542615B2 (en) | Machining line teaching method | |
| US20240123606A1 (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 | |
| JP3944419B2 (en) | Method for controlling welding robot apparatus | |
| JPH0790482B2 (en) | Method of detecting groove position at the beginning of processing line | |
| JPH0394979A (en) | Welding position detector |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090604 Year of fee payment: 10 |
|
| LAPS | Cancellation because of no payment of annual fees |