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

ロボットの制御方法

Info

Publication number
JP2680210B2
JP2680210B2 JP3188579A JP18857991A JP2680210B2 JP 2680210 B2 JP2680210 B2 JP 2680210B2 JP 3188579 A JP3188579 A JP 3188579A JP 18857991 A JP18857991 A JP 18857991A JP 2680210 B2 JP2680210 B2 JP 2680210B2
Authority
JP
Japan
Prior art keywords
robot
final actuator
coordinate system
final
actuator
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
Application number
JP3188579A
Other languages
English (en)
Other versions
JPH056215A (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.)
Hitachi Ltd
Original Assignee
Hitachi Ltd
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 Hitachi Ltd filed Critical Hitachi Ltd
Priority to JP3188579A priority Critical patent/JP2680210B2/ja
Publication of JPH056215A publication Critical patent/JPH056215A/ja
Application granted granted Critical
Publication of JP2680210B2 publication Critical patent/JP2680210B2/ja
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Landscapes

  • Numerical Control (AREA)
  • Manipulator (AREA)

Description

【発明の詳細な説明】 【0001】 【産業上の利用分野】本発明は複数種のハンド,ツー
ル,検出器等の最終作用器のうち任意の最終作用器が取
付可能であってその最終作用器が所望の軌道を描くよう
にしたロボットの制御方法に関するものである。 【0002】 【従来の技術】ロボットはその動作が自由に変化できる
点が1つの存在理由となっている。しかしロボットは、
システム的に固有の動作機能をもっておりそれらの組み
合わせにより全体の動作を変化させているのが一般的で
あった。これでは前記固有な動作機能がロボット使用者
にとって不都合な場合、その固有な動作をなさしめるシ
ステム自体を改変する必要があり、実際には不可能であ
ることが殆んどであった。このことは、ロボットに別の
作業,役割をさせる場合についても同様であり、従来の
ロボットは動作上の応用性,拡張性に極めて劣るもので
あった。 【0003】また、従来、IEEE TRANSACT
IONS ON SYSTEMS,MAN, AND
CYBERNETICS, VOL.SMC−11,N
o.4,APRIL 1981 (アイイイー トラン
ザクションズ オン システムズ マン アンド サイ
バネチックス ボリュウム エスエムシ−11 ナンバ
ーヨン エイプリール 1981)(pp.274〜2
89)に記載があるように、ロボットの最終作用器取付
け部位の座標系と最終作用器の座標系に分けてティーチ
ングならびに動作のプログラミングをし、ロボットの動
作経路のポイント−ポイントを上記座標系間の変換を用
いてより簡便にティーチングやプログラミングをできる
ようにしたロボットの制御方法である。 【0004】 【発明が解決しようとする課題】上記従来技術では、ロ
ボットのプレーバック時並びにティーチング時にポイン
ト−ポイントの間の経路補間時に最終作用器の座標系と
最終作用器取付け部位の座標系との間の座標変換を行っ
ていないため、経路補間中の軌道が所望の軌道を通ら
ず、障害物に当たるなどの問題が生じる。 【0005】本発明は上記のような実情に鑑みてなされ
たもので、選択された最終作用器の種類,機能およびロ
ボットへの取付部位に応じて適宜最終作用器座標系が選
択され、最終作用器が所望の軌道を描くようにして動作
機能の応用性,拡張性をもたせたロボットの制御方法を
提供することを目的とする。 【0006】 【課題を解決するための手段】本発明は、上記目的を達
成するために、複数種の最終作用器のうち任意の最終作
用器が取付け可能のロボットにおいて、前記最終作用器
が取り付けられるロボットの最終作用器取付部位にロボ
ットの取付部位に対しての位置及び姿勢を含んだ座標系
を定義し、さらに選択された最終作用器の種類、機能に
応じて決定され、前記ロボットの最終作用器取付部位の
座標系と位置及び姿勢を異にする最終作用器座標系を各
々の最終作用器について定義し、その定義された各々の
最終作用器座標系とロボットの最終作用器取付部位の座
標系とを相互に一次的に関係づける位置及び姿勢変換を
有する座標系変換マトリクスを備え、ロボットの最終作
用器取付部位を動作させて選択された一つの最終作用器
座標系の位置及び姿勢を補間する際、ロボットの最終作
用器取付部位を動作させるための位置指令値を、補間動
作の間逐次、前記選択された最終作用器の種類、機能に
応じた変換マトリクスを用いて一次的に関係づける位置
及び姿勢変換を施して、前記選択された最終作用器の位
置指令値として置き換え、逐次置き換えられた位置指令
値に基づいてロボットの最終作用器部位の位置及び姿勢
を表わす変換マトリクスを選択的に変化させるように補
間することにより、選択された最終作用器の種類、機能
及びロボットへの取付部位に応じて補間された座標系が
決定され、最終作用器が所望の軌道を描くようにし、さ
らに前記位置及び姿勢を最終作用器取付部位座標系に変
換し、ロボット動作機能を最終作用器取付部位に戻すこ
とができるようにしたことを特徴とする。 【0007】 【実施例】以下、前記座標系変換マトリックスについて
説明する。 【0008】ロボットの基本動作にはロボット各軸のア
クチュエータ単位の移動誤差があるが、ここではその説
明を省略し、高機能ロボットの特徴である手元の直線移
動と姿勢移動動作の補間に関して説明する。すなわち、
高機能ロボットには、これらの位置の移動補間と姿勢の
移動動作の補間が有り、それらの動作機能が基本的に要
求され、従来から何らかの方法でそれを実現している。 【0009】ここでは図1に示すように6軸の自由度を
有するロボットの旋回軸にZ軸をとった直交座標系をロ
ボットのシステム上の基本静止座標系1とする。X
(i)軸、Y(j)軸、Z(k)軸はここでの主方向で
あり、単位ベクトルの成分で表わすと、 X軸(1φφ) Y軸(φ1φ) Z軸(φφ1) である。ここで、図1に示すようにロボットの手先10
に同じ様な直交座標系を定義し、これを手先座標系2と
称する。この手先座標系2は前記静止座標系1に∵(XRX2+(XRY2+(XRZ2=1, と成分表示できる。なお、ロボットの姿勢(位置)を角
度で表わすか単位ベクトルの方向余弦を成分としたマト
リックスで表わすかはロボットのシステムにより任意に
決めて差し支えないが、ここでは方向余弦を成分とした
マトリックスで表わす。 【0010】ここで、位置と方向を合わせて記号化して
マトリックス〔L〕を と定義すると、ロボットの位置教示はこのマトリックス
〔L〕を求めることに他ならない。すなわち、ロボット
の動作は、このデータであるマトリックス〔L〕の成分
を他のマトリックス〔L〕の成分とで補間し、時間的に
連続に動かして他のマトリックス〔L〕の位置に移動さ
せることであり、ロボットの動作機能は、究極的に前記
補間とどのマトリックス〔L〕の成分を選択的に変化さ
せるかで決 についてはデータは変化させず、次式 により他の成分を変化させればよい。 【0011】 によればよい。これは他の成分の変化であっても同様で
ある。 【0012】なお、図1において、4〜9はロボットの
関節、θ1〜θ6はそれら関節4〜9の回転方向を示す。 【0013】次に、図2に基づいて本発明方法の具体例
について説明する。図2はロボットの手先座標系と最終
作用器座標系の関係を示す図で、図中3は最終作用器座
標系、11はハンド,ツール,検出器等の最終作用器で
ある。その他は図1と同様であるが、手先10は、ここ
では最終作用器11の取付部位となっている。この図2
において、最終作用器11の位置成分マトリックス
〔Q〕を前述マトリックス〔L〕と同様にして と定義すると、このマトリックス〔Q〕の成分は次式で表わされる。そしてこの(4)式中のλθ1〜λθ3,λ
1〜λa3,λb1〜λb3およびλc1〜λc3の各定数
を適宜定めることにより手先座標系2とは別の所望の最
終作用器座標系3を定義したことになる。また、(4)式
を整理し、逆に〔L〕 トリックス〔L〕を求めることもできる。 【0014】さて、一般に、ロボットの動作機能は手先
座標系2について固有のシステムによって固定化されて
おり、その変更は容易でない。しかし、前記マトリック
ス〔L〕とマトリックス〔Q〕は同一性質機能をもつも
のであり、ロボットがもっているマトリックス〔L〕を
操作する動作機能をそのままマトリックス〔Q〕に適用
しても何ら不都合は生じない。すなわち、図3に示すロ
ボットの動作機能を実現するフローチャートにおいて、
ステップ103「(4)式の逆行列の実行」を追加するだ
けで任意かつ簡単にロボットの動作機能を最終作用器1
1からその取付部の座標に変更することが可能となる。
(4)式を無効にし、ロボットの動作機能を手先10側に
戻すには(4)式中の定数を、 λθ1〜λθ3=φ λa1〜λb2=λc3=1 λa2,λa3=λb1,λb3=λc1,λc2=φ と定めればよい。 【0015】従って、ロボットの制御装置にステップ1
03を実行するブロックを追加すれば、ロボットの動作
機能を任意に変化させることが可能となり応用性,拡張
性のあるロボットが達成できる。 【0016】ここで、一応用例として、ロボットの手先
10を円弧運動させる方法について図2に基づき説明し
ておく。すなわち、ロボットの手先10を点12を中心
に円弧を描かせるには単に点12を前記(4)式中の定数
によってマトリックス〔Q〕 よく、他に特別な計算をすることなく簡単に行なわせる
ことが可能である。 【0017】なお、図3において100〜104は、各
々図中に記載の動作を実行するステップを指す。 【0018】 【発明の効果】以上述べたように本発明によれば、最終
作用器が取り付けられるロボットの部位に対し、選択さ
れた最終作用器の種類,機能に応じて決定される最終作
用器座標系を定義し、その定義された各最終作用器座標
系とロボットの最終作用器取付部位とを相互に関係づけ
る座標系変換マトリックスを備え、このマトリックスに
基づいてロボットの運動を指示することにより、プレー
バック時および動作教示時にロボットの最終作用器に対
して、適した運動を精度良く、容易に提供できる。
【図面の簡単な説明】 【図1】ロボットの基本静止座標系と手先座標系の関係
を示す図、 【図2】本発明に係るロボットの制御方法を説明するた
めの図であり、ロボットの手先座標系と最終作用器座標
系の関係を示す図、 【図3】本発明に係るロボットの制御方法を適用したロ
ボットの動作を示すフローチャートである。 【符号の説明】 1…基本静止座標系、 2…手先座標系、 3…最終作用器座標系、 4、5、6、7、8、9…関節、 10…手先、 11…最終作用器。
───────────────────────────────────────────────────── フロントページの続き (56)参考文献 特開 昭51−139544(JP,A) 特開 昭56−159709(JP,A) 特開 昭57−73410(JP,A) 「自動化技術」第11巻第8号、P134 〜139

Claims (1)

  1. (57)【特許請求の範囲】 1.複数種の最終作用器のうち任意の最終作用器が取付
    け可能のロボットにおいて、 前記最終作用器が取り付けられるロボットの最終作用器
    取付部位にロボットの取付部位に対しての位置及び姿勢
    を含んだ座標系を定義し、 さらに選択された最終作用器の種類、機能に応じて決定
    され、前記ロボットの最終作用器取付部位の座標系と位
    置及び姿勢を異にする最終作用器座標系を各々の最終作
    用器について定義し、 その定義された各々の最終作用器座標系とロボットの最
    終作用器取付部位の座標系とを相互に一次的に関係づけ
    る位置及び姿勢変換を有する座標系変換マトリクスを備
    え、 ロボットの最終作用器取付部位を動作させて選択された
    一つの最終作用器座標系の位置及び姿勢を補間する際、
    ロボットの最終作用器取付部位を動作させるための位置
    指令置を、補間動作の間逐次、前記選択された最終作用
    器の種類、機能に応じた変換マトリクスを用いて一次的
    に関係づける位置及び姿勢変換を施して、前記選択され
    た最終作用器の位置指令値として置き換え、 逐次置き換えられた位置指令値に基づいてロボットの
    終作用器の位置及び姿勢を表わす変換マトリクスの成分
    を選択的に変化させて補間することにより、選択された
    最終作用器の種類、機能及びロボットへの取付部位に応
    じて補間された座標系が決定され、最終作用器が所望の
    軌道を描くようにし、さらに前記位置及び姿勢を最終作
    用器取付部位座標系に変換し、ロボット動作機能を最終
    作用器取付部位に戻すことができるようにしたことを特
    徴とするロボットの制御方法。
JP3188579A 1991-07-29 1991-07-29 ロボットの制御方法 Expired - Lifetime JP2680210B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP3188579A JP2680210B2 (ja) 1991-07-29 1991-07-29 ロボットの制御方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP3188579A JP2680210B2 (ja) 1991-07-29 1991-07-29 ロボットの制御方法

Related Parent Applications (1)

Application Number Title Priority Date Filing Date
JP13722582A Division JPH0239802B2 (ja) 1982-08-09 1982-08-09 Robotsutonoseigyohoho

Related Child Applications (1)

Application Number Title Priority Date Filing Date
JP31507795A Division JP2791302B2 (ja) 1995-12-04 1995-12-04 ロボットの制御方法

Publications (2)

Publication Number Publication Date
JPH056215A JPH056215A (ja) 1993-01-14
JP2680210B2 true JP2680210B2 (ja) 1997-11-19

Family

ID=16226150

Family Applications (1)

Application Number Title Priority Date Filing Date
JP3188579A Expired - Lifetime JP2680210B2 (ja) 1991-07-29 1991-07-29 ロボットの制御方法

Country Status (1)

Country Link
JP (1) JP2680210B2 (ja)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR2960074B1 (fr) * 2010-05-14 2012-06-15 Staubli Sa Ets Procede de commande d'une cellule de travail automatisee

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5755414A (en) * 1980-09-19 1982-04-02 Mitsubishi Heavy Ind Ltd Attitude control system

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
「自動化技術」第11巻第8号、P134〜139

Also Published As

Publication number Publication date
JPH056215A (ja) 1993-01-14

Similar Documents

Publication Publication Date Title
JP2694669B2 (ja) ロボットの動作制御方法
EP1643327A2 (en) Systems and methods that facilitate motion control through coordinate system transformations
JP2874238B2 (ja) 多関節形ロボットの制御方法
JPH0720941A (ja) 作業座標上で柔らかさを指定可能な柔軟なサーボ制御方法
JP2680210B2 (ja) ロボットの制御方法
JP2703767B2 (ja) ロボットの教示データ作成方法
JPH0118442B2 (ja)
JPH0239802B2 (ja) Robotsutonoseigyohoho
JPH1083208A (ja) ロボット間相対位置演算機構
JP2791302B2 (ja) ロボットの制御方法
JP2610996B2 (ja) 多関節ロボット制御装置
JP3748454B2 (ja) 産業用ロボットの制御装置
JP3608673B2 (ja) 産業用ロボットの動作プログラム作成方法
JPH1097315A (ja) ロボットの制御方法
JP2676721B2 (ja) 多関節型ロボットの制御装置
JP3402378B2 (ja) 7軸マニピュレータの制御方法
JP2913661B2 (ja) ロボットの制御方法
JP2594546B2 (ja) ロボツトの仮想内部モデルに基づく制御方法
JPH03111184A (ja) ロボット制御装置
JP2664476B2 (ja) 工業用ロボット
JPH09179617A (ja) 溶接ロボットの制御装置
JP2001312305A (ja) ロボットのツール制御方法
JP2023017436A (ja) ロボット制御装置
JPS63184806A (ja) ロボツトによる相対座標系情報テイ−チング方式
JPS60200313A (ja) ロボツト座標補正装置