(57)【要約】【課題】  タンデム溶接の際の溶接線倣いにおいて、先行極のみでなく後行極についても高い倣い追従性能を実現する。【解決手段】  並進補正演算部２３は、先行極５ａの次時刻の位置のベース座標系Σbaseにおける並進方向の補正量である並進補正量ΔＰ(ｔ)で先行極５ａの目標値Ｐlead(t)を補正して一次補正目標値目標値Ｐlead(t)’を得る。回転補正演算部２４は並進補正量ΔＰ(ｔ)による補正によって生じる実溶接線Lreに対する先行極５ａ周りのトーチ６の姿勢のずれを補正するための回転補正量Δθ(ｔ)を計算し、回転補正量Δθ(ｔ)だけ先行極５ａ周りにトーチ６を回転させるように一次補正目標値Ｐlead(t)’を補正した二次補正目標値Ｐlead(ｔ)''を計算する。二次補正目標値Ｐlead(ｔ)''でマニピュレータ２を駆動する。【選択図】図１
2009166076.tif 000002
【特許請求の範囲】
【請求項１】
多関節型のマニピュレータと、
前記マニピュレータの先端に装着され、かつ一対の電極を備えるトーチと、前記電極に給電する溶接電源とを少なくとも含む溶接器と、
前記電極が教示経路に沿って移動するように前記マニピュレータを動作させつ、前記溶接器により溶接対象物の溶接を実行する制御装置と、
溶接中に前記溶接対象物の溶接継手の位置に対する前記電極の位置ずれを計測するセンシング手段と
を備え、
前記制御装置は、
前記電極のうち先行極の固定直交座標系における次時刻の位置及び姿勢の目標値を計算する目標値演算手段と、
前記センシング手段により計測された前記位置ずれに基づいて、前記先行極の次時刻の位置及び姿勢の前記固定座標系における並進方向の補正量である並進補正量を計算し、かつこの並進補正量で前記目標値を補正した一次補正目標値を計算する並進補正演算手段と、
前記並進補正量による補正によって生じる実溶接線に対する後行極の位置ずれを補正するための回転補正量を計算し、この回転補正量だけ前記先行極周りにトーチを回転させるように前記一次補正目標値を補正した二次補正目標値を計算する回転補正演算手段と、
前記二次補正目標値から計算した目標関節角度により前記マニピュレータの各関節を駆動する駆動手段と
を備える、溶接ロボット。
【請求項２】
前記回転補正量は以下の式で表される、請求項１に記載の溶接ロボット。
2009166076.tif 000009
【請求項３】
前記センシング手段は、それぞれ前記一対の電極のうちの一つに関連付けられた第１及び第２のセンシング手段を含み、
前記制御装置は、前記トーチの進行方向と、前記トーチの形状及び前記一対の電極の位置関係を規定するトーチ形状パラメータとに基づいて、前記一対の電極のうちのいずれが前記先行極であるかを判別する先行極判別手段を備え、
前記並進補正演算手段は、前記先行極判別手段の判別結果に基づいて、前記第１及び第２のセンシング手段のうち前記先行極に関連付けられたものの測定結果を使用して前記並進補正量を計算する、
請求項１又は請求項２に記載の溶接ロボット。
【請求項４】
前記第１及び第２のセンシング手段は電流検出センサである、請求項３に記載の溶接ロボット。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は溶接ロボットに関する。詳細には、本発明はタンデム溶接での溶接線倣いを行う溶接ロボットに関する。
【背景技術】
【０００２】
溶接ロボット等の自動溶接装置においては、各種センサによって溶接線を自動追従する「溶接線倣い(Seam Tracking)」が広範に採用されている。溶接線倣いは、対象ワークの加工誤差、設置誤差、熱歪みに起因する溶接中の動的誤差等によって生じる溶接狙い位置のずれをセンサで検知して補正することで、溶接欠陥を防止する事を目的としている。図１３は溶接線倣いの原理を模式的に示している。使用されるセンサ１としては、機械式センサ(特許文献１)、アーク溶接電流変化を用いるセンサ(特許文献２)、光学・視覚センサ(特許文献３)等がある。センサ１の方式が相違しても、センサ１によって計測した信号を信号処理部２で処理して溶接継ぎ手とトーチ３との位置ずれδ'を検出し、ロボット等の自動機械であるトーチ位置制御装置４に補正を指令するという点で、原理は同じである。
【０００３】
タンデム溶接法は、２つのアーク電極(溶接ワイヤ)で同時にアークを出して高溶着かつ高速の溶接を行うものである。タンデム溶接には、図１４Ａに示すように２つのアーク電極５ａ，５ｂが共通のトーチ６を備えるトーチ一体型と、図１４Ｂに示すように個々のアーク電極５ａ，５ｂ毎に別体のトーチ６ａ，６ｂを備える複数トーチ型がある。一般に、２つのアーク電極５ａ，５ｂのうち溶接線上の進行方向に対して前方側に位置するもの(図１４Ａ及び図１４Ｂのアーク電極５ａ)は先行極と呼ばれ、後方側に位置するもの(図１４Ａ及び図１４Ｂのアーク電極５ｂ)は後行極と呼ばれる。
【０００４】
溶接ロボットでタンデム溶接を行う際の溶接線倣いの一例が、特許文献４に開示されている。この特許文献４の溶接線倣いでは、ウィビング動作時のアーク溶接電流変化をセンサで検出し、このセンサを２つのアーク電極の両方に設けている。溶接線に対する経路の補正は、上下及び左右の並進成分により行っている。また、２つのアーク電極のうちのいずれの電流変化を参照するか（先行極の電流変化を参照する必要がある）は、操作者がプログラム命令等によって指定する方式を採用している。この特許文献４の溶接線倣いには、主として以下の２つの問題がある。
【０００５】
第１に、特に後行極について十分な倣い追従性能が確保されない。具体的には、倣いによる経路修正で後行極が位置ずれを起こして溶接欠陥を生じる。図１５に示すように教示経路Lteに対し実溶接線Lreが歪曲し、並進成分のみにより補正されたトーチ６の進行方向が教示経路Lteの進行方向に対して回転成分を持つ場合がある。この場合、先行極５ａは実溶接線Lreを正しく追従するものの、後行極５ｂについては実溶接線Lreに対する位置ずれδが生じて溶接欠陥となる。この問題を回避するには、倣いによる修正量自体を小さくする以外に方法が無い。倣いによる修正量を小さくするには、溶接対象ワークの加工精度向上だけでなく、設置時の位置ずれや溶接熱歪みを最小限に抑える等の製造面での工夫も必要となり、本来これら誤差を補正する目的の溶接線倣いが有効に機能しない結果となる。
【０００６】
第２に、操作が面倒でありヒューマンエラーの原因となる。前述のように特許文献４の溶接線倣いでは、２つのアーク電極のうちいずれの電流変化を倣い制御に用いるかは、操作者がプログラム命令等によって指定する方式を採用している。しかし、この方式では、プログラム作成時に、溶接の進行方向を把握しながら逐次いずれの電極を選択するかを入力するという面倒な作業を操作者に強いることになる。また、入力ミスにより後行極の電流変化値に基づいて倣いを行うと言う不適切な倣い方法を選択する可能性もある。
【０００７】
【特許文献１】特開昭５３−１１８２３９号公報
【特許文献２】特開昭５８−５３３７５号公報
【特許文献３】特開昭６２−１０１３７９号公報
【特許文献４】特開２００５−２５４２４２号公報
【発明の開示】
【発明が解決しようとする課題】
【０００８】
本発明は、タンデム溶接の際の溶接線倣いにおいて、先行極のみでなく後行極についても高い倣い追従性能を実現すること、及び操作者に面倒な作業を強いることなく、ヒューマンエラーも防止することを課題とする。
【課題を解決するための手段】
【０００９】
本発明は、多関節型のマニピュレータと、前記マニピュレータの先端に装着され、かつ一対の電極を備えるトーチと、前記電極に給電する溶接電源とを少なくとも含む溶接器と、前記電極が教示経路に沿って移動するように前記マニピュレータを動作させつ、前記溶接器により溶接対象物の溶接を実行する制御装置と、溶接中に前記溶接対象物の溶接継手の位置に対する前記電極の位置ずれを計測するセンシング手段とを備え、前記制御装置は、前記電極のうち先行極の固定直交座標系における次時刻の位置及び姿勢の目標値を計算する目標値演算手段と、前記センシング手段により計測された前記位置ずれに基づいて、前記先行極の次時刻の位置及び姿勢の前記固定座標系における並進方向の補正量である並進補正量を計算し、かつこの並進補正量で前記目標値を補正した一次補正目標値を計算する並進補正演算手段と、前記並進補正量による補正によって生じる実溶接線に対する後行極の位置ずれを補正するための回転補正量を計算し、この回転補正量だけ前記先行極周りにトーチを回転させるように前記一次補正目標値を補正した二次補正目標値を計算する回転補正演算手段と、前記二次補正目標値から計算した目標関節角度により前記マニピュレータの各関節を駆動する駆動手段とを備える、溶接ロボットを提供する。
【００１０】
この構成により、倣い制御により溶接進行方向が変化した場合に、先行極だけでなく後行極の位置も補正される。
【００１１】
具体的には、前記回転補正量は以下の式で表される。
【００１２】
【数１】
2009166076.tif 000003
【００１３】
前記センシング手段は、それぞれ前記一対の電極のうちの一つに関連付けられた第１及び第２のセンシング手段を含み、前記制御装置は、前記トーチの進行方向と、前記トーチの形状及び前記一対の電極の位置関係を規定するトーチ形状パラメータとに基づいて、前記一対の電極のうちのいずれが前記先行極であるかを判別する先行極判別手段を備え、前記並進補正演算手段は、前記先行極判別手段の判別結果に基づいて、前記第１及び第２のセンシング手段のうち前記先行極に関連付けられたものの測定結果を使用して前記並進補正量を計算する。
【００１４】
この構成により、一対の電極のうちいずれが先行極であるかが自動的に判別され、この判別結果に基づいて第１及び第２のセンシング手段のうち先行極に対応するものを使用した溶接線倣いが実行される。
【００１５】
前記第１及び第２のセンシング手段としては、電流検出センサを使用できる。また、光学式センサ、機械式センサ等の他の方式のセンサも採用できる。
【発明の効果】
【００１６】
回転補正演算手段を備える制御装置によって、倣いにより溶接進行方向が変化した場合に並進補正に加えて先行極周りにトーチを回転させる補正を行うことにより、先行極のみでなく後行極についても高い倣い追従性を実現できる。その結果、溶接対象物の加工精度や設置精度が低い場合や、熱歪み等による溶接中の動的誤差が発生した場合であっても高品質な溶接が可能となる。
【００１７】
制御装置に先行極判別手段を設けて先行極を自動的に判断し、先行極に対応するセンシング手段を自動的に選択する事で、従来のようにプログラム作成時に倣い制御に使用するセンサを操作者が逐次指定するという面倒な作業が不要となり、ヒューマンエラーも確実に防止できる。
【発明を実施するための最良の形態】
【００１８】
(第１実施形態)
図１に示す本発明の第１実施形態に係る溶接ロボット１は、マニピュレータ２、溶接器３、及び制御装置４を備える。この溶接ロボット１は溶接継手８ａに沿ってワーク(溶接対象物)８を自動的に溶接する。
【００１９】
マニピュレータ２の先端のフランジ面２ａ(図３参照)には、ワイヤからなる一対のアーク電極(以下、単に電極という。)５ａ，５ｂを備えるタンデム型のトーチ６が装着されている。マニピュレータ２は、このトーチ６の位置及び姿勢を三次元空間内で変化させる。マニピュレータ２は６個の回転関節RJm1，RJm2，RJm3，RJm4，RJm5，RJm6を有する。回転関節RJm1〜RJm6間はリンクで連結され、最も基端側の回転関節RJm1は台座７に取り付けられている。各回転関節RJm1〜RJm6は、回転駆動のためのモータ関節角度Ｊ(J1，J2，J3，J4，J5，J6)を検出するための角度センサを備える。
【００２０】
溶接器３は、前述のトーチ６に加え、個々の電極５ａ，５ｂに電力を供給する溶接電源９ａ，９ｂを備える。個々の電極５ａ，５ｂと対応する溶接電源９ａ，９ｂとの間には電流検出センサ１０ａ，１０ｂが配置されている。
【００２１】
図２を参照すると、制御装置４は、記憶部１１、マニピュレータ制御部１２、及び溶接制御部１３を備える。記憶部１１には、後述する教示プログラムとトーチ形状パラメータを含む種々の情報が記憶されている。マニピュレータ制御部１２は、回転関節RJm1〜RJm6を駆動してマニピュレータ２を動作させ、その位置及び姿勢を制御する。マニピュレータ制御部１２は、先行極判別部２１、目標値演算部２２、並進補正演算部２３、回転補正演算部２４、目標関節角度演算部２５、及び駆動部２６を備える。溶接制御部１３は、ワイヤ(電極５ａ，５ｂ)の送出速度や、溶接電源９ａ，９ｂの供給電力を含む溶接器３の動作を制御する。
【００２２】
次に、マニピュレータ２の制御に使用する座標を説明する。まず、マニピュレータ２に関し、原点がマニピュレータ２の台座７に設定され、かつ三次元空間に対して固定された直交座標系(ベース座標系Σbase)を設定する。ベース座標系Σbaseにおけるマニピュレータ２の位置及び姿勢をbaseP(X，Y，Z，α，β，γ)で表記する。αはロール角、βはピッチ角、γはヨー角をそれぞれ示す。また、図３に示すように、電極５ａ，５ｂを備えるトーチ６に関し、原点がマニピュレータ２の先端のフランジ面２ａに固定された直交座標系(フランジ座標系Σfln)を設定する。
【００２３】
次に、制御装置４により実行されるマニピュレータ２及び溶接器３の制御について説明する。
【００２４】
まず、制御装置４の記憶部１１には、教示プログラムとトーチ形状パラメータが記憶されている。
【００２５】
本実施形態における教示プログラムを図４に示す。この教示プログラムは、溶接開始位置Pnまで移動した後、溶接開始位置Pnから溶接速度V(cm/min)で直線移動し、振幅Aで周波数fの正弦波でウィビング動作を実行しつつ溶接開始位置Pnから溶接終了位置Pn+1まで溶接を行うという動作を溶接ロボット１に実行させるものである。本実施形態では教示経路Lte（図７及び図８参照）は直線である。ただし、この教示プログラムは一例であり、教示経路Lteが曲線等の他の条件下でも本発明を実行できる。
【００２６】
トーチ形状パラメータは、マニピュレータ２の先端に装着されたトーチ６が備える一対の電極５ａ，５ｂのマニピュレータ２に対する位置と、電極５ａ，５ｂ間の相互の位置関係とを規定したパラメータである。具体的には、トーチ形状パラメータは、一方の電極５ａの先端のフランジ座標系Σ flnでの位置及び姿勢flnPa(Xfa，Yfa，Zfa，αfa，βfa，γfa)と、他方の電極５ｂのフランジ座標系Σflnでの位置及び姿勢flnPb(Xfb，Yfb，Zfb，αfb，βfb，γfb)を含む。
【００２７】
以下、図５Ａ及び図５Ｂのフローチャートを参照する。まず、ステップＳ５−１において、マニピュレータ２により教示プログラムで教示された溶接開始位置Ｐｎまでトーチ６(本実施形態では電極５ａの先端)が移動する。次に、ステップＳ５−２において、先行極判別部２１が電極５ａ，５ｂのうちいずれが先行極であるかを判別する。この先行極の判別のために、教示プログラムで教示された溶接開始位置Pnと溶接終了位置Pn+1からベース座標系Σbaseにおける溶接の進行方向を示す単位ベクトル(溶接進行方向単位ベクトルｄ)が計算される。この溶接進行方向単位ベクトル(以下、単に進行方向ベクトルという。)ｄと前述のトーチ形状パラメータとから、電極５ａ，５ｂのいずれが先行極であるかが判別される。
【００２８】
以下の図５Ａ及び図５Ｂに関する説明では、ステップＳ４−２において電極５ａが先行極であると判別され、溶接開始位置Pn及び溶接終了位置Pn+1はベース座標系Σbaseにおける電極５ａの位置及び姿勢で表されるものとする。先行極の判別及びそれに伴う溶接開始位置Pn及び溶接終了位置Pn+1の設定の詳細については、図６及び図９を参照して後述する。以下の図５Ａ及び図５Ｂに関する説明では、必要に応じて電極５ａを「先行極」、電極５ｂを「後行極」と呼ぶ場合がある。また、電極５ａ，５ｂの位置及び姿勢に関して言及する場合には、電極５ａ，５ｂの先端の位置及び姿勢をいうものとする。
【００２９】
ステップＳ５−３で溶接が開始され、ステップＳ５−４で時刻tが初期化される(t＝０)。続いて、ステップＳ５−５〜Ｓ５−１３の処理が溶接終了位置Pn+1に到達するまで（ステップＳ５−１４）、一定の時間間隔(マニピュレータ２の経路計算周期)Ｔｃ毎に繰り返され、電極５ａ，５ｂの先端がウィビング動作しつつ、直線移動するように補間動作が実行される。まず、ステップＳ５−５において時刻tが時刻t+Tc(次時刻)に更新される。図７及び図８において符号６Ａは現時点におけるトーチ６(電極５ａ，５ｂ)の位置及び姿勢を示す。
【００３０】
次に、ステップＳ５−６において、目標値演算部２２がベース座標系Σbaseにおける時刻(次時刻)tでの先行極極５ａの位置及び姿勢の目標値Plead(t)を計算する。図４の教示プログラムの場合、目標値Plead(t)は以下の式(１)で表される。この式(１)において、振幅方向ベクトルwは進行方向ベクトルdと直交する単位ベクトルであり、ウィビング動作の向きを規定する。図８において、符号６Ｂはこの目標値Plead(ｔ)によりマニピュレータ２が動作した場合のトーチ６(電極５ａ，５ｂ)の位置及び姿勢を示す。
【００３１】
【数２】
2009166076.tif 000004
【００３２】
ステップＳ５−７〜Ｓ５−９は、並進補正演算部２３が実行する。
【００３３】
まず、ステップＳ５−７において、先行極の電流検出センサ(本例では電極５ａの電流検出センサ１０ａ)から溶接電流Ileadを取得する。前述のようにステップＳ５−２において先行極が自動的に判別され、自動的に判別された先行極５ａに対応する電流検出センサ１０ａから溶接電流Ileadを取得する。
【００３４】
次に、ステップＳ５−８において、この溶接電流Ileadとウィビングパターン(本実施形態では振幅A、周波数fの正弦波)から目標値Plead(ｔ)の実溶接線Lre（ワーク８の実際の溶接継手８ａ）に対する位置ずれ(時刻tにおける先行極５ａの実溶接線Lreに対する位置ずれ)を算出し、この位置ずれを補正するためのベース座標系Σbaseにおける並進補正量ΔP(t)(ΔX，ΔY，ΔZ)を算出する(図８参照)。この先行極５ａの位置ずれの算出及び時刻tにおける並進補正量ΔP(t)を算出する手法は種々知られており、例えば特開昭５８−５３３７５号に開示されている。続いて、ステップＳ５−９において、目標値Plead(t)を並進補正量ΔP(t)で補正して、時刻tにおける一次補正目標値Plead(t)’を計算する。一次補正目標値Plead(t)’は以下の式(２)で表すことができる。
【００３５】
【数３】
2009166076.tif 000005
【００３６】
図８の符号６Ｂを参照すれば明らかなように、仮に一次補正目標値Plead(ｔ)’に基づいてマニピュレータ２を動作させた場合、すなわち並進補正量ΔP(t)のみを考慮して経路修正を行った場合、先行極５ａは実溶接線Lreを正しく追従するものの、後行極５ａについては実溶接線Lreに対する位置ずれδが生じる。そこで、この後行極５ｂの位置ずれδを解消するために、回転補正演算部２４がステップＳ５−１０，Ｓ５−１１を実行して一次補正目標値Ｐlead(ｔ)’をさらに補正する。
【００３７】
まず、ステップＳ５−１０において、時刻tにおける回転補正量Δθ(t)を計算する。図８を参照すると、この回転補正量Δθ(t)は並進補正量ΔＰ(t)による目標位置Plead(ｔ)の補正(一次補正目標値Plead(t)’の計算)前後の進行方向ベクトルｄ，ｄ’の角度差を表す。言い換えれば、回転補正量Δθ(t)は、並進補正量ΔP(t)による目標位置Plead(ｔ)の補正によって生じる進行方向ベクトルdの回転角度を表す。図８を参照すれば明らかなように、幾何学的関係から回転補正量Δθ(t)は以下の式(３)で表される。
【００３８】
【数４】
2009166076.tif 000006
【００３９】
次に、ステップＳ５−１１において、一次補正目標値Ｐlead(t)’を回転補正量Δθ(t)で補正して二次補正目標値Plead(t)''を計算する。具体的には、矢印RCで示すように、符号を考慮して回転補正量−Δθ(ｔ)だけ先行軸５ａ周りにトーチ６が回転するように一次補正目標値Plead(t)’を補正する。図７及び図８の符号６Ｄを参照すれば明らかなように、二次補正目標値Plead(t)''に基づいてマニピュレータ２を動作させた場合、すなわち並進補正量ΔP(t)に加えて回転補正量Δθ(t)を考慮して経路修正を行った場合、先行極５ａが実溶接線Lreを正しく追従するだけでなく、後行極５ｂも位置ずれδが解消されて実溶接線Lreを正しく追従する。
【００４０】
次に、ステップＳ５−１２において、目標関節角度演算部２５が二次補正目標値Plead(t)''の逆キネマティクスを計算して目標関節角度Jta(t)(＝(Jta1，Jta2，Jta3，Jta4，Jta5，Jta6)を計算する。さらに、ステップＳ５−１３において、駆動部２６が目標関節角度Ｊta(ｔ)によりマニピュレータ２の個々の回転RJm1〜RJm6を駆動する。
【００４１】
以上のように、本実施形態の溶接ロボット１では、倣いにより溶接進行方向が変化した場合に、並進方向の補正に加えて先行極５ａ周りにトーチ６を回転させる補正を行うことにより、先行極５ａのみでなく後行極５ｂについても高い倣い追従性を実現できる。その結果、ワーク８の加工精度や設置精度の低い場合や、熱歪み等による溶接中の動的誤差が発生した場合であっても高品質な溶接が可能となる。
【００４２】
次に、図６及び図９を参照して先行極の判別(図５ＡのステップＳ５−２)について詳細に説明する。以下の例では現在位置(溶接開始位置)がマニピュレータ２の現在関節角度Ｊnow(J1now，J2now，J3now，J4now，J5now，J6now)で与えられ、次教示位置(溶接終了位置)もマニピュレータ２の関節角度Ｊ(J1n+1，J2n+1，J3n+1，J4n+1，J5n+1，J6n+1)で与えられたものとする。
【００４３】
まず、ステップＳ６−１において、現在関節角度Ｊnowを電極５ａ，５ｂのベース座標系Σbaseにおける現在位置及び姿勢Ｐanow，Ｐbnowに変換する。この変換は、現在関節角度Ｊnowの順キネマティクスを計算後、トーチ形状パラメータを適用することで実行できる。また、ステップＳ６−２において、次教示位置での関節角度Ｊn＋1を、電極５ａ，５ｂのベース座標系Σbaseにおける位置及び姿勢Ｐan+1，Ｐbn+1に変換する。この変換も、関節角度Ｊn+1の順キネマティクスを計算後、トーチ形状パラメータを適用することで実行できる。
【００４４】
次に、ステップＳ６−３において、電極５ａ，５ｂについて以下の式(４)，(５)で定義される溶接進行方向単位ベクトル(進行方向ベクトル)da，dbを計算する。
【００４５】
【数５】
2009166076.tif 000007
【００４６】
続いて、ステップＳ６−４において、進行方向ベクトルda，dbの内積を計算し、これらのベクトルがほぼ同一方向であるか否かを確認する。ステップＳ６−３において進行方向ベクトルda，dbが同一方向でない場合には、エラー(教示位置Pn，Pn+1が実行不可能な不正なものである)と判断して処理を中止する。このように、先行極の判別の際に、教示位置Pn，Pn+1の妥当性(電極５ａ，５ｂの狙いが溶接継手８ａから外れていないか)を確認可能であり、教示プログラムの誤りを溶接開始前に事前に検出できる。一方、ステップＳ６−４においてベクトルda，dbがほぼ同一方向であれば、ステップＳ６−５において電極５ａ，５ｂの進行方向ベクトルda，dbのうちのいずれか一方(いずれでもよい)を、代表の進行方向ベクトルdとして選択する。以下の説明では、電極５ａの進行方向ベクトルdaを進行方向ベクトルdとして選択したものとする(da＝d)。
【００４７】
次に、ステップＳ６−６において、以下の式(６)で定義される現在位置（溶接開始位置）における電極５ａから電極５ｂに向かう単位ベクトル(電極５ａ，５ｂの差分ベクトルdab)を計算する。
【００４８】
【数６】
2009166076.tif 000008
【００４９】
続いて、ステップＳ６−７において、進行方向ベクトルdと差分ベクトルdabの内積を計算し、それに基づいて進行方向ベクトルdと差分ベクトルdabの角度差Δθdを計算する。ステップＳ６−８において、この角度差Δθdを評価することで、電極５ａ，５ｂのいずれが先行極であるか判別する。
【００５０】
ステップＳ６−８で角度差Δθdがほぼ０°の場合、すなわち進行方向ベクトルdと差分ベクトルdabがほぼ同一方向である場合には、先行極は電極５ｂである。この場合、溶接開始位置Pnと溶接終了位置Pn+1は、先行極である電極５ｂの現在位置Pbnowと次教示位置Pbn+1にそれぞれ設定される。ステップＳ６−８でΔθｄがほぼ１８０°の場合、すなわち進行方向ベクトルdと差分ベクトルdabがほぼ反対方向である場合には、先行極は電極５ａである。この場合、溶接開始位置Pnと溶接終了位置Pn+1は、先行極である電極５ａの現在位置Panowと次教示位置Pan+1にそれぞれ設定される。ステップＳ６−８で、角度差Δθdがほぼ０°でもほぼ１８０°でもない場合には、ステップＳ６−１１において教示位置不正のエラーと判定されて処理を中止する。
【００５１】
以上のように、制御装置４の先行極判別部２１が先行極を自動的に判断し、先行極に対応する電流検出センサ１０ａ，１０ｂを自動的に選択する事で、従来のようにプログラム作成時に倣い制御に使用するセンサを操作者が逐次選択するという面倒な作業が不要となり、ヒューマンエラーも確実に防止できる。
【００５２】
現在位置と次教示位置は、関節角度以外、すなわち電極５ａのベース座標系Σbaseにおける位置及び姿勢、電極５ｂのベース座標系Σbaseにおける位置及び姿勢、又は電極５ａ，５ｂの中間のベース座標系Σbaseにおける位置及び姿勢で与えられてもよい。これらのいずれの場合も、図６のフローチャートを参照して説明した方法と同様の方法で先行極を判別した後、現在位置(溶接開始位置)と次教示位置(溶接終了位置)を電極５ａ，５ｂのうちの先行極のベース座標系Σbaseにおける位置及び姿勢に変換した後、図５Ａ及び図５Ｂのフローチャートを参照して説明した方法を適用することで、先行極と後行極の両方が実溶接線を追従する倣い制御を実行できる。
【００５３】
(第２実施形態)
図１０及び図１１に示す本発明の第２実施形態に係る溶接ロボット１は、電流検出センサ１０ａ，１０ｂ(図１及び図２参照)に代えて光学式センサ１００を備える。光学式センサ１００は、投光器１０１と受光センサ１０２を備える。また、本実施形態では先行極は予め分かっている(以下、電極５ａを先行極とする。)。
【００５４】
図１２Ａ及び図１２Ａに示す制御装置４により実行されるマニピュレータ２の制御は、溶接開始位置Pnまで移動して溶接が開始された後(ステップＳ１２−１，Ｓ１２−２)、先行電極５ａの目標値Plead(t)の計算、並進補正量ΔP(t)を使用した一次補正目標値Plead(t)’の計算、回転補正量Δθ(t)を使用した二次補正目標値Plead(t)''の計算、二次補正目標値Plead(t)''の目標関節角度Jta(t)への変換、及び目標関節角度Jta(t)のマニピュレータ２への出力を経路計算周期Tc毎に繰り返す点は、第１実施形態と同様である(ステップＳ１２−３〜Ｓ１２−１３)。
【００５５】
本実施形態は、並進量演算部２３が光学式センサ１００から入力される画像信号を使用して並進補正量ΔP(t)を計算している点が第１実施形態と異なる。具体的には、投光器１０１からレーザスリット光がワーク８に照射され、その反射光が受光センサ１０２により受光される。ステップＳ１２−６において、並進量演算部２３は受光センサ１０２から入力される画像信号を処理して溶接継手の位置を検出する(マニピュレータ２の先端に固定されたセンサ座標系が設定されており、画像処理によりまずセンサ座標系における溶接継手の位置を検出し、その後ベース座標系Σbaseに座標変換する)。ステップＳ１２−７において、光学式センサ１００を使用して検出した溶接継手の位置と先行極５ａの位置(いずれもベース座標系Σbase)とを比較して、並進補正量ΔＰ(ｔ)を計算する。
【００５６】
第２実施形態のその他の構成及び動作は第１実施形態と同様である。
【００５７】
本発明は前記実施形態に限定されず、種々の変形が可能である。例えば、トーチ一体型の溶接ロボットを例に本発明を説明したが、複数トーチ型の溶接ロボットにも本発明を適用できる。電流検出センサや光学センサ以外にも機械式センサを本発明の溶接ロボットに採用できる。
【図面の簡単な説明】
【００５８】
【図１】本発明の第１実施形態に係る溶接ロボットを示す概略構成図。
【図２】第１実施形態における制御装置のブロック図。
【図３】マニピュレータの先端付近を示す模式図。
【図４】教示プログラムを示す模式図。
【図５Ａ】本発明の第１実施形態に係る溶接ロボットの動作を説明するためのフローチャート。
【図５Ｂ】本発明の第１実施形態に係る溶接ロボットの動作を説明するためのフローチャート。
【図６】先行極の判判別を説明するためのフローチャート。
【図７】並進補正及び回転補正を説明するための模式図。
【図８】並進補正及び回転補正による先行極と後行極の移動示す模式図。
【図９】先行極の判別を説明するための模式図。
【図１０】本発明の第２実施形態に係る溶接ロボットを示す概略構成図。
【図１１】第２実施形態における制御装置のブロック図。
【図１２Ａ】本発明の第２実施形態に係る溶接ロボットの動作を説明するためのフローチャート。
【図１２Ｂ】本発明の第２実施形態に係る溶接ロボットの動作を説明するためのフローチャート。
【図１３】溶接線倣いの原理を示す模式図。
【図１４Ａ】トーチ一体型を示す模式図。
【図１４Ｂ】複数トーチ型を示す模式図。
【図１５】経路修正時の後行極の位置ずれを示す模式図。
【符号の説明】
【００５９】
１  溶接ロボット
２  マニピュレータ
２ａ  フランジ面
３  溶接器
４  制御装置
５ａ，５ｂ  アーク電極
６  トーチ
７  台座
８  ワーク
９ａ，９ｂ  溶接電源
１０ａ，１０ｂ  電流検出センサ
１１  記憶部
１２  マニピュレータ制御部
１３  溶接制御部
２１  先行極判別部
２２  目標値演算部
２３  並進補正演算部
２４  回転補正演算部
２５  目標関節角度演算部
２６  駆動部
１００  光学式センサ
１０１  投光器
１０２  受光センサ
RJｍ1〜RJm6  回転関節
【図１】
2009166076.tif 000010
【図２】
2009166076.tif 000011
【図３】
2009166076.tif 000012
【図４】
2009166076.tif 000013
【図５Ａ】
2009166076.tif 000014
【図５Ｂ】
2009166076.tif 000015
【図６】
2009166076.tif 000016
【図７】
2009166076.tif 000017
【図８】
2009166076.tif 000018
【図９】
2009166076.tif 000019
【図１０】
2009166076.tif 000020
【図１１】
2009166076.tif 000021
【図１２Ａ】
2009166076.tif 000022
【図１２Ｂ】
2009166076.tif 000023
【図１３】
2009166076.tif 000024
【図１４Ａ】
2009166076.tif 000025
【図１４Ｂ】
2009166076.tif 000026
【図１５】
2009166076.tif 000027