JP2892404B2 - 産業用ロボットの三次元経路補正方法 - Google Patents
産業用ロボットの三次元経路補正方法Info
- Publication number
- JP2892404B2 JP2892404B2 JP30971889A JP30971889A JP2892404B2 JP 2892404 B2 JP2892404 B2 JP 2892404B2 JP 30971889 A JP30971889 A JP 30971889A JP 30971889 A JP30971889 A JP 30971889A JP 2892404 B2 JP2892404 B2 JP 2892404B2
- Authority
- JP
- Japan
- Prior art keywords
- path
- point
- correction
- interpolation
- direction vector
- 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
Links
Description
めの教示・再生方式の産業用ロボットにおいて、特に、
その加工中心経路の補正方法に関する。
し、それらの区間をロボット制御装置内の補間機能によ
って補間し、補間後の曲線あるいは直線の経路に沿って
トーチなどの工具を移動させて、切断加工をする産業用
ロボットにおいて、切断加工時に発生する切断幅を考慮
し、教示経路に対してトーチ進行方向に直角な右または
左側の方向に経路を補正しなければならない。
点があった。
との関連で教示する必要があるため、その作業が煩雑と
なる。また、補正平面をXY、YZ、ZX平面に限定する方法
があるが、複雑な曲面では、誤差が大きくなること、教
示点ごとに、平面切り換え等を意識する必要があり、教
示作業が複雑で困難である。
点座標を書き替える手法もあるが、この場合、元の教示
データが残らず、再度補正の必要なときは、不都合があ
った。
データを作成することなく、また元の教示点座標を教示
データ上で変更することなく、経路補正を容易に行える
ようにすることである。
ことにより、トーチの姿勢と経路より、既に設定された
補正量を自動的に考慮し、再生時にトーチの方向を制御
装置内で計算し、補正量と右または左側の補正方向とに
より経路補正を容易にできるようにしている。
方向ベクトルをSi、教示点をPi、補正量をhiとする。こ
こでNi、Siについては、単位方向ベクトル(|Ni|=|Si|
=1)であり、hiについては右側補正の場合は、プラ
ス、左側補正の場合は、マイナスのスカラ量とする。こ
れらの変数にいて補正前の経路とともに第1図に示す。
と、それは次のように計算できる。
2図に、P′iについて他の変数とともに示す。同図で
P′iは補正量プラス、つまり進行方向右側の補正に対
応し、(P′i)は補正量マイナス、つまり進行方向左
側の補正に対応する。ここで、補正量hiは、教示時に与
えられる。また、接線方向ベクトルSiは、教示点Piより
補正前の経路計算時に予め計算されている。
プライン補間が可能であり、各補間経路は、始点、終点
を含めて、複数の教示点によって決定される。
経路計算を行い、接線方向ベクトルを求め(式1)によ
って、経路補正後の教示点に相当する点を計算する。こ
れらの経路補正後の教示点に相当する点をもとに、各補
間ごとに経路を再計算することとなる。第3図は、以上
述べた過程を整理して示す。
下の判定を行う。この判定結果により、補間経路の一部
を削除する交点処理、またはつなぎ円弧を追加するつな
ぎ処理を行って、連続した経路を作成する。
クトルをSEi、逆方向ベクトルをSEiとし、次補間の始点
で、補正前の接線方向ベクトルをSiとする。また、補
正前の教示点Piから経路補正後の教示点に相当する点
P′Si、P′EiまでのベクトルをP″Ei、P″Siとす
る。これらの変数について第4図に示す。
によって決定される平面上で、ベクトルP″Ei、P″Si
を上記の平面に投影したときの投影ベクトルを″Ei、
″Siとし、″EiとSSiとのなす角度をφS、″Si
とSEiとのなす角度をφEとし、Ei、とSSiとのなす角
度をΦとする。これらの関係を第5図に示す。
によって次の判定条件から判断される。
゜・・・交点処理 (2) (1)以外・・・つなぎ処理 なお、上記大小比較にあたって、所定の角度(180
゜、90゜)は、予め与えられ、Φ、φS、φEについて
は、180゜以下の角度を採用する。
場合のつなぎ経路を作成する過程について説明する。
をP′Ei、P′Si、Piによって決定される面に投影され
たベクトルEiとの関係を第6図に示す。
(補正量)である。したがって、Piを中心として、P′
Eiを始点、P′Siを終点とし、中心角が180゜以下の円
弧をつなぎ経路とする。中心角が180゜の場合は、Ei
の方向にある円弧をつなぎ経路とする。
れた場合の交点の求め方は、補間の組み合わせによって
次に示す5通りに分類できる。
L′E、L′S、LEとLSによって決定される平面(τ)
にL′E、L′Sを投影したものを、′E、′S。
′E′Sとの交点をPPi、PPiからL′Eへの垂線と
の交点をP′CEi、PPiからL′Sへの垂線との交点を
P′CSiとし、第7図に示す。
路の終点をP′CEi、L′Sに対する経路の始点をP′
CSiとする。さらにP′CEiとP′CSiを直線で結ぶ経路
を追加することにより連続した経路を作成する。
弧補間をC′i、C′iを赤道とする球を考え、L′i
との交点をP′CLi、球の北極と、P′CLi、球の南極の
3点を通る大円とC′iとの交点をP′CCiとして第8
図に示す。
対する経路の終点または始点をP′CLiとして、C′i
に対する始点または終点をP′CCiとする。さらにP′
CLiとP′CCiを直線で結ぶ経路を追加することによって
連続した経路を作成する。
C′2iとし、C′2iを赤道とする球を考え、C′1iとの
交点をP′C1i、球の北極と、P′C1iと、球の南極との
3点を通る大円とC′2iとの交点をP′C2iとして第9
図に示す。
対する経路の終点をP′C1i、C′2iに対する経路の始
点をP′C2iとする。さらにP′C1i、P′C2iを直線で
結ぶ経路を追加することによって連続した経路を作成す
る。
補間をA′i、L′iとA′iの距離が最小となるL′
i上の点をP′Li、A′i上の点をP′Aiとして、第10
図に示す。
する経路の終点または始点をP′Liとし、A′iに対す
る経路の始点または終点をP′Aiとする。さらにP′Li
とP′Aiを直線で結ぶ経路を追加することにより連続し
た経路を作成する。
円弧補間をC′i、C′iを赤道とする球と考え、C′
iとの交点をP′Aiとし、球の北極、P′Ai、球の南極
の3点を通る円とC′iとの交点をP′Ciとして、第11
図に示す。
する経路の終点または始点をP′Aiとし、C′iに対す
る経路の始点または終点をP′Ciとする。さらにP′Ai
とP′Ciとを直線で結ぶ経路を追加することによって連
続した経路を作成する。
す。
るとは限らず、例えば(a)直線と直線においては交点
PPi、(b)円・円弧と直線においては交点P′CLi、
(c)円・円弧と円・円弧においては交点P′CLi、
(e)円・円弧とスプラインにおいては交点P′Ai等が
実際に求まらない場合がある。
ローへ移行し、つなぎ処理、すなわち補正後の補間の終
点と始点とを、補正量を半径とする円弧でつなぐ経路を
求めることによって連続した経路を作成する。これによ
り、経路補正を確実に成し遂げることができる。
フローへ移行し、この時点でエラーとし、エラーメッセ
ージと同時に経路作成の処理を中止するようにしてもよ
い。これによりオペレータは補正量を変更するなどの手
段により経路補正を再開できる。
対する補正方向(左右)を適宜教示することにより、補
正のための教示点の修正や、補正方向ベクトルを教示点
毎に教示することなく、切断幅の補正を容易に短時間に
行うことができる。
となく補正経路データを作成できるので、元の教示デー
タが書き替えられず元のまま残るため、再度補正の必要
なときは元の教示データを再び使って経路補正ができ、
複数種の経路補正が容易に行える。
必ずといってよいほど、補正後の経路間で、交点がなく
なり、つなぎ処理が必要となるが、本発明によればその
ときのつなぎ処理について具体的な手法によって対応し
ているから、教示経路の補正によって、補正後の経路間
で、交点がなくなったとしても、適切な対応が可能とな
る。
点の説明図、第3図は経路補正後の教示点の説明図、第
4図はベクトルの説明図、第5図はベクトルの相関図、
第6図はベクトル説明図、第7図は直線補間の説明図、
第8図は円・円弧直線補間の説明図、第9図は円・円弧
補間の説明図、第10図はスプライン直線補間の説明図、
第11図は円・円弧スプライン補間の説明図、第12図およ
び第13図は経路補正過程のフローチャート、第14図は第
12図に続く他の方法を示すフローチャートである。
Claims (2)
- 【請求項1】教示時に教示された各教示点での接線方向
ベクトルとトーチ方向ベクトルにより経路補正後の教示
点に相当する点を求める過程、 経路補正後の教示点に相当する点より各補間ごとに経路
補正後の経路を求める過程、 上記各補間ごとの経路より連続した経路を求めるために
交点処理が必要か、つなぎ処理が必要かを、ある補間の
終点での補正前の経路の接線の逆方向ベクトルと次補間
の始点での補正前の接線方向ベクトルで決定される面上
で、上記逆方向ベクトルと接線方向ベクトルとのなす角
度と、上記逆方向ベクトルと補正前の教示点から補正後
の教示点に相当する点までのベクトルの上記面上の投影
ベクトルとの角度と、上記接線方向ベクトルと補正前の
教示点から補正後の教示点に相当する点までのベクトル
の上記面上の投影ベクトルとの角度と所定の角度との大
小比較から、判定する過程、 上記判定の過程によりつなぎ処理が必要と判断された場
合に教示点を中心とした補正量を半径とする円弧により
経路補正後の補間の終点と始点とをつないでつなぎ経路
を作成する過程、 上記判定の過程により交点処理が必要と判断された場合
に、補間の種類に応じた面で、補正後の経路上に各々の
交点を求め、求められた2交点を結んで連結した経路を
作成し、2交点が求まらないときに補正量を半径とする
円弧により経路補正後の補間の終点と始点とをつないで
つなぎ経路を作成すること、および2つの経路間の最短
距離を結んでつなぎ経路を作成することのいずれかを含
む過程、 以上の5つの過程からなる産業用ロボットの三次元経路
補正方法。 - 【請求項2】交点処理が必要と判断された場合に交点を
求め、連続した経路を作成する過程で、交点が求まらな
いときにエラーメッセージとともに経路作成を中止する
過程を有する特許請求の範囲第1項記載の産業用ロボッ
トの三次元経路補正方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP30971889A JP2892404B2 (ja) | 1989-09-22 | 1989-11-29 | 産業用ロボットの三次元経路補正方法 |
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP1-247656 | 1989-09-22 | ||
JP24765689 | 1989-09-22 | ||
JP30971889A JP2892404B2 (ja) | 1989-09-22 | 1989-11-29 | 産業用ロボットの三次元経路補正方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH03188508A JPH03188508A (ja) | 1991-08-16 |
JP2892404B2 true JP2892404B2 (ja) | 1999-05-17 |
Family
ID=26538358
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP30971889A Expired - Lifetime JP2892404B2 (ja) | 1989-09-22 | 1989-11-29 | 産業用ロボットの三次元経路補正方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2892404B2 (ja) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103616849B (zh) * | 2013-12-06 | 2018-10-09 | 北京配天技术有限公司 | 一种刀具轨迹规划方法、装置,工件加工方法、装置 |
-
1989
- 1989-11-29 JP JP30971889A patent/JP2892404B2/ja not_active Expired - Lifetime
Also Published As
Publication number | Publication date |
---|---|
JPH03188508A (ja) | 1991-08-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4091124B2 (ja) | 動作経路シミュレーション機能を有するロボット制御装置 | |
Piazzi et al. | Quintic g/sup 2/-splines for trajectory planning of autonomous vehicles | |
JPH0252283B2 (ja) | ||
JPH07107646B2 (ja) | 加工品の輪郭を決める装置 | |
JP3207409B2 (ja) | ロボットのツール姿勢制御方法 | |
CN110836671A (zh) | 轨迹规划方法、轨迹规划装置、存储介质与电子设备 | |
JP2892404B2 (ja) | 産業用ロボットの三次元経路補正方法 | |
JPS6263307A (ja) | 複合曲面加工方法 | |
JP2703767B2 (ja) | ロボットの教示データ作成方法 | |
CN113414762B (zh) | 焊道路径的偏移方法、装置、机器人及存储装置 | |
JPH08305429A (ja) | ロボット急停止後の再開方法 | |
JPH09164483A (ja) | 溶接経路の自動決定システム | |
JP3146550B2 (ja) | 産業用ロボットの制御装置 | |
JPS58189707A (ja) | 工業用ロボツトの手首角度補間方法 | |
JPH03245209A (ja) | ロボットの経路補間方法 | |
JPS6226868B2 (ja) | ||
JPS58187269A (ja) | 溶接ロボツトの軌跡制御方法 | |
JPH01260503A (ja) | 曲面加工用ncデータの作成方法 | |
JPS59110581A (ja) | 多関節ロボツトの制御方法 | |
JPH05134732A (ja) | 干渉回避経路生成方法 | |
JP4850759B2 (ja) | ロボット制御方法 | |
JPS59124561A (ja) | カム研削方法 | |
JPH06142937A (ja) | ロボットの軌跡制御方式 | |
JPH04123204A (ja) | 円弧補間方法およびその装置 | |
JPH01121188A (ja) | 自動工作機器の制御方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Year of fee payment: 10 Free format text: PAYMENT UNTIL: 20090226 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090226 Year of fee payment: 10 |
|
S533 | Written request for registration of change of name |
Free format text: JAPANESE INTERMEDIATE CODE: R313533 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090226 Year of fee payment: 10 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Year of fee payment: 10 Free format text: PAYMENT UNTIL: 20090226 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Year of fee payment: 11 Free format text: PAYMENT UNTIL: 20100226 |
|
EXPY | Cancellation because of completion of term | ||
FPAY | Renewal fee payment (prs date is renewal date of database) |
Year of fee payment: 11 Free format text: PAYMENT UNTIL: 20100226 |