JPH03161289A - マスター・スレーブロボットの制御方法 - Google Patents

マスター・スレーブロボットの制御方法

Info

Publication number
JPH03161289A
JPH03161289A JP29940489A JP29940489A JPH03161289A JP H03161289 A JPH03161289 A JP H03161289A JP 29940489 A JP29940489 A JP 29940489A JP 29940489 A JP29940489 A JP 29940489A JP H03161289 A JPH03161289 A JP H03161289A
Authority
JP
Japan
Prior art keywords
manipulator
workpiece
master
impedance
hand
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
JP29940489A
Other languages
English (en)
Other versions
JPH0741560B2 (ja
Inventor
Susumu Tate
▲すすむ▼ 舘
▲榊▼ 泰輔
Taisuke Sakaki
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.)
Yaskawa Electric Corp
National Institute of Advanced Industrial Science and Technology AIST
Original Assignee
Agency of Industrial Science and Technology
Yaskawa Electric Manufacturing Co 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 Agency of Industrial Science and Technology, Yaskawa Electric Manufacturing Co Ltd filed Critical Agency of Industrial Science and Technology
Priority to JP1299404A priority Critical patent/JPH0741560B2/ja
Publication of JPH03161289A publication Critical patent/JPH03161289A/ja
Publication of JPH0741560B2 publication Critical patent/JPH0741560B2/ja
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Landscapes

  • Manipulator (AREA)

Abstract

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

Description

【発明の詳細な説明】 〔産業上の利用分野〕 本発明は、マスター・スレーブロボットの制御方法に関
する。
〔従来の技術〕
拘束条件下での運動や物体との接触を伴うマニピュレー
タの運動において、位置及び力の情報を考慮することの
重要性は古くから論じられており、位置と力のハイブリ
ッド制御やインピーダンス制御が開発されてきた。
これらの制御法は、マニピュレータと作業対象物の動的
な相互作用を中心概念とし、マニピュレータの機械的な
インピーダンスを制御することで、マニピュレータが作
業対象物に接触する場合に安定的な力制御を行うことを
可能とした。
また、マスター◆スレーブ・マニピュレータを操作する
場合、従来の対称型や力逆送型あるいは力帰還型の各マ
スター・スレーブの制御方式では、スレーブアームが得
た力感覚を、そのままマスク一アームへ伝送する方法を
用いている。
しかし、一般に、スレーブアームが作業を行う環境は、
そのままオペレータにとって操作し易いとは限らず、例
えば慣性質量の大きな対象物を移動させる場合には、オ
ペレータにとっては負担となる。その場合には、オペレ
ータの作業を補助する意味から、対象物も含めた環境の
動特性を見かけ上変更することがより重要であり、作業
対象物のインピーダンスを制御することで操作感を変更
する手法が既に提案されている。
〔発明が解決しようとする課題3 このように、作業対象物の勤特性を考慮に入れたマニピ
ュレータの制御を行うには、作業対象物の動特性の情報
を、マニピュレータの制御ループの中に取り込むことが
重要である。
マニピュレータが、ある作業対象物に接触する場合には
、マニピュレータの動特性すなわちインピーダンスだけ
に注目するのではなく、作業対象物のインピーダンスの
大小によって、マニピュレータのインピーダンスを制{
卸することが、安定な接触作業を実行するには必要であ
る。
マタ、マスター・スレーブ・マニビュレータでは、スレ
ーブアームが把持した対象物の勤特性を計測し、作業者
が快適に操作できる対象物の劾特性の範囲と照らし合わ
せて、マスターアームの操作感を変更することになる。
したがって、作業対象物の動特性を、インピーダンスと
して同定することは、以上のようなマニピュレータの接
触作業、あるいはマスター・スレーブ・マニピュレータ
には不可欠である。
本発明は、上記のような実情に鑑みてなされたものであ
り、マニピュレータの安定的な接触作業、あるシ゛)は
操作生の良いマスター・スレーブ・マニピュレータを実
現することを可能とする制御方法を提案することを目的
とする。
〔課題を解決するための手段〕
この目的を達或するため、本発明のマスター・スレーブ
ロボットの制御方法は、 作業対象物の動特性を、 Mo:作業対象物の慣性質量 Bo:作業対象物の粘性 Ko:作業対象物の剛性 とし、マニピュレータの手先の動特性を、M,:マニピ
ュレータの手先の慣性質量B,マニピュレータの手先の
粘性 Km:マニピュレータの手先の剛性 とし、マニピュレータの手先の目標運動を、d”Xっ/
dt2:マニピュレータの手先の加速度dXm,#t 
 :マニピュレータの手先の速度X.:マニピュレータ
の手先の位置 とし、マニピ品レータ接触前の作業対象の運動を、 d2X./dt’;作業対象物の加速度dXm/dt 
 :作業対象物の速度 x0:作業対象物の位置 とし、マニピュレータの接触後の作業対象物とマニピュ
レータの運動を、 d’ X. /clL”:マニピュレータと作業対象物
の加速度 dX,/dt  :マニピュレータと作業対象物のX,
l 速度 :マニピュレータと作業対象物の 位置 としたとき、 作業対象物の動特性を、 とするインピーダンスとして求め、この作業対象物の劾
特性を用いてスレーブマニピュレータの把持している対
象物の同特性を変化させ、マスクマニピュレータを操作
するときの操作感を変更する制御を行うことを特徴とす
る。
〔作用〕
マニピュレータの内部センサから、マニピュレータが作
業対象物に接触した後の加速度、速度、位置を計測し、
予め定めたマニビュレータの目標加速度、目標速度、目
標位置、マニビュレータ接触前の作業対象物の加速度、
速度、位置及びマニピュレータの手先のインピーダンス
を上式に代入し、作業対象物の助特性をインピーダンス
として求め、この作業対象物の劾特性を用いてスレーブ
マニビュレータの把持している対象物の同特性を変化さ
せ、マスクマニピュレータを操作するときの操作感を見
かけ上重くしたり軽くしたりというように変更する。
〔実施例〕
以下、本発明を実施例に基づいて具体的に説明する。
未知の動特性(Mo, Bo, Ko)を持つ作業対象
吻に、助特性(M..Bつ,K,)を持つマニピュレー
タが接触する状態を第1図に示す。
マニビュレークの手先の目標運動を、 d2Xa/dt2:マニピュレータの手先の加速度dX
m/dt  :マニビュレータの手先の速度X,;マニ
ピュレータの手先の位置 とすると、マニピュレータが作業対象吻に接触する前で
は、これはそのままマニピュレータの実際の運動状態に
一致し、マニピュレータが作業対象物に接触後では、対
象物が存在しなかった場合のマニピュレータの仮想的な
運動状態となる。
マニピュレータの接触前の作業対象物の運動を、d2X
./dt’:作業対象物の加速度dX,/dt  :作
業対象物の速度 x0:作業対象物の位置 とすると、マニビ一レークが作業対象物に接触した後で
は、マニピュレータの手先の運動は、d2X./dt2
:マニピュレータと作業対象物の加速度 dXm/dt  :マニピュレータと作業対象物の速度 X.;マニピュレータと作業対象物の 位置 のように計測される。
例えば、マニビュレータと作業対象物かばね要素のみで
構或されているとすると、接触前の状態は第2図のよう
に表され、接触後では、第3図に示したように、マニビ
ュレータと作業対象物の接触点の位置は、マニビュレー
タの目標位置X,と接触前の作業対象物の位置Xo の
中間の平衡点X6で静止することになる。
このとき、接触によって、マニビュレータの目標位置X
,と平衡点X1には偏差X。−X,が生じ、マニピュレ
ータは作業対象物に対し、 F.= Km ・(X.− X.) だけの力を与えることになる。逆に、接触前の作業対象
物の位置Xoと平衡点Xやには、偏差XoX.が生じる
ので、作業対象物はマニピュレータに対し、 F.=Km ・(X.一X.) だけの反力を返すことになる。
これらの力は、作用・反作用の関係から等しくなり、 Km ・(X.− X.)=Km ・(X.−X.)な
る関係がある。
したがって、この関係より、作業対象物の弾性係数は、 のように求めることができる。
同様にマニピュレータと作業対象物の粘性についてのみ
注目するならば、作業対象物の粘性は、と求められ、同
様にマニピュレータと作業対象物の慣性についてのみ注
目するならば、作業対象物の慣性は、 と求めることができる。
このようにして、作業対象物の動特性は、インピーダン
スとして求めることができる。実際には、劾特性を弾性
、粘性、慣性と順に求める必要はなく、それぞれ同時に
求めればよい。
以上によって求められた作業対象物の動特性を用いてマ
ニビュレータの操作感を変更する制御について以下に説
明する。
マニビュレータの運動方程式が次式で与えられていると
する。
但し、工 ;マニピュレータの慣性行列Dv:マニピュ
レータの粘性行列 Ta;アクチュエー夕のトルク行列 θ ;マニピュレータの関節角行列 JT:ヤコビアンの転置行列 F.,;マニピュレータに加えられた外力いま、アクチ
ュエータのトルク行列T.をインピーダンス制御するこ
とにより、マニピュレータの手先のインピーダンスは見
かけ上、次式のようになっている。
Z.( jω)=B−+j(M−ω一玉〉ω このマニピュレータの手先が次のインピーダンス X Zo(j  ω)=Bo+j(Moω−     )ω をもつ対象物に接触しているとき、マニピュレータと対
象物とを合わせた全体のインピーダンスは、Z。(jω
)=B.+j(M.ω一玉〉ω となっている。
このとき、オペレータは、アームを通してインピーダン
スZ.( jω)を感じながら作業を行うが、オペレー
タがこのインピーダンスを変更したいときは、次のよう
に制御を行う。
マニピ二レークと対象物とを合わせたインピーダンスの
目標値を次のように設定する。
そうすると、インピーダンス制御により全体のシステム
の運動方程式は次のようになる。
以上のことから、既知の動特性(I,  Dv)をもつ
マニピュレータが、先に同定した動特性( M o ,
Bo,Ko)を持つ対象物に接触しているとき、全体の
システムの目標インピーダンスZc(jω)を実現する
ために必要なアクチュエー夕の出力T,は次のように決
定される。
+(D,+ J”Do+ J”Mo″J+ J’  C
Ko(L(θ)   X−)+Kc(Xo   L(θ
))〕 このブロック図を第4図に示す。このように、アクチス
エー夕への出力T.を制御することにより、オペレータ
にとっての操作感を変更することができる。
〔発明の効果〕
以上に説明したように、本発明では、マニピュレータの
作業対象物の勤特性をインピーダンスとして同定するこ
とができ、マニビュレータの安定的な接触作業、あるい
は操作性の良いマスター・スレーブ・マニピュレータを
実現することができる。
【図面の簡単な説明】
第1図はマニピュレータの作業対象物への接触状態を表
した説明図、第2図は接触前のマニピュレータと作業対
象物の状態をばね要素のみを抜き出して表した説明図、
第3図は接触後のマニピュレータと作業対象物の状態を
ばね要素のみを抜き出して表した説明図、第4図はマニ
ピュレータと対象物の全体のシステムのインピーダンス
を制御するブロック図である。

Claims (1)

  1. 【特許請求の範囲】 1、作業対象物の動特性を、 M_o:作業対象物の慣性質量 B_o:作業対象物の粘性 K_o:作業対象物の剛性 とし、マニピュレータの手先の動特性を、 M_m:マニピュレータの手先の慣性質量 B_m:マニピュレータの手先の粘性 K_m:マニピュレータの手先の剛性 とし、マニピュレータの手先の目標運動を、d^2X_
    m/dt^2:マニピュレータの手先の加速度dX_m
    /dt:マニピュレータの手先の速度X_m:マニピュ
    レータの手先の位置 とし、マニピュレータ接触前の作業対象の運動を、 d^2X_o/dt^2:作業対象物の加速度dX_o
    /dt:作業対象物の速度 X_o:作業対象物の位置 とし、マニピュレータの接触後の作業対象物とマニピュ
    レータの運動を、 d^2X_e/dt^2:マニピュレータと作業対象物
    の加速度 dX_e/dt:マニピュレータと作業対象物の速度 X_e:マニピュレータと作業対象物の 位置 としたとき、 作業対象物の動特性を、 M_o=M_e(d^2X_m/dt^2−d^2X_
    e/dt^2)/(d^2X_e/dt^2−d^2X
    _o/dt^2)B_o=B_m(dX_m/dt−d
    X_e/dt)/(dX_e/dt−dX_o/dt)
    K_o=K_m(X_m−X_e)/(X_e−X_o
    )とするインピーダンスとして求め、この作業対象物の
    動特性を用いてスレーブマニピュレータの把持している
    対象物の同特性を変化させ、マスタマニピュレータを操
    作するときの操作感を変更する制御を行うことを特徴と
    するマスター・スレーブロボットの制御方法。
JP1299404A 1989-11-16 1989-11-16 マスター・スレーブロボットの制御方法 Expired - Fee Related JPH0741560B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP1299404A JPH0741560B2 (ja) 1989-11-16 1989-11-16 マスター・スレーブロボットの制御方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP1299404A JPH0741560B2 (ja) 1989-11-16 1989-11-16 マスター・スレーブロボットの制御方法

Publications (2)

Publication Number Publication Date
JPH03161289A true JPH03161289A (ja) 1991-07-11
JPH0741560B2 JPH0741560B2 (ja) 1995-05-10

Family

ID=17872122

Family Applications (1)

Application Number Title Priority Date Filing Date
JP1299404A Expired - Fee Related JPH0741560B2 (ja) 1989-11-16 1989-11-16 マスター・スレーブロボットの制御方法

Country Status (1)

Country Link
JP (1) JPH0741560B2 (ja)

Cited By (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102039594A (zh) * 2009-10-20 2011-05-04 株式会社安川电机 阻抗控制参数调节装置和调节方法
WO2013018934A1 (en) * 2011-08-04 2013-02-07 Olympus Corporation Manipulation input device and manipulator system having the same
US9161772B2 (en) 2011-08-04 2015-10-20 Olympus Corporation Surgical instrument and medical manipulator
US9218053B2 (en) 2011-08-04 2015-12-22 Olympus Corporation Surgical assistant system
US9244524B2 (en) 2011-08-04 2016-01-26 Olympus Corporation Surgical instrument and control method thereof
US9244523B2 (en) 2011-08-04 2016-01-26 Olympus Corporation Manipulator system
US9423869B2 (en) 2011-08-04 2016-08-23 Olympus Corporation Operation support device
US9477301B2 (en) 2011-08-04 2016-10-25 Olympus Corporation Operation support device and assembly method thereof
US9519341B2 (en) 2011-08-04 2016-12-13 Olympus Corporation Medical manipulator and surgical support apparatus
US9524022B2 (en) 2011-08-04 2016-12-20 Olympus Corporation Medical equipment
US9568992B2 (en) 2011-08-04 2017-02-14 Olympus Corporation Medical manipulator
US9632577B2 (en) 2011-08-04 2017-04-25 Olympus Corporation Operation support device and control method thereof
US9632573B2 (en) 2011-08-04 2017-04-25 Olympus Corporation Medical manipulator and method of controlling the same
US9851782B2 (en) 2011-08-04 2017-12-26 Olympus Corporation Operation support device and attachment and detachment method thereof

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2022004568A1 (ja) * 2020-06-30 2022-01-06 学校法人慶應義塾 制御システム、制御方法及びプログラム

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6444510A (en) * 1987-08-13 1989-02-16 Omron Tateisi Electronics Co Robot control device

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6444510A (en) * 1987-08-13 1989-02-16 Omron Tateisi Electronics Co Robot control device

Cited By (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102039594A (zh) * 2009-10-20 2011-05-04 株式会社安川电机 阻抗控制参数调节装置和调节方法
WO2013018934A1 (en) * 2011-08-04 2013-02-07 Olympus Corporation Manipulation input device and manipulator system having the same
JP2013035117A (ja) * 2011-08-04 2013-02-21 Olympus Corp 操作入力装置およびこれを備えるマニピュレータシステム
CN103687701A (zh) * 2011-08-04 2014-03-26 奥林巴斯株式会社 操纵输入装置和具有该操纵输入装置的机械手系统
US9161772B2 (en) 2011-08-04 2015-10-20 Olympus Corporation Surgical instrument and medical manipulator
US9218053B2 (en) 2011-08-04 2015-12-22 Olympus Corporation Surgical assistant system
US9244524B2 (en) 2011-08-04 2016-01-26 Olympus Corporation Surgical instrument and control method thereof
US9244523B2 (en) 2011-08-04 2016-01-26 Olympus Corporation Manipulator system
US9423869B2 (en) 2011-08-04 2016-08-23 Olympus Corporation Operation support device
US9477301B2 (en) 2011-08-04 2016-10-25 Olympus Corporation Operation support device and assembly method thereof
US9519341B2 (en) 2011-08-04 2016-12-13 Olympus Corporation Medical manipulator and surgical support apparatus
US9524022B2 (en) 2011-08-04 2016-12-20 Olympus Corporation Medical equipment
US9568992B2 (en) 2011-08-04 2017-02-14 Olympus Corporation Medical manipulator
US9632577B2 (en) 2011-08-04 2017-04-25 Olympus Corporation Operation support device and control method thereof
US9632573B2 (en) 2011-08-04 2017-04-25 Olympus Corporation Medical manipulator and method of controlling the same
US9671860B2 (en) 2011-08-04 2017-06-06 Olympus Corporation Manipulation input device and manipulator system having the same
US9851782B2 (en) 2011-08-04 2017-12-26 Olympus Corporation Operation support device and attachment and detachment method thereof

Also Published As

Publication number Publication date
JPH0741560B2 (ja) 1995-05-10

Similar Documents

Publication Publication Date Title
US10562183B2 (en) Position/force controller, and position/force control method and storage medium
JPH03161289A (ja) マスター・スレーブロボットの制御方法
Salcudean et al. Transparent bilateral teleoperation under position and rate control
Luo et al. Control design of robot for compliant manipulation on dynamic environments
JP3283650B2 (ja) ロボット制御装置
JPH05329784A (ja) マスタ・スレーブロボットの制御方式
Tachi et al. Impedance control of a direct-drive manipulator without using force sensors
JPH03123907A (ja) ロボットの直接教示装置及び直接教示方法
JP2507891B2 (ja) マニピュレ―タのインピ―ダンス制御方式
JPS6077210A (ja) 空間運動機構の制御方法
JPS62297080A (ja) マスタスレ−ブマニピユレ−タ
JPH06339885A (ja) ロボットのコンプライアンス制御方法
Tavakoli et al. Haptic implications of tool flexibility in surgical teleoperation
JP2569412B2 (ja) 冗長ロボットマニピュレータのためのコンプライアンス制御法
JPH10202558A (ja) マスタスレーブ装置
JPH058187A (ja) ロボツト
Mudge et al. Unifying robot arm control
JP3253170B2 (ja) マニピュレータの制御方法
JP2520006B2 (ja) ロボット教示方式
JPH03262009A (ja) 多自由度ロボットの制御方法
JPH03117574A (ja) マスター・スレーブロボットの制御方法
JPH03184789A (ja) ロボットの力制御方式
JPS63276607A (ja) マニピュレータ装置
JP3355614B2 (ja) マスタ・スレーブロボットの制御装置
JPH06781A (ja) マスタスレーブマニピュレータ

Legal Events

Date Code Title Description
R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

LAPS Cancellation because of no payment of annual fees