JP3198671B2 - ロボットの軌跡制御方式 - Google Patents
ロボットの軌跡制御方式Info
- Publication number
- JP3198671B2 JP3198671B2 JP29690092A JP29690092A JP3198671B2 JP 3198671 B2 JP3198671 B2 JP 3198671B2 JP 29690092 A JP29690092 A JP 29690092A JP 29690092 A JP29690092 A JP 29690092A JP 3198671 B2 JP3198671 B2 JP 3198671B2
- Authority
- JP
- Japan
- Prior art keywords
- vector
- angle
- torch
- vertex
- 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.)
- Expired - Fee Related
Links
Landscapes
- Manipulator (AREA)
- Arc Welding In General (AREA)
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 JPH06142937A (ja) | 1994-05-24 |
JP3198671B2 true 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 |
---|---|
JPH06142937A (ja) | 1994-05-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US4675502A (en) | Real time tracking control for taught path robots | |
US7209801B2 (en) | Method and a system for programming an industrial robot | |
JPH0252283B2 (ja) | ||
CN105573315B (zh) | 用于工业机器人的笛卡尔空间轨迹的几何平滑方法 | |
JP2007042021A (ja) | ロボット制御装置 | |
KR900700244A (ko) | 로보트의 학 자세 제어방법 | |
JP2004005049A (ja) | クロソイドスプラインを用いたコーナ補間方法及び軌跡制御方法 | |
JP3198671B2 (ja) | ロボットの軌跡制御方式 | |
JPH04227506A (ja) | 位置決め装置の制御方法 | |
JP2006072673A (ja) | 溶接ロボットのポジショナ設定方法 | |
JPH09164483A (ja) | 溶接経路の自動決定システム | |
JP3346917B2 (ja) | プラズマ切断装置におけるトーチ高さ制御装置 | |
JPS58189707A (ja) | 工業用ロボツトの手首角度補間方法 | |
JPH11226886A (ja) | ロボット軌道の修正方法 | |
JP3166316B2 (ja) | プレイバック型ロボットの教示・制御方法 | |
JP2581102B2 (ja) | ロボットのオフラインティーチングにおける干渉防止方法 | |
JP3288799B2 (ja) | ワイヤ放電加工機 | |
JPH07106452B2 (ja) | 自動溶接装置の開先ギャップ検出方法 | |
JPH07200042A (ja) | 溶接トーチ姿勢自動設定方法 | |
JPS61177509A (ja) | ロボツト手先の位置姿勢制御方式 | |
JPH03114671A (ja) | アークセンサによる開先自動倣い制御におけるトーチ角度制御方法 | |
JPH11156550A (ja) | プラズマ切断装置 | |
JP2706340B2 (ja) | 工業用ロボットのウィービング幅補正方法および装置 | |
JPH03188508A (ja) | 産業用ロボットの三次元経路補正方法 | |
JP2576176B2 (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 |