JPH0271981A - マスタ・スレーブ・マニピユレータ制御装置 - Google Patents

マスタ・スレーブ・マニピユレータ制御装置

Info

Publication number
JPH0271981A
JPH0271981A JP22410988A JP22410988A JPH0271981A JP H0271981 A JPH0271981 A JP H0271981A JP 22410988 A JP22410988 A JP 22410988A JP 22410988 A JP22410988 A JP 22410988A JP H0271981 A JPH0271981 A JP H0271981A
Authority
JP
Japan
Prior art keywords
manipulator
contact
master
slave
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
JP22410988A
Other languages
English (en)
Other versions
JP2581192B2 (ja
Inventor
Tomohiro Miyazaki
友宏 宮崎
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.)
Mitsubishi Electric Corp
Original Assignee
Mitsubishi Electric 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 Mitsubishi Electric Corp filed Critical Mitsubishi Electric Corp
Priority to JP63224109A priority Critical patent/JP2581192B2/ja
Publication of JPH0271981A publication Critical patent/JPH0271981A/ja
Application granted granted Critical
Publication of JP2581192B2 publication Critical patent/JP2581192B2/ja
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J3/00Manipulators of leader-follower type, i.e. both controlling unit and controlled unit perform corresponding spatial movements
    • B25J3/04Manipulators of leader-follower type, i.e. both controlling unit and controlled unit perform corresponding spatial movements involving servo mechanisms

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)

Abstract

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

Description

【発明の詳細な説明】 〔産業上の利用分野〕 この発明は、例えば原子カプラントなどで用いられるマ
スタ・スレーブ・マニピュレータ制御装置に関するもの
である。
〔従来の技術〕
第4図は、例えば「ロボット工学入門」(オーム社)第
74頁〜第77頁に記載された従来のマスタ・スレーブ
・マニピュレータ制御装置の構成を1軸について示す構
成図である。図において、(1)tj:マスタ・マニピ
ュレータ、(2)ハスレープ・マニピュレータ、(8)
ハマスタ・マニピュレータ(1)の関節を駆動するモー
タ、(4)はマスタ・マニピュレータ(1)の関節トル
クを測定するトルク検出器、(5)はマスタ・マニピュ
レータ(1)の関節角度を測定する位置検出器、(6)
、 (7) 、 (8)はそれぞれ、スレーブ・マニピ
ュレータ(2)の関節に設けられたモータ。
トルク検出器2位置検出器である。また、(9)はマス
タ・マニピュレータ(1)を制御する第1運動制御器で
、ここではトルク調節器を用いている。叫はスレーブ・
マニピュレータ(2)を制御する第2運動制御器で、こ
こでは位置調節器である。0υは物体、例えば机である
次に動作について説明する。スレーブ・マニピュレータ
(2)が机aυに接触・非接触するのを検知する場合に
ついて説明する。人間がマスタ・マニピュレータ(1)
を手に持って動かすと、その動きが位置検出器(6)で
検出される。この検出値と位置検出器(8)で検出され
たスレーブ・マニピュレータ(2)の位置とを比較し、
その差が減少するように位置調節器αQによシスレープ
・マニピュレータ(2)を制御する。また、スレーブ・
マニピュレータ(2)が机aυに接触すると、その時ス
レーブ・マニピュレータ(2)に働く反力がトルク検出
器(γ)により検出される。
この検出値とトルク検出器(4)で検出されたマスタ・
マニピュレータ(1)が発生している力とを比較しその
差が減少するようにトルク調節器(9)によシマスタ・
マニピュレ−タ(1)を制御する。このようにして、人
間がマスタ・マニピュレータ(1) ヲ動かすと、それ
に追従してスレーブ・マニピュレータ(2)が動き、ま
た、スレーブ・マニピュL/ −タ(2)が机αυに接
触するとその反力がマスタ・マニピュレータ(1)を通
じて人間に感じられる。
〔発明が解決しようとする課題〕
従来のマスタ・スレーブ・マニピュレータ制御装置は以
」−のように構成されており、スレーブ・マニピュレー
タ(2)が物体と接触しているか否かにかかわらず、同
一の制御方式で制御されていた。
スレーブ・マニピュレータ(2)が物体に接触している
時と非接触である時とでは制御対象の動特性が変化し、
特に接触したときは不安定になυ易い。
そのため、常に制御系が不安定にならないように運動制
御器(q)、 叫のゲインを小さく抑えておく必要があ
った。このため、マスタ・マニピュレータ(1)の操作
が重くなったり、スレーブ・マニピュレータ(2)の追
従性が悪くなるなどの問題点があった。
この発明は、上記のような問題点を解消するためになさ
れたもので、スレーブ・マニピュレータが物体と接触あ
るいは非接触である状態のどちらにおいても、制御系の
安定性を保ちながら、軽い操作を実現し、かつスレーブ
・マニピュレータの追従性を改善できるマスタ・スレー
ブ・マニピュレータ制御装置を得ることを目的とする。
〔課題を解決するための手段〕
この発明に係るマスタ・スレーブ・マニピュレータ制御
装置は、マスタ・マニピュレータを制御する第1運動制
御器、スレーブ・マニピュレータを制御する第2運動制
御器、スレーブ・マニピュレータと物体との接触・非接
触を検知する接触検知器を備え、第1.第2運動制御器
のうちの少なくともいずれか一方の運動制御器における
制御方式を切り換え可能な構Ffi、、!−シ、スレー
ブ・マニピュレータ七物体との接触・非接触に基ずいて
第1、第2運動制御器のうちの少なく七も一方の運動制
御器における制御方式を切り換えるように構成したもの
である。
〔作用〕
この発明における運動制御器は、接触・非接触によって
制御方式を切り換え可能に構成されておυ、スレーブ・
マニピュレータが物体に接触している時々非接触な時と
で制御方式を切り換える。
これKより物体に接触している時には安定な制御が実現
でき、非接触の時には軽い操作と速い追従性を実現する
ことができる。
〔実施例〕
以下、この発明の一実施例を図について説明する。第1
図において、(1)はマスタ・マニピュレータ、(2)
はスレーブ・マニピュレータ、(8)、(4)、(5)
はそれぞれマスタ・マニピュレータ(1)の関節に設け
られたモータ、トルク検出器1泣置検出器、(6)、(
γ) 、 (S)はそれぞれスレーブ・マニピュレータ
(2)の関節に設けられたモータ、トルク検出器1泣置
検出器である。(9)、 <11)は第1.第2運動制
御器でここでは例えば(9)はトルク調節器、(2)は
位置調節器である。αυは物体で、例えば机(15)は
スレーブ・マニピュレータ(2)のトルク検出器(ア)
からの出力を入力し、スレーブ・マニピュレータQ2が
物体αυと接触しているか否かを判断する接触検知器で
ある。第2図は位置調節器a〔の−例として構成された
ものの詳細を示す構成図である。図において、(イ)は
比例制御器、C21)は微分補償器、のけ可変ゲインで
ある。可変ゲイン四のゲインは接触検知部(19からの
出力によυ切り換えられる。例えばスレーブ・マニピュ
レータ(2)が物体aυに接触していない時は大きな値
が選択され、接触している時は小さなゲインが選択され
る。第3図はトルク調節器(9)の−例として構成され
たものの詳細を示す構成図である。図において、器は比
例制御器、■は積分補償器、罰は可変ゲインである。可
変ゲイン罰のゲインは接触検知部(19からの出力によ
り切り換えられる。例えばスレーブ・マニピュレータ(
2)が物体0υに接触していない時は大きな値が選択さ
れ。
接触している時は小さなゲインが選択される。
次に動作について説明する。スレーブ・マニピュレータ
(2)が机αυに接触・非接触するのを検知する場合に
ついて説明する。人間がマスタ・マニピュレータ(1)
を手に持って動かす七、その動きが位置検出器(5)で
検出される。この検出値と位置検出器(8)で検出され
たスレーブ・マニピュレータ(2)の位t!i七を比較
し、その差が減少するように位置調節器(至)によりス
レーブ・マニピュレータ(2) t= 制御する。また
、スレーブ・マニピュレータ(2)が外部の物体、例え
ば机aυに接触すると、その時スレーブ・マニピュレー
タ(2)に働く反力がトルク検出器(γ)により検出さ
れる。この検出値とトルク検出器(4)で検出されたマ
スタ・マニピュレータ(1)が発生している力とを比較
し、その差が減少するようにトルク調節器(9)によシ
、マスタ・マニピュレータ(1)を制御する。この時、
スレーブ・マニピュレータ(2)が机0υに接触してい
るか否かを接触検知器19により判断する。接触してい
ない時はトルク調節器(9)、位置調節器αυともに大
きなゲインが選択される、即ち、接触していない時はス
レーブ・マニピュレータ(2)のトルク検出器(7)に
よって検出される反力は零であるから、トルク調節器(
9)には人間がマスタ・マニピュレータ(1)を操作す
るために加えた力がフィードバックされ、人間が力を加
えた方向にマスタ・マニピュレータ(1)がモータ(8
)により駆動される。従って、トルク調節器(9)のゲ
イン罰を大きく設定する七、小さい力でマスタ・マニピ
ュレータ(1)を操作するこ七ができ、操作が軽くなる
。また、位置調節器αO)のゲインのを大きく設定する
七、スレーブ・マニピュレータ(2)が高速かつ高精度
にマスタ・マニピュレータ(1)の動キに追従すること
ができる。
一方、スレーブ・マニピュレータ(2)が机αυに接触
している時は、トルク調節器(9)1位置調節器α〔七
もに小さいゲインが選択され、制御系が安定に保たれる
この実施例では接触検知器間において、スレーブ・マニ
ピュレータ(2)のトルク検出器(γ)によって検出さ
れた力があらかじめ定めた所定値よシ大きい場合にスレ
ーブ・マニピュレータ(2)が机(Illに接触してい
ると判断している。
なお、上記実施例では力帰還型と呼ばれる制御方式にこ
の発明を適用したものを示したが、力部送型や対称型な
どの他の制御方式にも同様に適用することができる。
また、上記実施例では運動制御器のゲインだけを切り換
えたが、運動制御器の構成自体を切如換えるように構成
すると、よシ効果的になる。例えば第1運動制御器Ta
lの場合に、比例制御器(ハ)のみを動作させる場合と
、比例制御器器と積分補償器■を共に動作させる場合に
切り換えたシしてもよい。
また、上記実施例では第1.第2運動制御器(9)、α
切のいずれも制御方式を切り換えるように構成したが、
どちらか一方でもよい。
また、第1.第2運動制御器(9)、αGの構成は上記
実施例に限るものではない。
〔発明の効果〕
以上のように、この発明によれば、マスタ・マニピュレ
ータを制御する第1運動制御器、スレーブ・マニピュレ
ータを制御する第2運動制御器、スレーブ・マニピュレ
ータと物体との接触・非接触を検知する接触検知器を備
え、第1.第2運動制御器のうちの少なく七もいずれか
一方の運動制御器における制御方式を切り換え可能な構
成としスレーブ・マニピュレータと物体との接触・非接
触に基ずいて第1.第2運動制御器のうちの少なくとも
一方の運動制御器における制御方式を切り換えるように
構成したことにより、スレーブ・マニピュレータが物体
に接触していない時はマスタ・マニピュレータの操作を
軽くでき、かつスレーブ・マニピュレータの追従性も向
上でき、さらに、スレーブ・マニピュレータが物体に接
触した時にも制御系を安定に保つこ七ができるマスタ・
スレーブ・マニピュレータ制御装置が得られる効果があ
る。
【図面の簡単な説明】
第1図はこの発明の一実施例によるマスタ・スレーブ・
マニピュレータ制御装置を示す構成図、第2図、第3図
はそれぞれこの発明の一実施例に係る第2.第1運動制
御器の詳細を示す構成図、第4 図ハ従来のマスタ・ス
レーブ・マニピュレータ制御装置を示す構成図である。 (1)はマスタ・マニピュレータ、(2)はスレーブ・
マニピュレータ、(9)は第1運動制御器、α窃は第2
運動制御器、(15)は接触検知器。 なお、図中、同一符号は同一、又は相当部分を示す。

Claims (1)

    【特許請求の範囲】
  1. マスタ・マニピュレータを制御する第1運動制御器、ス
    レーブ・マニピュレータを制御する第2運動制御器、上
    記スレーブ・マニピュレータと物体との接触・非接触を
    検知する接触検知器を備え、第1、第2運動制御器のう
    ちの少なくともいずれか一方の運動制御器における制御
    方式を切り換え可能な構相とし、上記スレーブ・マニピ
    ュレータと上記物体との接触・非接触に基ずいて第1、
    第2運動制御器のうちの少なくとも一方の運動制御器に
    おける制御方式を切り換えるように構成したマスタ・ス
    レーブ・マニピュレータ制御装置。
JP63224109A 1988-09-06 1988-09-06 マスタ・スレーブ・マニピユレータ制御装置 Expired - Lifetime JP2581192B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP63224109A JP2581192B2 (ja) 1988-09-06 1988-09-06 マスタ・スレーブ・マニピユレータ制御装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP63224109A JP2581192B2 (ja) 1988-09-06 1988-09-06 マスタ・スレーブ・マニピユレータ制御装置

Publications (2)

Publication Number Publication Date
JPH0271981A true JPH0271981A (ja) 1990-03-12
JP2581192B2 JP2581192B2 (ja) 1997-02-12

Family

ID=16808675

Family Applications (1)

Application Number Title Priority Date Filing Date
JP63224109A Expired - Lifetime JP2581192B2 (ja) 1988-09-06 1988-09-06 マスタ・スレーブ・マニピユレータ制御装置

Country Status (1)

Country Link
JP (1) JP2581192B2 (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002307336A (ja) * 2001-04-17 2002-10-23 Keio Gijuku マスタスレーブ装置、制御方法及びコンピュータープログラム
WO2013012096A1 (en) * 2011-07-20 2013-01-24 Olympus Corporation Operating mechanism of medical device and medical manipulator

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS60161081A (ja) * 1984-01-30 1985-08-22 株式会社日立製作所 サ−ボマニプレ−タの制御機構
JPS6235914A (ja) * 1985-08-09 1987-02-16 Toshiba Corp 産業用ロボツト

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS60161081A (ja) * 1984-01-30 1985-08-22 株式会社日立製作所 サ−ボマニプレ−タの制御機構
JPS6235914A (ja) * 1985-08-09 1987-02-16 Toshiba Corp 産業用ロボツト

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002307336A (ja) * 2001-04-17 2002-10-23 Keio Gijuku マスタスレーブ装置、制御方法及びコンピュータープログラム
WO2013012096A1 (en) * 2011-07-20 2013-01-24 Olympus Corporation Operating mechanism of medical device and medical manipulator
JP2013022671A (ja) * 2011-07-20 2013-02-04 Olympus Corp 医療用動作機構およびマニピュレータ
US9289901B2 (en) 2011-07-20 2016-03-22 Olympus Corporation Operating mechanism of medical device and medical manipulator

Also Published As

Publication number Publication date
JP2581192B2 (ja) 1997-02-12

Similar Documents

Publication Publication Date Title
JPH0596477A (ja) マスタスレーブマニピユレータの制御方法
US4970449A (en) Numerical control apparatus
JPH0271981A (ja) マスタ・スレーブ・マニピユレータ制御装置
JPH01154205A (ja) Nc工作機械
JPS6249503A (ja) 数値制御装置
JPH0792702B2 (ja) 制御装置
JPH06138945A (ja) マスタスレーブマニピュレータの制御装置
JPH0820893B2 (ja) 産業用多関節ロボットの最適移動制御方式
JPH0752363B2 (ja) 産業用ロボットの制御装置
JPH08132369A (ja) ロボット制御装置
KR0160673B1 (ko) 트윈 xy 로봇의 위치 제어 방법 및 장치
SU1248765A1 (ru) Способ стабилизации положени рабочих органов станка
JP2007144621A (ja) ロボットの制御装置
JPS63231602A (ja) 数値制御装置
JPH01254393A (ja) レーザ加工機の制御装置
KR20230134973A (ko) 서보 시스템
JP2712653B2 (ja) マニプレータの制御方式
JPS63146108A (ja) サ−ボ装置
JPH10268940A (ja) フィードバック制御装置
JPH0619696B2 (ja) 移動テ−ブル制御装置
JPH0315908A (ja) 移動部材の軌跡方向の加減速方法
JPH04137017A (ja) Ddモータの制御機構
JPH0197811A (ja) 衛星指向基準信号処理装置
JPH06348328A (ja) Cnc制御装置における円弧補間方法
JPH01146680A (ja) 産業用ロボットの制御方法