JPH06142937A - ロボットの軌跡制御方式 - Google Patents
ロボットの軌跡制御方式Info
- Publication number
- JPH06142937A JPH06142937A JP4296900A JP29690092A JPH06142937A JP H06142937 A JPH06142937 A JP H06142937A JP 4296900 A JP4296900 A JP 4296900A JP 29690092 A JP29690092 A JP 29690092A JP H06142937 A JPH06142937 A JP H06142937A
- Authority
- JP
- Japan
- Prior art keywords
- vector
- angle
- torch
- teaching
- welding
- 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)
- Arc Welding In General (AREA)
Abstract
先にプラズマトーチ等を取り付け、アングルの溶断を行
う場合、教示点を最小限とすることにより、教示作業の
短縮化を図ることにある。 【構成】 二つの教示点Pa,Pbにおけるトーチアプ
ローチベクトルAa,Abの双方に垂直なアングル頂点
ベクトルV1を算出すると共に該アングル頂点ベクトル
V1と前記トーチアプローチベクトルAaに垂直なベク
トルV2及び当該ベクトルV2と前記トーチアプローチ
ベクトルAbに垂直なベクトルV3を算出し、これら三
つのベクトルにより前記2点の教示点Pa,Pbの少な
くとも一方を通過しアングル頂点Pmを垂直に横断する
溶接経路を求める。
Description
制御方式に関する。
の手先にプラズマトーチ等を取り付け、アングルの溶
断、解体を行う場合、例えば、図2に示すように、アン
グル1の頂点及びその前後に三つの教示点P1,P2,P
3を教示して、P1→P2→P3の軌跡でトーチ2をプレイ
バック動作させ、アングル1を溶断しようとすると、P
1→P2、P2→P3の間で均等に補間されるため、アング
ル1の溶断厚さが変化し、安定した溶断ができない。
ングル1の頂点及びその前後に三つの教示点P1,P3,
P5を設けるのみならず、更に、頂点近傍で厚さが変化
する2カ所の位置にも教示点P2,P4を追加していた。
このように、五つの教示点P1,P2,P3,P4,P5を
教示すれば、頂点近傍において教示点P2→P3→P4の
間でトーチ2の姿勢を変化させることが出来るため、ア
ングルの溶断厚さが一定となり、安定した溶断が可能と
なる。
方法では、アングル1の頂点近傍に二つの教示点P2,
P4を追加する必要があるため、教示に時間を要する欠
点があった。また、トーチ2の姿勢を正確に教示するの
が煩雑であった。そこで、例えば、トーチ近傍に距離セ
ンサを設置し、アングル面に対し、トーチ姿勢を自動的
に垂直にする方式も提案されているが(特願昭62−1
94636号)、頂点近傍ではこの方式は適用できなか
った。
ものであり、アングル溶断の際の教示点を減少させ、教
示作業を容易に行うことが可能なロボットの軌跡制御方
式を提供することを目的とする。
発明の構成はプラズマトーチをロボット手先に取り付
け、ティーチングプレイバックによりアングルを溶断す
る際、トーチアプローチベクトルが溶接面に対して垂直
となるようにアングル両辺に教示された2点の教示点に
基づき、該トーチアプローチベクトルの双方に垂直なア
ングル頂点ベクトルを算出すると共に該アングル頂点ベ
クトルと前記トーチアプローチベクトルの一方に垂直な
ベクトル及び当該ベクトルと前記トーチアプローチベク
トルの一方に垂直なベクトルを算出し、これら三つのベ
クトルにより前記2点の教示点の少なくとも一方を通過
しアングル頂点を垂直に横断する溶接経路を求めること
を特徴とする。
参照して詳細に説明する。図3に本発明の一実施例を示
す。先ず、溶接開始点Pa、溶接終了点Pbをアングル1
の両辺に教示する。ここで、溶接開始点Pa、溶接終了
点Pbにおいては、トーチアプローチベクトルAa,Ab
を溶断面に垂直になるように教示する。
に相互に垂直となるアングル頂点ベクトルV1を下式の
ように求める。但し、“×”は外積であり、以下、同様
とする。 V1=Aa×Ab 同様に、アングル頂点ベクトルV1とトーチアプローチ
ベクトルAaとに相互に垂直となるベクトルV2を下式の
ように求める。
ルV3を下式のように求める。 V3=V1×V2 引続き、溶接開始点PaからベクトルV2に沿う直線とア
ングル頂点との交点を頂点Pmとし、溶接開始点Paから
頂点Pmまでの距離をL1とする。従って、頂点Pmは、
溶接開始点Pa からアングルを直角に横断する際の頂点
となる。
線と、溶接終了点PbからベクトルV1に沿う直線との交
点を新たな溶接終了点Pb′とし、頂点Pmと新たな溶接
終了点Pb′までの距離をL2とし、また溶接終了点Pb
から新たな溶接終了点Pb′までの距離をL3とする。距
離L1,L2,L3は、溶接開始点Pa 、溶接終了点Pb、
三つのベクトルV1,V2,V3から、下式に従い求める
ことができる。 Pb=Pa+L1・V2+L2・V3−L3・V1 L1・V2+L2・V3−L3・V1=Pb−Pa ∴
うに頂点Pmの座標、新たな新たな溶接終了点Pb′座標
を求める。 Pm=Pa+L1・V2 Pb′=Pm+L2・V3
接終了点Pb′へ、溶接開始点Paから溶接経路を構成
し、プレイバック時において溶接トーチを補間しながら
移動させることにより、安定した溶断が可能となる。
尚、本発明は、単なるティーチングプレイバックではな
く、プラズマ溶断電圧、電流からトーチのスタンドオフ
を自動的に算出し、制御する場合でも、同様に適用でき
るものである。
たように、本発明は、プラズマトーチをロボット手先部
に装着し、アングルを溶断させる際、2点の教示のみで
アングル頂点座標を算出し、自動的に溶接経路を算出す
ることができるので、アングルを垂直に溶断可能とな
り、また、教示時間の短縮が可能となる。
説明図である。
説明図である。
アングルを溶断する場合の溶断経路を示す説明図であ
る。
ル Ab 溶接終了点Pb におけるトーチアプローチベクト
ル Pm 溶接開始点Pa からアングルを直角に横断する際
の頂点 Pb ′ 溶接開始点からアングルを直角に溶断する際の
新たな溶接終了点 L1 溶接開始点Pa から頂点Pm までの距離 L2 頂点Pm から新たな溶接終了点Pb ′までの距離 L3 新たな溶接終了点Pb ′から溶接終了点Pb まで
の距離 V1 アングル頂点ベクトル V2 溶接開始点Pa から頂点Pm までのベクトル V3 溶接終了点Pb ′から溶接終了点Pb までのベク
トル
Claims (1)
- 【請求項1】 プラズマトーチをロボット手先に取り付
け、ティーチングプレイバックによりアングルを溶断す
る際、トーチアプローチベクトルが溶接面に対して垂直
となるようにアングル両辺に教示された2点の教示点に
基づき、該トーチアプローチベクトルの双方に垂直なア
ングル頂点ベクトルを算出すると共に該アングル頂点ベ
クトルと前記トーチアプローチベクトルの一方に垂直な
ベクトル及び当該ベクトルと前記トーチアプローチベク
トルの一方に垂直なベクトルを算出し、これら三つのベ
クトルにより前記2点の教示点の少なくとも一方を通過
しアングル頂点を垂直に横断する溶接経路を求めること
を特徴とするロボットの軌跡制御方式。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP29690092A JP3198671B2 (ja) | 1992-11-06 | 1992-11-06 | ロボットの軌跡制御方式 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP29690092A JP3198671B2 (ja) | 1992-11-06 | 1992-11-06 | ロボットの軌跡制御方式 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH06142937A true JPH06142937A (ja) | 1994-05-24 |
JP3198671B2 JP3198671B2 (ja) | 2001-08-13 |
Family
ID=17839617
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP29690092A Expired - Fee Related JP3198671B2 (ja) | 1992-11-06 | 1992-11-06 | ロボットの軌跡制御方式 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3198671B2 (ja) |
-
1992
- 1992-11-06 JP JP29690092A patent/JP3198671B2/ja not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP3198671B2 (ja) | 2001-08-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105573315B (zh) | 用于工业机器人的笛卡尔空间轨迹的几何平滑方法 | |
JP2007042021A (ja) | ロボット制御装置 | |
JPH0944225A (ja) | ロボットの制御方法 | |
JPH06142937A (ja) | ロボットの軌跡制御方式 | |
JP2006015431A (ja) | ロボットの制御装置及び制御方法 | |
JPH08305429A (ja) | ロボット急停止後の再開方法 | |
JP2656180B2 (ja) | ツール先端位置調整方法 | |
JPH02308311A (ja) | 多関節ロボットの補間速度指令方法 | |
JP2892404B2 (ja) | 産業用ロボットの三次元経路補正方法 | |
JP3166316B2 (ja) | プレイバック型ロボットの教示・制御方法 | |
JP2003039354A (ja) | ロボットの制御方法、制御装置および治具 | |
JPH11249723A (ja) | ロボットの制御方法および制御装置 | |
JPS60210357A (ja) | 隅肉継手のすきま溶接方法 | |
JPH03114670A (ja) | アークセンサによる開先自動倣い制御方法 | |
JP2728987B2 (ja) | 移動体の移動制御装置 | |
JPS62173086A (ja) | 溶接ロボツトのウイ−ビング装置 | |
JPS63133208A (ja) | ロボツトの位置補正方法および装置 | |
JPH07200042A (ja) | 溶接トーチ姿勢自動設定方法 | |
JPH03170282A (ja) | ロボットの制御方法 | |
JPH08339221A (ja) | ロボットの軌跡制御方法 | |
JPH0760341B2 (ja) | 数値制御方法 | |
SU1247207A1 (ru) | Устройство дл копировани контура разделки или линии стыка шва при автоматической дуговой сварке | |
JPS58137006A (ja) | ロボツトの制御方式 | |
JPS63120308A (ja) | ロボツトの制御方法 | |
JPS62231313A (ja) | ロボツト制御装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20010515 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090615 Year of fee payment: 8 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090615 Year of fee payment: 8 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100615 Year of fee payment: 9 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110615 Year of fee payment: 10 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110615 Year of fee payment: 10 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120615 Year of fee payment: 11 |
|
LAPS | Cancellation because of no payment of annual fees |