JPH10315169A - マニピュレータ制御装置 - Google Patents
マニピュレータ制御装置Info
- Publication number
- JPH10315169A JPH10315169A JP12431397A JP12431397A JPH10315169A JP H10315169 A JPH10315169 A JP H10315169A JP 12431397 A JP12431397 A JP 12431397A JP 12431397 A JP12431397 A JP 12431397A JP H10315169 A JPH10315169 A JP H10315169A
- Authority
- JP
- Japan
- Prior art keywords
- data
- posture
- hand
- orbit
- manipulator
- 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.)
- Withdrawn
Links
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
(57)【要約】
【課題】手先位置を入力するだけで適切にマニピュレー
タを駆動することができるマニピュレータ制御装置を提
供する。 【解決手段】予め設定された複数の特徴点の各々に対し
て教示される手先姿勢について該特徴点間の軌道を補間
する特徴点間軌道補間部7と、補間後の手先姿勢のデー
タを特徴点間の軌道の位置データに対応付けた姿勢デー
タテーブルを記憶する姿勢データテーブル部6と、位置
データ入力部1により入力された手先位置のデータにつ
いて手先位置間の軌道を補間する位置軌道補間部4と、
補間後の手先位置のデータに基づいて姿勢データテーブ
ルを検索して得られた手先姿勢のデータと、位置軌道補
間部2で補間された手先姿勢のデータに従ってマニピュ
レータを制御する運動制御部8とを備えた。
タを駆動することができるマニピュレータ制御装置を提
供する。 【解決手段】予め設定された複数の特徴点の各々に対し
て教示される手先姿勢について該特徴点間の軌道を補間
する特徴点間軌道補間部7と、補間後の手先姿勢のデー
タを特徴点間の軌道の位置データに対応付けた姿勢デー
タテーブルを記憶する姿勢データテーブル部6と、位置
データ入力部1により入力された手先位置のデータにつ
いて手先位置間の軌道を補間する位置軌道補間部4と、
補間後の手先位置のデータに基づいて姿勢データテーブ
ルを検索して得られた手先姿勢のデータと、位置軌道補
間部2で補間された手先姿勢のデータに従ってマニピュ
レータを制御する運動制御部8とを備えた。
Description
【0001】
【発明の属する技術分野】本発明は、溶接ロボットや塗
装ロボットなどに適用されるマニピュレータ制御装置に
関する。
装ロボットなどに適用されるマニピュレータ制御装置に
関する。
【0002】
【従来の技術】溶接ロボットや塗装ロボットは、マニピ
ュレータの先端部に塗装ガンなどのツールを取り付け、
操作者の入力に従ってマニピュレータを駆動することに
よりツールの位置を移動させて作業を行うものである。
ュレータの先端部に塗装ガンなどのツールを取り付け、
操作者の入力に従ってマニピュレータを駆動することに
よりツールの位置を移動させて作業を行うものである。
【0003】マニピュレータを駆動する場合、作動経路
に沿っていくつかのポイント(PTP:Point to Poin
t)について手先位置および手先姿勢(以下、手先位置
姿勢と称する)を入力し、各ポイント間の手先位置姿勢
を補間した後、マニピュレータを駆動する方法が従来か
ら知られている。このとき、従来では図8に示されるよ
うなマニピュレータ制御装置が用いられ、各ポイントに
ついてデカルト座標系における位置データ(x,y,
z)および姿勢データ(A,B,C)が入力されると、
位置軌道補間部81および姿勢軌道補間部82において
各ポイント間の軌道が補間され、連続した位置軌道デー
タおよび姿勢軌道データが生成されて、この結果に応じ
て運動制御部83によりマニピュレータが駆動される。
に沿っていくつかのポイント(PTP:Point to Poin
t)について手先位置および手先姿勢(以下、手先位置
姿勢と称する)を入力し、各ポイント間の手先位置姿勢
を補間した後、マニピュレータを駆動する方法が従来か
ら知られている。このとき、従来では図8に示されるよ
うなマニピュレータ制御装置が用いられ、各ポイントに
ついてデカルト座標系における位置データ(x,y,
z)および姿勢データ(A,B,C)が入力されると、
位置軌道補間部81および姿勢軌道補間部82において
各ポイント間の軌道が補間され、連続した位置軌道デー
タおよび姿勢軌道データが生成されて、この結果に応じ
て運動制御部83によりマニピュレータが駆動される。
【0004】このようなマニピュレータ制御装置の一例
として、例えば特開平7−20919号「マニプレータ
の制御装置」に、操作者に入力されたデータを補間して
軌道データを求める処理とは別に、溶接のためのウイビ
ングなどの軌道データを予め生成しておき、これらの軌
道データから最終的な軌道データを生成する技術が開示
されている。
として、例えば特開平7−20919号「マニプレータ
の制御装置」に、操作者に入力されたデータを補間して
軌道データを求める処理とは別に、溶接のためのウイビ
ングなどの軌道データを予め生成しておき、これらの軌
道データから最終的な軌道データを生成する技術が開示
されている。
【0005】
【発明が解決しようとする課題】マニピュレータの手先
位置姿勢を入力する方法は、操作者にとって位置の入力
を直感的に行うことができる反面、姿勢の入力を直感的
に行うことが難しいという問題がある。
位置姿勢を入力する方法は、操作者にとって位置の入力
を直感的に行うことができる反面、姿勢の入力を直感的
に行うことが難しいという問題がある。
【0006】この対策として、単純に手先の姿勢を無視
して、例えば一定の姿勢値をとるようにしておき、とり
あえず手先の位置のみを入力してマニピュレータを駆動
し、その後で姿勢を調節するという方法が考えられる。
して、例えば一定の姿勢値をとるようにしておき、とり
あえず手先の位置のみを入力してマニピュレータを駆動
し、その後で姿勢を調節するという方法が考えられる。
【0007】しかし、マニピュレータをあるポイントか
ら別のポイントまで動かす場合、マニピュレータの関節
の可動範囲の制限から、移動の途中で何度か姿勢を変更
しなければならないことがある。従って、上述したよう
に単に姿勢を無視する方法では適切にマニピュレータを
駆動することが難しく、マニピュレータの関節角度が可
動範囲を越えて、エラーによるコントローラの停止やそ
れに伴う再起動といった手間のかかる作業を必要とする
事象が頻繁に発生するおそれがある。
ら別のポイントまで動かす場合、マニピュレータの関節
の可動範囲の制限から、移動の途中で何度か姿勢を変更
しなければならないことがある。従って、上述したよう
に単に姿勢を無視する方法では適切にマニピュレータを
駆動することが難しく、マニピュレータの関節角度が可
動範囲を越えて、エラーによるコントローラの停止やそ
れに伴う再起動といった手間のかかる作業を必要とする
事象が頻繁に発生するおそれがある。
【0008】例えば、図9に示されるようにマニピュレ
ータ90をポイント91からポイント92に移動させる
場合、姿勢に関して直感性のある操作者であれば、状態
93においてマニピュレータ90の手首部関節が可動範
囲を越えてしまうことを事前に察知して、例えば状態9
4から状態95となるような姿勢の変更を行い、さらに
状態96の近傍からポイント92に近づけるような制御
を行うことができるため不都合は少ない。しかし、ごく
一般的な操作者の場合、単にポイント91からポイント
92まで移動させるような制御を行いがちであるため、
結果としてエラーが発生してしまう。
ータ90をポイント91からポイント92に移動させる
場合、姿勢に関して直感性のある操作者であれば、状態
93においてマニピュレータ90の手首部関節が可動範
囲を越えてしまうことを事前に察知して、例えば状態9
4から状態95となるような姿勢の変更を行い、さらに
状態96の近傍からポイント92に近づけるような制御
を行うことができるため不都合は少ない。しかし、ごく
一般的な操作者の場合、単にポイント91からポイント
92まで移動させるような制御を行いがちであるため、
結果としてエラーが発生してしまう。
【0009】本発明は、このような問題を解決するため
になされたもので、手先位置を入力するだけでマニピュ
レータを適切に駆動することができるマニピュレータ制
御装置を提供することを目的とする。
になされたもので、手先位置を入力するだけでマニピュ
レータを適切に駆動することができるマニピュレータ制
御装置を提供することを目的とする。
【0010】
【課題を解決するための手段】上記課題を解決するた
め、本発明は予め設定された複数の特徴点の各々に対し
て教示される手先姿勢について特徴点間の軌道を補間す
る特徴点間補間手段と、この特徴点間補間手段による補
間後の手先姿勢のデータを特徴点間の軌道の位置データ
に対応付けた姿勢データテーブルを記憶する記憶手段
と、手先位置のデータを入力するための位置データ入力
手段と、この位置データ入力手段により入力された手先
位置のデータについて手先位置間の軌道を補間する位置
軌道補間手段と、この位置軌道補間手段による補間後の
手先位置のデータに基づいて姿勢データテーブルから手
先姿勢のデータを検索する検索手段と、位置軌道補間手
段による補間後の手先位置のデータおよび検索手段によ
り検索された手先姿勢のデータに従ってマニピュレータ
を制御する制御手段とを備えている。
め、本発明は予め設定された複数の特徴点の各々に対し
て教示される手先姿勢について特徴点間の軌道を補間す
る特徴点間補間手段と、この特徴点間補間手段による補
間後の手先姿勢のデータを特徴点間の軌道の位置データ
に対応付けた姿勢データテーブルを記憶する記憶手段
と、手先位置のデータを入力するための位置データ入力
手段と、この位置データ入力手段により入力された手先
位置のデータについて手先位置間の軌道を補間する位置
軌道補間手段と、この位置軌道補間手段による補間後の
手先位置のデータに基づいて姿勢データテーブルから手
先姿勢のデータを検索する検索手段と、位置軌道補間手
段による補間後の手先位置のデータおよび検索手段によ
り検索された手先姿勢のデータに従ってマニピュレータ
を制御する制御手段とを備えている。
【0011】
【発明の実施の形態】図1は、本発明の一実施形態に係
るマニピュレータ制御装置の構成を示すブロック図であ
る。このマニピュレータ制御装置は、デカルト座標系に
おける位置データおよび座標データをPTP(Point to
Point)で入力してマニピュレータを制御するものであ
り、各ポイントの位置データを入力する位置データ入力
部1と、各ポイント間の位置軌道を補間する位置軌道補
間部2と、各ポイントの姿勢データを入力する姿勢デー
タ入力部3と、各ポイント間の姿勢軌道を補間する姿勢
軌道補間部4と、姿勢データの入力を行うか否かを切り
替える姿勢入力切替部5と、姿勢データを教を入力しな
いときに使用される姿勢データテーブルを記憶する姿勢
データテーブル部6と、姿勢データテーブルを生成する
ための特徴点間軌道補間部7と、実際にマニピュレータ
を駆動する運動制御部8とで構成されている。
るマニピュレータ制御装置の構成を示すブロック図であ
る。このマニピュレータ制御装置は、デカルト座標系に
おける位置データおよび座標データをPTP(Point to
Point)で入力してマニピュレータを制御するものであ
り、各ポイントの位置データを入力する位置データ入力
部1と、各ポイント間の位置軌道を補間する位置軌道補
間部2と、各ポイントの姿勢データを入力する姿勢デー
タ入力部3と、各ポイント間の姿勢軌道を補間する姿勢
軌道補間部4と、姿勢データの入力を行うか否かを切り
替える姿勢入力切替部5と、姿勢データを教を入力しな
いときに使用される姿勢データテーブルを記憶する姿勢
データテーブル部6と、姿勢データテーブルを生成する
ための特徴点間軌道補間部7と、実際にマニピュレータ
を駆動する運動制御部8とで構成されている。
【0012】このマニピュレータ制御装置は、図2に示
されるような構造のマニピュレータに対して用いられる
ものとする。同図に示されるマニピュレータ20は、ベ
ース面21でアーム22を支持しており、アーム22は
回転機構23を介してアーム24を支持している。アー
ム24は旋回機構25を介してアーム26を支持し、ア
ーム26は旋回機構27を介してアーム28を支持して
いる。アーム28は回転機構29を介してアーム30を
支持し、アーム30は旋回機構31を介してアーム32
を支持している。アーム32は回転機構33を介してア
ーム34を支持しており、アーム34の先端部には把握
機構などを備えたハンド35が設けられている。
されるような構造のマニピュレータに対して用いられる
ものとする。同図に示されるマニピュレータ20は、ベ
ース面21でアーム22を支持しており、アーム22は
回転機構23を介してアーム24を支持している。アー
ム24は旋回機構25を介してアーム26を支持し、ア
ーム26は旋回機構27を介してアーム28を支持して
いる。アーム28は回転機構29を介してアーム30を
支持し、アーム30は旋回機構31を介してアーム32
を支持している。アーム32は回転機構33を介してア
ーム34を支持しており、アーム34の先端部には把握
機構などを備えたハンド35が設けられている。
【0013】すなわち、ハンド35自体の動きを無視す
れば、マニピュレータ20は3つの回転機構23,2
9,33および旋回機構25,27,31による6軸、
すなわち6自由度を有しており、各軸の可動範囲、具体
的には回転機構23,29,33の最大回転角度と、旋
回機構25,27,31の最大旋回角度とで設定される
作動領域内であれば、ハンド35をベース座標系の任意
の位置に任意の姿勢で移動させることができる。このハ
ンド35はマニピュレータ20の手先であり、塗装や溶
接を行うときはハンド35を取り付けずに塗装ガンや溶
接トーチをアーム34の先端部に直接設置してもよい。
れば、マニピュレータ20は3つの回転機構23,2
9,33および旋回機構25,27,31による6軸、
すなわち6自由度を有しており、各軸の可動範囲、具体
的には回転機構23,29,33の最大回転角度と、旋
回機構25,27,31の最大旋回角度とで設定される
作動領域内であれば、ハンド35をベース座標系の任意
の位置に任意の姿勢で移動させることができる。このハ
ンド35はマニピュレータ20の手先であり、塗装や溶
接を行うときはハンド35を取り付けずに塗装ガンや溶
接トーチをアーム34の先端部に直接設置してもよい。
【0014】図1に説明を戻すと、このマニピュレータ
制御装置ではマニピュレータ20の手先、すなわちハン
ド35をあるポイントから別のポイントに移動させると
き、手先の位置データ(x,y,z)および姿勢データ
(A,B,C)を入力する第1のモードと、手先の位置
データ(x,y,z)のみを入力する第2のモードとを
選択することができる。以下、各モードにおける処理に
ついて詳細に説明する。なお、位置データ(x,y,
z)および姿勢データ(A,B,C)はデカルト座標系
のデータとして入力される。
制御装置ではマニピュレータ20の手先、すなわちハン
ド35をあるポイントから別のポイントに移動させると
き、手先の位置データ(x,y,z)および姿勢データ
(A,B,C)を入力する第1のモードと、手先の位置
データ(x,y,z)のみを入力する第2のモードとを
選択することができる。以下、各モードにおける処理に
ついて詳細に説明する。なお、位置データ(x,y,
z)および姿勢データ(A,B,C)はデカルト座標系
のデータとして入力される。
【0015】第1のモードによりマニピュレータ20を
制御する場合、まず切替信号を姿勢入力切替部5に入力
して、操作者に入力された姿勢データが有効となるよう
にモードを切り替えておく。この後は、従来のマニピュ
レータ制御装置と同様に、書もとする作動経路に応じた
いくつかのポイントについて、位置データ(x,y,
z)および姿勢データ(A,B,C)を位置データ入力
部1および姿勢データ入力部3から入力する。
制御する場合、まず切替信号を姿勢入力切替部5に入力
して、操作者に入力された姿勢データが有効となるよう
にモードを切り替えておく。この後は、従来のマニピュ
レータ制御装置と同様に、書もとする作動経路に応じた
いくつかのポイントについて、位置データ(x,y,
z)および姿勢データ(A,B,C)を位置データ入力
部1および姿勢データ入力部3から入力する。
【0016】次に、位置軌道補間部2は各ポイント間の
手先位置を予め設定された刻み幅に従って直線や円弧で
細かく刻み、各ポイント間の位置変化の配分を定めて各
ポイント間の位置軌道を補間し、連続した位置軌道デー
タを生成する。同様に、姿勢軌道補間部4は各ポイント
間の手先姿勢を予め設定された刻み幅に従って直線や円
弧で細かく刻み、各ポイント間の姿勢変化の配分を定め
て各ポイント間の姿勢軌道を補間し、連続した姿勢軌道
データを生成する。
手先位置を予め設定された刻み幅に従って直線や円弧で
細かく刻み、各ポイント間の位置変化の配分を定めて各
ポイント間の位置軌道を補間し、連続した位置軌道デー
タを生成する。同様に、姿勢軌道補間部4は各ポイント
間の手先姿勢を予め設定された刻み幅に従って直線や円
弧で細かく刻み、各ポイント間の姿勢変化の配分を定め
て各ポイント間の姿勢軌道を補間し、連続した姿勢軌道
データを生成する。
【0017】そして、位置軌道補間部2から出力された
位置軌道データと、姿勢軌道補間部4から姿勢入力切替
部5を介して出力された姿勢軌道データとが組み合わさ
れて運動制御部83に入力され、運動制御部8はこれら
位置軌道データおよび姿勢軌道データに基づいて、マニ
ピュレータ20の回転機構23,29,33および旋回
機構25,27,31を制御してマニピュレータ20を
駆動する。
位置軌道データと、姿勢軌道補間部4から姿勢入力切替
部5を介して出力された姿勢軌道データとが組み合わさ
れて運動制御部83に入力され、運動制御部8はこれら
位置軌道データおよび姿勢軌道データに基づいて、マニ
ピュレータ20の回転機構23,29,33および旋回
機構25,27,31を制御してマニピュレータ20を
駆動する。
【0018】一方、第2のモード、すなわち手先の位置
データのみを入力してマニピュレータ20の制御を行う
場合、姿勢制御を適切に行うために姿勢データテーブル
を予め設定しておく必要がある。以下、この姿勢データ
テーブルの設定について詳細に説明する。
データのみを入力してマニピュレータ20の制御を行う
場合、姿勢制御を適切に行うために姿勢データテーブル
を予め設定しておく必要がある。以下、この姿勢データ
テーブルの設定について詳細に説明する。
【0019】まず、マニピュレータ20の作動領域や各
軸の可動範囲などに基づいて、マニピュレータ20を駆
動するときのいくつかの主要なポイントを特徴点として
設定し、各特徴点の各々に対して基準となる手先姿勢の
教示を行う。
軸の可動範囲などに基づいて、マニピュレータ20を駆
動するときのいくつかの主要なポイントを特徴点として
設定し、各特徴点の各々に対して基準となる手先姿勢の
教示を行う。
【0020】具体的には、図3に示されるようにマニピ
ュレータ20の手先位置を決定するためのベース座標系
のXb 軸、Yb 軸およびZb 軸の各軸上に必要な個数
(この場合は3個ずつ)の特徴点xt1〜xt3,yt1〜y
t3,zt1〜zt3を設定し、各特徴点xt1〜xt3,yt1〜
yt3,zt1〜zt3に対して、基準となる手先姿勢を示す
姿勢データ(A,B,C)と各姿勢データに対応付ける
ための位置データ(x,y,z)とからなる特徴データ
を教示する。
ュレータ20の手先位置を決定するためのベース座標系
のXb 軸、Yb 軸およびZb 軸の各軸上に必要な個数
(この場合は3個ずつ)の特徴点xt1〜xt3,yt1〜y
t3,zt1〜zt3を設定し、各特徴点xt1〜xt3,yt1〜
yt3,zt1〜zt3に対して、基準となる手先姿勢を示す
姿勢データ(A,B,C)と各姿勢データに対応付ける
ための位置データ(x,y,z)とからなる特徴データ
を教示する。
【0021】この際、各特徴点xt1〜xt3,yt1〜yt
3,zt1〜zt3に対応する姿勢データおよび位置データ
の値を直接教示するようにしても、前述した第1のモー
ドによってマニピュレータ20を実際に駆動しながら、
意図した手先姿勢が得られる特徴点を探しだし、得られ
た特徴点に対応する位置データおよび姿勢データをマニ
ピュレータ20から呼び出して、教示するようにしても
よい。
3,zt1〜zt3に対応する姿勢データおよび位置データ
の値を直接教示するようにしても、前述した第1のモー
ドによってマニピュレータ20を実際に駆動しながら、
意図した手先姿勢が得られる特徴点を探しだし、得られ
た特徴点に対応する位置データおよび姿勢データをマニ
ピュレータ20から呼び出して、教示するようにしても
よい。
【0022】このようにして教示された特徴点データ
は、位置姿勢データ(x,y,z,A,B,C)として
一つにまとめられた後、以下のように4×4の行列Pに
変換されて特徴点間軌道補間部7に記憶される。
は、位置姿勢データ(x,y,z,A,B,C)として
一つにまとめられた後、以下のように4×4の行列Pに
変換されて特徴点間軌道補間部7に記憶される。
【0023】
【数1】
【0024】図4は、図3中の各特徴点xt1〜xt3,y
t1〜yt3,zt1〜zt3に対して教示された手先姿勢の例
を示したものである。なお、同図ではマニピュレータ2
0の手先、すなわちハンド35の付近のみを示してい
る。また、(a)はXb 軸上の特徴点xt1〜xt3に対応
する手先姿勢、(b)はYb 軸上の特徴点yt1〜yt3に
対応する手先姿勢、(c)はZb 軸上の特徴点zt1〜z
t3に対応する手先姿勢をそれぞれ表している。
t1〜yt3,zt1〜zt3に対して教示された手先姿勢の例
を示したものである。なお、同図ではマニピュレータ2
0の手先、すなわちハンド35の付近のみを示してい
る。また、(a)はXb 軸上の特徴点xt1〜xt3に対応
する手先姿勢、(b)はYb 軸上の特徴点yt1〜yt3に
対応する手先姿勢、(c)はZb 軸上の特徴点zt1〜z
t3に対応する手先姿勢をそれぞれ表している。
【0025】この場合、(a)に示されるように、特徴
点xt1を手先姿勢41に対応させ、特徴点xt2を手先姿
勢42に対応させて、特徴点xt3を手先姿勢43に対応
させている。また、(b)に示されるように特徴点yt1
〜yt を手先姿勢44〜46にそれぞれ対応させ、
(c)に示されるように特徴点zt1〜zt3を手先姿勢4
7〜49にそれぞれ対応させている。
点xt1を手先姿勢41に対応させ、特徴点xt2を手先姿
勢42に対応させて、特徴点xt3を手先姿勢43に対応
させている。また、(b)に示されるように特徴点yt1
〜yt を手先姿勢44〜46にそれぞれ対応させ、
(c)に示されるように特徴点zt1〜zt3を手先姿勢4
7〜49にそれぞれ対応させている。
【0026】次に、特徴点間軌道補間部7は特徴点間の
軌道を手先姿勢について補間する。この際、Xb 軸上の
特徴点xt1〜xt3間、Yb 軸上の特徴点yt1〜yt3間お
よびZb 軸上の特徴点zt1〜zt3間でそれぞれ別々に補
間を行い、Xb 軸の位置変化に対する姿勢変化を示すX
b 軸ブロックと、Yb 軸の位置変化に対する姿勢変化を
示すYb 軸ブロックと、Zb 軸の位置変化に対する姿勢
変化を示すZb 軸ブロックとからなる3ブロックによっ
て姿勢データテーブルが構成されるようにする。このと
き、補間を行うための刻み幅はXb 軸、Yb 軸およびZ
b 軸でそれぞれ等しくしておく。
軌道を手先姿勢について補間する。この際、Xb 軸上の
特徴点xt1〜xt3間、Yb 軸上の特徴点yt1〜yt3間お
よびZb 軸上の特徴点zt1〜zt3間でそれぞれ別々に補
間を行い、Xb 軸の位置変化に対する姿勢変化を示すX
b 軸ブロックと、Yb 軸の位置変化に対する姿勢変化を
示すYb 軸ブロックと、Zb 軸の位置変化に対する姿勢
変化を示すZb 軸ブロックとからなる3ブロックによっ
て姿勢データテーブルが構成されるようにする。このと
き、補間を行うための刻み幅はXb 軸、Yb 軸およびZ
b 軸でそれぞれ等しくしておく。
【0027】図5は、Xb 軸上の特徴点xt1〜xt3の間
の補間を行うときの例を示したものである。(a)は3
つの特徴点xt1〜xt3に対応する手先姿勢と、補間され
たポイントx1n,x2m(n,mは任意)に対応する手先
姿勢を表し、(b)はXb 軸ブロックのデータ構造を示
している。この場合、特徴点xt1と特徴点xt2との間を
例えばXb =1mm間隔の刻み幅でx11,x12,…のよ
うに分割し、その分割数に応じた位置姿勢データ(x1
1,y11,z11,A11,B11,C11),(x12,y12,
z12,A12,B12,C12),…を順次求めることによ
り、特徴点xt1に対応する位置姿勢データ(xt1,yt
1,zt1,At1,Bt1,Ct1)と特徴点xt2に対応する
位置姿勢データ(xt2,yt2,zt2,At2,Bt2,Ct
2)との間の姿勢を補間する。
の補間を行うときの例を示したものである。(a)は3
つの特徴点xt1〜xt3に対応する手先姿勢と、補間され
たポイントx1n,x2m(n,mは任意)に対応する手先
姿勢を表し、(b)はXb 軸ブロックのデータ構造を示
している。この場合、特徴点xt1と特徴点xt2との間を
例えばXb =1mm間隔の刻み幅でx11,x12,…のよ
うに分割し、その分割数に応じた位置姿勢データ(x1
1,y11,z11,A11,B11,C11),(x12,y12,
z12,A12,B12,C12),…を順次求めることによ
り、特徴点xt1に対応する位置姿勢データ(xt1,yt
1,zt1,At1,Bt1,Ct1)と特徴点xt2に対応する
位置姿勢データ(xt2,yt2,zt2,At2,Bt2,Ct
2)との間の姿勢を補間する。
【0028】さらに、特徴点xt2と特徴点xt3との間を
同じように1mm間隔の刻み幅で分割し、その分割数に
応じて位置姿勢データ(x21,y21,z21,A21,B2
1,C21),…を順次求めることにより、特徴点xt2に
対応する位置姿勢データ(xt2,yt2,zt2,At2,B
t2,Ct2)と特徴点xt3に対応する位置姿勢データ(x
t3,yt3,zt3,At3,Bt3,Ct3)との間の姿勢を補
間する。なお、特徴点xt1〜xt3はXb 軸上に設定され
ているので、Yb 軸に対応する項目のデータyt1,y1
1,yt2,…,yt2,y21,…,yt3、さらにZb 軸に
対応する項目のデータzt1,z11,zt2,…,zt2,z
21,…,zt3は全て値が0になる。
同じように1mm間隔の刻み幅で分割し、その分割数に
応じて位置姿勢データ(x21,y21,z21,A21,B2
1,C21),…を順次求めることにより、特徴点xt2に
対応する位置姿勢データ(xt2,yt2,zt2,At2,B
t2,Ct2)と特徴点xt3に対応する位置姿勢データ(x
t3,yt3,zt3,At3,Bt3,Ct3)との間の姿勢を補
間する。なお、特徴点xt1〜xt3はXb 軸上に設定され
ているので、Yb 軸に対応する項目のデータyt1,y1
1,yt2,…,yt2,y21,…,yt3、さらにZb 軸に
対応する項目のデータzt1,z11,zt2,…,zt2,z
21,…,zt3は全て値が0になる。
【0029】図5は、以上のような処理によって最終的
に姿勢データテーブル部6に設定された姿勢データテー
ブルの例を示している。(a)、(b)および(c)は
それぞれXb 軸、Yb 軸およびZb 軸に対応するブロッ
クを示しており、上述したように全てのデータ値が0に
なる項目は省略して表している。同図に示されるよう
に、Xb 軸ブロックにはl組のデータがあり、Yb 軸ブ
ロックにはm組のデータがあり、Zb 軸ブロックにはn
組のデータがあるといったように、各ブロックのデータ
個数は異なった値となる。なお、一つのポイントに対応
する位置姿勢データは後述するような3×3の姿勢行列
として姿勢データテーブル部6に記憶されている。
に姿勢データテーブル部6に設定された姿勢データテー
ブルの例を示している。(a)、(b)および(c)は
それぞれXb 軸、Yb 軸およびZb 軸に対応するブロッ
クを示しており、上述したように全てのデータ値が0に
なる項目は省略して表している。同図に示されるよう
に、Xb 軸ブロックにはl組のデータがあり、Yb 軸ブ
ロックにはm組のデータがあり、Zb 軸ブロックにはn
組のデータがあるといったように、各ブロックのデータ
個数は異なった値となる。なお、一つのポイントに対応
する位置姿勢データは後述するような3×3の姿勢行列
として姿勢データテーブル部6に記憶されている。
【0030】このように、姿勢データテーブルは予め設
定された複数の特徴点の各々に対して教示される手先姿
勢について各特徴点間の軌道を補間し、補間された後の
姿勢データを特徴点間の軌道の位置データに対応付けた
ものとして設定される。
定された複数の特徴点の各々に対して教示される手先姿
勢について各特徴点間の軌道を補間し、補間された後の
姿勢データを特徴点間の軌道の位置データに対応付けた
ものとして設定される。
【0031】次に、このような姿勢データテーブルを利
用し、実際に位置データのみを入力してマニピュレータ
20を駆動するときの処理について説明する。まず、切
替信号を姿勢入力切替部5に入力して、姿勢データ入力
部3からのデータを無効にし、姿勢制御データテーブル
からのデータを有効とするようにモードの切り替えを行
う。
用し、実際に位置データのみを入力してマニピュレータ
20を駆動するときの処理について説明する。まず、切
替信号を姿勢入力切替部5に入力して、姿勢データ入力
部3からのデータを無効にし、姿勢制御データテーブル
からのデータを有効とするようにモードの切り替えを行
う。
【0032】次に、作動経路に応じたいくつかのポイン
トの位置データ(x,y,z)を位置データ入力部1か
ら入力する。位置軌道補間部2は、第1のモードと同様
に各ポイント間の手先位置を予め設定された刻み幅に従
って直線や円弧で細かく刻み、位置変化の配分を定め
て、連続した位置軌道データを生成する。この位置軌道
データは、まず姿勢データテーブル部6に入力される。
トの位置データ(x,y,z)を位置データ入力部1か
ら入力する。位置軌道補間部2は、第1のモードと同様
に各ポイント間の手先位置を予め設定された刻み幅に従
って直線や円弧で細かく刻み、位置変化の配分を定め
て、連続した位置軌道データを生成する。この位置軌道
データは、まず姿勢データテーブル部6に入力される。
【0033】姿勢データテーブル部6は、位置軌道補間
部2から入力された位置軌道データに基づいて姿勢デー
タテーブルを参照し、位置軌道データに対して最適とさ
れる姿勢軌道データを生成する。この場合、実際には位
置軌道データを構成する各ポイントの位置データに対し
て最適とされる姿勢データを順次求めることにより姿勢
軌道データを生成している。
部2から入力された位置軌道データに基づいて姿勢デー
タテーブルを参照し、位置軌道データに対して最適とさ
れる姿勢軌道データを生成する。この場合、実際には位
置軌道データを構成する各ポイントの位置データに対し
て最適とされる姿勢データを順次求めることにより姿勢
軌道データを生成している。
【0034】例えば、位置データ(x,y,z)に対し
て最適とされる姿勢データを求める場合、データx,デ
ータy,データzの各データ値と姿勢データテーブルを
構成するXb 軸ブロック、Yb 軸ブロックおよびZb 軸
ブロックとをそれぞれ照らし合わせて、以下に示される
ようにデータx、yおよびzに対応する4×4の姿勢行
列Rx ,Ry およびRz を選定する。
て最適とされる姿勢データを求める場合、データx,デ
ータy,データzの各データ値と姿勢データテーブルを
構成するXb 軸ブロック、Yb 軸ブロックおよびZb 軸
ブロックとをそれぞれ照らし合わせて、以下に示される
ようにデータx、yおよびzに対応する4×4の姿勢行
列Rx ,Ry およびRz を選定する。
【0035】
【数2】
【0036】次に、図7に示されるように姿勢行列Rx
,Ry およびRz をベース座標系のベクトルRx ,Ry
およびRz とみなして、まずベクトルRx とRy との
中間ベクトルRxyを求め、この中間ベクトルRxyとRz
との中間ベクトルRを求めて、この中間ベクトルRに対
応する姿勢行列Rを変換しなおして得られた姿勢データ
(A,B,C)を位置データ(x,y,z)対して最適
とされる姿勢データとする。
,Ry およびRz をベース座標系のベクトルRx ,Ry
およびRz とみなして、まずベクトルRx とRy との
中間ベクトルRxyを求め、この中間ベクトルRxyとRz
との中間ベクトルRを求めて、この中間ベクトルRに対
応する姿勢行列Rを変換しなおして得られた姿勢データ
(A,B,C)を位置データ(x,y,z)対して最適
とされる姿勢データとする。
【0037】このようにして、各ポイントの位置データ
に対して最適とされる姿勢データが次々に求められ、最
終的に位置軌道データに対して最適とされる姿勢軌道デ
ータが生成される。この姿勢軌道データは、第1のモー
ドと同様に姿勢入力切替部5を介して送られ、対応する
位置軌道データと互いに組をなして運動制御部83に入
力される。運動制御部8は、第1のモードと同様にこれ
ら位置軌道データおよび姿勢軌道データに基づいて、マ
ニピュレータ20の回転機構23,29,33および旋
回機構25,27,31を制御してマニピュレータ20
を駆動する。
に対して最適とされる姿勢データが次々に求められ、最
終的に位置軌道データに対して最適とされる姿勢軌道デ
ータが生成される。この姿勢軌道データは、第1のモー
ドと同様に姿勢入力切替部5を介して送られ、対応する
位置軌道データと互いに組をなして運動制御部83に入
力される。運動制御部8は、第1のモードと同様にこれ
ら位置軌道データおよび姿勢軌道データに基づいて、マ
ニピュレータ20の回転機構23,29,33および旋
回機構25,27,31を制御してマニピュレータ20
を駆動する。
【0038】このように本実施形態のマニピュレータ制
御システムでは、あらかじめマニピュレータを駆動する
ときの主要なポイントを特徴点データとして定め、各特
徴点に対して教示される姿勢データについて各特徴点間
の軌道を補間して、補間後の姿勢データを各特徴点間の
軌道の位置データに対応付けた姿勢データテーブルを予
め生成しておき、位置データが入力がされたときは、ま
ず入力された位置データについて手先位置間の軌道を補
間して、その結果得られる位置軌道データに基づいて姿
勢データテーブルから対応する姿勢軌道データを検索し
て、これら位置軌道データおよび姿勢軌道データに基づ
いてマニピュレータを制御している。
御システムでは、あらかじめマニピュレータを駆動する
ときの主要なポイントを特徴点データとして定め、各特
徴点に対して教示される姿勢データについて各特徴点間
の軌道を補間して、補間後の姿勢データを各特徴点間の
軌道の位置データに対応付けた姿勢データテーブルを予
め生成しておき、位置データが入力がされたときは、ま
ず入力された位置データについて手先位置間の軌道を補
間して、その結果得られる位置軌道データに基づいて姿
勢データテーブルから対応する姿勢軌道データを検索し
て、これら位置軌道データおよび姿勢軌道データに基づ
いてマニピュレータを制御している。
【0039】このため、操作者は直感的に入力しやすい
位置データを入力するだけでよく、位置データに対応す
る姿勢データは姿勢データテーブルを参照して自動的に
生成されるので、マニピュレータのリモート操作などを
従来に比べてはるかに容易に行うことができる。また、
マニピュレータの姿勢に関する直感性がそれほど優れて
いない操作者の場合でも、正しい姿勢データでマニピュ
レータを駆動することができるので、関節角度が可動範
囲を越えたことによるエラーなどが発生しなくなる。
位置データを入力するだけでよく、位置データに対応す
る姿勢データは姿勢データテーブルを参照して自動的に
生成されるので、マニピュレータのリモート操作などを
従来に比べてはるかに容易に行うことができる。また、
マニピュレータの姿勢に関する直感性がそれほど優れて
いない操作者の場合でも、正しい姿勢データでマニピュ
レータを駆動することができるので、関節角度が可動範
囲を越えたことによるエラーなどが発生しなくなる。
【0040】
【発明の効果】以上説明したように本発明によれば、複
数の特徴点の各々に対して教示される手先姿勢について
特徴点間の軌道を補間し、補間後の手先姿勢のデータを
特徴点間の軌道の位置データに対応付けた姿勢データテ
ーブルを予め生成しておき、操作者により手先位置のデ
ータが入力されたときは、その手先位置のデータについ
て手先位置間の軌道を補間し、その補間後の手先位置の
データに基づいて姿勢データテーブルから手先姿勢のデ
ータを検索して、この結果得られた手先位置および手先
姿勢のデータに従ってマニピュレータを制御しているの
で、手先位置を入力するだけで適切にマニピュレータを
駆動することができる。
数の特徴点の各々に対して教示される手先姿勢について
特徴点間の軌道を補間し、補間後の手先姿勢のデータを
特徴点間の軌道の位置データに対応付けた姿勢データテ
ーブルを予め生成しておき、操作者により手先位置のデ
ータが入力されたときは、その手先位置のデータについ
て手先位置間の軌道を補間し、その補間後の手先位置の
データに基づいて姿勢データテーブルから手先姿勢のデ
ータを検索して、この結果得られた手先位置および手先
姿勢のデータに従ってマニピュレータを制御しているの
で、手先位置を入力するだけで適切にマニピュレータを
駆動することができる。
【図1】本発明の一実施形態に係るマニピュレータ制御
装置の構成を示すブロック図
装置の構成を示すブロック図
【図2】同実施形態の適用されるマニピュレータの構成
を示す図
を示す図
【図3】同実施形態における特徴点の設定について説明
するための図
するための図
【図4】同実施形態における特徴点とマニピュレータと
の対応関係の例を示す図
の対応関係の例を示す図
【図5】同実施形態で姿勢制御テーブルを生成するとき
の軌道補間について説明するための図
の軌道補間について説明するための図
【図6】同実施形態における姿勢制御テーブルのデータ
構造を示す図
構造を示す図
【図7】同実施形態においてマニピュレータの姿勢デー
タを求めるときの計算を説明するための図
タを求めるときの計算を説明するための図
【図8】従来のマニピュレータ制御装置の構成を示すブ
ロック図
ロック図
【図9】従来のマニピュレータ制御装置の問題点を説明
するための図
するための図
1…位置データ入力部 2…位置軌道補間部 3…姿勢データ入力部 4…姿勢軌道補間部 5…姿勢入力切替部 6…姿勢制御テーブル 7…特徴点間軌道補間部 8…運動制御部
Claims (1)
- 【請求項1】予め設定された複数の特徴点の各々に対し
て教示される手先姿勢について該特徴点間の軌道を補間
する特徴点間補間手段と、 この特徴点間補間手段による補間後の手先姿勢のデータ
を前記特徴点間の軌道の位置データに対応付けた姿勢デ
ータテーブルを記憶する記憶手段と、 手先位置のデータを入力するための位置データ入力手段
と、 この位置データ入力手段により入力された手先位置のデ
ータについて該手先位置間の軌道を補間する位置軌道補
間手段と、 この位置軌道補間手段による補間後の手先位置のデータ
に基づいて前記姿勢データテーブルから前記手先姿勢の
データを検索する検索手段と、 前記位置軌道補間手段による補間後の手先位置のデータ
および前記検索手段により検索された手先姿勢のデータ
に従ってマニピュレータを制御する制御手段とを備えた
ことを特徴とするマニピュレータ制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP12431397A JPH10315169A (ja) | 1997-05-14 | 1997-05-14 | マニピュレータ制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP12431397A JPH10315169A (ja) | 1997-05-14 | 1997-05-14 | マニピュレータ制御装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH10315169A true JPH10315169A (ja) | 1998-12-02 |
Family
ID=14882247
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP12431397A Withdrawn JPH10315169A (ja) | 1997-05-14 | 1997-05-14 | マニピュレータ制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH10315169A (ja) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2012106323A (ja) * | 2010-11-19 | 2012-06-07 | Daihen Corp | アーク溶接ロボット制御装置 |
WO2012121124A1 (ja) * | 2011-03-08 | 2012-09-13 | 株式会社神戸製鋼所 | 多関節型ロボットの制御装置,制御方法及び制御プログラム |
CN113226663A (zh) * | 2019-01-04 | 2021-08-06 | 索尼集团公司 | 控制装置、控制方法和程序 |
-
1997
- 1997-05-14 JP JP12431397A patent/JPH10315169A/ja not_active Withdrawn
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2012106323A (ja) * | 2010-11-19 | 2012-06-07 | Daihen Corp | アーク溶接ロボット制御装置 |
WO2012121124A1 (ja) * | 2011-03-08 | 2012-09-13 | 株式会社神戸製鋼所 | 多関節型ロボットの制御装置,制御方法及び制御プログラム |
US9242373B2 (en) | 2011-03-08 | 2016-01-26 | Kobe Steel, Ltd. | Control device, control method, and control program for articulated robot |
CN113226663A (zh) * | 2019-01-04 | 2021-08-06 | 索尼集团公司 | 控制装置、控制方法和程序 |
CN113226663B (zh) * | 2019-01-04 | 2024-04-26 | 索尼集团公司 | 控制装置、控制方法和程序 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US5254923A (en) | Industrial robot synchronous control method and apparatus | |
EP1145804B1 (en) | Robot controller | |
EP1644782B1 (en) | Multiple robot arm tracking and mirror jog | |
US20060069466A1 (en) | Method for controlling trajectory of robot | |
JPS59708A (ja) | 適合速度制御を行なう経路運動マニピユレ−タ | |
JP2007000954A (ja) | ロボット教示装置及び方法 | |
JP2009066738A (ja) | ロボットの教示装置 | |
EP0785492B1 (en) | Jog operation method of robot | |
JPS58225406A (ja) | 工業用ロボツト | |
JPH1083208A (ja) | ロボット間相対位置演算機構 | |
JPH10315169A (ja) | マニピュレータ制御装置 | |
JP3424130B2 (ja) | レーザ加工機 | |
JPH08286722A (ja) | Cadデータ利用オフラインティーチング方法及びそのシステム | |
CN116529035A (zh) | 数值控制装置以及数值控制*** | |
JP2750739B2 (ja) | 産業用ロボットの制御装置 | |
JP3304484B2 (ja) | 産業用ロボットの制御装置 | |
JPH0699377A (ja) | ロボット軌道を教示するための方法 | |
JP2001312305A (ja) | ロボットのツール制御方法 | |
JPH05505893A (ja) | ロボット・セルの経路の制御方法 | |
US20240066690A1 (en) | Numerical control apparatus and numerical control system | |
JPH09128024A (ja) | 冗長軸を有するロボットの動作プログラムの最適化方法 | |
JP3351601B2 (ja) | 産業用ロボットの手動教示操作における速度制御装置 | |
JPH0736526A (ja) | 数値制御装置 | |
JPH07205068A (ja) | ロボットの座標系設定方法 | |
JPH0820893B2 (ja) | 産業用多関節ロボットの最適移動制御方式 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A300 | Withdrawal of application because of no request for examination |
Free format text: JAPANESE INTERMEDIATE CODE: A300 Effective date: 20040803 |