JPH0453621B2 - - Google Patents

Info

Publication number
JPH0453621B2
JPH0453621B2 JP56158627A JP15862781A JPH0453621B2 JP H0453621 B2 JPH0453621 B2 JP H0453621B2 JP 56158627 A JP56158627 A JP 56158627A JP 15862781 A JP15862781 A JP 15862781A JP H0453621 B2 JPH0453621 B2 JP H0453621B2
Authority
JP
Japan
Prior art keywords
welding
weaving
robot
point
trajectory
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 - Lifetime
Application number
JP56158627A
Other languages
English (en)
Other versions
JPS5877775A (ja
Inventor
Osamu Nio
Toyoji Hamashima
Shinobu Sato
Shigemi Nohayashi
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.)
YASUKAWA DENKI KK
Original Assignee
YASUKAWA DENKI KK
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
Family has litigation
First worldwide family litigation filed litigation Critical https://patents.darts-ip.com/?family=15675835&utm_source=google_patent&utm_medium=platform_link&utm_campaign=public_patent_search&patent=JPH0453621(B2) "Global patent litigation dataset” by Darts-ip is licensed under a Creative Commons Attribution 4.0 International License.
Application filed by YASUKAWA DENKI KK filed Critical YASUKAWA DENKI KK
Priority to JP56158627A priority Critical patent/JPS5877775A/ja
Priority to DE8282109112T priority patent/DE3274728D1/de
Priority to EP82109112A priority patent/EP0076498B1/en
Priority to AT82109112T priority patent/ATE24290T1/de
Priority to NO823331A priority patent/NO159579C/no
Publication of JPS5877775A publication Critical patent/JPS5877775A/ja
Publication of JPH0453621B2 publication Critical patent/JPH0453621B2/ja
Granted legal-status Critical Current

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B23MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
    • B23KSOLDERING OR UNSOLDERING; WELDING; CLADDING OR PLATING BY SOLDERING OR WELDING; CUTTING BY APPLYING HEAT LOCALLY, e.g. FLAME CUTTING; WORKING BY LASER BEAM
    • B23K9/00Arc welding or cutting
    • B23K9/02Seam welding; Backing means; Inserts
    • B23K9/0216Seam profiling, e.g. weaving, multilayer
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B23MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
    • B23KSOLDERING OR UNSOLDERING; WELDING; CLADDING OR PLATING BY SOLDERING OR WELDING; CUTTING BY APPLYING HEAT LOCALLY, e.g. FLAME CUTTING; WORKING BY LASER BEAM
    • B23K9/00Arc welding or cutting
    • B23K9/24Features related to electrodes
    • B23K9/28Supporting devices for electrodes
    • B23K9/287Supporting devices for electrode holders
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B23MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
    • B23KSOLDERING OR UNSOLDERING; WELDING; CLADDING OR PLATING BY SOLDERING OR WELDING; CUTTING BY APPLYING HEAT LOCALLY, e.g. FLAME CUTTING; WORKING BY LASER BEAM
    • B23K9/00Arc welding or cutting
    • B23K9/24Features related to electrodes
    • B23K9/28Supporting devices for electrodes
    • B23K9/30Vibrating holders for electrodes
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Program-controlled manipulators
    • B25J9/16Program controls
    • B25J9/1679Program controls characterised by the tasks executed
    • B25J9/1684Tracking a line or surface by means of sensors
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Program-control systems
    • G05B19/02Program-control systems electric
    • G05B19/42Recording and playback systems, i.e. in which the program is recorded from a cycle of operations, e.g. the cycle of operations being manually controlled, after which this record is played back on the same machine
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B23MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
    • B23KSOLDERING OR UNSOLDERING; WELDING; CLADDING OR PLATING BY SOLDERING OR WELDING; CUTTING BY APPLYING HEAT LOCALLY, e.g. FLAME CUTTING; WORKING BY LASER BEAM
    • B23K2101/00Articles made by soldering, welding or cutting
    • B23K2101/04Tubular or hollow articles
    • B23K2101/10Pipe-lines
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/36Nc in input of data, input key till input tape
    • G05B2219/36417Programmed coarse position, fine position by alignment, follow line, path adaptive
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/36Nc in input of data, input key till input tape
    • G05B2219/36495Recording position and other parameters, current, tool diameter, voltage
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/45Nc applications
    • G05B2219/45135Welding

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Mechanical Engineering (AREA)
  • Plasma & Fusion (AREA)
  • Robotics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)
  • Numerical Control (AREA)
  • Resistance Welding (AREA)
  • Arc Welding In General (AREA)
  • Butt Welding And Welding Of Specific Article (AREA)

Description

【発明の詳細な説明】 〔産業上の利用分野〕 本発明は、多関節型アーク溶接ロボツトの溶接
線倣い制御における溶接トーチ姿勢の制御に関す
るものである。
〔従来の技術〕
従来、消耗電極式アーク溶接機で第1図aに示
すような隅肉溶接や、第1図bに示すようなV開
先溶接を行う場合、ウイービング運動する溶接ト
ーチ1を搭載した台車を開先線に沿つて走行させ
ているが、台車がワークの開先線に沿つて正しく
走行しないときは溶接部2が偏つて溶接される。
この問題点を除去するため、溶接トーチ先端のウ
イービングの中心が、溶接線から偏つた場合、ウ
イービング両端における溶接電流又は電圧が異な
つたものとなることを利用し、溶接トーチ1を溶
接線に対し、ウイービング方向に水平に移動させ
るアクチユエータを設け、これを前記ウイービン
グ両端での検出値の差が0になるように制御して
左右にずれのない溶接ビードが得られるように
し、またその検出値が常に一定になるように垂直
方向(消耗電極方向)にアクチユエータを制御す
る溶接線自動追従倣い制御装置が提案されてい
る。
この倣い方式を公知の円筒座標ロボツト
(cylin−drical coordinates robot)、極座標ロボ
ツト(polar coordinates robot)、直角座標ロボ
ツト(cartesian coordinates robot)、多関節ロ
ボツト(articulated robot)で実行する場合を
考えると、例えば第2図に示すような構成のアー
ク溶接ロボツトとなる。
この第2図に示すものは多関節ロボツトに前記
方式を適用した場合の一例を示すもので、ロボツ
トの手首にウイービング装置3と水平駆動アクチ
ユエータ4、及び垂直駆動アクチユエータ5を装
備したものであるが、2軸のアクチユエータとウ
イービング装置の合計3軸の駆動源がロボツト手
首に装着されることになるため、その重量と大き
さが問題になる。即ち、作業ツールが重くなる
と、ロボツト手首への負担が大きくなり、手首の
耐久性から好ましくないし、また作業ツールが大
きくなると、狭い所へ入つて行わないため、溶接
箇所の制約を受け、汎用性を損う欠点がある。
また、提案されている前記溶接線自動追従倣い
制御装置には、溶接ロボツトに必要な以下の技
術・手段が何ら開示されていない。すなわち、手
首角度(溶接トーチ姿勢)制御や多数ブロツクか
ら成る被溶接物のブロツク切替方法(曲り角検出
方法)やワークずれのため、被溶接物の溶接開始
点に溶接トーチが正しくセツトされないときの迅
速な溶接開始点への接近方法や、間欠的に与えら
れるウイービング両端での軌跡修正信号間の3次
元的溶接トーチ駆動方法が、この先行技術には何
ら示されておらず、汎用の3次元ワーク溶接倣い
に使用できないという欠点がある。
〔発明が解決しようとする課題〕
本発明は、従来のように、ロボツトの手首に、
ウイービング装置3、水平駆動アクチユエータ4
及び垂直駆動アクチユエータ5を装備しなくと
も、それらを装備した場合と同様の動作を行う多
関節型溶接ロボツトを提供することができる制御
方法を得ることを目的とするものである。
〔課題を解決するための手段〕
本発明は前記の目的を達成するためになされた
もので、従来のウイービング軸、水平軸アクチユ
エータ及び、垂直軸アクチユエータの3軸動作又
は水平及び垂直軸アクチユエータの動作をロボツ
トの3次元運動を行なわせるための基本3軸又は
基本3要素で代行させ、その基本3軸又は基本3
要素を制御することにより、溶接トーチ先端の移
動及びウイービング動作させる多関節型溶接ロボ
ツトであつて、ウイービング中心が予め教示され
ている軌跡上またはその軌跡を3次元平行シフト
した軌跡上を進行するよう制御すると共に、ウイ
ービング端に来る毎に溶接電流または溶接電圧を
検出し、前回のウイービング端でのそれと比較
し、その差があれば、その差をなくす方向、すな
わち、ウイービング中心(実際の溶接線)の進行
方向に対する左、右(ウイービング方向)と、前
回のウイービング端と今回のウイービング端での
溶接電流または溶接電圧の平均値をプリセツトさ
れている値と比較し、その差があれば、その差を
なくす方向、すなわちウイービング中心の進行方
向に対する上、下(ウイービング方向と直交する
方向)とで規定される合成ベクトル方向へウイー
ビング中心をロボツト基本3軸又は基本3要素を
制御することによりシフトさせて、ウイービング
中心と実際の溶接の位置ずれを修正し、かつ溶接
電流又は溶接電圧を一定にすることによつて適正
なるウイービング溶接を行なうと同時に、直線補
間を行なうべく教示されている始点、終点の2点
間を移動するときの時々刻々のロボツト手首角度
を(溶接トーチ姿勢)を、始点、終点で教示され
ているロボツト手首角度の差をこの2点間で均一
一様に変化させた手首角度と等しくなるよう制御
することを特徴とする多関節型溶接ロボツトの制
御方法を提供するものである。
〔実施例〕 以下にその制御方法について更に図面を参照し
ながら説明する。
第3図は本発明を実行するための多関節型テイ
ーチング・プレイバツク・ロボツトの一例を示す
もので、11が消耗電極式溶接トーチである。
この溶接ロボツトは、土台12上に屈曲する2
つのアーム13,14を具えた旋回体15を設
け、アーム13の先端に取付けられた溶接トーチ
11はふり角度及びひねり角度を駆動モータで変
えられるようになつており、溶接トーチ11のウ
イービングは、アーム13と14と旋回体15を
制御して行なわれる。
周知のように、テイーチング・プレイバツク・
ロボツトは、図示しないテイーチボツクスで2点
を教示すると、直線補間によつてその2点間を結
ぶ直線上を溶接トーチ11が移動する。
従つて、第4図aに示すような曲線からなるワ
ーク溶接線Rを追跡させるような場合には、軌跡
修正機能を持たないロボツトでは多数の教示点を
与えないと、適正な溶接を行なうことができな
い。
そこで、この発明ではおおまかにP1,P2,P3
の3教示点を与えるだけで、ワーク溶接線Rを追
跡する制御方法を提供しようとするものである。
この実用的価値は、溶接開始前の教示作業を簡単
化し、ロボツトの取扱を容易にすると共に、ワー
クの精度が悪い場合でも適正な溶接が実行される
ことを可能とするものである。
先ず原理について説明する。
ロボツトの溶接トーチ11の先端がワークの溶
接線R上の軌跡を動くためには前述のずれ量検出
のためのウイービング運動を続け乍ら、溶接トー
チのウイービング中心を常に溶接線上に持つて行
うようにすればよい。そして、ウイービング中心
が溶接線R上をたどるためには、公知のセンサか
ら与えられるウイービング両端での軌跡修正信号
に対応した方向にウイービング中心を移動させ、
その後、教示された軌跡を3次元的に平行シフト
した軌跡11,12,13……上をたどるようにすれば
よい。
これら3つの動き、即ちウイービング運動、ウ
イービング中心の軌跡修正、テイーチング軌跡の
3次元平行シフトされた軌跡上をウイービング中
心が移動する運動をロボツト基本3軸又は基本3
要素で実行させ、ウイービング中心より等しい距
離だけ溶接線に対し左右にウイービングしながら
両端での軌跡修正信号が与えられると、その方向
へウイービング中心を移動させ、移動完了後は3
次元平行シフトされた新たな軌跡上をウイービン
グ中心が移動、与えられないときにはもとの軌跡
上を移動しながら次の軌跡修正信号を持つ動作を
くり返し、P2″達する。
このP2″点即ち変曲点以後は平行シフトの方向
23方向としてシフトさせ乍ら追跡動作を
行なわせればワーク溶接線Rの追跡制御が実行さ
れることになる。
この平行シフト方向の切換を行うための変曲点
P2″の検出は、曲り角検出監視点P20を∠P1,P2
P3の補角側に定め、溶接トーチ先端のウイービ
ング中心との距離mを常に演算し、その最小値よ
りある変動巾だけ大きくなつた点を検出すれば
P2″が求めることが出来る。
なおP20は∠P1,P2,P3の2等分線上に設定さ
れることが望ましい。
このようにして追跡制御を行えば、従来法に比
し、極めてラフなテイーチング(教示)で、適正
なウイービング溶接が実行され、溶接ロボツトの
運転操作に貢献するところ極めて大である。
次に、ロボツト基本3軸又は基本3要素による
ウイービング運動に関し図5に基づき説明する。
ロボツト運転に先立つて先ず、ウイービングの
方向、振巾、周波数等、倣い溶接上必要な条件を
テイーチングする必要がある。
前記教示点P1,P2間でQ1,Q2,Q3の3点を任
意にテイーチングすることにより、ウイービング
の方向と振巾を設定する。2点Q1,Q2のみでは
溶接線に対するウイービングする面が決まらない
ため、点Q3を設定するものである。
こゝで1 2にQ3から垂線を下ろしてその足を
Hとし、12′=Jとなる点Q2′を求め、
ウイービング中心Hからの振巾を等しくH→Q1
→H→Q2′→Hの単振動ウイービングをさせる。
Q1,Q2,Q3で作られる面と1 2の交点W(xw
yw,zw)は、 P1111) P2222) P3333) Q1(x1,y1,z1) Q2(x2,y2,z2) Q3(x3,y3,z3)……(1) (α,β、γ)……1 2の方向余弦 (α′,β′、γ′)……1 3の方向余弦 (λ,μ,ν)……1 3の方向余弦……(2) とすると、Wの位置は、 xw=f1(x1,y1,z1111,α, β、γ,α′,β′、γ′,λ,μ,ν) =x1+λSA yw=f1(x1,y1,z1111,α, β、γ,α′,β′、γ′,λ,μ,ν) =y1+μSA zw=f1(x1,y1,z1111,α, β、γ,α′,β′、γ′,λ,μ,ν) =z1+νSA……(3) 但し、 SA=(x11)(βγ′−β′γ)+(y11
)(γα′−γ′α)+(z11)(αβ′−α′β
)/γ(βγ′−β′γ)+μ(γα′−γ′α)+ν
(αβ′−α′β) P1,P2,Q1,Q2,Q3は教示された点であり、
その座標値は判明しているので、α,β、γ,
α′,β′、γ′,λ,μ,νすなわちxw,yw,zwは演
算装置によてい簡単に求められる。
ウイービング中心はHであるが、説明をわかり
やすくするために、本記載事項中では、交点Wを
ウイービング中心と仮称する。このウイービング
中心Wが第4図におけるP1から始まり、倣い動
作をしながらP2′点に到達することになる。ロボ
ツトの手首に装着した溶接トーチ先端は、Wの軌
跡をたどるのではなく、時々刻々のWの値にH→
ベクトルとHからのウイービング現在値を加算し
た軌跡をたどることになる。WはP1P2上または
P1P2の3次元平行シフト軌跡11,12……上または
修正軌跡をたどる。
溶接トーチの先端がHから出発し基準クロツク
K回後のウイービング点座標を求めるために1回
の基準クロツクで1 2′上を動く距離Sを求め
る。
こゝにいう基準クロツクとは、一般にサーボク
ロツクと称される信号で、第4図に示す分周、立
上り微分回路37の出力信号である。
その詳細は第18図に関する説明で後述する
が、同図BRM(Binary Rated Multiplier)の出
力、即ちロボツトを構成している各軸の位置サー
ボへのパルス列信号としての位置サーボ指令が同
図に示すクロツクφとBRMビート数で決まる時
間で払い出し完了となる周期を有するクロツクの
ことである。そしてその周期を基準クロツク周期
と称する。
この基準クロツク周期内に各軸への次の位置サ
ーボ指令データ、即ち、同図に示すバツフア41
への入力データが演算器31で演算される。なお
この演算クロツク周期は、通常数msに設定され、
この基準クロツク周期毎にロボツト各軸の移動量
をインクリメンタル演算し、きめの細いウイービ
ング運動を行なわせるものである。
ウイービング運動を行なわせるあたり、最初こ
のKをK=1とし、基準クロツク周期毎にK=K
+1となる値にKを増分させていく。
こゝで、基準クロツク周期をCo、ウイービン
グ周波数をh、ウイービング振巾の半分をjとす
ると、 S=4hjCo ……(4) SのX,Y,Z成分Δx,Δy,Δzは Δx=−Sα Δy=−Sβ Δz=−Sγ……(5) で表わされる。また基準クロツクN回後のウイー
ビングパターン上の現在値xkykzkは xk=N・Δx yk=N・Δy zk=N・Δz……(6) で表わされる。なおHQ1HQ2′Hのウイービング
でQ1,Q2′から折り返すときにはΔx,Δy,Δzの
符号を逆にするのは当然である。
WHの長さと方向は常に一定であり、その成分
xp,yp,zpは xp=x1+jα−xw yp=y1+jβ−yw zp=z1+jγ−zw……(7) となる。
従つて、(6)式、(7)式にウイービング中心Wの座
標を加算した軌跡を溶接トーチ先端がたどればよ
いことになる。第4図に示すようにウイービング
中心Wは最初P1を始点、P2を終点とする直線上
を動き始めウイービング長短での軌跡修正信号に
より方向を修正し、次に1 2と平行な新たな軌
跡I1をたどる。すなわちウイーボング中心Wの制
御には修正モードと平行移動モードの2つがあ
る。第5図aに示すように修正モード時における
ウイービング中心Wの進行方向に対する右、左の
軌跡方向はウイービング方向すなわちQ2′Q1――→,
Q1Q2――→′、上下方向はベクルQ1Q2′――→とP1P2
―→の外積
の方向と定義する。第5図bに示すように1 2
を平行移動させ1 2とH点で交わらしたときの
∠P2HQ2′=ωとおくと、上下方向Aの方向余
弦(e,f,g)は e=f4(ω,β,γ,μ,ν) =(βν−γμ)/sinω f=f5(ω,β,γ,μ,ν) =(γλ−αν)/sinω g=f6(ω,β,γ,μ,ν) =(αμ−βλ)/sinω……(8) で求められる。左右方向の方向余弦は前記α,
β,γとなる。
第6図は8通りの左右上下の修正ベクトルを示
す。
修正ベクトルの方向余弦(u,v,w)は
Q1Q2′およびAに関するその方向に応じて8個
の形をとる。すなち右側のものから、 となる。
ウイービング中心、Wの修正なしのときの進行
方向はP1P2に平行であり、その方向余弦は前記
(λ,μ,ν)となる。第7図はウイービング中
心Wを(λ,μ,ν)の方向へλだけ移動させな
がら修正させることを示す図である。合成された
実際のWの修正ベクトルδのx,y,z成分δx,
δy,δzは次式より求まる。
x=f10(r,q,λ,μ,ν,α,β,e,
f,g) =λγ+qu(またはλγ+√2qu) =λγ+qu(またはλγ+√2qu) y=f11(r,q,λ,μ,ν,α,β,e,f,g
) =μγ+qv(またはνγ+√2qv) =μγ+qv(またはνγ+√2qv) z=f12(r,q,λ,μ,ν,α,β,e,f,g
) =νγ+qv(またはνγ+√2qv)……(10) 指定された溶接速度Vを実現するために平行移動
モード時の基準クロツク毎の移動量は で表わされる。
修正モードを除き平行移動モードでウイービン
グ中点Wが基準クロツクK回後に移動する距離
δx′′′は x′=1op・k y′=1op・k z′=1op・k……(12) となる。
図7のベクトルδをたどる修正モードではr方
向が指定速度Vで制御されるのでr/Vなる時間
にWはδだけ移動する。よつて基準クロツク1回
当りのδ方向への移動量o1o1o1となる。
修正モード中の基準クロツクK′回目の移動量
x1o1・K′y1o1・K′z1o1・K′……(14) となる。
このx1y1z1が修正モード終了時xy
δzと一致するように修正モードの最終回でその差
を補正する。
よつてウイービング中心Wの基準クロツクN回
目の座標xo,yo,zo N=K+K′ ……(16) として求まる。
前記したように溶接トーチ先端の制御点の座標
xo,yo,zoを次式になるよう制御すればよい。
Xo=xo+xk+xp Yo=yo+yk+yp Zo=zo+zk+zp……(17) またそのブロツクの終点P2″を求めるために点P20
202020)とウイービング中心Wとの距離
D D=√(20o2+(20o)+(20o
2
……(18) を基準クロツク毎に求め、最小値を保存し、Wが
P2に近づくにつれ最小値が更新され、WがP2″点
を過ぎるとDが最小値より大きくなる。Wの
P1P2″への進行につれて平均的には距離Dは小さ
くなつていくが、修正モードでの修正ベクトルの
出かたによつては必ずしもミクロな意味でDは小
さくなるとはかぎらない。このため現在までの最
小値にある微小な変動巾を持たせ、それを越えた
点をそのブロツクの終点とする。
この曲り角認識方法は、第4図に示すようなな
だらかな曲り角検出には有効であるが、急峻な直
角コーナ等の曲り角には適用できない。よつて第
13図、第14図で説明する曲り角認識法と併用
することになる。
つぎにロボツト手首軸の制御について説明す
る。
第4図bは手首姿勢(溶接トーナ姿勢)は、溶
接線に沿い手首角度θ(こゝでは手首ふり軸Bの
角度とひねり軸Tの角度で決める角度)が溶接上
で決まるある変化巾内にあるよう制御されねばな
らない。教示点P1,P2,P3点での手首姿勢は最
初に正しくテイーチングされている。
こゝで、理解を容易にするため、ワーク溶接線
R上のP1,P2,P3″点での手首角度がそれぞれθ1
θ2,θ3とテイーチングされているものとすると、
θ1≠θ2≠θ3である。
本発明は、手首角度をテイーチングした3点以
外の位置における手首の姿勢制御を次のような補
間制御により行うようにしたものである。
即ち、直線補間を行なうべく教示されている始
点と終点、例えばP1とP2″点間を移動するときの
時々刻々の手首角度θ11,θ12……を、前記教示さ
れている2点の手首角度の差を均一一様に変化さ
せた手首角度と等しくなるように制御するように
したものである。
即ち、ワーク溶接線R上のP1点からP2″への溶
接倣いの場合、手首ふり軸B、ひねり軸TのP1
P2点での値を1122として、基準クロ
ツクC0当りの増分量ΔB、ΔTを次式より求め 基準クロツク毎にこれを加算しP1→P2″への進行
にともない修正モード、平行移動モードを問わず
一様に変化させるものである。基準クロツクN回
目のBo,Toは Bo1+ΔB・N To1+ΔT・N……(20) となる。
なお、以上説明した実施例では、手首角度姿勢
が2軸(手首ふり軸Bとひねり軸T)によつて決
定される場合であるが、3軸で手首姿勢が決定さ
れる場合は、2軸と同様にして各軸を制御させる
ことになる。
ブロツクの終点P2″でのB,Tは22と一般
に等しくならないが、第4図aではワークのずれ
が跨張して書かれているにすぎず、現実の対象ワ
ークでのP2,P2″点間の距離は小さいため、この
差は何ら実用上の支障にならない。従つて溶接倣
い中、常に適正な溶接トーチ姿勢が保たれる。
(1)式のX,Y,Z値は制御点である溶接トーチ
先端の値であるから、(1)式を求めるために、ロボ
ツトの形態が直交形、多関節形、円筒形、極座標
形を問わず、メモリに格納されているP1,P2
Q1,Q2,Q3の各駆動軸座標データから直交座標
への変換が必要となる。
また(17)式、(20)式で計算された時々刻々
(基準クロツク毎)の溶接トーチのあるべき位置
(Xo,Yo,Zo,Bo,To)をロボツトとして実現
するために(17)式の解Xo,Yo,Zoをロボツト
基本3軸の駆動軸データに逆変換しなければなら
ない。ロボツト手首軸データはBo,Toとなる。
第3図に示した実施例ロボツトの基本3軸、す
なわち3要素の旋回体15アーム13,14はそ
れぞれ回転角φ,ψ,θで制御され、手首ふり
軸、ひねり軸は回転角B,Tで制御される。制御
点Pは溶接トーチ11の先端である。
手首ふり軸回転中心より距離A、ひねり軸回転
中心より距離d離れた点Pがテイーチングされた
制御点であるから、その直交座標値は X=(Lcosθ+lcosφ+AsinB+cosT ・cosB×cosψ−dsinT・sinψ Y=(Lcosθ+lcosφ+AsinB+cosT ・cosB×sinψ−dsinT・cosψ Z=(Lsinθ+lsinφ−AcosB+dcosT ・sinB……(21) となる。また(17)式で求めたXo,Yo,Zo
(20)式で求めたBo,Toより(21)式を逆変換し
た次式により関節ロボツトの基本3軸の回転角
Ψo,θo,ψoが求まる。
但し、 a=√222 2 −(AsinBn+dcosTncosBn) b=Zn+(AcosBn−dcosTnsinBn) (21)式、(22)式はそれぞれのロボツト形態に
応じ、夫々定義される。
第8図はウイービング両端での溶接電圧、溶接
電流等から上、下、左、右方向へ一定量qだけ移
動させるための軌跡修正信号を発生させるセンサ
回路部である。
第5図で説明したQ1,Q2,Q3がテイーチング
で与えられると、垂線の足Hの座標は求まり、そ
れをxh,yh,zhとすると、ウイービングの現在値
xk,yk,zk((6)式)より現在の振巾j′が求まる。
j′=√(kh2+(kh2+(kh
2
……(23) このj′がjとなつたときウイービング端であ
り、このときセンサ回路へ測定開始指令が与えら
れる。
溶接トーチのウイービング中心が実際の溶接線
より溶接線方向に対し右にずれているときには
“左”信号が発生される。左にずれたときには
“右”信号が発生される。ウイービング両端の値
の平均値がプリセツトされている値より大きいと
きには、“上”信号が、小さいときには、“下”信
号が発生される。この上下左右信号は8通りの組
合わせがある(第6図参照)。
第9図にこゝで言う上下左右の方向を示す、左
右はウイービング方向で、上下は溶接トーチ方
向、すなわちワイヤ電極11aの出てくる方向で
ある。
第10図はウイービング教示パターンの自動継
続を説明するための図である。図においてP1
P2,P3は第5図同様テイーチング点、Q1,Q2′,
Q3は第5図と全く同じことを意味する。
1 2の延長線上にPeをとる。P1とΔQ1,Q2′Q3
をこのまゝ1 2にそつて平行移動し、P1をP2
もつてきたとき1 2′が10 20′の位置になる。
P2P32で作る平面に垂直な方向2を引く。
ただし2は2つのベクトルP2P3――→とP2Pe――→
の外積
の方向にとる。∠P3P2Pe=ωoとして10 20′を
P2Uの軸のまわりに2から2 3へ向う方向へ
ωoだけ回転させると次のブロツクのウイービン
グパターン1 2′が求める。
P1111),P2222)の座標値

1 2の方向余弦(λ,μ,ν)を求めP22
y22),P3333)の座標値から2 3

向余弦(λ′,μ′,ν′)を求めるとωoは次式で定

される。
ωo=f16(λ,μ,ν,λ′,μ′,ν′) =cos-1(λλ′,μμ′,νν′) ……(24) Q1,Q2′,Q3の座標値がそれぞれ(x1,y1
z1)、(x2,y2,z2),(x3,y3,z3)のとき1
(x1′,y1′,z1′)は次式で定義される。
但し、 dx=x11 dx=y11 dx=z11 m=dx(μν′−μ′ν) +dy(νλ′−ν′λ)+dz(λμ′−λ′μ)2 ′(x2′,y2′,z2′),3′(x3′,y3′,z3
)も同
様に求められる。ウイービングパターン、振巾の
テイーチングは最初の溶接線で1回行なうだけで
なく、後続ブロツクでは12′,3を順次求
め、第5図で説明したことをくり返しながらウイ
ービングが適正な方向に自動継続される。途中に
ウイービングをしないエアーカツトのブロツクが
あつても演算上は上記計算を続行するのでエアー
カツト後の溶接線でもウイービング点Q1,Q2
Q3のテイーチングは不要である。換言すると、
Q1,Q2,Q3のテイーチングは1回で済む。
テイーチング点P1,P2間の同一ブロツク内で、
テイーチングされている軌跡と実際のワーク溶接
線のずれ角ξ(第11図、第12図参照)には溶
接倣い上の制約がある。
すなわちウイービング周波数h(Hz)、溶接濃度
V(mm/min)、第6図に示した軌跡修正量q
(mm)、または√2q(mm)によりζの許容最大値
ζmaxが決まる。
ζmax=tan-1120hq/V ……(26) または ζmax=tan-1120√2hq/V ……(27) このζmax以下なら同一ブロツク内で溶接倣い
が可能となり、本来曲り角とみなす必要はない。
しかし、こゝではζmax/2を同一ブロツク内
の許容角度とする。今h=2Hz、q=0.7mm、V
=300mm/minではζmax≒30°となりζmax≒15°と
溶接自動化上の生産技術からみても15°もワーク
のバラツキがある被溶接物は一般に存在しないこ
とからしてζmax/2を採用することは妥当とい
える。
第13図は隅肉溶接における急峻な直角コーナ
部での倣い溶接の挙動を示している。
実際のワーク溶接線上を倣いながら進み、ウイ
ービング中心はP2′点に達する。P1′〜P2′間のウ
イービング方向はP1P2に直角な方向である。
P2′で隅肉部がまくなると平板上に溶接ビード
を乗せだす。この場合ロボツトは平板上をP1P2
に平行なベクトルP2′Pn′を基準とし倣い溶接を続
行し、(26),(27)式で決まるζmaxの角度の方
向へウイービング中心は進む。
第14図はP2′点近傍におけるウイービング中
心の挙動を更に詳細に示す拡大図である。前記
(15)式で与えられるウイービング中心(xo,yo
zo)を修正モード前後, 1′ ,, 2′ ……で
記憶しておき、前回の修正モードに入る直前の座
標(xo-1,yo-1,zo-1)と今回の修正モードに入
る直前の座標(xo,yo,zo)を結ぶ直線11をテイ
ーチングされている直線1 22 3で作られる
面上へ投影したときの1 2とのなす角度ζを求
める。また今回の修正モード完了直後の座標
((xo′,yo′,zo′)と前回の修正モード完了直後
の座標(xo-1,yo-1,zo-1)を結ぶ直線12を上
記面へ投影したときの1 2とのなす角度ηを求
める。
,,……の方向余弦(a,b,c)、
1′ 2′ , 2′ 3′ ……の方向余弦(a′,b′,
c′)、1 2の方向余弦(λ,μ,ν)、2 3の方
向余弦(λ′,μ′,ν′)はP1,P2,P3,, 1′

, 2′ 、……の座標値がわかつているから簡単
に求まる。よつてξ,ηは次式で定義される。
このξとηの平均値を溶接倣い中修正モードの
前後で毎回計算し、FIFOに順次記憶しておき
FIFO内の平均値がζmax/2以上でζmaxに近づ
いたとき第13図点P2″を曲り角と認識するよう
にする。
こゝで第10図で説明したようにウイービング
方向が切り替わり2 3に直角な方向となる。
P2″を始点としP2P2″′変移ベクトルだけP3をシフ
トした点P3′を終点とする直線を基準として次の
ブロツクの倣い溶接が始める。
しかし、まだ隅肉部でなく平板上にトーチウイ
ービング中心があるため、23′とζmaxなる角
度の方向へ向かいP2″点へ到達後、正確な隅肉部
溶接倣いを実行する。
曲り角認識後のξ,ηの平均値もζmaxとなる
ためこゝで曲り角の認識をしないためのインター
ロツクは必要である。この場合P2′→P2″→P3
いうようにオーバターンをすることになるが、こ
のオーバターンは必ずしも悪いとはいえない。即
ち、もともと鋭角コーナ部の溶接は難しく、アン
ダーカツトをなくすために、倣なしのロボツトに
よる鋭角曲り角のテイーチングは、第15図に示
すように溶接線の外側を曲る例が多い。
第15図は隅肉溶接でのテイーチング位置と溶
接トーチ姿勢を上と横からにた図である。
比較的大きな溶接電流を使う隅肉溶接では、通
常ウエブ側のアンダーカツトを防ぐため、溶接ト
ーチのねらい位置をフランジ側にtだけずらして
溶接する。
そして、特にコーナ部では肉量が多くなるた
め、ウエブ側のアンダーカツトが生じやすいの
で、図示のようにコーナ部では溶接トーチのねら
い位置をtよりも大きくする。このことを考える
と、この曲り角認識法に妥協性があるといえる。
また第15図に示すtなるオフセツト量は、セ
ンサ回路部の左右信号比較回路(図示せず)にバ
イアスをかけ、零点をオフセツトすれば本溶接倣
いでも当然可能である。
第16図、第17図は、量産の場合にしばしば
起る実際の溶接開始点が、もともと溶接開始点と
してテイーチングされていた点から大きくずれて
いるときの溶接開始点サーチ機能の説明図であ
る。
第16図中、点線で示されたワーク位置で正し
くテイーチングされた溶接開始点P1が、ワーク
が点線から実線の位置に斜め情報にずれたため隅
肉部がなく実際の溶接開始点は平板上になるの
で、その点P′1でウイービング溶接倣いを開始す
ると平板上を第9図で説明したウイービング方向
(左右方向)に溶接トーチ11を振るためウイー
ビング両端で電流差が生じる。溶接線に平行なベ
クトル12′を基準とし、その電流差をなくし、
しかも溶接電流を一定にしようとして左方向、下
方向の合成ベクトル方向すなわち隅肉部へ向つて
ζmaxなる角度で近づきP1″点より正常な溶接を
始めることになる。
長さm1を最小にし、しかもP1′→P1″への不要
溶接ビードが被溶接物に悪影響を与えないように
するため、P1′→P1″間は実際の溶接線(P1″以降)
と異なるウイービング条件、溶接速度で溶接倣い
を行なうようにする。
すなわち、溶接速度Vと溶接電流値を極端に落
とし、ウイービング周波数hを上げ、軌跡修正量
qを大きくし、(26)、(27)式のζmaxが大きく
なるようにする。
P1″点の認識は、第13図、第14図で説明し
た方法を準用すればよい。第17図はワークが逆
にずれたときの図であり、第16図と全く同様に
処理される。
第18図は本発明の一実施例における演算器と
2段バツフア付きBRMで構成された溶接倣い制
御器とロボツト全体の動作を総括するメイン
CPU(マイクロプロセツサ)と、溶接電流指令切
替スイツチ及び第8図で説明したセンサ回路部と
のつなぎを示すブロツク図である。
演算器からのコマンド要求に対し、全体ロボツ
ト動作シーケンス上から溶接倣いを行なう場合に
は、メインCPU20は図示しないテイーチボツ
クスで指定した倣うべきブロツクの始点P1、終
点P2と倣うべきブロツクに続くつぎのブロツク
の終点P3とウイービングパターン定義点Q1,Q2
Q3および距離監視点P20のロボツト基本3軸とロ
ボツト手首軸の原点からのパルス数、溶接速度
V、ウイービング周波数h、軌跡修正量qをメモ
リ(図示せず)から読み出してレヂスタ21〜レ
ヂスタ30にセツトし、溶接倣い開始マクロコマ
ンドを出力する機能を有している。
演算器31は、シーケンスコントローラ32、
マイクロプログラムメモリ33、パイプラインレ
ヂスタ34、マルチプレクサ35、RALU
(Register and Arithmetic Logical Uuit)3
6、レヂスタ21〜レヂスタ30、クロツクφの
分周、立ち上り微分回路37及び基準クロツク・
アドレスゼネレータ38より構成される。
シーケンスコントローラ32はマイクロプログ
ラムメモリ33に格納されているマイクロインス
トラクシヨンの実行シーケンスをセツトするアド
レスコントローラである。パイプラインレヂスタ
34からの制御命令により種々のアドレツシング
をスタツクコントロールを行なう。
更に詳しくいえば、現在実行中のアドレスのイ
ンクリメント、マクロコマンドで指定されたアド
レス選択、基準クロツクアドレスジエネレータ3
8で指定されたアドレス選択、RALUステイタ
スを含めテスト条件に応じた条件ジヤンプのとき
パイプラインレヂスタ34から与えられるジヤン
プアドレスの選択、無条件ジヤンプのときパイプ
ラインレヂスタ34から与えられるジヤンプアド
レスの選択、マクロサブルーチンコール時のスタ
ツクコントロール等を処理する部分である。
アドレツシングのための入力情報としては
CPUからのマクロコマンド、基準クロツクアド
レスジエネレータ38の出力及びパイプラインレ
ヂスタ34の出力の3つがある。
マイクロプログラムすなわちパイプラインレヂ
スタ34の制御命令により、シーケンスコントロ
ーラ32がこの3つのうちどれを選ぶか、または
どちらも選ばずカレントアドレスのインクリメン
トを行なうかが決まる。
溶接倣い制御用には次の4とのマクロコマンド
がある。
エアカツト直後のアークスタートブロツクで
あり、しかも次のブロツクとの曲り角認識を距
離監視方式で行う。
エアカツト直後のアークスタートブロツクで
あり、しかも次のブロツクとの曲り角認識を
(ξ+η)/2角度計算方式で行なう。
既に前回のブロツクでアークスタートが出さ
れ溶接を連続して行なうブロツクで、次のブロ
ツクとの曲り角認識を距離監視方式で行なう。
既に前回のブロツクでアークスタートが出さ
れ、溶接を連続して行なうブロツクで、次のブ
ロツクとの曲り角認識を(ξ+η)/2角度計
算方式で行なう。
このマクロコマンドと基準クロツクアドレスジ
エネレータ38の出力はハードウエア上からいれ
ば、それぞれの処理マイクロプログラムの先頭ア
ドレスを示す形で与えられる。これらがシーケン
スコントローラに与えられていないときには、パ
イプラインレヂスタ34出力からのジヤンプアド
レス、サブルーチンコールアドレス、カレントア
ドレスインクリメントが与えられる。
マイクロプログラムメモリ33は本演算器31
の中枢部で、全ての演算処理はこのマイクロプロ
グラムの指令通りに実行される。
パイプラインレヂスタ34はマイクロプログラ
ムメモリ33のバツフアレヂスタで現在実行すべ
き演算用マイクロインストラクシヨンをRALU
36へ出力するとともに、次のマイクロアドレス
決定のための制御命令をシーケンスコントローラ
32と、マルチプレクサ35へ出力し、ジヤンプ
アドレス、サブルーチンコールアドレス、カレン
トアドレスインクリメントをシーケンスコントロ
ーラ32へ出力する。また溶接倣い実行中のブロ
ツクで曲り角が検出されたときには、次のブロツ
クの座標データを要求するコマンド要求をメイン
CPU20へ出力する。
このパイプラインレヂスタ34は、2つの信号
パスを形成し、各々を並列に同時進行させ、マイ
クロサイクルタイムを短縮させ、演算の高速化を
はかるためにある。
すなわち、1つのパスはパイプラインレヂスタ
34→シーケンスコントローラ32→マイクロプ
ログラムメモリ33とつながるコントロール系の
パス、今一つはパイプラインレヂスタ34→
RALU36の演算系のパスで、この2つのパス
を同じクロツクサイクルの間に並列に動作させる
ために、パイプラインレヂスタ34が用意されて
いる。
クロツクCPの立ち上り時には既にコントロー
ル系のパスで準備されたマイロクプログラムの次
の命令がパイプラインレヂスタ34の入力にあら
われているため、メモリフエツチ時間がゼロと等
価な高速動作が可能となる。
マルチプレクサ35はパイプラインレヂスタ3
4の制御命令に応じRALUステイタス、センサ
部よりの軌跡修正信号の第6図に示す8通りのテ
スト条件をシーケンスコントローラ32へ与え、
それぞれの処理プログラム条件ジヤンプを実行さ
せるためのものである。
RALU36は論理・算術演算ユニツトとプロ
グラマブルレヂスタで構成され、マイクロプログ
ラムで規定された演算インストラクシヨンを実行
する。演算結果である基準クロツク毎のロボツト
各駆動軸の増分パルス数がRALU36内の所定
のレヂスタに格納される。
レヂスタ21は始点P1、レヂスタ22は終点
P2、レヂスタ23はP3点、レヂスタ24はQ1点、
レヂスタ25はQ2点、レヂスタ26はQ3点、レ
ヂスタ27はP20点のロボツト基本3軸とロボツ
ト手首軸の原点からのパルス数を格納するレヂス
タである。
レヂスタ28は倣い溶接速度Vを、レヂスタ2
9はウイービング周波数hを、レヂスタ30は軌
跡修正量qを格納するレヂスタである。バツフア
41はロボツト各駆動軸のつぎの基準クロツクで
払い出すべき増分パルス数を格納するレヂスタ、
バツフア42は現在払い出し中の増分パルス数を
格納するレヂスタである。
BRMはバツフア42に格納されているパルス
数を基準クロツク周期内に、クロツクφに同期し
たパルスとして均一一様に配分し、基準クロツク
毎にバツフア転送用払い出し完了信号を出力す
る。
分周、立ち上り微分回路はクロツクφより
BRMのビツト数だけ分周された基準クロツクを
作りその立ち上りを微分する回路で、BRM払い
出し完了信号と基準クロツクの同期をとるための
ものである。
溶接機とセンサ回路部50への溶接電流指令は
メインCPU20から与えられるが溶接開始点検
出時には演算器出力により溶接電流指令切替スイ
ツチ51が切替わり、固定値を選択するし、溶接
開始点が検出されると演算器出力によりメイン
CPU指令値側に切替わる。
第19図は、第18図で説明したBRMから払
い出される指令パルスにより制御される多関節形
ロボツトの基本3軸(φ軸、θ軸、ψ軸)と手首
2軸(B軸、T軸)の位置サーボである。
溶接トーチ先端がウイービング運動をしながら
溶接倣いをするべく与えられた各軸指令パルスと
各パルスゼネレータ616,626,636,6
46,656からのフイードバツクパルスとの差
が偏差カウンタ611,621,631,64
1,651から出力されD/A変換器612,6
22,632,642,652を介してアナログ
の速度指令がサーボアンプ613,623,63
3,643,653に夫々入力される。サーボア
ンプはその速度指令とタコゼネレータ615,6
25,635,645,655の出力(検出速
度)とを夫々比較し、その差がなくなるように各
駆動モータを制御する。この位置サーボ系によ
り、ロボツトに装着された溶接トーチ先端が指令
パルス通りに追従し所望の溶接倣い動作が行なわ
れる。
つぎに、第18図に示した制御回路による溶接
倣い制御動作について説明する。
演算器31は最初ウエイトルーチンを実行して
いる。シーケンスコントローラ32は、メイン
CPU20からマクロコマンドが与えられると、
そのサービスプログラムの先頭アドレスを選択す
る制御命令をパイプラインレヂスタ34から与え
られながら、演算器31がウエイトルーチンを実
行するようアドレスコントロールしている。
このウエイトルーチンには基準クロツク分周回
路37をリセツトする命令が入つているため、基
準クロツクは発生しない。
溶接倣い制御を始めるにあたつて、メイン
CPU20はまずレヂスタ21〜26に、溶接倣
いブロツクの始点P111111)、終
点P222222)、次ブロツクの終
点P333333)、ウイービングパ
ターン定義点Q1(ψ1,θ1,φ1,T1,B1)、Q2(ψ2
θ2,φ2,T2,B2)、Q3(ψ3,θ3,φ3,T3,B3)の
座標値をセツトする。
またレヂスタ28〜レヂスタ30に、倣い溶接
速度V、ウイービング周波数h、軌跡修正量qを
セツトする。そしてそのブロツクの曲り角認識が
距離監視方式であるときにはレヂスタ27にP20
((2020202020)の座標値をセツト
する。
メインCPU20が前記4つのマクロコマンド
のうち1ケを出力するとそれぞれの対応するサー
ビスマイクロプログラムの先頭アドレスが選択さ
れる。この4通りのサービスプログラムは、溶接
開始点検出を含むブロツクであるときには溶接開
始点検出フラグ(図示せず)を1にセツトし、含
まないブロツクであるときには0にリセツトし、
曲り角検出が距離監視方式であるときには、曲り
角検出フラグ(図示せず)を1にセツトし、(ξ
+η)/2計算方式であるときには曲り角検出フ
ラグを0にリセツトした後溶接倣い処理プログラ
ムN#へエントリーするプログラムである。また
この4通りのプログラムには基準クロツク分周回
路37のリセツト信号の解除命令が入つているた
め、分周回路37はクロツクφをカウントし始め
る。以後次の基準クロツクアドレスゼネレータ3
8よりの出力がくるまでシーケンスコントローラ
32は演算処理に必要なアドレツシングを行なう
よう動作する。
では次にN#から始まる溶接倣い処理プログラ
ムにつて説明しよう。
アークスタート時のブロツクから溶接倣いを始
めるので、最初は溶接開始点フラグは1になつて
いる。よつて正規の溶接開始点に溶接倣い動作が
到達する迄は、溶接速度V、ウイービング周波数
h、軌跡修正量qはレヂスタ28〜レヂスタ30
にセツトされている値を使わずに、演算器内に固
定値として記憶されている値を使う。また溶接機
とセンサ回路部50に与える溶接電流指令が固定
値となるよう溶接電流指令切替スイツチ51を演
算器出力で切替える。
レヂスタにセツトされているP1,P2,P3,Q1
Q2,Q3を(21)式により(1)式に示す直交座標系
データに変換する。また曲り角検出フラグが1の
ときにはP20を(21)式によりP20202020
に変換する。
つぎに演算器内に固定値として記憶されている
hにより(4)式、(5)式を解く。また、固定値Vによ
り(11)式を解く。また、(2)式及び(3)式を解き次
いで(7)式を解く。
P1,P2の手首軸角度より(19)式を解く。こ
れ以降の処理プログラムが格納されている先頭番
地がM#であるとする。
溶接倣いを開始する最初の基準クロツクでは、
溶接トーチはまだウイービング中心上に位置して
いるため軌跡修正信号は発生しない。よつて今の
時点では(8)式〜(10)式、(13)式、(14)式は関
与せず演算器31は平行移動モードの状態とな
る。
一番最初の基準クロツクではN=1にして(6)式
を解く。またK′=0であるから(16)式よりK
=1となる。(12)式、(15)式、(7)式より(17)
式のXn,Yn,Znを求める。(20)式よりBn,
Tnを求める。
(20)式の解Bn,Tnと前回の基準ロツク時の
Bn,Tn(今の場合には11,)の差ΔB,ΔT
をRALU36内の所定のレヂスタにセツトする。
(17)式の解Xn,Yn,ZnとBn,Tnを(22)式
に代入して基本3軸ψo,θo,φoを求め、前回の基
準ロツク時のψo,θo,φo(今の場合111
の差Δψ,Δθ,ΔφをRALU内の所定のレヂスタ
にセツトする。
また曲り角検出フラグが1のときには(18)式
を計算しその値をRALU内の所定のレヂスタに
セツトし演算器31は待機する。
この待機はメインCPU20よりのマクロコマ
ンドを待つウエイトルーチンとは異なり、次の基
準クロツクアドレスゼネレータ出力M#を待つル
ーチンであり、分周回路37のリセツトは行なわ
れない。
以上の演算が終了するまでの時間以上に基準ク
ロツク周期が長くなるようにクロツクφとBRM
ビツト数を設定しているので、演算時間が間にあ
わないというトラブルは発生しない。
演算器31がM#を待つウエイトルーチンを実
行しているとき基準クロツクが発生すると同時に
BRMより払い出し完了信号が出力され5ケのバ
ツフア41に前記RALU36内の所定のレヂス
タからΔψ,Δθ,Δφ,ΔB,ΔTがそれぞれロー
ドされ、バツフア42にはバツフア41の内容が
ロードされる。
初回の基準クロツクではバツフア41がクリア
されたままであるため、バツフア42には0が入
り、BRMによるパルス払い出しは行なわれな
い。この基準クロツクにより基準クロツクアドレ
スジエネレータ38が作動し、マイクロポログラ
ムはM#から実行され始めN=2にして(6)式を求
める。
前回の基準クロツク時の(23)式のj′がjにな
つていないため軌跡修正信号は発生せず演算器は
平行移動モードを継続する。よつてK′=0のま
まで、(16)式よりK=2となる。
そこで(12)式、(15)式より(17)式のXn,
Yn,Znを求める。また(20)式のBn,Tnを求
め、前回との差ΔB,ΔTをRALU内の所定のレ
ヂスタにセツトする。このXn,Yn,ZnとBn,
Tnを(22)式に代入しψo,θo,φoを求め、前回
との差Δψ,Δθ,ΔφをRALU内の所定のレヂス
タにセツトする。また(18)式を計算し、その値
がRALU内に格納されている前回の値より小さ
いことを確認してその値を入れ変える。
その後演算器は待機し、次の基準クロツクアド
レスゼネレータ出力M#を待つ。
つぎの基準クロツクでバツフア42には前回の
バツフア1の内容が入り、バツフア41には今回
のΔψ,Δθ,Δφ,ΔB,ΔTがそれぞれロードさ
れ、BRMにより各軸位置サーボへ指令パルスが
払い出される。この動作は(23)式におけるj′が
jになるまでくり返えされる。j′=jとなつた時
点で(15)式で求めたウイービング中にxo,yo
zoを記憶しておき、測定開始指令をセンサ回路部
50へ与え、次の基準クロツクで演算器31は軌
跡修正モードに入る。すなわちセンサ回路部より
の上下左右の軌跡修正信号をM#でテスト条件と
して受けとり、既に計算済みのα,β,γ,λ,
μ,νと演算器内に固定値として記憶されている
qと固定値γとにより(8)式,(10)式、(13)式を
解く。K′=1とおき(14)式を解き、Kは前回
の値のままで(15)式を解いて求めたウイービン
グ中心xo,yo,zoをx′o,y′o,z′oとして記憶して
おく。N=K+K′とおき(6)式を解く。(17)式の
解Xn,Yn,Znを求める。Bn,Tnを求め、Δψ,
Δθ,Δφ,ΔT,ΔBに変換しRALU内の所定のレ
ヂスタにセツトし、BRMにより位置サーボ制御
をする。
また(18)式を計算しその値を更新する。
次に演算器は再度平行移動モードに入り、基準
クロツクがくる毎にψn,θn,φn,Tn,Bnを求
め前回の基準クロツク時との差Δψ,Δθ,Δφ,
ΔT,ΔBにより位置サーボ制御を行なう。(18)
式の計算も毎回行ない最小値を保存しておく。再
度j′=jになるまで平行移動モードを続行する。
再度j′=jとなつた時、(15)式で求めたxo,yo
zoと前回記憶したxo,yo,zo(xo-1,yo-1,zo-1
なる)を結ぶ直線の方向余弦(a,b,c)を
xo,yo,zo,xo-1,yo-1,zo-1の座標値より求め、
P23の方向余弦(λ′,μ′,ν′)をP2(x22

z2)、P3333)の座標値より求め、既に(2)
式で求めている1 2の方向余弦とより(28)式
のξを計算する。そのξの値をFIFO(First In
First Out)メモリに記憶しておく。
また今回求めたxo,yo,zoを前回値と入れ替え
記憶する。測定開始指令をセンサ回路部50へ与
え、次の基準クロツクで演算器31は軌跡修正モ
ードに入る。センサ回路部50から軌跡修正信号
に応じ(8)式、(10)式、(13)式を解く、そして
K′=2とおき(14)式を解き、Kは前回の基準
クロツク時の値のままで(15)式を解いて求めた
ウイービング中心xo,yo,zoをx′o,y′o,z′oとす
る。このx′o,y′o,z′oと前回記憶したx′o,y′o
z′o(x′o-1,y′o-1,z′o-1となる)を結ぶ直線の方

余弦(a′,b′,c′)をx′o,y′o,z′o,x′o-1,y
o-1
z′o-1の座標値から求め、既に求めている方向余
弦(λ,μ,ν)と(λ′,μ′,ν′)により(29)
式のηを計算する。そのηの値FIFOメモリに記
憶しておく。また今回求めたxo′,yo′,zo′を前回
値と入れ替え記憶する。N=K+K′とおき(6)式
を解く。(17)式の解Xn,Yn,Znを求める。
Bn,Tnを求めΔψ,Δθ,Δφ,ΔT,ΔBに変換し
RALU内所定のレヂスタにセツトし、BRMによ
り位置サーボ制御をする。
また(18)式を計算しその値を更新する。これ
で修正モードは終り再度平行移動モード⇒修正モ
ード⇒平行移動モード…を繰り返えす。
この修正モードでの前後でFIFOメモリに記憶
されている(ξ+η)/2の平均値が(26)式ま
たは(27)式で計算されたζmaxの1/2以上で
ζmaxに近づいているかどうか計算し、ζmaxに
近い値であるときには溶接開始点検出中であると
認識し、V,h,qをそのままの固定値で、溶接
電流指令切替スイツチ51も固定値側にしたまま
溶接倣いを続行する。
そして((ξ+η)/2の平均値がζmax/2
以下になつたとき溶接開始点に到達したと判断
し、溶接電流指令切替スイツチ51がメイン
CPU20よりの溶接電流指令値を選択するよう
演算器出力を制御し、V,h,qの値をレヂスタ
28〜レヂスタ30の値に変更し、(4),(5)式を解
き基準クロツク当りのウイービング移動量Δx,
Δy,Δzを求め直し、(11)式のopopopを求
め直し、(10)式の計算にもレヂスタ30のqを
使う。また(26)式、(27)式のζmaxも計算し
直す。
以降、曲り角検出フラグが1のときには(18)
式の最小値を更新していき、曲り角検出フラグが
0のときにはξ,ηを順次FIFOに貯えておき、
上記溶接倣い動作を続行する。
曲り角検出フラグが1のときには、(18)式の
最小値がある変動巾以上になつたときをそのブロ
ツクの終点とする。曲り角検出フラグが0のとき
は、FIFOメモリ内の(ξ+η)/2の平均値が
ζmaxの/2以上でζmaxに近づいたときをその
ブロツクの終点とする。
曲り角検出が終ると、演算器31は次のブロツ
クでのウイービング方向を決め、前のブロツクの
ウイービング振巾と等しい振巾になるようにウイ
ービングパターン継続処理を行なう。すなわち、
既に前ブロツクで求めた1 2の方向余弦(λ,
μ,ν)と2 3の方向余弦(λ′,μ′,ν′)によ

(24)式のωpを求め、(25)式より次ブロツクで
のQ1点すなわち第9図で説明した1点の座標
x′1,y′1,z′1を求める。同様に2点、3点を求め
(1)式のQ1,Q2,Q3を入れ替える。
曲り角が検出されたときのウイービング中心の
位置(xo,yo,zo)が次ブロツクの始点となる。
このxo,yo,zoとP2点(222)との差i1
(xo2)、i2=yo−y2)、i3=(zo2)を記憶し
ておき、xo,yo,zoを(1)式のP1の座標データ2
y22とする。
その後演算器31からのコマンド要求に対しメ
インCPU20は次ブロツクの終点のロボツト5
軸の原点からのパルス数をレヂスタ22にセツト
し、つぎのつぎのブロツクの終点および次のブロ
ツクの距離監視点のロボツト5軸の原点からのパ
ルス数をレヂスタ23,レヂスタ27にセツトし
た後、前記マクロコマンドを演算器31に与え
る。このマクロコマンドは溶接開始点検出を含ま
ない。
演算器31はレヂスタ22にセツトされたブロ
ツクの新たな終点P2座標(2222
B2)、レヂスタ23にセツトされた次ブロツクの
新たな終点P3座標(33332)、レヂ
スタ27にセツトされた新たな終点P20(20
θ20202020)を(21)式により、P22

y22),P3333),P202020
20
に変換する。このP2222)の座標値を、
記憶しているi1,i2,i3だけシフトした点を新た
に終点座標とする。すなわち2+i122+i2
22→i33と変更を行ない新たな終点P2
222)とする。その後の溶接倣い動作は
溶接開始点検出を行なわないことを除いて前ブロ
ツクの動作と全く同様である。
また2段バツフアにより指令パルスを払い出し
ながらいつもバツフア41に次のデータが入つて
いるため曲り角にきたときもブロツク間停止がな
くなめらかな溶接倣いが実現される。
〔発明の効果〕 以上説明したように、本実施例による溶接倣い
システムは精度の悪いワークの溶接の自動化を可
能とするもので次のような長所をもつている。
(1) ロボツト手首に溶接トーチ以外なにも装着さ
れていないため、溶接トーチが入つていける所
ならどんな狭い所でも溶接倣いが可能である。
(2) ワーク精度が悪く実際のワーク溶接点がテイ
ーチングさらた点から大巾にずれていても高価
なビジヨンシステム等の形状認識装置がなくて
も溶接開始点を検出できる。
(3) 形状認識装置がなくても、溶接倣いをしなが
ら円滑にどんな形状の曲り角をも適正な溶接が
可能である。またその曲り角がワークにより大
巾にばらついても適正な溶接が可能である。
(4) ウイービング周波数、溶接速度、軌跡修正量
の設定値で決まる溶接倣い角度以下のワーク溶
接線は同一部とに含めてよいため、最初のテイ
ーチング作業が簡単で操作性が良い。
(5) ウイービングパターン自動継続機能があるた
め最初の溶接ブロツクにのみウイービングパタ
ーンを定義する3点をテイーチングするだけで
よいのでテイーチング作業性が良い。
(6) 特別のセンサをロボツト手首に装着するので
はなく、アーク現象(溶接電流、溶接電圧)そ
のものからセンシング情報を得るため、非接触
センサ、接触センサを問わず通常他のセンサで
は問題になる“溶接時センサが邪魔になる”、
“死角が存在する”、“溶接熱、スパツター、フ
ユーム等による悪環境下での信頼性に弱点があ
る”等の欠点がない。
従つて本発明によれば、精度の悪いワークで
も、ワーク取付位置が多少ずれたり、溶接線が波
を打つているような場合でもロボツトによる溶接
の自動化が可能となり、溶接自動化に貢献するこ
とが極めて大きいといえる。
【図面の簡単な説明】
第1図はウイービング溶接の説明図、第2図は
従来のウイービング溶接方式を適用したアーク溶
接ロボツトの斜視ず、第3図は本発明を実施する
ためのアーク溶接ロボツトの斜視図、第4図は本
発明による倣い制御方式の説明図、第5図はウイ
ービング運動設定用教示点の説明図、第6図は修
正ベクトル図、第7図は修正ベクトル図、第8図
はセンサ回路部の入出力信号の説明図、第9図は
溶接トーチの制御方向を示す図、第10図はウイ
ービング教示パルスの自動継続を説明するための
図、第11図はテイーチング軌跡と実際の溶接線
のずれ角を説明するための図、第12図はテイー
チング軌跡と実際の溶接線のずれ角を説明するた
めの図、第13図は隅肉溶接における急崚な直角
コーナ部での倣い溶接の挙動を示す説明図、第1
4図は第13図の一部拡大説明図、第15図は隅
肉溶接での教示点と溶接トーチ姿勢を示す図、第
16図は実際の溶接開始点が教示点と相違する場
合の動作説明図、第17図は実際の溶接開始点が
教示点と相違する場合の動作説明図、第18図は
実施例における制御回路のブロツク図、第19図
は実施例におけるサーボ制御部のブロツク図であ
る。 11……溶接トーチ、12……土台、13……
アーム、14……アーム、15……旋回体。

Claims (1)

  1. 【特許請求の範囲】 1 3次元運動を行なわせるための基本3軸又は
    基本3要素を制御することにより、溶接トーチ先
    端の移動及びウイービング動作させる多関節型溶
    接ロボツトであつて、 ウイービング中心が予め教示されている軌跡上
    またはその軌跡を3次元平行シフトした軌跡上を
    進行するよう制御すると共に、ウイービング端に
    来る毎に溶接電流または溶接電圧を検出し、前回
    のウイービング端でのそれと比較し、その差があ
    れば、その差をなくす方向、すなわち、ウイービ
    ング中心(実際の溶接線)の進行方向に対する
    左、右(ウイービング方向)と、前回のウイービ
    ング端と今回のウイービング端での溶接電流また
    は溶接電圧の平均値をプリセツトされている値と
    比較し、その差があれば、その差をなくす方向、
    すなわちウイービング中心の進行方向に対する
    上、下(ウイービング方向と直交する方向)とで
    規定される合成ベクトル方向へウイービング中心
    を前記ロボツト基本3軸又は基本3要素を制御す
    ることによりシフトさせて、ウイービング中心と
    実際の溶接の位置ずれを修正し、かつ溶接電流又
    は溶接電圧を一定にすることによつて適正なるウ
    イービング溶接を行なうと同時に、 直線補間を行なうべく教示されている始点、終
    点の2点間を移動するときの時々刻々のロボツト
    手首角度を、始点、終点で教示されているロボツ
    ト手首角度の差をこの2点間で均一一様に変化さ
    せた手首角度と等しくなるよう制御することを特
    徴とする多関節型溶接ロボツトの制御方法。
JP56158627A 1981-10-07 1981-10-07 溶接ロボツトの制御方式 Granted JPS5877775A (ja)

Priority Applications (5)

Application Number Priority Date Filing Date Title
JP56158627A JPS5877775A (ja) 1981-10-07 1981-10-07 溶接ロボツトの制御方式
DE8282109112T DE3274728D1 (en) 1981-10-07 1982-10-02 A method controlling an arc welding torch of a welding robot
EP82109112A EP0076498B1 (en) 1981-10-07 1982-10-02 A method controlling an arc welding torch of a welding robot
AT82109112T ATE24290T1 (de) 1981-10-07 1982-10-02 Verfahren zur kontrolle eines lichtbogenschweissbrenners eines schweissroboters.
NO823331A NO159579C (no) 1981-10-07 1982-10-04 Fremgangsm te fo styre et lysbuesveisehode.

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP56158627A JPS5877775A (ja) 1981-10-07 1981-10-07 溶接ロボツトの制御方式

Related Child Applications (4)

Application Number Title Priority Date Filing Date
JP22023282A Division JPS58154459A (ja) 1982-12-17 1982-12-17 溶接ロボットのウィービング制御方法
JP8717191A Division JPH04367373A (ja) 1991-01-28 1991-01-28 溶接ロボットの制御方法
JP4143099A Division JPH0741419B2 (ja) 1992-04-20 1992-04-20 溶接ロボットの制御方法
JP4143098A Division JPH0741418B2 (ja) 1992-04-20 1992-04-20 溶接ロボットの制御方法

Publications (2)

Publication Number Publication Date
JPS5877775A JPS5877775A (ja) 1983-05-11
JPH0453621B2 true JPH0453621B2 (ja) 1992-08-27

Family

ID=15675835

Family Applications (1)

Application Number Title Priority Date Filing Date
JP56158627A Granted JPS5877775A (ja) 1981-10-07 1981-10-07 溶接ロボツトの制御方式

Country Status (5)

Country Link
EP (1) EP0076498B1 (ja)
JP (1) JPS5877775A (ja)
AT (1) ATE24290T1 (ja)
DE (1) DE3274728D1 (ja)
NO (1) NO159579C (ja)

Families Citing this family (25)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5916674A (ja) * 1982-07-19 1984-01-27 Nachi Fujikoshi Corp ロボツトのウイ−ビング制御装置
JPS5927307A (ja) * 1982-08-04 1984-02-13 Hitachi Ltd 経路制御方法及び装置
GB2146796B (en) * 1983-08-31 1986-12-17 Mitsubishi Electric Corp Method for controlling an industrial robot to perform weaving-like motion and apparatus for practising the same
JPS60124475A (ja) * 1983-12-09 1985-07-03 Hitachi Ltd 溶接線倣い制御方法および装置
FR2564016B1 (fr) * 1984-05-11 1989-02-17 Commissariat Energie Atomique Procede de recalage de la trajectoire d'un organe et dispositif pour la mise en oeuvre de ce procede
JPS6133775A (ja) * 1984-07-24 1986-02-17 Shin Meiwa Ind Co Ltd 溶接ロボツトにおける溶接線追従方法
JPS6178564A (ja) * 1984-09-27 1986-04-22 Fanuc Ltd 自動溶接機における溶接制御方式
JPS6188975A (ja) * 1984-10-05 1986-05-07 Fanuc Ltd 自動溶接機の経路補正方式
JPS61159280A (ja) * 1984-12-28 1986-07-18 Fanuc Ltd 自動溶接機の溶接線補正方式
JPS61279481A (ja) * 1985-06-01 1986-12-10 株式会社安川電機 ロボツトの作業開始点検出制御方法
US4870247A (en) * 1986-03-20 1989-09-26 Hitachi Construction Machinery Co., Ltd. Method and apparatus for controlling a welding robot forming a nonuniform weld satisfying predetermined criteria related to an interspace between elements being welded
JPH0692029B2 (ja) * 1987-03-20 1994-11-16 ファナック株式会社 ア−ク溶接ロボットの制御方法
DE19526339A1 (de) * 1995-07-19 1997-01-23 Krupp Ag Hoesch Krupp Schweißverbindung für dünne Bleche
JP4842656B2 (ja) * 2006-02-14 2011-12-21 株式会社ダイヘン 溶接ロボット制御装置
US9403233B2 (en) 2011-12-16 2016-08-02 Illinois Tool Works Inc. DC electrode negative rotating arc welding method and system
WO2013136756A1 (ja) 2012-03-16 2013-09-19 パナソニック株式会社 溶接線検出方法および産業用ロボット
US9511442B2 (en) 2012-07-27 2016-12-06 Illinois Tool Works Inc. Adaptable rotating arc welding method and system
US10543551B2 (en) * 2013-09-16 2020-01-28 Illinois Tool Works Inc. Synchronized rotating arc welding method and system
US10953484B2 (en) 2013-09-16 2021-03-23 Illinois Tool Works Inc. Narrow groove welding method and system
CN104924300B (zh) * 2015-07-09 2017-01-18 中国计量学院 气缸型五自由度机械手装置
CN109975302B (zh) * 2017-12-28 2021-06-18 中核建中核燃料元件有限公司 一种钎焊格架外观自动化检测装置
CN112091967B (zh) * 2020-07-27 2024-04-19 一重集团大连核电石化有限公司 焊接机器人轨迹离线编程批量修正方法
CN112743206A (zh) * 2020-12-03 2021-05-04 上海中船临港船舶装备有限公司 一种用于船舶中组立的机器人焊接工艺
JP7609747B2 (ja) * 2021-09-24 2025-01-07 コベルコROBOTiX株式会社 ウィービング制御方法、溶接制御装置、溶接システム、溶接方法及びウィービング制御プログラム
CN115041856B (zh) * 2022-06-30 2024-03-26 中船黄埔文冲船舶有限公司 一种中组立立角焊缝的焊接方法及装置

Family Cites Families (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR2223126B1 (ja) * 1973-03-26 1978-07-28 Kobe Steel Ltd
JPS5210773A (en) * 1975-07-15 1977-01-27 Matsushita Electric Ind Co Ltd Date changing device
US4151395A (en) * 1976-07-06 1979-04-24 CRC-Crose, International, Inc. Method and apparatus for electric arc and analogous welding under precision control
US4380695A (en) * 1976-07-06 1983-04-19 Crutcher Resources Corporation Control of torch position and travel in automatic welding
JPS5411050A (en) * 1977-06-27 1979-01-26 Kobe Steel Ltd Copying device for weld line
US4336440A (en) * 1979-07-03 1982-06-22 Westinghouse Electric Corp. Weld tracking/electronic arc sensing system
US4385358A (en) * 1979-10-19 1983-05-24 Tokico Ltd. Robot
NO810726L (no) * 1980-03-05 1981-09-07 Thermwood Corp Industrirobot.
FR2478507A1 (fr) * 1980-03-18 1981-09-25 Bignier Schmid Laurent Procede et appareil de soudage avec suivi automatique du joint a souder
US4316075A (en) * 1980-04-08 1982-02-16 Kabushiki Kaisha Komatsu Seisakusho Automatic welding position control method, and device
DE3176303D1 (en) * 1980-05-23 1987-08-13 Shin Meiwa Ind Co Ltd Automatic position controlling apparatus
JPS57109575A (en) * 1980-12-27 1982-07-08 Nippon Kokan Kk <Nkk> Arc welding method
US4403281A (en) * 1981-04-03 1983-09-06 Cincinnati Milacron Industries, Inc. Apparatus for dynamically controlling the tool centerpoint of a robot arm off a predetermined path

Also Published As

Publication number Publication date
NO159579B (no) 1988-10-10
ATE24290T1 (de) 1987-01-15
EP0076498B1 (en) 1986-12-17
NO159579C (no) 1989-01-18
EP0076498A2 (en) 1983-04-13
EP0076498A3 (en) 1983-05-18
DE3274728D1 (en) 1987-01-29
JPS5877775A (ja) 1983-05-11
NO823331L (no) 1983-04-08

Similar Documents

Publication Publication Date Title
JPH0453621B2 (ja)
US4568816A (en) Method and apparatus for manipulator welding apparatus with improved weld path definition
US4380696A (en) Method and apparatus for manipulator welding apparatus with vision correction for workpiece sensing
US6124693A (en) Robot controller
KR101617750B1 (ko) 로봇
JPH065486B2 (ja) ロボットの軌跡制御方法
JPS59708A (ja) 適合速度制御を行なう経路運動マニピユレ−タ
JP7144754B2 (ja) 多関節ロボットおよび多関節ロボットシステム
WO1989008878A1 (fr) Procede de commande de l&#39;orientation d&#39;un outil dans un robot
JPH0252592B2 (ja)
US4677276A (en) Method of welding robot control which controls the three basic axes of a robot to provide a repetition of a weaving pattern along a robot locus
US6192298B1 (en) Method of correcting shift of working position in robot manipulation system
JPS5815801B2 (ja) 工業用ロボツトの軌跡制御方式
JPH05261546A (ja) 溶接ロボットの制御方法
JPH04367373A (ja) 溶接ロボットの制御方法
JPS58192108A (ja) 溶接ロボツトの制御方法
JPS58189707A (ja) 工業用ロボツトの手首角度補間方法
JPH01205880A (ja) ウィービング溶接制御方法
JPH0741418B2 (ja) 溶接ロボットの制御方法
JPH055270U (ja) ウイービング動作をするアーク溶接ロボツト
JPH0428471B2 (ja)
JPS5946758B2 (ja) 自動作業機械の動作制御方法
JPH0146275B2 (ja)
JPH0416272B2 (ja)
JPH04228268A (ja) 溶接ロボットのティーチング方法