JPH1158014A - 溶接ロボットのウィービング制御装置 - Google Patents

Abstract

(57)【要約】 （修正有） 【課題】任意方向への高周波でのウィービング制御装置
を提供する。 【解決手段】少なくとも６自由度を有する多関節溶接ロ
ボットの各軸を用いてトーチを溶接線に沿って移動させ
るとともに、手首軸のうちの最先端の軸を除く２つの軸
を用いてトーチ先端を溶接線に対し左右にウィービング
動作を行う溶接ロボットのウィービング制御装置であっ
て、溶接に先立ち、手首軸の回転軸の方向がウィービン
グ相対量と垂直になるように、溶接時のトーチの位置及
び姿勢を設定する設定手段３と、溶接時、前記２つの軸
について、当該軸のみが微小角度回転したときにトーチ
先端の動く方向ベクトルをそれぞれ求める第１の演算手
段４と、溶接時、ウィービング相対量を２つの軸につい
ての方向ベクトルに分解することにより２軸の変化量を
求める第２の演算手段５と、溶接時、これら求めた変化
量に基づいて２つの軸の単振動分の目標角度を逐次求め
る第３の演算手段６とを具える。

Description

【発明の詳細な説明】

【０００１】

【産業上の利用分野】この発明は、多関節溶接ロボット
のウィービング制御装置に関する。

【０００２】

【従来の技術および発明が解決しようとする課題】産業
用ロボットを用いて溶接を行う場合、ロボット先端に溶
接トーチを持たせるが、このときウィービングと呼ばれ
る、トーチを左右に振動させながら溶接する方法がよく
用いられる。

【０００３】ウィービング動作を実現するためには、ロ
ボットに、溶接線の始点及び終点、そしてウィービング
相対量を教示する必要がある。ウィービング相対量と
は、トーチを溶接線に対して、どの方向にどの程度の量
揺動させるかを表すベクトル量である。

【０００４】ウィービング動作を行う場合、ロボット各
軸はこれら教示されたデータ（溶接線の始点及び終点、
ウィービング相対量）に基づいて動くことによってウィ
ービングを実現するのであるが、この際各軸をどのよう
に動作させるかについては、従来より様々な方法がとら
れてきた。

【０００５】ある従来手法では、全ての軸を振動動作さ
せることでトーチの揺動動作を実現するようにしている
が、ロボットには構造上剛性の低い軸やイナーシャの大
きな軸があり、全軸を動かしてウィービングを行う場
合、こうした軸の影響を受けるため、満足する軌跡精度
が得られない、高い周波数でのウィービングを行う事が
できないなどの問題があった。

【０００６】そこで、特開平５−７３１３０号公報，特
開平１−２７３６７４号公報などにおいては、ロボット
軸のうち根元側の数軸を用いて溶接線を辿るように制御
するとともに、剛性が高くイナーシャの低い先端側の数
軸をウィービング相対量だけ動くように動作させること
で、ウィービング動作を行うようにしている。

【０００７】特開平５−７３１３０号公報では、根元側
の基本３軸は溶接線に沿った軌跡を保つための動作を行
わせ、先端側の手首３軸のみを使用してウィービングパ
ターンを生成するとともに、図１１に示すように、ウィ
ービングのための回転軸中心Ｐ1とトーチ先端Ｐeを結ぶ
ベクトルＶ1が、回転軸中心Ｐ1と真の目標位置Ｐwとを
結ぶベクトルＶ2に重なるように振り角θを求め、該円
弧状に変化していく各トーチ位置を目標位置としてこれ
を手首軸３軸の各軸の位置に逆変換するようにしてい
る。

【０００８】しかしこの従来手法では、トーチ先端の軌
跡は円弧となるので、トーチ先端点Ｐeが真の目標位置
Ｐwには一致しない。すなわち、ウィービングは本来、
振幅中心位置からＰw位置までを直線で動かさなくては
ならないので、上記従来手法では充分な溶接品質が得ら
れないという問題がある。

【０００９】つぎに、特開平１−２７３６７４号公報で
は、トーチの単振動ウィービングを手首軸による制御と
しかつ溶接線倣いの動作制御をアーム軸による制御とす
るとともに、図１０に示すように、溶接トーチの延長線
Ｘ−Ｘ´が手首軸の各軸α，β，γの交点Ｏに交わるよ
うに手首軸を位置させてウィービングを行うようにして
いる。

【００１０】しかし、この従来手法では、溶接トーチの
延長線Ｘ−Ｘ´が手首軸の各軸α，β，γの交点Ｏに交
わるように手首軸を位置させるというように溶接トーチ
の姿勢に制限があるので、実用に供しない。また、この
従来技術では、手首軸の１つの軸に関しては、この軸を
回転させてもトーチ先端を動かすことができず、このた
めこの従来手法では、手首３軸でウィービングするとい
っても、実質は２軸でのウィービングとなり、任意の方
向へのウィービングは不可能である。

【００１１】そこで、特開平８−１５５６４７号公報に
おいては、６軸ロボットにおいて、溶接トーチ先端側の
第４軸、第５軸、第６軸からなる３軸、あるいは第３
軸、第４軸、第５軸からなる３軸を用いて溶接トーチ先
端を単振動動作させるとともに、前記選択した３つの軸
について、当該軸のみが微小距離回転したときにトーチ
先端の動く方向を各別に求め、ウィービング相対量を前
記求めた３つの軸の方向に分解することにより該３軸の
変化量を求め、これら求めた変化量に基づいて前記選択
した各３軸の目標角度を求めることによりウィービング
制御の前記単振動動作を行わせるようにしている。

【００１２】しかし、上記従来技術において、溶接トー
チ先端側の第４軸、第５軸、第６軸によって単振動動作
を行わせるようにした場合、溶接トーチ先端を第６軸の
回転軸上に一致するよう装着した際には、第６軸を回転
させてもトーチ先端を動かすことができず、このような
場合には、ウィービングで動くことのできる軸が２軸に
減るので、動けない方向がでてくる。すなわち、実際の
産業用ロボットでは溶接トーチ先端は第６軸の回転軸上
に一致するよう装着することが多くあるが、このような
装着形態の場合には、上記従来技術の場合は、任意の方
向へウィービングさせることができなくなる。

【００１３】また、この従来技術において、６軸ロボッ
トで、第３軸、第４軸、第５軸からなる３軸を用いて単
振動動作を行わせるようにした場合は、３軸というイナ
ーシャの高い軸を用いており、高い周波数でのウィービ
ングには限界があった。

【００１４】この発明はこのような実情に鑑みてなされ
たもので、理想的な軌跡による任意方向への高周波での
ウィービング制御を高精度に実現できる溶接ロボットの
ウィービング制御装置を提供することを目的とする。

【００１５】

【課題を解決するための手段及び作用効果】この発明で
は、少なくとも６自由度を有しかつ隣合う２つの軸が直
交する手首３軸を有する多関節溶接ロボットの各軸を用
いて溶接トーチ先端を溶接線に沿って移動させるととも
に、前記手首軸のうちの最先端の軸を除く２つの軸を用
いて溶接トーチ先端を溶接線に対し左右にウィービング
相対量だけ単振動させることによりウィービング平面上
でウィービング動作を行う溶接ロボットのウィービング
制御装置であって、溶接に先立ち、前記手首軸のうちの
最先端の軸の回転軸の方向がウィービング相対量と垂直
になるように、溶接時の溶接トーチの位置及び姿勢を設
定する設定手段と、溶接時、前記手首軸のうちの最先端
の軸を除く２つの軸について、当該軸のみが微小角度回
転したときにトーチ先端の動く方向ベクトルをそれぞれ
求める第１の演算手段と、溶接時、前記ウィービング相
対量を前記求めた２つの軸についての方向ベクトルに分
解することにより該２軸の変化量を求める第２の演算手
段と、溶接時、これら求めた変化量に基づいて前記２つ
の軸の前記単振動分の目標角度を逐次求める第３の演算
手段とを具えるようにしている。

【００１６】本発明によれば、手首３軸を有する６軸ロ
ボットにおいて、根元側から先端側に向かって第１軸、
第２軸、…、第６軸とするならば、溶接に先立ち、第６
軸の回転軸の方向がウィービング相対量と垂直になるよ
うに溶接時の溶接トーチの位置及び姿勢を設定し、溶接
時には、前記ウィービング相対量を第４軸および第５軸
がそれぞれ微小回転したときの方向ベクトルに分解する
ことにより第４軸および第５軸の角度の変化量を求め、
この変化量に基づいて求めた第４軸及び第５軸の目標角
度に従って第４軸及び第５軸を振動動作させて、ウィー
ビングの際の単振動動作を実現するようにしている。

【００１７】このようにこの発明によれば、ロボットの
手首３軸の内の最先端側の軸を除く２軸が微小回転した
ときにトーチ先端が動く平面上に、ウィービング相対量
が含まれるように教示し、これら２つの軸でウィービン
グ動作の単振動を実現するようにしたので、理想的な軌
跡による任意方向への高周波でのウィービング制御を高
精度に実現することができる。また、この発明は、溶接
トーチ先端を手首３軸の最先端軸の回転軸上に一致する
ように装着するような場合、すなわち最先端軸を回転さ
せてもトーチ先端を動かすことができないような溶接ト
ーチの姿勢がとられたような場合においても、手首３軸
の内の最先端側の軸を除く２軸のみを用いて、高精度且
つ高周波でのウィービング動作を実現することができ
る。

【００１８】また、この発明では、少なくとも６自由度
を有しかつ隣合う２つの軸が直交する手首３軸を有する
多関節溶接ロボットの各軸を用いて溶接トーチ先端を溶
接線に沿って移動させるとともに、前記手首軸のうちの
最先端の軸を除く２つの軸を用いて溶接トーチ先端を溶
接線に対し左右にウィービング相対量だけ単振動させる
ことによりウィービング平面上でウィービング動作を行
う溶接ロボットのウィービング制御装置であって、溶接
に先立ち、前記手首軸のうちの最先端の軸の回転軸の方
向がウィービング相対量と垂直になるように、溶接時の
溶接トーチの位置及び姿勢を設定する設定手段と、溶接
時、前記手首軸のうちの最先端の軸を除く２つの軸につ
いて、当該軸のみが微小角度回転したときにトーチ先端
の動く方向ベクトルをそれぞれ求める第１の演算手段
と、溶接時、前記求めた２つの方向ベクトルから形成さ
れる平面を求める第２の演算手段と、前記溶接線の方向
とウィービング相対量からウィービング平面を求める第
３の演算手段と、溶接時、前記第２の演算手段によって
求められた平面と第３の演算手段で求められたウィービ
ング平面との交線を求め、前記ウィービング相対量の方
向が前記交線方向に一致するようにウィービング相対量
を補正する第４の演算手段と、溶接時、前記補正された
ウィービング相対量を前記求めた２つの軸についての方
向ベクトルに分解することにより前記２つの軸の変化量
を求める第５の演算手段と、溶接時、これら求めた変化
量に基づいて前記２つの軸の前記単振動分の目標角度を
逐次求める第６の演算手段とを具えるようにしている。

【００１９】本発明では、手首３軸を有する６軸ロボッ
トにおいて、根元側から先端側に向かって第１軸、第２
軸、…、第６軸とするならば、溶接に先立ち、第６軸の
回転軸の方向がウィービング相対量と垂直になるように
溶接時の溶接トーチの位置及び姿勢を設定するととも
に、溶接時に、ウィービング相対量を、第４軸及び第５
軸がそれぞれ微小角度回転したときにトーチ先端の動く
各方向ベクトルから形成される平面とウィービング平面
との交線上にくるように補正し、この補正したウィービ
ング相対量を第４軸および第５軸がそれぞれ微小回転し
たときの方向ベクトルに分解することにより第４軸およ
び第５軸の角度の変化量を求め、この変化量に基づいて
求めた第４軸及び第５軸の目標角度に従って第４軸及び
第５軸を振動動作させて、ウィービングの際の単振動動
作を実現するようにしている。

【００２０】このようにこの発明によれば、初期設定さ
れたウィービング相対量の方向が、第４軸及び第５軸に
よって溶接トーチ先端が実際に動くことができる方向に
補正されてウィービングが行われるようになるので、第
６軸の回転軸の方向がウィービング相対量と垂直になる
ような教示設定が正確に行われないような場合において
も、良好な溶接品質を確保できるようになる。

【００２１】

【発明の実施の形態】以下、この発明を添付図面に示す
実施例に従って詳細に説明する。

【００２２】図２は、本発明が適用される溶接ロボット
の外観を示している。この図２に示す溶接ロボットは、
６軸の垂直多関節ロボットであり、第１軸Ｊ1、第２軸
Ｊ2および第３軸Ｊ3から成る基本軸と、第４軸Ｊ4、第
５軸Ｊ5および第６軸Ｊ6から成る手首軸とを有し、その
先端に溶接トーチ１０が取り付けられている。また、以
下の実施例において、ロボットは直交座標系Ｘ−Ｙ−Ｚ
によって制御され、トーチ先端の位置やウィービング相
対量はこの座標系で表現される。この場合、溶接トーチ
１０は、トーチ取付体１１を介してその先端１０ａが第
６軸Ｊ6の回転軸上１２に一致するように取り付けられ
ている。したがって、この場合、第６軸Ｊ6を回転させ
ても、溶接トーチ先端１０ａの位置は変化しない。

【００２３】図３は、溶接トーチ１０の姿勢変化を示す
ものである。

【００２４】すなわち、溶接トーチ１０は、姿勢パラメ
ータＡ，Ｂ，Ｃを有しており、溶接トーチ１０をＡ方
向、Ｂ方向またはＣ方向に回転させることで、その姿勢
を変化させることができる。なかでも、Ｃ方向の姿勢パ
ラメータＣは、トーチ１０自体の回転姿勢の変化であ
り、この姿勢パラメータＣを変化せることで、溶接対象
ワークに対する溶接トーチの向きは変えないで、ロボッ
トの各軸Ｊ1〜Ｊ6の角度を変化させることができる。

【００２５】図４は、ウィービング軌跡を示すもので、
始点Ｐ1から終点Ｐ2に至る溶接線に沿った軌跡に、各時
刻におけるウィービング相対量Ｗを加えたものがウィー
ビング軌跡となる。点Ｐeは或る時刻における溶接線上
の位置を示し、点Ｐwは同時刻におけるウィービング軌
跡上の目標位置を示している。つまり、ウィービング軌
跡は始点Ｐ1と終点Ｐ2とを結ぶベクトルとウィービング
相対量Ｗとで形成される平面上にあり、この平面をウィ
ービング面という。

【００２６】次に、図５および図６に従ってこの発明の
第１実施例を示す。

【００２７】図５は溶接を行う際のロボット先端付近を
示すもので、ａ4は第４軸Ｊ4を微小角度だけ回転させた
ときにトーチ先端の動く方向を示し、ａ5は第５軸Ｊ5を
微小角度だけ回転させたときにトーチ先端の動く方向を
示している。よって、第４軸Ｊ4及び第５軸Ｊ5をウィー
ビング軸として用いた場合に、ウィービング動作でトー
チ先端が動ける範囲は、ベクトルａ4とベクトルａ5とで
形成される平面上にあり、言い換えればこれは第６軸Ｊ
6の回転軸１２に垂直な平面上となる。

【００２８】したがって、ウィービング相対量Ｗがこの
平面内にあるように、すなわちウィービング相対量Ｗが
第６軸Ｊ6の回転軸と垂直になるように教示するように
すれば、第４軸Ｊ4と第５軸Ｊ5との２つの軸だけでウィ
ービング動作を行うことができる。

【００２９】すなわち、ティーチングボックスを操作し
てトーチの先端位置を溶接線の始点及び終点に位置させ
て溶接線を教示した後、この始点及び終点位置におい
て、溶接トーチ１０を先の図３に示すＡ方向，Ｂ方向に
動かして溶接トーチ１０の向きを決定し、最後に溶接ト
ーチを先の図３のＣ方向に回転させることで（トーチの
向きは変化しない）、ロボットの各軸Ｊ1〜Ｊ6を回転さ
せ、この状態中に第６軸の回転軸１２の方向が所望のウ
ィービング相対量Ｗ（ウィービング平面）と垂直になる
ようなロボットの各軸Ｊ1〜Ｊ6の姿勢を見つけだす。そ
して、このロボット各軸の姿勢を溶接始点及び終点にお
ける各軸Ｊ1〜Ｌ6の姿勢として教示設定する。

【００３０】以上の教示設定動作が第１の実施例の前提
である。

【００３１】次に、図６を用いてウィービング制御を行
う制御構成を示す。

【００３２】図６において、教示データ保存部１には、
前述した方法で教示された溶接線の始点位置データ、溶
接線の終点位置データ、溶接始点および終点で各軸Ｊ1
〜Ｊ6がとるべき角度データなどが予め保存されてい
る。ウィービングデータ保存部２には、ウィービング相
対量Ｗを決定するためのパラメータ（補助点あるいは傾
き角）や、ウィービング振幅、ウィービング周波数など
が予め設定されている逆変換部３は、教示データ保存部
１に記憶された教示データを用いて各時刻における溶接
線上の位置に対応する第１軸Ｊ1〜第６軸Ｊ6の目標角度
θ1〜θ6を求める。ウィービング相対量計算部４では、
ウィービングデータ保存部２に記憶された前記ウィービ
ングデータから各時刻におけるウィービング相対量Ｗを
計算する。

【００３３】ウィービング動作演算部５では、ウィービ
ング相対量Ｗおよび目標角度θ1〜θ6から各時刻におけ
る第４軸Ｊ4と第５軸Ｊ5の角度変化量Δθ4、Δθ5を求
める。ロボット動作指令部６では、逆変換部３から入力
される目標角度θ1〜θ6のうちのθ1〜θ3およびθ6を
そのまま第１軸Ｊ1〜第３軸Ｊ3および第６軸Ｊ6の指令
角度Θ1〜Θ3およびΘ6としてロボットに出力するとと
もに、逆変換部３から入力される目標角度θ4，θ5に、
ウィービング動作演算部５で求めた変化量Δθ4、Δθ5
をそれぞれ加算し、該加算結果（θ4+Δθ4）、（θ5+
Δθ5）を第４軸Ｊ4および第５軸Ｊ5の指令角度Θ4，Θ
5としてロボットに出力する。

【００３４】以下、上記図６の構成の動作を図１のフロ
ーチャートにしたがって詳細に説明する。なお、このフ
ローチャートは、或る時刻におけるウィービング軌跡上
の目標位置Ｐw（図４参照 ）に対応する各軸Ｊ1〜Ｊ6の
目標値Θ1〜Θ6を演算する場合について示しており、こ
のような動作が溶接開始から終了まで繰り返し実行され
る。

【００３５】ロボット動作中、逆変換部３では、教示デ
ータ保存部１に記憶された教示データを用いて或る時刻
における溶接線上の点Ｐeの座標（Ｘe，Ｙe，Ｚe）を求
め、さらにこのＰe座標（Ｘe，Ｙe，Ｚe）を各軸の角度
θ1〜θ6に変換する（ステップ１００）。

【００３６】次に、ウィービング相対量演算部４は、ウ
ィービングデータを用いて点Ｐeに対応するウィービン
グ相対量Ｗ（Ｗx，Ｗy，Ｗz）を計算する（ステップ１
１０）。

【００３７】次に、ウィービング動作演算部５では、ウ
ィービング動作を行わせる２つの軸、すなわち第４軸及
び第５軸について、当該軸のみが微小角度回転したとき
にトーチ先端１０の動く方向を各別に求める（ステップ
１２０）。詳細は以下の通りである。

【００３８】まず、第４軸Ｊ4に関しては、第４軸Ｊ4の
軸方向の単位ベクトルをｉ4とし、第４軸Ｊ4とトーチ先
端を結ぶベクトルをｖ4とするとき、第４軸Ｊ4のみが回
転したときトーチ先端が動く方向ベクトルａ4は次式の
ようになる。

【００３９】 ａ4＝ｉ4＊ｖ4 (*はベクトル積) …（１） 図７は、図２に示した６軸多関節ロボットを模式的に示
すものであり、この図７に示した各部の寸法や角度を用
いると、上記単位ベクトルｉ4やベクトルｖ4は、次式の
ように示される。

【００４０】 …（２） …（３） 第５軸Ｊ5に関しても同様であり、第５軸Ｊ5の軸方向の
単位ベクトルをｉ5とし、第５軸Ｊ5とトーチ先端を結ぶ
ベクトルをｖ5とするとき、第５軸Ｊ5のみが回転したと
きトーチ先端が動く方向ベクトルａ5は次式のようにな
る。

【００４１】 ａ5＝ｉ5＊ｖ5 (*はベクトル積) …（４） つぎに、ウィービング動作演算部５は、ウィービング相
対量計算部４で求めた点Ｐeにおけるウィービング相対
量Ｗを前記求めた２つの方向ベクトルａ4，ａ5に分解す
ることにより第４軸と第５軸の角度変化量Δθ4，Δθ5
を求める（ステップ１３０）。

【００４２】具体的には、全てのベクトルが３次元であ
ることを考慮して、まず方向ベクトルａ4，ａ5のベクト
ル積ａ45を作成する。

【００４３】 ａ45＝ａ4＊ａ5 …（５） つぎに、これら３つのベクトルａ4，ａ5，ａ45の単位ベ
クトルを求める。

【００４４】 ｅ4＝ｅ4／｜ｅ4｜ …（６） ｅ5＝ｅ5／｜ｅ5｜ …（７） ｅ4＝ｅ45／｜ｅ45｜ …（８） このとき、ウィービング相対量Ｗは Ｗ＝Δθ4・ｅ4＋Δθ5・ｅ5＋Δθ45・ｅ45 …（９） と表すことができる。

【００４５】ここで、Δθ45はｅ45方向への移動量であ
り、ロボットの軸の角度変化量には対応しないが、計算
上便宜上導入した。

【００４６】ｅ4，ｅ5，ｅ45を …（１０） とすれば、上記（９）式は下式（１１）のようになるの
で、 …（１１） 上記（１１）式を変形して下式（１２）のように逆行列
を掛けることにより、第４軸と第５軸の変化量Δθ4，
Δθ5を求めることができる。

【００４７】 …（１２） なお、教示の際に、ウィービング相対量Ｗはベクトルａ
4とベクトルａ5とで形成される平面に含まれるようにロ
ボットの姿勢が教示されているので、理想的には、Δθ
45は零になり、ウィービング動作には関係がない。

【００４８】ロボット動作指令部６は、逆変換部３から
入力される目標角度θ1〜θ6のうちのθ1〜θ3およびθ
6をそのまま第１軸Ｊ1〜第３軸Ｊ3および第６軸Ｊ6の指
令角度Θ1〜Θ3およびΘ6としてロボットに出力すると
ともに、逆変換部３から入力される目標角度θ4，θ5
に、ウィービング動作演算部５で求めた変化量Δθ4、
Δθ5をそれぞれ加算し、該加算結果（θ4+Δθ4）、
（θ5+Δθ5）を第４軸Ｊ4および第５軸Ｊ5の指令角度
Θ4，Θ5としてロボットに出力する（ステップ１４
０）。

【００４９】このように上記実施例によれば、第４軸お
よび第５軸がΔθ4およびΔθ5だけ変化することで、溶
接トーチ１０の先端がウィービング相対量Ｗだけ移動す
ることになる。すなわち、本実施例によれば、２つの
軸、第４軸および第５軸のみを振動動作させることによ
り、所望のウィービング軌跡を実現することができる。
次に、図８、図９および図１０に従ってこの発明の第２
実施例を示す。

【００５０】先の第１の実施例では、教示の際に、ウィ
ービング相対量Ｗがａ4とａ5で形成される平面に含まれ
るようにトーチ先端の位置や姿勢を教示したが、こうし
た教示を厳密に行うことは非常に困難であり、そのよう
な教示をしたつもりでも実際にはウィービング相対量Ｗ
はａ4とａ5とで形成される平面から多少なりとも離れて
いる。すなわち、先の第１の実施例の方法で第４軸と第
５軸とを振動動作させてもトーチは所望のウィービング
面上を動かず、結果として良好な溶接品質が得られない
場合がある。

【００５１】この第２実施例はこの問題点を考慮してな
されたもので、ウィービング相対量Ｗを、ａ4とａ5とで
形成される平面と、ウィービング面との交線上にくるよ
うに修正することで、教示を厳密に行わなくとも、トー
チを所望のウィービング面上で動かせ、良好な溶接品質
を得ることができるようにしている。

【００５２】図８は、ウィービング相対量Ｗと溶接線方
向を示すベクトルｆ（始点Ｐ1から終点Ｐ2に向かうベク
トル）とから形成されるウィービング面Ｓwとベクトル
ａ4，ａ5から形成される平面Ｓ45との関係を示したもの
である。

【００５３】この図からも判るように、通常の教示で
は、ウィービング相対量Ｗは平面Ｓ45上にはなく、この
ような場合に先の実施例に従ってウィービングを行う
と、溶接トーチ先端はＷd方向にウィービングすること
になる。つまり、この場合には所望のウィービング面上
を動く事ができず、良好な溶接品質を得ることはできな
い。

【００５４】そこで、この第２実施例では、ウィービン
グ相対量Ｗをウィービング平面Ｓwと平面Ｓ45との交線
Ｃ上にあるように補正し、この補正したウィービング相
対量Ｗ45に従ってウィービング動作させることで、第４
軸及び第５軸の２つの軸の振動動作によってウィービン
グ面Ｓw上を溶接トーチ先端が動くようにしている。す
なわち、この実施例では、ウィービング相対量Ｗの方向
を、第４軸及び第５軸によって溶接トーチ先端が実際に
動くことができる方向Ｗ45に補正することで、教示が正
確に行われないような場合においても、良好な溶接品質
を確保できるようにしている。

【００５５】図９は、第２の実施例の制御構成を示すブ
ロック図である。この図９において、ウィービング動作
演算部７以外の各構成要素の動作機能は先の図６に示し
たものと全く同じであり、重複する説明は省略する。

【００５６】ウィービング動作演算部７においては、ウ
ィービング相対量計算部４で求めたウィービング相対量
Ｗと、溶接線の始点及び終点から求めた溶接線の方向を
示すベクトルｆとからウィービング平面Ｓwを求めると
共に、第４軸及び第５軸について当該軸のみが微小角度
回転したときにトーチが動く方向ａ4とａ5とから形成さ
れる平面Ｓ45を求め、これら平面ＳwとＳ45との交線上
にあってウィービング相対量Ｗと同じ大きさを持つウィ
ービング相対量の補正値Ｗ45を求め、この補正値Ｗ45を
用いて先の実施例と全く同じ方法で第４軸と第５軸の変
化量Δθ4，Δθ5を求めるよう動作する。

【００５７】以下、上記図９の構成の動作を図１０のフ
ローチャートにしたがって詳細に説明する。なお、この
フローチャートは、或る時刻におけるウィービング軌跡
上の目標位置Ｐw（図８参照 ）に対応する各軸Ｊ1〜Ｊ6
の目標値Θ1〜Θ6を演算する場合について示しており、
このような動作が溶接開始から終了まで繰り返し実行さ
れる。

【００５８】なお、この第２実施例においても、実際の
溶接を行う前に、先の第１実施例と同様の教示動作を行
う。すなわち、第６軸の回転軸の方向がウィービング相
対量Ｗと垂直になるように、溶接時の溶接トーチの位置
及び姿勢を教示する。

【００５９】つぎに、溶接時の動作を説明する。

【００６０】ロボット動作中、逆変換部３では、教示デ
ータ保存部１に記憶された教示データを用いて或る時刻
における溶接線上の点Ｐeの座標（Ｘe，Ｙe，Ｚe）を求
め、さらにこのＰe座標（Ｘe，Ｙe，Ｚe）を各軸の角度
θ1〜θ6に変換する（ステップ２００）。

【００６１】次に、ウィービング相対量演算部４は、ウ
ィービングデータを用いて点Ｐeにおけるウィービング
相対量Ｗ（Ｗx，Ｗy，Ｗz）を計算する（ステップ２１
０）。

【００６２】次に、ウィービング動作演算部５では、ウ
ィービング動作を行わせる２つの軸、すなわち第４軸及
び第５軸について、当該軸のみが微小角度回転したとき
にトーチ先端の動く方向ａ4とａ5を各別に求める（ステ
ップ２２０）。これらの、詳細は先の実施例と同様であ
る。

【００６３】続いて、教示データ保存部１に記憶された
溶接線の始点Ｐ1および終点Ｐ2を用いて溶接線の方向を
示すベクトルｆを次式（１３）により求める（ステップ
２３０）。

【００６４】ｆ＝Ｐ2Ｐ1…（１３） つぎに、ａ4とａ5とから形成される平面Ｓ45と、ウィー
ビング面Ｓwとの交線を求める。まず、ａ4とａ5とから
形成される平面Ｓ45は次式（１４）によって表わされ
る。

【００６５】ａ4＊ａ5…（１４） また、ウィービング面Ｓwに垂直なベクトルは、前記求
めたウィービング相対量Ｗと溶接線の方向を示すベクト
ルｆを用いて次式（１５）で表される。

【００６６】Ｗ＊ｆ…（１５） よって、２つの平面の交線Ｃを次式（１６）によって求
める。

【００６７】Ｃ＝（Ｗ＊ｆ）＊（ａ4＊ａ5）…（１６） さらに、ＣはＷに近い方向に向くように、次式（１７）
で補正してＣwを求める。

【００６８】 つぎに、ウィービング相対量Ｗからその大きさが同じ
で、方向が交線方向Ｃwに一致するようなウィービング
相対量の補正値Ｗ45を次式（１８）によって求める。

【００６９】Ｗ45＝｜Ｗ｜Ｃw／｜Ｃw｜…（１８） 次に、ウィービング相対量の補正値Ｗ45を前記求めた２
つの方向ベクトルａ4，ａ5に分解することにより、第４
軸及び第５軸の変化量Δθ4，Δθ5を求める（ステップ
２６０）。

【００７０】その詳細は、先の実施例と同様である。

【００７１】ロボット動作指令部６は、逆変換部３から
入力される目標角度θ1〜θ6のうちのθ1〜θ3およびθ
6をそのまま第１軸Ｊ1〜第３軸Ｊ3および第６軸Ｊ6の指
令角度Θ1〜Θ3およびΘ6としてロボットに出力すると
ともに、逆変換部３から入力される目標角度θ4，θ5
に、ウィービング動作演算部７で求めた変化量Δθ4、
Δθ5をそれぞれ加算し、該加算結果（θ4+Δθ4）、
（θ5+Δθ5）を第４軸Ｊ4および第５軸Ｊ5の指令角度
Θ4，Θ5としてロボットに出力する（ステップ２７
０）。

【００７２】このようにこの第２の実施例によれば、ウ
ィービング相対量Ｗの方向を、第４軸及び第５軸によっ
て溶接トーチ先端が実際に動くことができる方向Ｗ45に
補正することで、教示が正確に行われないような場合に
おいても、良好な溶接品質を確保できるようにしてい
る。

【００７３】なお、上記各実施例では、図５に示すよう
に、溶接トーチ１０の先端が第６軸の回転軸に一致する
ように溶接トーチを取り付けるようにしたが、本発明は
これに必ずしも限るわけでなく、そうでない場合にも適
用することができる。

【００７４】また、上記実施例では、本発明を６軸多関
節ロボットに適用するようにしたが、本発明を７軸以上
の多関節ロボットに適用するようにしてもよい。

【図面の簡単な説明】

【図１】この発明の第１実施例の作用を示すフローチャ
ート。

【図２】６軸多関節溶接ロボットの外観構成を示す図。

【図３】溶接トーチの姿勢パラメータを示す図。

【図４】ウィービング軌跡を示す図。

【図５】実施例の作用を説明するために溶接トーチ先端
付近を示した図。

【図６】この発明の第１実施例の制御構成を示すブロッ
ク図。

【図７】６軸多関節ロボットの動作演算のための各種パ
ラメータが記入された模式図。

【図８】第２実施例の原理を説明する図。

【図９】この発明の第２実施例の制御構成を示すブロッ
ク図。

【図１０】この発明の第２実施例の作用を示すフローチ
ャート。

【図１１】従来技術を示す図。

【図１２】他の従来技術を示す図。

【符号の説明】

１…教示データ保存部 ２…ウィービングデータ保存部 ３…逆変換部 ４…ウィービング相対量計算部 ５…ウィービング動作演算部 ６…ロボット動作指令部 ７…ウィービング動作演算部 １０…溶接トーチ

───────────────────────────────────────────────────── フロントページの続き (51)Int.Cl.⁶ 識別記号 ＦＩ Ｇ０５Ｂ 19/42 Ｇ０５Ｂ 19/42 Ｒ

Claims (4)

【特許請求の範囲】
1. 【請求項１】少なくとも６自由度を有しかつ隣合う２つ
   の軸が直交する手首３軸を有する多関節溶接ロボットの
   各軸を用いて溶接トーチ先端を溶接線に沿って移動させ
   るとともに、前記手首軸のうちの最先端の軸を除く２つ
   の軸を用いて溶接トーチ先端を溶接線に対し左右にウィ
   ービング相対量だけ単振動させることによりウィービン
   グ平面上でウィービング動作を行う溶接ロボットのウィ
   ービング制御装置であって、 溶接に先立ち、前記手首軸のうちの最先端の軸の回転軸
   の方向がウィービング相対量と垂直になるように、溶接
   時の溶接トーチの位置及び姿勢を設定する設定手段と、 溶接時、前記手首軸のうちの最先端の軸を除く２つの軸
   について、当該軸のみが微小角度回転したときにトーチ
   先端の動く方向ベクトルをそれぞれ求める第１の演算手
   段と、 溶接時、前記ウィービング相対量を前記求めた２つの軸
   についての方向ベクトルに分解することにより該２軸の
   変化量を求める第２の演算手段と、 溶接時、これら求めた変化量に基づいて前記２つの軸の
   前記単振動分の目標角度を逐次求める第３の演算手段
   と、 を具えるようにした溶接ロボットのウィービング制御装
   置。
2. 【請求項２】前記設定手段は、溶接トーチを所望の位置
   及び姿勢に位置決めした後、溶接トーチの回転姿勢のみ
   を変化させて前記手首軸のうちの最先端の軸の回転軸が
   ウィービング相対量と直角になるように溶接始点及び終
   点での各軸の角度を教示する教示手段であることを特徴
   とする請求項１記載の溶接ロボットのウィービング制御
   装置。
3. 【請求項３】少なくとも６自由度を有しかつ隣合う２つ
   の軸が直交する手首３軸を有する多関節溶接ロボットの
   各軸を用いて溶接トーチ先端を溶接線に沿って移動させ
   るとともに、前記手首軸のうちの最先端の軸を除く２つ
   の軸を用いて溶接トーチ先端を溶接線に対し左右にウィ
   ービング相対量だけ単振動させることによりウィービン
   グ平面上でウィービング動作を行う溶接ロボットのウィ
   ービング制御装置であって、 溶接に先立ち、前記手首軸のうちの最先端の軸の回転軸
   の方向がウィービング相対量と垂直になるように、溶接
   時の溶接トーチの位置及び姿勢を設定する設定手段と、 溶接時、前記手首軸のうちの最先端の軸を除く２つの軸
   について、当該軸のみが微小角度回転したときにトーチ
   先端の動く方向ベクトルをそれぞれ求める第１の演算手
   段と、 溶接時、前記求めた２つの方向ベクトルから形成される
   平面を求める第２の演算手段と、 前記溶接線の方向とウィービング相対量からウィービン
   グ平面を求める第３の演算手段と、 溶接時、前記第２の演算手段によって求められた平面と
   第３の演算手段で求められたウィービング平面との交線
   を求め、前記ウィービング相対量の方向が前記交線方向
   に一致するようにウィービング相対量を補正する第４の
   演算手段と、 溶接時、前記補正されたウィービング相対量を前記求め
   た２つの軸についての方向ベクトルに分解することによ
   り前記２つの軸の変化量を求める第５の演算手段と、 溶接時、これら求めた変化量に基づいて前記２つの軸の
   前記単振動分の目標角度を逐次求める第６の演算手段
   と、 を具えるようにした溶接ロボットのウィービング制御装
   置。
4. 【請求項４】前記設定手段は、溶接トーチを所望の位置
   及び姿勢に位置決めした後、溶接トーチの回転姿勢のみ
   を変化させて前記手首軸のうちの最先端の軸の回転軸が
   ウィービング相対量と直角になるように溶接始点及び終
   点での各軸の角度を教示する教示手段であることを特徴
   とする請求項３記載の溶接ロボットのウィービング制御
   装置。