JPH0326482A - 産業用ロボットの制御装置 - Google Patents

産業用ロボットの制御装置

Info

Publication number
JPH0326482A
JPH0326482A JP16105089A JP16105089A JPH0326482A JP H0326482 A JPH0326482 A JP H0326482A JP 16105089 A JP16105089 A JP 16105089A JP 16105089 A JP16105089 A JP 16105089A JP H0326482 A JPH0326482 A JP H0326482A
Authority
JP
Japan
Prior art keywords
tool
coordinate system
axis
control device
axes
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
Application number
JP16105089A
Other languages
English (en)
Other versions
JP2750739B2 (ja
Inventor
Kikuo Koma
喜久夫 小間
Muneaki Kaga
加賀 宗明
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.)
Nippei Toyama Corp
Original Assignee
Nippei Toyama Corp
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
Application filed by Nippei Toyama Corp filed Critical Nippei Toyama Corp
Priority to JP16105089A priority Critical patent/JP2750739B2/ja
Publication of JPH0326482A publication Critical patent/JPH0326482A/ja
Application granted granted Critical
Publication of JP2750739B2 publication Critical patent/JP2750739B2/ja
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Abstract

(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。

Description

【発明の詳細な説明】 〔産業上の利用分野〕 本発明は、産業用ロボソトの制御装置に関し、特にティ
ーチングの容易な制御手段に係る。
〔従来の技術〕
工具の姿勢制御可能な産業用ロポットは、工具の先端と
被加工物との相対位置を決定するための直交3軸の他、
工具姿勢を決定するために少なくとも回転2軸を具備し
ている。したがって、その運動制御は、それらの各軸に
ついて必要なデータを入力することによって行われる。
そして、その制御装置に対する運動経路の設定は、点座
標をティーチングすることによって行われる。
従来、そのティーチング操作は、斜面上の経路などに対
して工具の姿勢を固定したまま工具の先端を工具の向い
ている方向に移動させるときや、その方向に垂直な面で
移動させるときに、工具を直交3軸の方向それぞれイン
チングキーなどで動かずことによって行われている。こ
の場合、工具の方向やその力向に垂直な面に対し、直交
3軸は、必ずしも平行な状態または垂直な状態となって
いない。このため、工具の方向やその方向に垂直な平面
上での移動経路のティーチング操作は、移動方向を各輔
方向に分解し、同時に2軸以上のデータを入力すること
によって割り出さなければならないため、非常に困難で
あり、また長時間を必要とした。
〔発明の目的〕
したがって、本発明の目的は、工具方向やその方向に垂
直な平面上の移動を簡単な入力操作により行えるようG
こし、斜面上の教示点のテイーチング操作を簡略化(−
、教示時間の短縮を図ることである。
〔発明の解決手段〕
」二記目的のもとに、本発明は、直交3軸の移動モード
と別に、ティーチングのために工具について専用の工具
座標系を設定し、この工具座標系で工具先端のティーチ
ング操作をテイーチングボソクスにより直接行えるよう
にしている。
このため、ティーチングに際し、オ(ヘ)レータは、、
工具の姿勢を固定1,たまま、その工具に固有な工具座
標系にもとづいて、ティーチングボックスのインチーン
グキーにより工具先端を移動できる。この教示に際し、
制御装置は、工具座標系のデークを直交3軸ずなわちワ
ールド座標系に変換し、王只の先端を移動1−、エ具の
先端のワールド座標系での位置データをメモリ内に格納
して行く。
工具座標系とワールド座標系との関係は、以下のように
定められる。
工具座標系で各軸の速度指令値(6,m,n)が与えら
れると、工具の移動ベクトルVは次式で計算され、ワー
ルド座標系での移動に変換される。
(eイL  e,,ezz)  :工具座標系基底ベク
トル(e,  e,  (!,)“:ワーJレド座標系
基底ベクトル [e  m  n)     :工具座標系での各座標
軸の速度指令値 に対する傾斜面に対し工具を垂直な状態に設定すれば、
その傾斜面と平行または乗直な位置関係の工具座標系に
よって直接必要な軸移動ができる。
このため、教示過程で、移動方向の分解・合戒や変換操
作が必要とされず、教示のための移動が簡酩化できる。
〔実施例〕
第1図は、制御対象の産業用ロボ・ノト1を示している
この産業用ロボットlは、被加工IFI2に対し工具3
の相対位置および運動経路を制御するために、直交3軸
つまりX軸、Y軸およびZ軸方向の位置決め機構4およ
び回転2軸としてのα軸およびβ軸の位置決め機構5を
備えている。直交3軸の位置決め機構4は、例えば門形
の直交3軸割り出し機構などによって横戊されている。
また、α軸は、Z軸を中心に回転する軸であり、β軸は
、α軸に対して45度の交角で回転する。そして、工具
3は、β軸の回りに45度の交角で回転自在に支持され
ていて、その先端の加工点Pは、α軸とβ軸との交点に
あるため、α軸やβ軸の回転にかかわらず、ワールド座
標上で移動しない。ここで、被加工物2と工具3の先端
との相対位置は、ワールド座標系すなわちX軸、Y軸お
よびZ軸によって決定され、また工具の姿勢は、α軸お
よびβ軸の角度により決定される。
次に、第2図は、産業用ロボットiの制御装置10の構
成を示している。
この制′4B装置10は、各軸毎に位置制御部11、l
2、13、14、15を備えている。これらの回転量お
よび回転速度の制御は、運動制御部16内のCPU16
1のプログラムおよびメモリl62の記憶データにもと
づいてデータバスl7を介し行われる。また、これらの
運動制御部16に対するデータ入力は、主制御盤18に
よりインターフェースl9を介し、またはティーチング
ボックス20によるインターフェース21を介し設定さ
れる. 第3図は、ティーチングポンクス20の一例を示す。こ
のティーチングボックス20は、インチング指定キー2
2、軸指定キー23、インチングキー24、トーチ(工
具)モードキー25、テンキー26、その他のファンク
ションキーや、表示器27および各種の表示ランプ28
を具備している。
〔ティーチング操作〕
まず、オペレータは主制御盤l8でティーチングモード
を選択し、ティーチングボックス20のインチング指定
キー22を操作して、軸移動モードをインチングモード
に設定し、軸指定キー23を必要な回数だけ押すことに
よって、αβ軸を選択してから、インチングキー24を
押すことによって、α軸またはβ軸を中心として工具3
を回転させ、被加工物2の例えば斜面のティーチングに
適切な垂直姿勢とする。
次に、オペレータは、トーチモードキー25を押し、軸
指定モードを工具座標系移動モードとし、インチングキ
ー24を押すことによって、工具座標系をXYZ軸の方
向に移動させる。
また、この時点で制御装置は、工具座標系とワールド座
標系との関係を現在のα軸β軸の回転角により計算し、
(T)の値をあらかじめ求めておく. このあと、オペレータが各インチングキ−24を押すこ
とによって、制御装置は予め工具座標系の軸毎に指定し
てある速度を参照し、選択した軸に対応する工具座標系
の速度指令値(lmn)を決定し、(1!mn)(T)
の演算を施すことにより、ワ ールド座標系の各軸移動
速度を求め、位置制御部11、12、13、l4、l5
に指令データを送り、工具3を移動させる。なお、工具
座標系のインチングでは、α軸およびβ軸のインチング
は無視される。
〔工具座標系からワールド座標系への変換〕ティーチン
グ操作中に、運動制御部l6は、座標変換して、ワール
ド座標系(XYZ)の移動指令を作威し、工具先端を移
動後ティーチングボックスの追加、修正キーによりティ
ーチングデータを記憶する. 第4図は座標変換の説明である。
+1)XYZ座標系をZ軸回りにU回転し、その座標系
をxIyI zl座標系とする。
(21  X+  3’l  2+座標系をyI軸回り
に、π/4回転し、その座標系を、Xz yx Zz座
標系とする。この座標系で(0、0、■)がβ軸の方向
ベクトルである。
(3)  Xt YZ 2g座標系を22軸回りにV回
転し、その座標系をXs Vx Xs座標系とする。
(4)xゴYx zi座標系をy,軸回りにーπ/4回
転し、その座標系をX4 3’4 Z4座標系とする。
この座標系で(0、0、l)が工具方向ベクトルNであ
り、この座標系が工具座標である。
ここで、U=一α、■=一βである。
よって、これら(1) (2) (31 (41より、
回転マトリックスを求めて、XYZ座標系(ワールド座
標系)とx4y4 z4座標系(工具座標系)との関係
を求める。なお、マトリックス中CはCosを、またS
はSinをそれぞれ表す。
Z軸回りの回転マトリックス y1軸回りの回転マトリックス Zt軸回りの回転マトリックス −1/2Sα(1千Cβ)−1/反CαCβCαCβ−
1ポSαSβ −1/2sα(1−Cβ)+1/汀CαCβ1/2(1
−Cβ)I よッテ、T = T yx ’ T−2 ’ Ty+ 
’ T−とすれば、X4y4  2aの工具座標系とX
YZ座標系の関係は、それぞれの座標系の基底ベクトル
を(e84cya+  e ,+4)、(eX+  y
+ea)とすれば、e 下記となる。
工具方向ベクトルは、Xs ya 24座標系では、、
(0、0、1)より次式が成立する。
T = Tys ・T−z ・ Ty+ = T,ただ
し、Tijは式(6)の各要素である。
工具方向ベクトルは、それをntとすると、次式となる
. また、κ4y,z4座標系で速度指令値(ffmn)が
与えられると、工具3の移動方向ヘクトルは、次式で求
められる。
〔発明の効果〕
本発明では、工只座標移動モードにより、直交3軸のワ
ールド座標系とは別に工具の姿勢に固有な工具座標系が
設定され、この工具座標系で工具の移動経路が入力でき
るため、工具の方向やその方向に垂直な面でのデータ入
力がティーチングボノクスのインチングキーなどにより
直接的に行え、複羅な演算や同時入力なども必要とされ
ないため、教示操作が簡単に行え、それに必要な時間も
短縮できる。
【図面の簡単な説明】
第1図は産業用ロボソトのスケルトン斜面図、第2図は
制御装置のブロック線図、第3図はティーチングボック
スの正面図、第4図および第5図は座標変換の説明図で
ある。 1・・産業用ロボソl・、2・・被加工物、3・・工具
、4・・直交3軸の位置決め機構、5・・回転2軸の位
置決め機構、10・・制御装置、ii、12、13、1
4、15・・位置制御部、16・・運動制御部、l8・
・主制御盤、2o・・ティーチングボックス。 第 ! 図 第 2 図 第 3 図

Claims (1)

    【特許請求の範囲】
  1. 工具の先端と被加工物との相対位置を設定する直交3軸
    および工具姿勢を決定する少なくとも回転2軸を具備す
    る産業用ロボットと、記憶部内に直交3軸上の所定の点
    座標および回転2軸の所定の回転角を記憶させこの点座
    標および回転角により上記産業用ロボットの運動を制御
    する制御装置と、上記制御装置に電気的に接続され離間
    した位置で産業用ロボットの各軸のデータを入力可能な
    ティーチングボックスと、ティーチングのために各軸毎
    の移動モードと別に工具座標系にて工具の移動を行う工
    具座標移動モードを設け、工具の姿勢を決定する回転2
    軸の角度により工具の姿勢に固有の工具座標系とワール
    ド座標系の関係を求める手段と、工具座標系にて移動方
    向を指定するインチングキーなどに応じて工具を移動さ
    せるために、工具座標系からワールド座標系への変換手
    段を設けたことを特徴とする産業用ロボットの制御装置
JP16105089A 1989-06-23 1989-06-23 産業用ロボットの制御装置 Expired - Fee Related JP2750739B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP16105089A JP2750739B2 (ja) 1989-06-23 1989-06-23 産業用ロボットの制御装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP16105089A JP2750739B2 (ja) 1989-06-23 1989-06-23 産業用ロボットの制御装置

Publications (2)

Publication Number Publication Date
JPH0326482A true JPH0326482A (ja) 1991-02-05
JP2750739B2 JP2750739B2 (ja) 1998-05-13

Family

ID=15727655

Family Applications (1)

Application Number Title Priority Date Filing Date
JP16105089A Expired - Fee Related JP2750739B2 (ja) 1989-06-23 1989-06-23 産業用ロボットの制御装置

Country Status (1)

Country Link
JP (1) JP2750739B2 (ja)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06114767A (ja) * 1992-09-29 1994-04-26 Kawasaki Heavy Ind Ltd 回転外部軸を有する産業用ロボットの教示方法およびそれに用いる教示装置
WO1997006473A1 (fr) * 1995-08-09 1997-02-20 Fanuc Ltd Robot fonctionnant par petits deplacements
KR19980054432A (ko) * 1996-12-27 1998-09-25 이종수 월드좌표계에 대한 산업용 로봇좌표계의 정의 장치 및 그 방법
JP2012066322A (ja) * 2010-09-22 2012-04-05 Daihen Corp ロボット制御システム
CN116944702A (zh) * 2023-09-19 2023-10-27 南通科美自动化科技有限公司 一种原位激光切割机械手、装置及方法

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06114767A (ja) * 1992-09-29 1994-04-26 Kawasaki Heavy Ind Ltd 回転外部軸を有する産業用ロボットの教示方法およびそれに用いる教示装置
WO1997006473A1 (fr) * 1995-08-09 1997-02-20 Fanuc Ltd Robot fonctionnant par petits deplacements
US5911892A (en) * 1995-08-09 1999-06-15 Fauc Ltd. Jog operation method for robot
KR19980054432A (ko) * 1996-12-27 1998-09-25 이종수 월드좌표계에 대한 산업용 로봇좌표계의 정의 장치 및 그 방법
JP2012066322A (ja) * 2010-09-22 2012-04-05 Daihen Corp ロボット制御システム
CN116944702A (zh) * 2023-09-19 2023-10-27 南通科美自动化科技有限公司 一种原位激光切割机械手、装置及方法
CN116944702B (zh) * 2023-09-19 2024-04-16 南通科美自动化科技有限公司 一种原位激光切割方法

Also Published As

Publication number Publication date
JP2750739B2 (ja) 1998-05-13

Similar Documents

Publication Publication Date Title
Dubey et al. Redundant robot control using task based performance measures
US4836742A (en) System for controlling a robot in association with a rotary table
Feng-yun et al. Development of a robot system for complex surfaces polishing based on CL data
JPH079606B2 (ja) ロボット制御装置
JPH09265313A (ja) ロボットの速度演算装置、およびロボットの速度演算方法
JP3070329B2 (ja) 産業用ロボットシステム
CN108436915A (zh) 双机器人运动控制方法
US4706000A (en) Tool posture control system
JPH0326482A (ja) 産業用ロボットの制御装置
JPS6318404A (ja) 位置制御方法
JPS60252914A (ja) 視覚センサ座標情報とロボツト基準座標情報の換算方式
JPH0437496A (ja) レーザ加工機のノズル移動方式
JP2979552B2 (ja) ロボットの制御方法
JPS5851088A (ja) 工業用ロボツト
JPH1190868A (ja) ロボット制御装置
JPS6145306A (ja) 多関節型ロボツトの制御システム
JP4291482B2 (ja) 複数種類の工作機械に適用可能な座標変換部を持つ数値制御装置
JP2573100B2 (ja) ロボットにおける基準位置データの作成方法
JP2597508B2 (ja) 球面作業ロボット
JP3295247B2 (ja) パネルベンダ用マニピュレータの制御装置
JPH01188903A (ja) ロボットのティーチングデータ修正方法
JP2723570B2 (ja) 3次元レーザのノズル制御方式
JP2576176B2 (ja) ロボットの制御方法
JP2759278B2 (ja) ロボットのティーチングデータ作成装置
JPH05204440A (ja) オフライン・ダイレクト・ティーチング装置

Legal Events

Date Code Title Description
FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20090227

Year of fee payment: 11

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20090227

Year of fee payment: 11

S533 Written request for registration of change of name

Free format text: JAPANESE INTERMEDIATE CODE: R313533

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20090227

Year of fee payment: 11

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

LAPS Cancellation because of no payment of annual fees