JPS60207781A - 異構造・マスタスレイブ・マニピュレータの動作制限装置 - Google Patents

異構造・マスタスレイブ・マニピュレータの動作制限装置

Info

Publication number
JPS60207781A
JPS60207781A JP59063979A JP6397984A JPS60207781A JP S60207781 A JPS60207781 A JP S60207781A JP 59063979 A JP59063979 A JP 59063979A JP 6397984 A JP6397984 A JP 6397984A JP S60207781 A JPS60207781 A JP S60207781A
Authority
JP
Japan
Prior art keywords
manipulator
slave
master
master arm
slave 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.)
Granted
Application number
JP59063979A
Other languages
English (en)
Other versions
JPH0442145B2 (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.)
National Institute of Advanced Industrial Science and Technology AIST
Original Assignee
Agency of Industrial Science and Technology
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 Agency of Industrial Science and Technology filed Critical Agency of Industrial Science and Technology
Priority to JP59063979A priority Critical patent/JPS60207781A/ja
Publication of JPS60207781A publication Critical patent/JPS60207781A/ja
Publication of JPH0442145B2 publication Critical patent/JPH0442145B2/ja
Granted legal-status Critical Current

Links

Landscapes

  • Testing And Monitoring For Control Systems (AREA)
  • Manipulator (AREA)

Abstract

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

Description

【発明の詳細な説明】 本発明は、マスタスレイブ・マニピュレータの動作制限
装置に関するものである。
一般に、マスタスレイブ・マニピュレータでは、制御の
簡単化を図るためにマスタアームとスレイブ・マニピュ
レータの構造を同一にしているが、この場合にはマスタ
アームの操作性が悪いなどの問題があり、従ってマスク
アーム及びスレイブ・マニピュレータをそれぞれ目的に
適合した異構造のものにするのが操作性等の観点から有
効である。
このような異構造のマスクスレイブ・マニピュレータ・
システムを構成する際、マスタアーム及びスレイブ・マ
ニピュレータの位置、速度、力などの情報を相互の関節
座標系間において座標変換することになるが、両者の関
節座標系にはそれらに特有の手先可動範囲が存在し、こ
の可動範囲の相違によるトラブルが問題になる。
さらに具体的に説明すると、第1図A−Cに例示するよ
うに、関節形マニピュレータM1、極座標形マニピュレ
ータM2、及び直交座標形マニビュレータ当の手先が、
それぞれAt r AQ * A3の可動範囲をもって
いた場合、それらを組合わせてマスタスレイブ・マニピ
ュレータ・システムを構成すると、それぞれのマニピュ
レータが可動範囲を異にするために第2図A−Cに示す
共通の可動範囲ムの範囲内でなければ動作させることが
できず、マスタアームによりスレイブ舎マニピュレータ
の可動範囲を越えて動作指令を与えた場合などには、装
置を破損させたり、それに伴ってオペレータに危害が及
ぼす可能性がある。なお、第2図Aは関節形及び極座標
形マニピュレータに共通の可動範囲を示し、同図Bは関
節形及び直交座標形マニピュレータの共通可動範囲を、
同図Cは極座標形及び直交座標形マニピュレータの共通
可動範囲を示している。
本発明は、上述した問題を解決し、任意の関節構造をも
つマスタアームとスレイブ・マニピュレータとの組合わ
せにおいて、作動領域の相違によるトラブルを防止して
、オペレータの操作を容易にすることを目的とするもの
である。
かかる目的を達成するため、本発明のマニピュレータ制
御装置は、マスタアームとそれによって駆動されるスレ
イブ・マニピュレータとを備え、それらを座標変換器を
介して接続することにより関節座標系の変換を行って情
報の伝達を行うようにしたマスタスレイブ・マニピュレ
ータにおいて、上記マスタアーム及びスレイブ舎マニピ
ュレータのいずれかが可動範囲の限界に達したときにそ
れをオペレータにフィードバックするための動作限界指
示装置を設けることによって構成される。
而して、本発明の動作制限装置によれば、任意の関節座
標系をもつマスタアームとスレイブ・マニピュレータと
を、自由に組合わせて使用するにあたり、マスタアーム
またはスレイブ・マニピュレータのいずれかが可動範囲
の限界に達したときにオペレータにそれをフィードパ・
ツタするようにしているので、両者の可動範囲の相違に
よる誤動作等のトラブルを防止することができる。
以下、図面を参照して本発明の実施例について詳述する
第3図は、本発明に係るマニピュレータの動作制限装置
の実施例を示すもので、マスタアーム1及びスレイブ・
マニピュレータ2としては、各種構造のものを自由に選
択して用いることができる。
第3図に示したマスタアームl及びスレイブ・マニピュ
レータ2は、それらにおける各関節の構成を模式的に示
し、11.21は関節における各軸に駆動力を発生する
モータ等のアクチュエータ、12.22はポテンショメ
ータ等の位置検出器、13.23は反力を検出するため
のトルクセンサその他の力センサ、 14.24はタコ
ジェネレータ等の速度検出器である。マスタアームとス
レイブ・マニピュレータは、それらの自由度をnとする
と、それぞれn個の関節をもち、従ってアクチュエータ
及び各種センサもそれぞれn個ずつ設置される。
このようなマスタアーム1とスレイブ俸マニピュレータ
2とは、関節構造を異にする異構造のものが用いられる
ため、それらの関節座標系の間で座標変換を行う必要が
あり、この座標変換のために両者は位置座標変換器5、
力座標変換器6、速度座標変換器7を介して接続される
而して、マスク側の位置検出器12において検出された
位置の情報P0を位置座標変換器5においてマスタアー
ム1の関節座標系からスレイブ書マニピュレータ2の関
節座標系に変換し、変換された位置情報P″1を指令値
としてスレイブ側の位置検出器22によって検出された
位置情報Psと比較し、その差をもって位置制御器31
を介してスレイブ側のアクチュエータ21を駆動する。
従って、スレイブ・マニピュレータ2の手先はマスクア
ーム1の手先に追従してそれと同じ動きをすることにな
る。
一方、スレイブ側における力センサ23で検出した力情
報Fsをマスタ側にフィー・ドパツクするため、その力
センサ23の出力をカ座標変換器6においてスレイブ・
マニピュレータ2の関節座標系からマスタアーム1の関
節座標系に変換し、変換された力情報Fsをマスク側に
おける力センサ13によって検出された力情報戸と比較
し、その差をもって力制御器32を介してマスク側のア
クチュエータ11に駆動力を発生させる。従って、スレ
イブ・マニピュレータ2の先端に対象物との干渉等によ
る反力が生じたときには、マスタアームにそれが伝達さ
れる。
また、上記制御の応答を改善するため、次のような速度
の制御を行うようにしている。即ち、スタ側における速
度検出器14で検出した速度情報vI11の座標系を、
速度座標変換器7においてスレイブ・マニピュレータ2
の関節座標系に変換し、これをスレイブ側における速度
検出器24によって検出された速度情報vsと比較し、
その差をもって位置制御器31を介してアクチュエータ
21を駆動する。
なお、マスクアーム1においては、力制御を行うため、
マスク側の速度検出器14の速度情報を力制御器32を
介してアクチュエータ11にフィードバックする。
上記マスタスレイブ・マニピュレータ・システムにおい
ては、異構造のマスタアームとスレイプφマニピュレー
タにおける可動範囲の差異によってトラブル等が生じる
という問題を解消するため、動作限界指示装置を付設し
ている。第3図の実施例における動作限界指示装置は、
マスタアーム1がマスタ側及びスレイブ側に共通の可動
範囲即ち与えられた動作領域を越えて駆動されたとき、
それを一時停止させ、強制的に基準状態へ復帰させるよ
うにしたものである。上記基準状態とは、マスタアーム
がその可動範囲の略中夫にある状態、あるいは初期設定
位置にある状態等を意味している。而して、上記動作制
限装置としては、具体的には、基準状態復帰回路41内
に、マスク側及びスレイブ側に共通の可動範囲即ち動作
領域を記憶する記憶装置を内蔵させ、上記基準状態復帰
回路41において、マスク側及びスレイブ側の位置検出
器12.22からの位置の情報が上記動作領域内にある
か否かを判断させ、それが動作領域外にあると判断され
た場合には、直ちにマスク側及びスレイブ側のアクチュ
エータ11.21にそれらを一時停止させるための信号
を出力し、且つそれに統いてマスタアームl及びスレイ
ブ・マニピュレータ2を基準状態に復帰させるための信
号を出力するものとして構成することができる。
第4図の実施例・における動作限界指示装置は、モニタ
ディスプレイ等を含む動作表示装置42を、マスク側及
びスレイブ側の位置検出器12.22に接続することに
より構成したもので、上記動作表示装置42は、モニタ
ディスプレイに動作領域を表示すると共に、上記位置検
出器12.22の出力に基づいてその動作領域における
マスタアーム1及びスレイブ・マニピュレータの手先位
置を表示するように構成している。
従って、オペレータがこの動作表示装置42におけるモ
ニタディスプレイを見ながらマスタアーム1の操作を行
うことにより、動作領域から外れるのを防止することが
できる。
なお、その他の構成は第3図の実施例と変るところがな
いので、同一または相当部分に同一の符号を付してその
説明を省略する。
また第5図の実施例における動作限界指示装置は、マス
タアームl及びスレイブφマニピュレータ2にそれぞれ
作動領域の制限回路43.44を付設することにより構
成し、マスタアームとスレイブ・マニピュレータのいず
れかが作動領域の限界に達したときに、マスタアームに
作動領域内への復帰力を発生させるようにしている。
即ち、上記マスタアーム1に付設した制限回路43は、
予め与えられた作動領域の限界値pHと位り 値検出用の位置検出器12から構成される装置情報pH
とを比較し、その差に相当する出力を関数発生要素45
に入力して、その入力がある設定値に達したときに一定
の出力を発生させ、その出力により前記力制御器32を
介してマスク側のアクチュエータ11を動作させ、これ
によってマスタアーム1がその作動領域の限界に達した
ときに作動領域内への復帰力を発生させる。
また、上記スレイブ・マニピュレータ2に付設した制限
回路44は、予め与えられた作動領域の限界値P2と位
置検出器22からの位置情報PSとの差に相当する出力
を関数発生要素46に入力して、その入力がある設定値
に達したときに一定の出力を発で検出した力情報Fsに
付加してマスク側にフィードバックし、スレイブ・マニ
ピュレータ2が作動領域の限界に達したときにマスタア
ーム!に対して作動領域内への復帰力を発生させる。
従って、マスタアーム1及びスレイブ・マニピュレータ
2のいずれかが作動領域の限界に達したとき、マスタア
ーム1に共通の作動領域内への復帰力が発生することに
なる。
なお、その他の構成は第3図の実施例と変るところがな
く、従って第3図と同一の符′号を付している。
【図面の簡単な説明】
第1図A−Cはマニピュレータの可動範囲についての説
明図、第2図A−Cは上記マニピュレータを組合わせた
マスタスレイブ・マニピュレータの動作領域に関する説
明図、第3図ないし1g5図は本発明の実施例の模式的
構成図である。 l ・・マスタアーム、 2争・スレイブ・マニピュレータ、 5・・位置座標変換器、 6・・力座標変換器、 7φ・速度座標変換器、 11.21 ・争アクチュエータ、 12.22 ・・位置検出器。 13.23 ・・力センサ、 14.24 ・・速度検出器、 41・・基準状態復帰回路、 42・拳動作表示装置、 43.44 畳・制限回路。 第1II A B A 第2rllB

Claims (1)

    【特許請求の範囲】
  1. 1、 マスタアームとそれによって駆動されるスレイブ
    ・マニピュレータとを備え、それらを座標変換器を介し
    て接続することにより関節座標系の変換を行って情報の
    伝達を行うようにしたマスタスレイブ・マニピュレータ
    において、上記マスタアーム及びスレイブ・マニピュレ
    ータのいずれかが可動範囲の限界に達したときにそれを
    オペレータにフィードバックするための動作限界指示装
    置を設けたことを特徴とするマスタスレイブ・マニピュ
    レータの動作制限装置。
JP59063979A 1984-03-30 1984-03-30 異構造・マスタスレイブ・マニピュレータの動作制限装置 Granted JPS60207781A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP59063979A JPS60207781A (ja) 1984-03-30 1984-03-30 異構造・マスタスレイブ・マニピュレータの動作制限装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP59063979A JPS60207781A (ja) 1984-03-30 1984-03-30 異構造・マスタスレイブ・マニピュレータの動作制限装置

Publications (2)

Publication Number Publication Date
JPS60207781A true JPS60207781A (ja) 1985-10-19
JPH0442145B2 JPH0442145B2 (ja) 1992-07-10

Family

ID=13244907

Family Applications (1)

Application Number Title Priority Date Filing Date
JP59063979A Granted JPS60207781A (ja) 1984-03-30 1984-03-30 異構造・マスタスレイブ・マニピュレータの動作制限装置

Country Status (1)

Country Link
JP (1) JPS60207781A (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH01183379A (ja) * 1988-01-12 1989-07-21 Meidensha Corp マスター・スレーブマニプレータの制御方式
JPH01228784A (ja) * 1988-03-09 1989-09-12 Hitachi Ltd マスタ/スレーブマニピュレータ制御方法

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS57114380A (en) * 1980-12-30 1982-07-16 Chiyuushiyou Kigiyou Shinkou J Discriminator for force of remote control type manipulator

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS57114380A (en) * 1980-12-30 1982-07-16 Chiyuushiyou Kigiyou Shinkou J Discriminator for force of remote control type manipulator

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH01183379A (ja) * 1988-01-12 1989-07-21 Meidensha Corp マスター・スレーブマニプレータの制御方式
JPH01228784A (ja) * 1988-03-09 1989-09-12 Hitachi Ltd マスタ/スレーブマニピュレータ制御方法

Also Published As

Publication number Publication date
JPH0442145B2 (ja) 1992-07-10

Similar Documents

Publication Publication Date Title
US4661032A (en) Bilateral master-slave manipulator control device
JP2664205B2 (ja) マニピュレータ制御システム
JPS6243710A (ja) ロボットの動作制御システム
JPH07271415A (ja) 協調ロボット制御方法
JPS60207781A (ja) 異構造・マスタスレイブ・マニピュレータの動作制限装置
JPS61252081A (ja) マスタ・スレ−ブ・マニピユレ−タ
JP2729758B2 (ja) 遠隔操作型ロボットの自動実行監視方式
JPH0538689A (ja) 多関節ロボツトの分散制御システム
JPH09261618A (ja) 遠隔操作装置
JPH0198911A (ja) 形状寸法測定装置におけるデータ転送システム
JPS60207783A (ja) 異構造バイラテラル・マスタスレイブ・マニピユレ−タの制御装置
JPS60207782A (ja) バイラテラル・マスタスレイブ・マニピユレ−タの制御装置
US20110166702A1 (en) Electronic board and system comprising a plurality of such boards
JP3348424B2 (ja) 多関節型ロボットシステム
JPS632686A (ja) ロボツトの遠隔制御方法
JPH08318479A (ja) 遠隔操縦システム
JPS5810197B2 (ja) エンカツソウジユウソウチ
JPH0431829B2 (ja)
JP2533594B2 (ja) マスタスレ―ブマニピユレ―タ
JPH0413103B2 (ja)
JPH0774962B2 (ja) 産業用ロボット
JPS62124886A (ja) 動的コンプライアンス逆送型バイラテラル遠隔制御装置
JPH04134501A (ja) ロボット制御装置
JPS63283878A (ja) 半自動遠隔操作装置
JPS6249403A (ja) マニピユレ−タ制御装置

Legal Events

Date Code Title Description
EXPY Cancellation because of completion of term