JPH05123866A - センサを用いた溶接トーチの姿勢制御方式 - Google Patents
センサを用いた溶接トーチの姿勢制御方式Info
- Publication number
- JPH05123866A JPH05123866A JP31135091A JP31135091A JPH05123866A JP H05123866 A JPH05123866 A JP H05123866A JP 31135091 A JP31135091 A JP 31135091A JP 31135091 A JP31135091 A JP 31135091A JP H05123866 A JPH05123866 A JP H05123866A
- Authority
- JP
- Japan
- Prior art keywords
- torch
- welding
- angle
- sensor
- 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.)
- Granted
Links
Landscapes
- Manipulator (AREA)
Abstract
(57)【要約】
【目的】 溶接中トーチ角度を常に最適トーチ角度に保
持する。 【構成】 トーチ１のワイヤ先端位置Ｐｔとセンサ２で
検出した溶接線位置Ｐｗ及びセンサ座標系の原点位置Ｐ
ｓより溶接線Ｌに対するトーチ角度θを求める。該トー
チ角度θが溶接条件によって決まる教示トーチ角度αに
なるようにトーチ姿勢を常に補正する。これにより溶接
線Ｌに対するトーチ角度θは常に教示角度αになり、溶
接結果を均一にすることができる。
持する。 【構成】 トーチ１のワイヤ先端位置Ｐｔとセンサ２で
検出した溶接線位置Ｐｗ及びセンサ座標系の原点位置Ｐ
ｓより溶接線Ｌに対するトーチ角度θを求める。該トー
チ角度θが溶接条件によって決まる教示トーチ角度αに
なるようにトーチ姿勢を常に補正する。これにより溶接
線Ｌに対するトーチ角度θは常に教示角度αになり、溶
接結果を均一にすることができる。
Description
【０００１】
【産業上の利用分野】本発明は、溶接線の位置をリアル
タイムで検出することのできるセンサを取り付けた溶接
ロボットにおける溶接トーチ姿勢制御方式に関する。
タイムで検出することのできるセンサを取り付けた溶接
ロボットにおける溶接トーチ姿勢制御方式に関する。
【０００２】
【従来の技術】溶接ロボット等においては、ロボツトに
レーザセンサ等のセンサを取り付け、該センサによって
リアルタイムで溶接線位置を検出し、その測定結果を制
御装置に送り、溶接線を追跡するようにしている。例え
ば、図６はレーザセンサの構造を示す図で、１０は検出
部で、レーザ発振器１１，レーザビームをスキャンさせ
る揺動ミラー（ガルバノメータ）１２，反射光を捕らえ
て受光素子１４に像を作る光学系１３を有し、制御部２
０には、レーザ発振器１１を駆動しレーザビームを発生
させるレーザ駆動部２１，揺動ミラー１２を揺動させる
ミラー操作部２２，受光素子１４で受光した位置から、
検出対象物位置を検出する信号検出部２３で構成されて
いる。
レーザセンサ等のセンサを取り付け、該センサによって
リアルタイムで溶接線位置を検出し、その測定結果を制
御装置に送り、溶接線を追跡するようにしている。例え
ば、図６はレーザセンサの構造を示す図で、１０は検出
部で、レーザ発振器１１，レーザビームをスキャンさせ
る揺動ミラー（ガルバノメータ）１２，反射光を捕らえ
て受光素子１４に像を作る光学系１３を有し、制御部２
０には、レーザ発振器１１を駆動しレーザビームを発生
させるレーザ駆動部２１，揺動ミラー１２を揺動させる
ミラー操作部２２，受光素子１４で受光した位置から、
検出対象物位置を検出する信号検出部２３で構成されて
いる。
【０００３】レーザ駆動部２１により、レーザ発振器１
１を駆動し、レーザビームを発生させると共に、ミラー
操作部２２を駆動し揺動ミラー１２を揺動させて、レー
ザ発振器１１から発生するレーザビームをワーク３０上
に当て走査させる。ワーク３０上で拡散反射したレーザ
ビームは光学系１３により、対象物上の反射位置に応じ
て、受光素子１４上に像を作ることになる。この受光素
子１４上の位置から三角測量の原理を用いて対象物との
距離を測定する。そして、上記揺動ミラーを１回走査
（１片側揺動）させることにより、レーザビーム走査方
向の対象物の断面データを得て、この断面データより溶
接線位を求めるようにしている（詳細は特願平３−１６
５０３８号，特願平３−２４０４７３号等参照）。
１を駆動し、レーザビームを発生させると共に、ミラー
操作部２２を駆動し揺動ミラー１２を揺動させて、レー
ザ発振器１１から発生するレーザビームをワーク３０上
に当て走査させる。ワーク３０上で拡散反射したレーザ
ビームは光学系１３により、対象物上の反射位置に応じ
て、受光素子１４上に像を作ることになる。この受光素
子１４上の位置から三角測量の原理を用いて対象物との
距離を測定する。そして、上記揺動ミラーを１回走査
（１片側揺動）させることにより、レーザビーム走査方
向の対象物の断面データを得て、この断面データより溶
接線位を求めるようにしている（詳細は特願平３−１６
５０３８号，特願平３−２４０４７３号等参照）。
【０００４】このようなレーザセンサを用いて溶接線位
置をリアルタイムで検出し、溶接線を追跡して溶接を行
う溶接ロボットにおいては、トーチ先端を溶接線上に位
置するように制御するだけで、トーチの姿勢は初めに教
示された状態を維持するだけである。
置をリアルタイムで検出し、溶接線を追跡して溶接を行
う溶接ロボットにおいては、トーチ先端を溶接線上に位
置するように制御するだけで、トーチの姿勢は初めに教
示された状態を維持するだけである。
【０００５】
【発明が解決しようとする課題】溶接を行う場合、最適
な溶接を得るには溶接条件に応じて、トーチを進行方
向、すなわち溶接線方向に前方向もしくは後方向に前進
角もしくは後進角（以下トーチ角度という）だけ傾ける
必要がある。しかし、従来の溶接ロボットではトーチ姿
勢は教示された姿勢を保持し、溶接線（溶接線の傾き
等）が変化しても、トーチ姿勢は変化せず上記トーチ角
度は溶接線の変化に合わせて変化することはない。例え
ば、図２に示すような曲面ワークの溶接線Ｌに対して溶
接を行う場合、トーチ姿勢が一定であるとトーチ角度は
大きく変化することになる。図２において、１はトー
チ、２はレーザセンサ、３はワイヤ、Ｌは溶接線であ
る。図２のような溶接線Ｌに対してＡ点からＢ点まで溶
接を行う場合に、Ａ点でトーチ姿勢を教示しても、溶接
線Ｌが変化し、トーチ１に対するワークの角度（トーチ
角度）も変化することになるので、溶接条件にあったト
ーチ角度をＡ点で教示していても、Ｂ点まで移動する途
中において、ワークに対する最適なトーチ角度で溶接が
行われないことになる。そのため、従来の方法では、教
示点を増加して、トーチ角度を最適な状態にする必要が
ある。
な溶接を得るには溶接条件に応じて、トーチを進行方
向、すなわち溶接線方向に前方向もしくは後方向に前進
角もしくは後進角（以下トーチ角度という）だけ傾ける
必要がある。しかし、従来の溶接ロボットではトーチ姿
勢は教示された姿勢を保持し、溶接線（溶接線の傾き
等）が変化しても、トーチ姿勢は変化せず上記トーチ角
度は溶接線の変化に合わせて変化することはない。例え
ば、図２に示すような曲面ワークの溶接線Ｌに対して溶
接を行う場合、トーチ姿勢が一定であるとトーチ角度は
大きく変化することになる。図２において、１はトー
チ、２はレーザセンサ、３はワイヤ、Ｌは溶接線であ
る。図２のような溶接線Ｌに対してＡ点からＢ点まで溶
接を行う場合に、Ａ点でトーチ姿勢を教示しても、溶接
線Ｌが変化し、トーチ１に対するワークの角度（トーチ
角度）も変化することになるので、溶接条件にあったト
ーチ角度をＡ点で教示していても、Ｂ点まで移動する途
中において、ワークに対する最適なトーチ角度で溶接が
行われないことになる。そのため、従来の方法では、教
示点を増加して、トーチ角度を最適な状態にする必要が
ある。
【０００６】そこで本発明の目的は、溶接中トーチ角度
を常に最適トーチ角度に保持できるセンサを用いた溶接
トーチの姿勢制御方式を提供することにある。
を常に最適トーチ角度に保持できるセンサを用いた溶接
トーチの姿勢制御方式を提供することにある。
【０００７】
【課題を解決するための手段】本発明は、トーチ位置と
上記センサで検出した溶接線位置とにより溶接線に対す
るトーチ角度を求め、該トーチ角度が教示トーチ角度に
なるようにトーチ姿勢を制御する。特に、トーチ位置と
センサ間は所定距離があり、トーチ位置とセンサで検出
される溶接線位置の間にはすでにセンサで検出した溶接
線位置が複数あることになる。そのため、センサで検出
した溶接線位置を順次記憶しておき、トーチ位置と該ト
ーチ位置に一番近い進行方向の記憶溶接線位置によりト
ーチ目標位置を求めるようにして、より精度を向上させ
る。また、トーチ姿勢を急激に変えると発振する恐れが
あるため、現時点のトーチ姿勢より目標トーチ姿勢に移
動させるときには設定ゲインを掛けて徐々に移動させる
ようにする。
上記センサで検出した溶接線位置とにより溶接線に対す
るトーチ角度を求め、該トーチ角度が教示トーチ角度に
なるようにトーチ姿勢を制御する。特に、トーチ位置と
センサ間は所定距離があり、トーチ位置とセンサで検出
される溶接線位置の間にはすでにセンサで検出した溶接
線位置が複数あることになる。そのため、センサで検出
した溶接線位置を順次記憶しておき、トーチ位置と該ト
ーチ位置に一番近い進行方向の記憶溶接線位置によりト
ーチ目標位置を求めるようにして、より精度を向上させ
る。また、トーチ姿勢を急激に変えると発振する恐れが
あるため、現時点のトーチ姿勢より目標トーチ姿勢に移
動させるときには設定ゲインを掛けて徐々に移動させる
ようにする。
【０００８】
【作用】図３に示すように、ワーク（溶接線Ｌ）に対す
るトーチ１の角度（前進角または後進角）θは溶接条件
等によって最適値がある。そこで、トーチの位置（ワイ
ヤ先端点位置）Ｐｔとセンサ２で検出される溶接線位置
Ｐｗ、及びセンサ座標系の原点Ｐｓよりトーチ角度θを
求め、このトーチ角度θが教示したトーチ角度αにから
ずれると、トーチ姿勢をトーチ角度が教示角度αになる
ように（θ−α）だけ移動させトーチ角度が教示角度α
に常になるように補正するようにする。そして、センサ
で検出される溶接線位置の中からその時点におけるトー
チ位置の進行方向の一番近い位置よりトーチ目標位置を
求める。また、トーチ姿勢を変えるときには、設定ゲイ
ン（１より小さい値）を掛けて徐々に移動させる。
るトーチ１の角度（前進角または後進角）θは溶接条件
等によって最適値がある。そこで、トーチの位置（ワイ
ヤ先端点位置）Ｐｔとセンサ２で検出される溶接線位置
Ｐｗ、及びセンサ座標系の原点Ｐｓよりトーチ角度θを
求め、このトーチ角度θが教示したトーチ角度αにから
ずれると、トーチ姿勢をトーチ角度が教示角度αになる
ように（θ−α）だけ移動させトーチ角度が教示角度α
に常になるように補正するようにする。そして、センサ
で検出される溶接線位置の中からその時点におけるトー
チ位置の進行方向の一番近い位置よりトーチ目標位置を
求める。また、トーチ姿勢を変えるときには、設定ゲイ
ン（１より小さい値）を掛けて徐々に移動させる。
【０００９】
【実施例】図３〜図５は本発明の一実施例におけるトー
チ角度θ及びトーチ角度制御方法の説明図である。図３
において、ワーク表面（溶接線Ｌ上）に当接したトーチ
１の先端（ワイヤ先端）をＰｔ、レーザセンサ２でワー
ク表面（溶接線Ｌ上）を検出した位置をＰｗ、このレー
ザセンサ２のサンサ座標系の原点位置をＰｓとしたと
き、トーチ先端点Ｐｔとセンサ座標系原点位置Ｐｓを結
ぶ線と、トーチ先端点Ｐｔとセンサが検出したワーク位
置Ｐｗとを結ぶ線とのなす角をトーチ角度θとする。ま
た、センサ座標系（Ｘｓ，Ｙｓ，Ｚｓ）とトーチ座標系
（Ｘｔ，Ｙｔ，Ｚｔ）を本実施例では図４に示すように
定義する。すなわち、トーチ座標系の原点はトーチ先端
点（ワイヤ先端点）Ｐｗとし、トーチ座標系とセンサ座
標系の各軸は同じ方向とする。また、本実施例では、セ
ンサ座標系の原点をトーチ座標系の原点からＸ軸方向の
みシフトした点としている（必ずしも、センサ座標系原
点をこのような位置に設定する必要がないが、説明を簡
単にするためにこのように設定する）。なお、図４にお
いて、トーチ座標系及びセンサ座標系のＹ軸の方向は紙
面垂直方向で紙面裏面から表面への方向を正の方向とし
ている。そして、上記トーチ角度θはトーチ座標系のＹ
ｔ軸の右ねじ回転方向を正の方向としており、図３に示
すトーチ角度θ（＝α）は逆方向に回転した値であるの
で負の値である。
チ角度θ及びトーチ角度制御方法の説明図である。図３
において、ワーク表面（溶接線Ｌ上）に当接したトーチ
１の先端（ワイヤ先端）をＰｔ、レーザセンサ２でワー
ク表面（溶接線Ｌ上）を検出した位置をＰｗ、このレー
ザセンサ２のサンサ座標系の原点位置をＰｓとしたと
き、トーチ先端点Ｐｔとセンサ座標系原点位置Ｐｓを結
ぶ線と、トーチ先端点Ｐｔとセンサが検出したワーク位
置Ｐｗとを結ぶ線とのなす角をトーチ角度θとする。ま
た、センサ座標系（Ｘｓ，Ｙｓ，Ｚｓ）とトーチ座標系
（Ｘｔ，Ｙｔ，Ｚｔ）を本実施例では図４に示すように
定義する。すなわち、トーチ座標系の原点はトーチ先端
点（ワイヤ先端点）Ｐｗとし、トーチ座標系とセンサ座
標系の各軸は同じ方向とする。また、本実施例では、セ
ンサ座標系の原点をトーチ座標系の原点からＸ軸方向の
みシフトした点としている（必ずしも、センサ座標系原
点をこのような位置に設定する必要がないが、説明を簡
単にするためにこのように設定する）。なお、図４にお
いて、トーチ座標系及びセンサ座標系のＹ軸の方向は紙
面垂直方向で紙面裏面から表面への方向を正の方向とし
ている。そして、上記トーチ角度θはトーチ座標系のＹ
ｔ軸の右ねじ回転方向を正の方向としており、図３に示
すトーチ角度θ（＝α）は逆方向に回転した値であるの
で負の値である。
【００１０】そこで、ワーク（溶接線Ｌ）に対してトー
チ角度を図３に示すようにθ＝α（ただしα＜０であ
る）として教示しているときに、図５に示すようにワー
ク表面（溶接線Ｌ）が変化しトーチ角度がθとなり教示
トーチ角度αではなくなった場合、トーチ１をトーチ座
標系におけるＹｔ軸回りに（θ−α）だけ回転させれば
教示角度αとなる。図３及び図５においては、教示トー
チ角度θ＝αで負の値であるから、（θ−α）＝（θ＋
｜α｜）だけ回転させれば良いことになる。すなわち、
トーチ１を右ねじ方向に（図５中反時計方向に）（θ＋
｜α｜）だけ回転させれば、トーチ角度は教示角度のα
となる。
チ角度を図３に示すようにθ＝α（ただしα＜０であ
る）として教示しているときに、図５に示すようにワー
ク表面（溶接線Ｌ）が変化しトーチ角度がθとなり教示
トーチ角度αではなくなった場合、トーチ１をトーチ座
標系におけるＹｔ軸回りに（θ−α）だけ回転させれば
教示角度αとなる。図３及び図５においては、教示トー
チ角度θ＝αで負の値であるから、（θ−α）＝（θ＋
｜α｜）だけ回転させれば良いことになる。すなわち、
トーチ１を右ねじ方向に（図５中反時計方向に）（θ＋
｜α｜）だけ回転させれば、トーチ角度は教示角度のα
となる。
【００１１】一方、ロボットのベース座標系に対するト
ーチ座標系は次ぎの数式１で表される。
ーチ座標系は次ぎの数式１で表される。
【００１２】
【数１】 なお、数式１において（ｎｘ，ｎｙ，ｎｚ）はノーマル
ベクトルＮ、（ｏｘ，ｏｙ，ｏｚ）はオリエンテーショ
ンベクトルＯ、（ａｘ，ａｙ，ａｚ）はアプローチベク
トルＡを表し、（ｐｘ，ｐｙ，ｐｚ）はベース座標系か
らみたトーチ座標系の原点位置ベクトル、すなわちトー
チ先端位置ベクトルＰを表している。また、トーチ１を
トーチ座標系のＹｔ軸回りに（θ−α）だけ回転させた
ときの行列Ｔrtは次ぎの数式２で表される。
ベクトルＮ、（ｏｘ，ｏｙ，ｏｚ）はオリエンテーショ
ンベクトルＯ、（ａｘ，ａｙ，ａｚ）はアプローチベク
トルＡを表し、（ｐｘ，ｐｙ，ｐｚ）はベース座標系か
らみたトーチ座標系の原点位置ベクトル、すなわちトー
チ先端位置ベクトルＰを表している。また、トーチ１を
トーチ座標系のＹｔ軸回りに（θ−α）だけ回転させた
ときの行列Ｔrtは次ぎの数式２で表される。
【００１３】
【数２】 よって回転後のトーチ座標系Ｐtb´は次ぎの数式３とな
る。
る。
【００１４】
【数３】 なお、上記数式３において、Ｃ＝ｃｏｓ（θ−α）、Ｓ
＝ｓｉｎ（θ−α）である。次ぎにトーチの現在位置Ｐ
（ｐｘ，ｐｙ，ｐｚ）よりトーチが移動すべき位置Ｐ´
（ｐｘ´，ｐｙ´，ｐｚ´）を求めるが、これは従来と
同様で、レーザセンサ２で検出した溶接線位置Ｐｗによ
って求める。現在位置Ｐよりレーザセンサ２がその時点
で検出している溶接線位置Ｐｗ方向にトーチを移動させ
ればよいが、トーチ先端とレーザセンサ２が検出する位
置は所定間隔離れており、その時点でレーザセンサ２で
検出した溶接線位置Ｐｗとトーチ先端位置Ｐｔ間にはす
でに検出した溶接線位置が複数存在することになる。そ
こで、レーザセンサ２が所定周期毎検出した溶接線位置
Ｐｗをバッファに記憶すると共に、該バッファに記憶す
る最も古い溶接線位置を読みだし、該バッフアからこの
読み出した溶接線位置を消去する処理を行い、現在のト
ーチ位置Ｐｔに最も近い検出溶接線位置を求める。この
溶接線位置をｗとし、指令された溶接速度をｖとする
と、次ぎにトーチが移動すべき目標位置Ｐ´は次ぎの数
式４によって求められる。
＝ｓｉｎ（θ−α）である。次ぎにトーチの現在位置Ｐ
（ｐｘ，ｐｙ，ｐｚ）よりトーチが移動すべき位置Ｐ´
（ｐｘ´，ｐｙ´，ｐｚ´）を求めるが、これは従来と
同様で、レーザセンサ２で検出した溶接線位置Ｐｗによ
って求める。現在位置Ｐよりレーザセンサ２がその時点
で検出している溶接線位置Ｐｗ方向にトーチを移動させ
ればよいが、トーチ先端とレーザセンサ２が検出する位
置は所定間隔離れており、その時点でレーザセンサ２で
検出した溶接線位置Ｐｗとトーチ先端位置Ｐｔ間にはす
でに検出した溶接線位置が複数存在することになる。そ
こで、レーザセンサ２が所定周期毎検出した溶接線位置
Ｐｗをバッファに記憶すると共に、該バッファに記憶す
る最も古い溶接線位置を読みだし、該バッフアからこの
読み出した溶接線位置を消去する処理を行い、現在のト
ーチ位置Ｐｔに最も近い検出溶接線位置を求める。この
溶接線位置をｗとし、指令された溶接速度をｖとする
と、次ぎにトーチが移動すべき目標位置Ｐ´は次ぎの数
式４によって求められる。
【００１５】
【数４】 その結果、現在のトーチの位置姿勢より、次ぎの移動位
置へ移動する目標位置，姿勢は上記数式３，数式４より
次ぎの数式５に示されるようになる。
置へ移動する目標位置，姿勢は上記数式３，数式４より
次ぎの数式５に示されるようになる。
【００１６】
【数５】 このようにしてトーチ１が次ぎに移動すべき目標位置，
姿勢が上記数式５で求まると、従来の動作制御と同様
に、逆変換を行ってロボットの各軸の移動量を計算し、
各軸を駆動すればよい。ただし、トーチ角度を（θ−
α）の値そのまま移動させると発振する恐れが生じるの
で、実際には、ゲインｇを掛けた値ｇ（θ−α）で移動
させ、徐々にトーチ角度を教示角度αに移動させるよう
にする。このゲインｇは「１」よりも小さい値で、実験
によってきめる。
姿勢が上記数式５で求まると、従来の動作制御と同様
に、逆変換を行ってロボットの各軸の移動量を計算し、
各軸を駆動すればよい。ただし、トーチ角度を（θ−
α）の値そのまま移動させると発振する恐れが生じるの
で、実際には、ゲインｇを掛けた値ｇ（θ−α）で移動
させ、徐々にトーチ角度を教示角度αに移動させるよう
にする。このゲインｇは「１」よりも小さい値で、実験
によってきめる。
【００１７】図１は、上述したトーチの位置姿勢制御を
行うロボット制御装置のプロセッサが実施する処理のフ
ローチャートである。なお、ロボット及びロボット制御
装置の構成は従来のレーザセンサを用いた溶接ロボット
の構成と同一であるので、そのハードウエアは省略す
る。
行うロボット制御装置のプロセッサが実施する処理のフ
ローチャートである。なお、ロボット及びロボット制御
装置の構成は従来のレーザセンサを用いた溶接ロボット
の構成と同一であるので、そのハードウエアは省略す
る。
【００１８】まず、プロセッサはトーチ１をプログラム
で設定された姿勢及び溶接開始位置にトーチ１を移動さ
せる（ステップＳ１）。そして、レーザセンサ２によっ
て溶接線位置Ｐｗを求め溶接線開始位置Ｐｔと検出した
溶接線位置Ｐｗよりトーチ角度θを求めこの角度を教示
トーチ角度αとして記憶する（ステップＳ２，Ｓ３）。
図３，図５の例では、この教示トーチ角度は負の値であ
る。
で設定された姿勢及び溶接開始位置にトーチ１を移動さ
せる（ステップＳ１）。そして、レーザセンサ２によっ
て溶接線位置Ｐｗを求め溶接線開始位置Ｐｔと検出した
溶接線位置Ｐｗよりトーチ角度θを求めこの角度を教示
トーチ角度αとして記憶する（ステップＳ２，Ｓ３）。
図３，図５の例では、この教示トーチ角度は負の値であ
る。
【００１９】次ぎに、溶接指令を出力し溶接を開始し
（ステップＳ４）、レーザセンサ２が検出した溶接線位
置Ｐｗを記憶するバッファより現時点のトーチ位置に一
番近い溶接線位置ｗを読みだし、現時点のトーチ位置
Ｐ，設定溶接速度ｖ及び読み出した溶接線位置ｗより上
記数式４の演算を行い目標移動位置Ｐ´を求める（ステ
ップＳ５）。さらに、現時点のトーチ位置と読み出した
溶接線位置ｗよりトーチ角度θを求め数式３の演算を行
うことによってトーチ姿勢を求める（ステップＳ６）。
次ぎに、求められた目標移動位置及び姿勢にトーチ１を
移動させる（ステップＳ７）。この場合トーチ姿勢の移
動量（θ−α）に対して設定ゲインｇを掛けてトーチ姿
勢を徐々に移動させる。以下、溶接終了まで（ステップ
Ｓ８）、ステップＳ５〜Ｓ８の処理を繰り返し実行す
る。
（ステップＳ４）、レーザセンサ２が検出した溶接線位
置Ｐｗを記憶するバッファより現時点のトーチ位置に一
番近い溶接線位置ｗを読みだし、現時点のトーチ位置
Ｐ，設定溶接速度ｖ及び読み出した溶接線位置ｗより上
記数式４の演算を行い目標移動位置Ｐ´を求める（ステ
ップＳ５）。さらに、現時点のトーチ位置と読み出した
溶接線位置ｗよりトーチ角度θを求め数式３の演算を行
うことによってトーチ姿勢を求める（ステップＳ６）。
次ぎに、求められた目標移動位置及び姿勢にトーチ１を
移動させる（ステップＳ７）。この場合トーチ姿勢の移
動量（θ−α）に対して設定ゲインｇを掛けてトーチ姿
勢を徐々に移動させる。以下、溶接終了まで（ステップ
Ｓ８）、ステップＳ５〜Ｓ８の処理を繰り返し実行す
る。
【００２０】
【発明の効果】本発明は、トーチ角度を常に求め、該ト
ーチ角度が設定教示角度になるように制御されるから、
ワーク（溶接線）に対して教示された最適トーチ角度
に、溶接中、常に保持され均一な溶接結果を得ることが
できる。
ーチ角度が設定教示角度になるように制御されるから、
ワーク（溶接線）に対して教示された最適トーチ角度
に、溶接中、常に保持され均一な溶接結果を得ることが
できる。
【図１】本発明の一実施例のロボット制御装置のプロセ
ッサが実施するトーチ位置・姿勢制御のフローチャート
である。
ッサが実施するトーチ位置・姿勢制御のフローチャート
である。
【図２】トーチ角度が変化することの説明図である。
【図３】本発明の一実施例におけるトーチ角度の説明図
である。
である。
【図４】本発明の一実施例におけるトーチ座標系とセン
サ座標系の説明図である。
サ座標系の説明図である。
【図５】同一実施例においてトーチ角度が変化したとき
のトーチ角度補正の説明図である。
のトーチ角度補正の説明図である。
【図６】同一実施例において使用するレーザセンサの概
要ブロック図である。
要ブロック図である。
１ トーチ ２ レーザセンサ ３ ワイヤ Ｌ 溶接線 Ｐｔ トーチ位置（ワイヤ先端点） Ｐｗ センサによる溶接線検出位置 Ｐｓ センサ座標系の原点 θ トーチ角度 α 教示トーチ角度
───────────────────────────────────────────────────── フロントページの続き (72)発明者 脇尾 宏志 山梨県南都留郡忍野村忍草字古馬場3580番 地 フアナツク株式会社商品開発研究所内 (72)発明者 岩本 孝 山梨県南都留郡忍野村忍草字古馬場3580番 地 フアナツク株式会社商品開発研究所内
Claims (3)
- 【請求項１】 ロボットに取り付けられたセンサでリア
ルタイムで溶接線位置を検出して溶接を行う溶接ロボッ
トにおいて、トーチ位置と上記センサで検出した溶接線
位置とにより溶接線に対するトーチ角度を求め、該トー
チ角度が教示トーチ角度になるようにトーチ姿勢を制御
することを特徴とするセンサを用いた溶接トーチの姿勢
制御方式。 - 【請求項２】 上記センサで検出した溶接線位置を順次
記憶しておき、トーチ位置と該トーチ位置に一番近い進
行方向の記憶溶接線位置により上記トーチ角度を求め、
該トーチ角度が教示トーチ角度になるようにトーチ姿勢
を制御することを特徴とする請求項１記載のセンサを用
いた溶接トーチの姿勢制御方式。 - 【請求項３】 現時点のトーチ姿勢より目標トーチ姿勢
に設定ゲインをもって移動させる請求項１または請求項
２記載のセンサを用いた溶接トーチの姿勢制御方式。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP31135091A JP2935600B2 (ja) | 1991-10-31 | 1991-10-31 | センサを用いた溶接トーチの姿勢制御装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP31135091A JP2935600B2 (ja) | 1991-10-31 | 1991-10-31 | センサを用いた溶接トーチの姿勢制御装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH05123866A true JPH05123866A (ja) | 1993-05-21 |
| JP2935600B2 JP2935600B2 (ja) | 1999-08-16 |
Family
ID=18016097
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP31135091A Expired - Fee Related JP2935600B2 (ja) | 1991-10-31 | 1991-10-31 | センサを用いた溶接トーチの姿勢制御装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP2935600B2 (ja) |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2001162371A (ja) * | 1999-12-09 | 2001-06-19 | Daihen Corp | トーチ姿勢制御方法及び装置及びアーク溶接用ロボット |
| EP1380379A3 (de) * | 2002-07-09 | 2005-11-23 | Airbus Deutschland GmbH | Anordnung und Verfahren zur Regelung der Nahtlage eines laserstrahlgefügten Profils |
| JP2015163407A (ja) * | 2014-02-28 | 2015-09-10 | ファナック株式会社 | 溶接トーチ検出装置および溶接ロボットシステム |
-
1991
- 1991-10-31 JP JP31135091A patent/JP2935600B2/ja not_active Expired - Fee Related
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2001162371A (ja) * | 1999-12-09 | 2001-06-19 | Daihen Corp | トーチ姿勢制御方法及び装置及びアーク溶接用ロボット |
| EP1380379A3 (de) * | 2002-07-09 | 2005-11-23 | Airbus Deutschland GmbH | Anordnung und Verfahren zur Regelung der Nahtlage eines laserstrahlgefügten Profils |
| JP2015163407A (ja) * | 2014-02-28 | 2015-09-10 | ファナック株式会社 | 溶接トーチ検出装置および溶接ロボットシステム |
| US10016834B2 (en) | 2014-02-28 | 2018-07-10 | Fanuc Corporation | Welding torch detector and welding robot system |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2935600B2 (ja) | 1999-08-16 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US5624588A (en) | Method of controlling robot for use in arc welding | |
| US5006999A (en) | Real-time robot control system tracking based on a standard path | |
| JPH08166813A (ja) | ウィービング動作を伴うロボットのトラッキング制御方法 | |
| JPS6388612A (ja) | 予見追跡制御型ロボツト | |
| JPH0810949A (ja) | 多層盛り溶接における溶接ロボットシステムの制御方法 | |
| JPH10264067A (ja) | 作業線探索機能を備えたロボット−レーザセンサシステム | |
| JPH07266272A (ja) | マニピュレータ用追従方法及び装置 | |
| JPH05123866A (ja) | センサを用いた溶接トーチの姿勢制御方式 | |
| JP3228717B2 (ja) | レーザマーカ装置 | |
| JP2597368B2 (ja) | 自動溶接装置 | |
| JPH08197248A (ja) | 多層盛溶接の為のトラッキング制御方法 | |
| JP3483713B2 (ja) | 隅肉多層盛り溶接ロボットシステムにおける制御方法 | |
| JP2727379B2 (ja) | レーザーロボットの制御方法 | |
| JPH10175085A (ja) | ３次元レーザー加工機における倣い軸制御方法と装置 | |
| JPH11123678A (ja) | ワークの位置検出方法 | |
| JPH0394979A (ja) | 溶接位置検出装置及び該装置を備えた溶接ロボット | |
| JP2502533B2 (ja) | センサ付溶接ロボツト | |
| JP2542615B2 (ja) | 加工線テイ−チング方法 | |
| US20240123606A1 (en) | Teaching point generation device that generates teaching points on basis of output of sensor, and teaching point generation method | |
| JP3944419B2 (ja) | 溶接ロボット装置の制御方法 | |
| JP3166316B2 (ja) | プレイバック型ロボットの教示・制御方法 | |
| US11654562B2 (en) | Apparatus, robot control device, robot system, and method of setting robot coordinate system | |
| JP2019089086A (ja) | レーザ加工方法、コントローラおよびロボットシステム | |
| JPH0790482B2 (ja) | 加工線始端の開先位置検出方法 | |
| JPH0816227A (ja) | 位置センサを用いた自動機械の移動経路教示方法 |
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 |