JP2979552B2 - ロボットの制御方法 - Google Patents

ロボットの制御方法

Info

Publication number
JP2979552B2
JP2979552B2 JP1223986A JP22398689A JP2979552B2 JP 2979552 B2 JP2979552 B2 JP 2979552B2 JP 1223986 A JP1223986 A JP 1223986A JP 22398689 A JP22398689 A JP 22398689A JP 2979552 B2 JP2979552 B2 JP 2979552B2
Authority
JP
Japan
Prior art keywords
robot
point
work
coordinate system
axis
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
Application number
JP1223986A
Other languages
English (en)
Other versions
JPH0385608A (ja
Inventor
善勝 南
雅人 田中
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
Application filed by YASUKAWA DENKI KK filed Critical YASUKAWA DENKI KK
Priority to JP1223986A priority Critical patent/JP2979552B2/ja
Priority to PCT/JP1990/001082 priority patent/WO1991003779A1/ja
Priority to DE69032398T priority patent/DE69032398T2/de
Priority to EP90912489A priority patent/EP0440816B1/en
Priority to US07/684,921 priority patent/US5222199A/en
Publication of JPH0385608A publication Critical patent/JPH0385608A/ja
Application granted granted Critical
Publication of JP2979552B2 publication Critical patent/JP2979552B2/ja
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/42Recording and playback systems, i.e. in which the programme 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
    • G05B19/425Teaching successive positions by numerical control, i.e. commands being entered to control the positioning servo of the tool head or end effector
    • 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/36446Keep tool stationary, move workpiece
    • 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/36448Teaching, consider workpoint on workpiece temporarily as tip of end effector
    • 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/45083Manipulators, robot
    • 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/50Machine tool, machine tool null till machine tool work handling
    • G05B2219/50353Tool, probe inclination, orientation to surface, posture, attitude

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Numerical Control (AREA)
  • Manipulator (AREA)

Description

【発明の詳細な説明】 〔産業上の利用分野〕 本発明は、6軸関節形ロボットのティーチング操作時
の動作制御方法に関する。
〔従来の技術〕
従来、6軸関節形ロボットのティーチング操作におい
て、ロボットが把持するワークの姿勢を任意の作業点に
対して所望の相対姿勢に変化させる場合、次のような動
作制御を行っていた。
(1) ロボットの各軸を単独に動作させて所望のワー
ク姿勢をとる。
(2) ロボット本体の有する基準座標軸回りの回転動
作と基準座標軸方向の平行移動により所望のワーク姿勢
をとる(第7図参照)。
(3) ロボット本体の有するツール座標軸回りの回転
動作とツール座標軸方向の平行移動により所望のワーク
姿勢をとる(第7図参照)。
前記の(2),(3)の回転動作はロボットの制御点
Rを回転中心として動作制御を行う。
〔発明が解決しようとする課題〕
ところが、前記の方法では、ロボットの各軸を単独に
動作させたりロボットの制御点Rを回転中心として、あ
る座標軸回りに回転動作させてロボットの把持するワー
クを任意の作業点に対して所望の相対姿勢となるよう動
作させた場合、第7図に示すように、P点の位置を変化
させずにワークの姿勢だけを変化させることができず
に、回転動作と平行移動を繰り返し操作する必要がある
ため、ティーチング作業時間が長くかかるという問題が
あった。
そこで本発明は、ロボットの把持するワークと任意の
作業点Aとの相対姿勢を、第6図に示すようにP点の位
置を変化させることなく動作させることを目的とする。
〔課題を解決するための手段〕
この目的を達成するため、本発明のロボットの制御方
法は、ワークを把持して作業を行うロボットを、下記の
ステップで制御することを特徴とする。
(1)ツール寸法が正しく測定された測定用ツールをロ
ボットの手首部に装着して任意の作業点Aの座標を教示
する。
(2)ワークをロボットで把持して教示する際に用いる
前記任意の作業点Aを原点とする直交座標系を4×4マ
トリクスのSで次のように定義する。
S=Z・S 但し、A=(pxs pys pzs) ▲▼=(nxs nys nzs) ▲▼=(Oxs Oys Ozs) ▲▼=(axs ays azs) ▲▼,▲▼,▲▼は単位ベクトル (3)ティーチング操作する際に、前記任意の作業点A
を一時的にロボット制御点Rから見たエンドエフェクタ
として演算する。
S=Z・T・E E=T-1・S ここでTはロボットの制御点Rを表すマトリクス、E
はロボットの制御点Rから作業点Aまでのエンドエフェ
クタを表すマトリクス。
(4)作業点Aに定義された座標系のXU回り、YU軸回り
及びZU軸回りの回転動作の回転角度をそれぞれψ,φ及
びθとし、回転移動マトリクスMを、 とする。
(5)ワークを把持して行うロボットの実際の作業に際
し、前記任意の作業点Aの座標系Sの見掛け上の座標系
S′を S′=S・M と表し、ロボットを、 T′・E=S′ T′=S′E-1 で表されるT′の6軸のリンク角で動作させる。
〔実施例〕
以下、本発明を、実施例に基づいて具体的に説明す
る。
第1図は本発明のロボットの制御方法を実施するため
のロボット制御装置の構成例を示すブロック図、第2図
はCPUの処理手順を示すフローチャートである。
まず、第3図に示すように、ツール寸法が正しく測定
されたツール2をロボット1の手首部に装着して任意の
作業点A3の座標を教示する。次に、第4図に示すよう
に、B点及びC点にツール2を移動し教示する。ただ
し、A点〜C点の関係は次の通りである。
A点・・・作業点(座標の原点) B点・・・XU軸方向 C点・・・YU軸方向 ▲▼,▲▼の外積をZU軸方向とする。
第5図に示すように、A,B,C点の座標値よりロボット
の基準座標Zから見た任意の作業点Aでの座標系をS
(4×4マトリクス)で定義すると、 S=Z・S となる。
但し、A=(pxs pys pzs =(nxs nys nzs =(Oxs Oys Ozs =(axs ays azsU ,U,は単位ベクトル 次に、ティーチング操作する際に、任意の作業点Aを
一時的にロボット制御点Rから見たエンドエフェクタと
して演算する(第5図)。
S=Z・T・E E=T-1・S ここでTはロボットの制御点Rを表すマトリクス、E
はロボットの制御点Rから作業点Aまでのエンドエフェ
クタを表すマトリクスである。
ここで作業点Aに定義された座標系のZU軸回りの回転
動作を例にとって説明する。回転角度をθとすると、回
転移動マトリクスMは、 となり、任意の作業点Aの座表系Sは見掛け上、S′ S′=S・M と表されるため、ロボットは、 T′・E=S′ T′=S′E-1 で表されるT′の6軸のリンク角を算出すればよい。
この算出方法としては、例えば特開昭62−193786号公
報に記載された方法を用いることができる。算出された
リンク角により各軸に対して動作指令を出力することに
より、ロボットの把持するワーク姿勢を第6図に示すよ
うに動作させることが可能となる。XU軸、YU軸回りの回
転動作も同様である。すなわち、作業点Aに定義された
座標系のXU回り、YU軸回り及びZU軸回りの回転動作の回
転角度をそれぞれψ、φ及びθとすると、回転移動マト
リクスMは、 となり、任意の作業点Aの座標系Sの見掛け上の座標系
S′は S′=S・M と表わされるため、ロボットは、 T′・E=S′ T′=S′E-1 で表されるT′の6軸のリンク角を算出して、これに基
づいてワークを動作させることになる。
以上の制御方法を実施するためのロボット制御装置の
構成を示すブロック図が第1図である。
第1図に示すようにロボット制御装置は記憶部10とCP
U処理部20により構成されている。その動作を、第2図
のフローチャートに従って説明する。まず、ステップ10
0に示すように任意の作業点Aの座標をロボットで教示
する。次に、ステップ110に示すように、教示点より作
業点の座標Sを演算し、記憶部10の記憶エリアを格納す
る。次のステップ120においては、ティーチボックスの
信号によりCPUへ動作命令が出されると、ロボットの制
御点Rから作業点AまでのエンドエフェクタEを算出す
る。ステップ130では、作業点Aの回転座標S′と元の
エンドエフェクタEよりロボットの制御点座標T′を算
出する。ステップ140では、ロボットの制御点座表T′
より各軸のリンク角を算出し、動作指令を出力する。
〔発明の効果〕
以上に説明したように、本発明によれば、任意の作業
点を一時的にロボット制御点からのエンドエフェクタと
して回転動作制御することにより、ロボットの把持する
ワークの姿勢を任意の作業点に対して所望の相対姿勢と
なるように短時間で変更することができ、ティーチング
時間の短縮に大きな効果がある。
【図面の簡単な説明】
第1図は本発明のロボットの制御方法を実施するための
ロボット制御装置の構成例を示すブロック図、第2図は
その処理手順を示すフローチャート、第3図及び第4図
は任意の作業点の座標定義を示す図、第5図はロボット
制御点と任意の作業点の関係を示すベクトル図、第6図
は本発明での動作例を示す説明図、第7図は従来のティ
ーチング動作例を示す説明図である。
───────────────────────────────────────────────────── フロントページの続き (56)参考文献 特開 昭64−37603(JP,A) 特開 昭60−193016(JP,A) 特開 昭63−29806(JP,A) 特開 昭63−184806(JP,A) (58)調査した分野(Int.Cl.6,DB名) G05B 19/42

Claims (1)

    (57)【特許請求の範囲】
  1. 【請求項1】ワークを把持して作業を行うロボットを、
    下記のステップで制御することを特徴とするロボットの
    制御方法。 (1)ツール寸法が正しく測定された測定用ツールをロ
    ボットの手首部に装着して任意の作業点Aの座標を教示
    する。 (2)ワークをロボットで把持して教示する際に用いる
    前記任意の作業点Aを原点とする直交座標系を4×4マ
    トリクスのSで次のように定義する。 S=Z・S 但し、A=(pxs pys pzs) ▲▼=(nxs nys nzs) ▲▼=(Oxs Oys Ozs) ▲▼=(axs ays azs) ▲▼,▲▼,▲▼は単位ベクトル (3)ティーチング操作する際に、前記任意の作業点A
    を一時的にロボット制御点Rから見たエンドエフェクタ
    として演算する。 S=Z・T・E E=T-1・S ここでTはロボットの制御点Rを表すマトリクス、Eは
    ロボットの制御点Rから作業点Aまでのエンドエフェク
    タを表すマトリクス。 (4)作業点Aに定義された座標系のXU回り、YU軸回り
    及びZU軸回りの回転動作の回転角度をそれぞれψ,φ及
    びθとし、回転移動マトリクスMを、 とする。 (5)ワークを把持して行うロボットの実際の作業に際
    し、前記任意の作業点Aの座標系Sの見掛け上の座標系
    S′を S′=S・M と表し、ロボットを、 T′・E=S′ T′=S′E-1 で表されるT′の6軸のリンク角で動作させる。
JP1223986A 1989-08-29 1989-08-29 ロボットの制御方法 Expired - Fee Related JP2979552B2 (ja)

Priority Applications (5)

Application Number Priority Date Filing Date Title
JP1223986A JP2979552B2 (ja) 1989-08-29 1989-08-29 ロボットの制御方法
PCT/JP1990/001082 WO1991003779A1 (en) 1989-08-29 1990-08-27 Robot control method
DE69032398T DE69032398T2 (de) 1989-08-29 1990-08-27 Robotersteuerungsverfahren
EP90912489A EP0440816B1 (en) 1989-08-29 1990-08-27 Robot control method
US07/684,921 US5222199A (en) 1989-08-29 1990-08-29 Robot control method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP1223986A JP2979552B2 (ja) 1989-08-29 1989-08-29 ロボットの制御方法

Publications (2)

Publication Number Publication Date
JPH0385608A JPH0385608A (ja) 1991-04-10
JP2979552B2 true JP2979552B2 (ja) 1999-11-15

Family

ID=16806791

Family Applications (1)

Application Number Title Priority Date Filing Date
JP1223986A Expired - Fee Related JP2979552B2 (ja) 1989-08-29 1989-08-29 ロボットの制御方法

Country Status (5)

Country Link
US (1) US5222199A (ja)
EP (1) EP0440816B1 (ja)
JP (1) JP2979552B2 (ja)
DE (1) DE69032398T2 (ja)
WO (1) WO1991003779A1 (ja)

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0615589A (ja) * 1992-07-03 1994-01-25 Daihen Corp 産業用ロボット制御装置
EP0671246A3 (de) * 1994-03-09 1998-05-27 Siemens Aktiengesellschaft Greiferbezogenes Handverfahren
JP4700646B2 (ja) * 2007-03-26 2011-06-15 株式会社神戸製鋼所 ワーク位置決め装置の制御装置およびそのプログラム
JP2010023128A (ja) * 2008-07-15 2010-02-04 Yaskawa Electric Corp ロボットシステム
DE102013007742B4 (de) 2012-05-21 2019-12-05 teconsult GmbH precision robotics Verfahren und Vorrichtung zur Wiederherstellung der Betriebsbereitschaft einer mehrachsigen Bewegungseinrichtung
DE102017008316A1 (de) * 2017-09-05 2019-03-07 Audi Ag Bearbeitungssystem mit einer auf einem Fahrzeug angeordneten Aufnahmeeinheit für mindestens ein Bauteil und Verfahren zum Bearbeiten mindestens eines Bauteils

Family Cites Families (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4456961A (en) * 1982-03-05 1984-06-26 Texas Instruments Incorporated Apparatus for teaching and transforming noncoincident coordinate systems
JPS59189415A (ja) * 1983-04-13 1984-10-27 Hitachi Ltd 工業用ロボツトの動作教示方法および装置
JPS60193016A (ja) * 1984-03-14 1985-10-01 Toyota Motor Corp ロボツト装置
JPS6142004A (ja) * 1984-08-06 1986-02-28 Toyota Central Res & Dev Lab Inc 追従ロボツト装置
JPS61229107A (ja) * 1985-04-04 1986-10-13 Omron Tateisi Electronics Co 自動機械群の協調運転方式
US4817017A (en) * 1985-04-08 1989-03-28 Mitsubishi Denki Kabushiki Kaisha Industrial robot
JPS6244809A (ja) * 1985-08-23 1987-02-26 Hitachi Ltd ロボツト教示方式
JPS63216689A (ja) * 1987-03-04 1988-09-08 株式会社日立製作所 自動作業装置
JP2691985B2 (ja) * 1987-08-04 1997-12-17 ファナック 株式会社 ロボットの軌跡制御方法
JP2572093B2 (ja) * 1987-12-28 1997-01-16 本田技研工業株式会社 ロボットのティーチング方法
JPH079606B2 (ja) * 1988-09-19 1995-02-01 豊田工機株式会社 ロボット制御装置
JP2786225B2 (ja) * 1989-02-01 1998-08-13 株式会社日立製作所 工業用ロボットの制御方法及び装置
US5053976A (en) * 1989-05-22 1991-10-01 Honda Giken Kogyo Kabushiki Kaisha Method of teaching a robot

Also Published As

Publication number Publication date
US5222199A (en) 1993-06-22
EP0440816B1 (en) 1998-06-10
EP0440816A1 (en) 1991-08-14
JPH0385608A (ja) 1991-04-10
WO1991003779A1 (en) 1991-03-21
DE69032398T2 (de) 1999-03-25
EP0440816A4 (en) 1994-05-18
DE69032398D1 (de) 1998-07-16

Similar Documents

Publication Publication Date Title
JPH079606B2 (ja) ロボット制御装置
EP0402788B1 (en) Method of controlling robot movements
EP0383944B1 (en) Action teaching method and control apparatus for a robot
JP3070329B2 (ja) 産業用ロボットシステム
JP2006048244A (ja) 加工プログラム作成装置
JPH0869314A (ja) リードスルーによるロボットプログラミングシステム
EP0216930B1 (en) System for setting rectangular coordinates of workpiece for robots
EP0188626A1 (en) System for correcting position of tool
JP2979552B2 (ja) ロボットの制御方法
JP2667153B2 (ja) 複腕装置の直接教示方法
JP2779072B2 (ja) ロボットの教示方法
JPS62194513A (ja) ロボツトの円弧補間姿勢制御装置
JPH05303425A (ja) 直接教示方式ロボット
JP2656180B2 (ja) ツール先端位置調整方法
JPH0647689A (ja) 多関節形ロボットの制御方法
JP2763613B2 (ja) 産業用ロボットの干渉チェック方法
JP2913661B2 (ja) ロボットの制御方法
JP2752784B2 (ja) ロボットの姿勢修正方法
JP3402378B2 (ja) 7軸マニピュレータの制御方法
JP2518177B2 (ja) ロボットの相互干渉チェック方法
JP2000020120A (ja) ロボットのティーチングシステム
JPH07205068A (ja) ロボットの座標系設定方法
JPH0724762A (ja) ロボット制御装置
JPH08255011A (ja) ロボットの制御方法
JP2841364B2 (ja) 加工装置の位置決め方法

Legal Events

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

Free format text: PAYMENT UNTIL: 20070917

Year of fee payment: 8

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

Free format text: PAYMENT UNTIL: 20080917

Year of fee payment: 9

LAPS Cancellation because of no payment of annual fees