JPH07205058A - マスタ・スレーブロボットの制御装置 - Google Patents
マスタ・スレーブロボットの制御装置Info
- Publication number
- JPH07205058A JPH07205058A JP1214494A JP1214494A JPH07205058A JP H07205058 A JPH07205058 A JP H07205058A JP 1214494 A JP1214494 A JP 1214494A JP 1214494 A JP1214494 A JP 1214494A JP H07205058 A JPH07205058 A JP H07205058A
- Authority
- JP
- Japan
- Prior art keywords
- force
- master
- slave
- arm
- target
- 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
Links
Abstract
的な相似性が満足するようなマスタ・スレーブロボット
の制御装置を提供する。 【構成】マスタ・スレーブのそれぞれであつかう物理量
の相似性を満足するように力、長さ、目標インピーダン
スのスケール比をそれぞれのアームの手先で検出した力
に乗じる手段と、その乗算値と対応する検出値との差
を、力指令値としてそれぞれマスタおよびスレーブの目
標インピーダンスに与える手段とを備える。
Description
量をあつかうマスタ・スレーブロボットの制御装置に関
する。
ってスレーブロボットを作動させるマスタ・スレーブロ
ボットにおいて、マイクロマニピュレータのようにマス
タとスレーブでスケールの異なるマスタ・スレーブロボ
ットの制御装置が提案されている。例えば、文献(福
田:マイクロマニプレータのバイラテラル制御に関する
研究:第25回計測自動制御学会学術講演会学術講演会
予稿集、pp.715−716、1986)ではインピ
ーダンスをマスタとスレーブでマッチングさせる方式を
提案している。しかし、この方式はマスタとスレーブの
間で物理的な相似性に満足される補償がない点が問題で
ある。文献(榊、舘:インピーダンス制御型マスタ・ス
レーブ・システム(II):日本ロボット学会誌、Vo
1.8、No.3、pp.253−264、1990)
ではマスタとスレーブで物理的相似性をもつ制御方式を
提案している。しかし、この方式はトルクを直接制御す
る方法のため、モーションを制御するサーボコントロー
ラを内蔵する一般のロボットコントローラに組み込むこ
とが容易でないという問題がある。
マスタ・スレーブロボットの制御装置において、マスタ
とスレーブで異なる物理量をあつかう技術として、従来
は、インピーダンスをマッチングさせる方式とトルクを
直接制御する方式が存在する。前者の方式ではマスタと
スレーブであつかう物理量の間に物理的な相似性が保た
れているか保証されていない。また後者の方式では物理
的な相似性は保たれるものの市販のサーボコントローラ
に組み込むことが容易でないという問題がある。この発
明の目的は、各アームにサーボコントローラをそなえ、
各アームに仮想的なインピーダンスを実現するマスタ・
スレーブロボットにおいて、マスタとスレーブの間であ
つかう物理量の物理的な相似性が満足するようなマスタ
・スレーブロボットの制御装置を提供することである。
置あるいは速度あるいは加速度のモーションのサーボ装
置をそなえ、各アームの手先に予め設定した目標インピ
ーダンス(目標慣性・目標粘性・目標弾性)を実現する
ように位置あるいは速度あるいは加速度のモーションの
指令値を各アームのサーボ装置へ入力してマスタとスレ
ーブの各システムで局所的にインピーダンス制御し、長
さあるいは力などの物理量において異なるスケールの物
理量をあつかうマスタ・スレーブロボットの制御装置に
おいて、マスタ・スレーブのそれぞれであつかう物理量
の相似性を満足するように力、長さ、目標インピーダン
スのスケール比をそれぞれのアームの手先で検出した力
に乗じる手段と、その乗算値と対応する検出値との差
を、力指令値としてそれぞれマスタおよびスレーブの目
標インピーダンスに与える手段と、を備えたことを特徴
とするものである。
ーラをそなえ、各アームに仮想的なインピーダンスを実
現するマスタ・スレーブロボットにおいて、マスタとス
レーブの間であつかう物理量の物理的な相似性が満足す
るようなマスタ・スレーブロボットの制御装置を提供で
きる。以下、本発明の原理を説明する。マスタとスレー
ブであつかう物理量の相似のスケール比を設定する。
力、長さ、インピーダンスのスケール比をそれぞれつぎ
のようにあらわす。 Fm =f* Fs (式1) Xm =L* Xs (式2) Zm =z* Zs (式3) ここで、f* 、L* 、z* はそれぞれ力、長さ、インピ
ーダンスのスケール比をあらわす。また、Fm 、Fs は
それぞれマスタとスレーブで発生した力の値、Xm 、X
s はそれぞれマスタとスレーブの位置、Zm 、Zs はそ
れぞれマスタとスレーブの目標インピーダンスである。
これらの目標インピーダンスはZm =[mo1 、b
o1 、ko1 ]、Zs =[mo2 、bo2 、ko2 ]と
あらわされる。mo1 、bo1 、ko1 はそれぞれマス
タの目標慣性、目標粘性、目標弾性、またmo2 、bo
2 、ko2 はそれぞれスレーブの目標慣性、目標粘性、
目標弾性である。ここで力、長さ、インピーダンスの関
係が Fm =Zm Xm (式4) Fs =Zs X s (式5) であることからスケール比の間の関係を f* =z* L* (式6) となるように設定する。 すなわち、 f* とz* を決めたとき…L* =f* /z* (式7) f* とL* を決めたとき…z* =f* /L* (式8) z* とL* を決めたとき…f* =z* L* (式9) というように設定する。また、マスタとスレーブのロボ
ットの手先に実現する目標インピーダンスの各パラメー
タであるマスタの目標慣性m01、スレーブの目標慣性m
02、マスタの目標粘性b01、スレーブの目標粘性b02、
マスタの目標剛性k01、スレーブの目標剛性k02を、そ
れぞれ、 m01/m02=b01/b02=k01/k02=z* (式10) が成り立つように各パラメータをきめる。このように設
定したパラメータをもとに各アームでインピーダンス制
御を実行すると、マスタとスレーブのみかけの動特性は
それぞれ周波数でつぎのように表される。 Fm (s)=(m01 s2 +b01 s+k01 )Xm (s) (式11) Fs (s)=(m02 s2 +b02 s+k02 )Xs (s) (式12) また、操作力Fm と、外力Fs に力の相似比f* を乗じ
た値f* Fs との差であるF1 (=Fm −f* Fs )
と、マスタの目標インピーダンスzm とから、マスタの
位置指令Xmrを、 Xmr=F1 /zm (式13) にしたがって計算する。同時に、操作力Fm を力の相似
比f* で割った値Fm /f* と外力Fs との差であるF
2 (=Fm /f* −Fs )と、スレーブの目標インピー
ダンスzs とから、スレーブの位置指令Xsrを、 Xsr=F2 /zs (式14) にしたがって計算する。このとき、マスタとスレーブと
の間で物理的な相似性がなりたっていることを説明す
る。マスタとスレーブにくわわった力Fm とFs と各ア
ームの目標インピーダンスZm 、Zs とから各アームの
位置を求めてみる。ここで、各アームのサーボ系が理想
的に働いたとすると、まず、スレーブの位置Xs は、
(式13)、(式14)から、 Xs =(Fm /f* −Fs )/zs (式15) となる。これと(式7)とからマスタの位置Xm は、 Xm =(Fm −f* Fs )/zm =(f* /z* )(Fm /f* −Fs )/zs =L* Xs (式16) となる。このことからマスタとスレーブにそれぞれ加わ
った力と各目標インピーダンスによって発生する各アー
ムの運動の関係は位置Xm とXs とであらわされ、これ
らの位置の関係が最初に設定したスケール比L* にした
がうことから、マスタとスレーブとの間に物理的な相似
性が成立することがわかる。以上説明したように、異な
るスケールの物理量をあつかうマスタ・スレーブロボッ
トにおいてマスタトスレーブとの間で物理的な相似性が
成立することとなる。
示して説明する。マスタ1とスレーブ2のアームに各々
取り付けられた力検出器3、4で検出した力5、6は、
座標変換演算部7、8に入力され、直交座標系へ座標変
換したマスタの操作力Fm と、スレーブの力座標演算部
で検出した力を直交座標系の力へ変換した外力Fs とに
変換される。操作力Fm と、外力に力のスケール比f*
を乗じた値f* Fs との差F1 をとって、F1 とマスタ
の目標インピーダンスzmとから、マスタの位置指令X
mrを計算する。また、操作力Fm に力のスケール比で割
った値Fm /f* と外力Fs との差F2 をとって、F2
とスレーブの目標インピーダンスzs とから、スレーブ
の位置指令Xsrを計算する。それぞれのサーボコントロ
ーラ9、10では、各アーム1、2を動かしたときに各
関節の角度、角速度、角加速度を検出し、これらの位置
指令値を追従するように各関節のサーボ補償をおこな
う。サーボ補償としては通常のPI補償器あるいはPI
D補償器で構成する。
各アームにサーボコントローラをそなえ、各アームに仮
想的なインピーダンスを実現するマスタ・スレーブロボ
ットにおいて、マスタとスレーブの間であつかう物理量
の物理的な相似性が満足するようなマスタ・スレーブロ
ボットの制御装置を実現できる。
装置の実施例を示す図。
Claims (1)
- 【請求項1】 各アームに位置あるいは速度あるいは加
速度のモーションのサーボ装置をそなえ、各アームの手
先に予め設定した目標インピーダンス(目標慣性・目標
粘性・目標弾性)を実現するように位置あるいは速度あ
るいは加速度のモーションの指令値を各アームのサーボ
装置へ入力してマスタとスレーブの各システムで局所的
にインピーダンス制御し、長さあるいは力などの物理量
において異なるスケールの物理量をあつかうマスタ・ス
レーブロボットの制御装置において、 マスタ・スレーブのそれぞれであつかう物理量の相似性
を満足するように力、長さ、目標インピーダンスのスケ
ール比をそれぞれのアームの手先で検出した力に乗じる
手段と、 その乗算値と対応する検出値との差を、力指令値として
それぞれマスタおよびスレーブの目標インピーダンスに
与える手段と、を備えたことを特徴とするマスタ・スレ
ーブロボットの制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP01214494A JP3355614B2 (ja) | 1994-01-07 | 1994-01-07 | マスタ・スレーブロボットの制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP01214494A JP3355614B2 (ja) | 1994-01-07 | 1994-01-07 | マスタ・スレーブロボットの制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH07205058A true JPH07205058A (ja) | 1995-08-08 |
JP3355614B2 JP3355614B2 (ja) | 2002-12-09 |
Family
ID=11797312
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP01214494A Expired - Fee Related JP3355614B2 (ja) | 1994-01-07 | 1994-01-07 | マスタ・スレーブロボットの制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3355614B2 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109173125A (zh) * | 2018-09-29 | 2019-01-11 | 北京力升高科科技有限公司 | 一种消防机器人的协同工作方法及系统 |
-
1994
- 1994-01-07 JP JP01214494A patent/JP3355614B2/ja not_active Expired - Fee Related
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109173125A (zh) * | 2018-09-29 | 2019-01-11 | 北京力升高科科技有限公司 | 一种消防机器人的协同工作方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
JP3355614B2 (ja) | 2002-12-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Luh et al. | Joint torque control by a direct feedback for industrial robots | |
Agrawal et al. | Control of cable actuated devices using smooth backlash inverse | |
Handlykken et al. | Control system analysis and synthesis for a six degree-of-freedom universal force-reflecting hand controller | |
CN111618858A (zh) | 一种基于自适应模糊滑模的机械手鲁棒跟踪控制算法 | |
Kuntze et al. | Control algorithms for stiffening an elastic industrial robot | |
JP3283650B2 (ja) | ロボット制御装置 | |
JPH03161289A (ja) | マスター・スレーブロボットの制御方法 | |
JPH03123907A (ja) | ロボットの直接教示装置及び直接教示方法 | |
JPH07205058A (ja) | マスタ・スレーブロボットの制御装置 | |
JPS6077210A (ja) | 空間運動機構の制御方法 | |
Leininger et al. | Pole placement self-tuning control of manipulators | |
JPH06222817A (ja) | ロボットのウィービング制御装置 | |
JPH0695294B2 (ja) | 産業用ロボットの軌跡補間方法 | |
JP2610996B2 (ja) | 多関節ロボット制御装置 | |
JPH11231940A (ja) | ロボットの制御装置 | |
JPH04369004A (ja) | マニピュレータのインピーダンス制御方法 | |
Carignan et al. | Achieving impedance objectives in robot teleoperation | |
JPH08141951A (ja) | ロボットの協調制御方法および協調制御装置 | |
JPH0630012B2 (ja) | 産業用ロボツトの制御方法 | |
JP2691591B2 (ja) | 力制御ロボットの制御方式 | |
JP3618363B2 (ja) | ロボット制御装置 | |
JPS61217802A (ja) | ロボツト制御装置 | |
JPS6010309A (ja) | ロボツトハンドの経路補間方法 | |
JPH03184786A (ja) | ロボットの軌道生成方式 | |
JPS63229279A (ja) | マスタ・スレ−ブ・バイラテラルサ−ボ・マニピユレ−タのマスタア−ム制御装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Year of fee payment: 6 Free format text: PAYMENT UNTIL: 20081004 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20081004 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Year of fee payment: 7 Free format text: PAYMENT UNTIL: 20091004 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20101004 Year of fee payment: 8 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Year of fee payment: 9 Free format text: PAYMENT UNTIL: 20111004 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Year of fee payment: 9 Free format text: PAYMENT UNTIL: 20111004 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121004 Year of fee payment: 10 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20131004 Year of fee payment: 11 |
|
LAPS | Cancellation because of no payment of annual fees |