JPH0630378Y2 - マスタ−マニプレ−タ - Google Patents
マスタ−マニプレ−タInfo
- Publication number
- JPH0630378Y2 JPH0630378Y2 JP11968085U JP11968085U JPH0630378Y2 JP H0630378 Y2 JPH0630378 Y2 JP H0630378Y2 JP 11968085 U JP11968085 U JP 11968085U JP 11968085 U JP11968085 U JP 11968085U JP H0630378 Y2 JPH0630378 Y2 JP H0630378Y2
- Authority
- JP
- Japan
- Prior art keywords
- axis
- hand
- arm
- around
- operator
- 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.)
- Expired - Lifetime
Links
Description
【考案の詳細な説明】 A.産業上の利用分野 本考案は、マスター・スレーブマニプレータにおけるマ
スターマニプレータに関する。
スターマニプレータに関する。
B.考案の概要 この考案は、操作者がマスターマニプレータを操作する
とスレーブマニプレータがマスターマニプレータの動き
と類似の動作をするマスター・スレーブマニプレータに
おける前記マスターマニプレータにおいて、 操作者の手首の曲げ,傾け,ねじりに応じて回動する部
材の回動軸心が一点で交差するようにし、各回動部材の
回動角度等を検出するための検出手段を具えることによ
り、 操作者の手首の曲げ,傾け,ねじりの動作をそのまま正
確にマスターマニプレータが行ってスレーブマニプレー
タに伝達するようにしたものである。
とスレーブマニプレータがマスターマニプレータの動き
と類似の動作をするマスター・スレーブマニプレータに
おける前記マスターマニプレータにおいて、 操作者の手首の曲げ,傾け,ねじりに応じて回動する部
材の回動軸心が一点で交差するようにし、各回動部材の
回動角度等を検出するための検出手段を具えることによ
り、 操作者の手首の曲げ,傾け,ねじりの動作をそのまま正
確にマスターマニプレータが行ってスレーブマニプレー
タに伝達するようにしたものである。
C.従来の技術 原子力施設等のように人が立ち入ることのできない場所
で作業をする場合にはマニプレータが用いられる。マニ
プレータには、操作者が放射性雰囲気外でマスターマニ
プレータを操作すると放射性雰囲気下にあるスレーブマ
ニプレータがマスターマニプレータと類似の動きをして
作業を行うマスター・スレーブマニプレータがある。
で作業をする場合にはマニプレータが用いられる。マニ
プレータには、操作者が放射性雰囲気外でマスターマニ
プレータを操作すると放射性雰囲気下にあるスレーブマ
ニプレータがマスターマニプレータと類似の動きをして
作業を行うマスター・スレーブマニプレータがある。
従来のマスターマニプレータとしては第5図に示すもの
がある。図のようにアーム50の先端にx軸まわりに回
動自在な中間部材51が設けられ、中間部材51には紙
面と直角なy軸まわりに回動自在なハンド52が取り付
けられる。ハンド52にはz軸まわりに回動自在なグリ
ップ53が取り付けられる。操作者が腕54を保持部材
55a,55bを介してアーム50に固定し、グリップ
53を手56で握ったのちに手首を曲げたり、曲げと直
角な方向へ傾けたり、手首のまわりにねじったりする
と、ハンド52がx軸まわりに回動したり、y軸まわり
に回動したり、グリップ53がz軸まわりに回動したり
する。これらのx,y,z軸まわりの回動角度が図示し
ないセンサで検出され、その検出信号がスレーブマニプ
レータへ送られ、これによってスレーブマニプレータが
マスターマニプレータと類似の動作をする。
がある。図のようにアーム50の先端にx軸まわりに回
動自在な中間部材51が設けられ、中間部材51には紙
面と直角なy軸まわりに回動自在なハンド52が取り付
けられる。ハンド52にはz軸まわりに回動自在なグリ
ップ53が取り付けられる。操作者が腕54を保持部材
55a,55bを介してアーム50に固定し、グリップ
53を手56で握ったのちに手首を曲げたり、曲げと直
角な方向へ傾けたり、手首のまわりにねじったりする
と、ハンド52がx軸まわりに回動したり、y軸まわり
に回動したり、グリップ53がz軸まわりに回動したり
する。これらのx,y,z軸まわりの回動角度が図示し
ないセンサで検出され、その検出信号がスレーブマニプ
レータへ送られ、これによってスレーブマニプレータが
マスターマニプレータと類似の動作をする。
D.考案が解決しようとする課題 ところが、曲げ部,傾け部,ねじり部の3つの自由度を
構成する部分が分散して設けられており、操作をする手
と比較してみると手は手首の一点を通る3軸を軸心とし
て曲げ,傾け,ねじりの各動作をするのに対し、マスタ
ーマニプレータは一点で交わらないx,y,z軸を軸心
として曲げ,傾け,ねじりの各動作を行うことになる。
このため、例えばx軸まわりに曲げる場合には中間部材
51を含んだハンド52より先の部分を全て回動させる
ことになり回動させる部分の重量が重くて操作上の慣性
力が大きく、また操作者の手の動きに合った動きが得ら
れず操作性が悪い。
構成する部分が分散して設けられており、操作をする手
と比較してみると手は手首の一点を通る3軸を軸心とし
て曲げ,傾け,ねじりの各動作をするのに対し、マスタ
ーマニプレータは一点で交わらないx,y,z軸を軸心
として曲げ,傾け,ねじりの各動作を行うことになる。
このため、例えばx軸まわりに曲げる場合には中間部材
51を含んだハンド52より先の部分を全て回動させる
ことになり回動させる部分の重量が重くて操作上の慣性
力が大きく、また操作者の手の動きに合った動きが得ら
れず操作性が悪い。
そこで本考案は、斯かる欠点を解消したマスターマニプ
レータを提供することを目的とする。
レータを提供することを目的とする。
E.課題を解決するための手段 斯る目的を達成するための本考案の構成は、操作者の手
首の曲げの軸心,傾けの軸心,ねじりの軸心を順に操作
者の手首の基準点で相互に直交するx,y,z軸として
想定し、操作者の腕の動きと対応して動くアームの先端
に、x軸に対してもy軸に対しても回動自在なハンドを
結合するとともに操作者の手で握るグリップをねじり軸
を介してz軸のまわりに回動自在にハンドに取り付ける
一方、アームの先端部に設けられるとともに基準点での
曲げ,傾けの動作を置き換える位置としての置換点で相
互に直交して前記x,y,z軸に平行なx′,y′,
z′を想定し、z′軸上に具えられる連動部材を置換点
を中心としてx′軸及びy′軸のまわりに回動自在にア
ームの先端部に取り付け、ハンドの中心線と連動部材の
中心線とが平行四辺形の対向する二辺を形成するよう
に、ハンドの中心線及び連結部材の中心線を含む面と略
直角なピンを介して連結部材により、連動部材の先端部
とハンドの先端部とを連結し、x′軸,y′軸まわりの
連動部材の回動角度等を検出する第一,第二検出手段を
アームに具え、z軸まわりのねじり軸の回動角度等を検
出する第三検出手段をアームに具えるとともに連動部材
及び連結部材にわたって設けられた回転伝達手段を介し
てねじり軸と第三検出手段とを連動連結したことを特徴
とする。
首の曲げの軸心,傾けの軸心,ねじりの軸心を順に操作
者の手首の基準点で相互に直交するx,y,z軸として
想定し、操作者の腕の動きと対応して動くアームの先端
に、x軸に対してもy軸に対しても回動自在なハンドを
結合するとともに操作者の手で握るグリップをねじり軸
を介してz軸のまわりに回動自在にハンドに取り付ける
一方、アームの先端部に設けられるとともに基準点での
曲げ,傾けの動作を置き換える位置としての置換点で相
互に直交して前記x,y,z軸に平行なx′,y′,
z′を想定し、z′軸上に具えられる連動部材を置換点
を中心としてx′軸及びy′軸のまわりに回動自在にア
ームの先端部に取り付け、ハンドの中心線と連動部材の
中心線とが平行四辺形の対向する二辺を形成するよう
に、ハンドの中心線及び連結部材の中心線を含む面と略
直角なピンを介して連結部材により、連動部材の先端部
とハンドの先端部とを連結し、x′軸,y′軸まわりの
連動部材の回動角度等を検出する第一,第二検出手段を
アームに具え、z軸まわりのねじり軸の回動角度等を検
出する第三検出手段をアームに具えるとともに連動部材
及び連結部材にわたって設けられた回転伝達手段を介し
てねじり軸と第三検出手段とを連動連結したことを特徴
とする。
F.作用 操作者がグリップを握って手首を曲げると、ハンドがx
軸まわりに回動すると同時に連動部材がハンドと連動し
てx′軸まわりに回動し、検出手段によって連動部材の
回動角度や回転トルクつまりはハンドの回動角度等が検
出される。また、手首を曲げの方向と直角な方向へ傾け
ると、ハンドがy軸まわりに回動すると同時に連動部材
がハンドと連動してy′軸まわりに回動し、前記と同様
にしてその回動角度等が検出される。また、グリップを
握って手首をねじると、グリップがz軸まわりに回動し
て検出手段によりねじり角度等が検出される。これらの
x,y,z軸まわりのハンド又はグリップの回動は夫々
独立しており、x,y,z軸は人の手の曲げ,傾け,ね
じりの軸心の交点を通るので、操作者の手の動きをその
まま正確にスレーブマニプレータに伝達することができ
る。
軸まわりに回動すると同時に連動部材がハンドと連動し
てx′軸まわりに回動し、検出手段によって連動部材の
回動角度や回転トルクつまりはハンドの回動角度等が検
出される。また、手首を曲げの方向と直角な方向へ傾け
ると、ハンドがy軸まわりに回動すると同時に連動部材
がハンドと連動してy′軸まわりに回動し、前記と同様
にしてその回動角度等が検出される。また、グリップを
握って手首をねじると、グリップがz軸まわりに回動し
て検出手段によりねじり角度等が検出される。これらの
x,y,z軸まわりのハンド又はグリップの回動は夫々
独立しており、x,y,z軸は人の手の曲げ,傾け,ね
じりの軸心の交点を通るので、操作者の手の動きをその
まま正確にスレーブマニプレータに伝達することができ
る。
G.実施例 以下、本考案を図面に示す実施例に基づいて詳細に説明
する。
する。
この考案は、人の手における手首の曲げ,傾け,ねじり
の3自由度の夫々の軸心が一点(以下、基準点とする)
で交わっていることから、3自由度を有するマスターマ
ニプレータの軸心も基準点で交わるようにしたものであ
る。
の3自由度の夫々の軸心が一点(以下、基準点とする)
で交わっていることから、3自由度を有するマスターマ
ニプレータの軸心も基準点で交わるようにしたものであ
る。
人の手首は、曲げと傾けとねじりを行うことができ、ね
じりは手首よりも肘に近い部分で行われるが、マニプレ
ータの指部は限られたつかみの自由度しか有しないのが
一般的であり手首を曲げた状態で指部を回転させる必要
があるため、一般的にねじりの機構は手首よりも指先に
近い部分に設けられる。
じりは手首よりも肘に近い部分で行われるが、マニプレ
ータの指部は限られたつかみの自由度しか有しないのが
一般的であり手首を曲げた状態で指部を回転させる必要
があるため、一般的にねじりの機構は手首よりも指先に
近い部分に設けられる。
第1図〜第4図に本考案によるマスターマニプレータの
実施例を示す。
実施例を示す。
図において操作者の手首の曲げの軸心をx軸とし、傾け
の軸心をy軸とし、ねじりの軸心をz軸とすると、x,
y,z軸は夫々一点(基準点P)で相互に直交する。
の軸心をy軸とし、ねじりの軸心をz軸とすると、x,
y,z軸は夫々一点(基準点P)で相互に直交する。
図中、1はアームであり、アーム1は操作者の腕2aの
甲側に腕2aと略平行に設けられる。そして、操作者の
腕2aをおいたときのx軸及びy軸まわりに回動自在な
状態で、ハンド3がアーム1の先端部に取り付けられ
る。即ち、アーム1の一方側にy軸を中心として回動自
在なL字形部材5が補助部材4を介して取り付けられ、
L字形部材5にはx軸を中心として回動自在なL字形の
ハンド3が取り付けられる。
甲側に腕2aと略平行に設けられる。そして、操作者の
腕2aをおいたときのx軸及びy軸まわりに回動自在な
状態で、ハンド3がアーム1の先端部に取り付けられ
る。即ち、アーム1の一方側にy軸を中心として回動自
在なL字形部材5が補助部材4を介して取り付けられ、
L字形部材5にはx軸を中心として回動自在なL字形の
ハンド3が取り付けられる。
ハンド3には、z軸を中心として回動自在にグリップ6
が取り付けられている。即ち、ハンド3の先端部には補
強のための円筒部7が形成され、円筒部7内の孔8には
グリップ6と一体のねじり軸9が回動自在に挿通されて
いる。グリップ6は操作者の手2bが握れるように把持
部6aを有する口の字形となっており、スレーブマニプ
レータに各種の動作指令を出すためのスイッチレバー1
0やスイッチボタン11が設けられる。
が取り付けられている。即ち、ハンド3の先端部には補
強のための円筒部7が形成され、円筒部7内の孔8には
グリップ6と一体のねじり軸9が回動自在に挿通されて
いる。グリップ6は操作者の手2bが握れるように把持
部6aを有する口の字形となっており、スレーブマニプ
レータに各種の動作指令を出すためのスイッチレバー1
0やスイッチボタン11が設けられる。
一方、アーム1の先端部の置換点Qにはハンド3と連動
して類似の動作をする連動部材12が具えられる。この
ように連動部材12を設けるのは、アーム1とは離れた
操作者の手首の位置である基準点Pを中心として回動す
るハンド3の回動をそのままハンド3上の置換点Qで連
動部材12の回動に置換するためである。このように基
準点Pにおける回動を置換点Qにおける回動に置換した
のは、後述するトルクセンサ等の制御部をハンド3に取
り付けることなくアーム1に取り付けてハンド3の軽量
化を図るためである。置換点Qで相互に直交してx.
y.z軸に平行なx′,y,z′軸を想定すると(本実
施例ではy′軸はy軸に一致する)、z′軸上に配置さ
れた連動部材12が置換点Qを中心としてx′軸及びy
軸のまわりに回動自在にアーム1の先端部に取り付けら
れる。即ち、アーム1の先端にx′軸まわりに回動自在
に中間部材13が取り付けられ、中間部材13にはy軸
まわりに回動自在に連動部材12が取り付けられる。連
動部材12はz′軸に沿って伸びる回動部12aと、1
/4の略円を形成する円弧部12bと、軸部12cとか
ら構成されており、y軸を軸心とする軸部12cが中間
部材13内に回動自在に嵌め込まれる。この連動部材1
2の先端部とハンド3の先端部とが連結部材15を介し
て連結される。即ち、連動部材12の先端部と前述した
円筒部7とがx軸と平行な合計4本のピン14(第2
図,第3図参照)を介して連結部材15によって連結さ
れる。これにより、第1図中のX軸,X′軸,ピン1
4,ピン14が平行四辺形を形成する。
して類似の動作をする連動部材12が具えられる。この
ように連動部材12を設けるのは、アーム1とは離れた
操作者の手首の位置である基準点Pを中心として回動す
るハンド3の回動をそのままハンド3上の置換点Qで連
動部材12の回動に置換するためである。このように基
準点Pにおける回動を置換点Qにおける回動に置換した
のは、後述するトルクセンサ等の制御部をハンド3に取
り付けることなくアーム1に取り付けてハンド3の軽量
化を図るためである。置換点Qで相互に直交してx.
y.z軸に平行なx′,y,z′軸を想定すると(本実
施例ではy′軸はy軸に一致する)、z′軸上に配置さ
れた連動部材12が置換点Qを中心としてx′軸及びy
軸のまわりに回動自在にアーム1の先端部に取り付けら
れる。即ち、アーム1の先端にx′軸まわりに回動自在
に中間部材13が取り付けられ、中間部材13にはy軸
まわりに回動自在に連動部材12が取り付けられる。連
動部材12はz′軸に沿って伸びる回動部12aと、1
/4の略円を形成する円弧部12bと、軸部12cとか
ら構成されており、y軸を軸心とする軸部12cが中間
部材13内に回動自在に嵌め込まれる。この連動部材1
2の先端部とハンド3の先端部とが連結部材15を介し
て連結される。即ち、連動部材12の先端部と前述した
円筒部7とがx軸と平行な合計4本のピン14(第2
図,第3図参照)を介して連結部材15によって連結さ
れる。これにより、第1図中のX軸,X′軸,ピン1
4,ピン14が平行四辺形を形成する。
アーム1には、第一制御部16,第二制御部17,第三
制御部18が設けられる。
制御部18が設けられる。
第一制御部16内にはハンド3の曲げ角度等を検出する
第一検出手段等が内蔵されており、第一制御部16の回
転軸に取り付けられたプーリ19と中間部材13に一体
に形成されたプーリ13aとの間にベルト21が巻き掛
けられる。
第一検出手段等が内蔵されており、第一制御部16の回
転軸に取り付けられたプーリ19と中間部材13に一体
に形成されたプーリ13aとの間にベルト21が巻き掛
けられる。
また、第二制御部17内にはハンド3の傾け角度等を検
出する第二検出手段等が内蔵されており、軸部12cを
中心とする連動部材12の回動運動が第二制御部17へ
伝わるようになっている。第3図に示すように、x′軸
を軸心として傘歯車22aとプーリ22bを有する伝達
歯車22が回転自在に設けられ、傘歯車22aは軸部1
2cと一体の傘歯車12dと噛み合う。一方、プーリ2
2bと第二制御部17の回転軸に取り付けられたプーリ
23との間にベルト24が巻き掛けられる。
出する第二検出手段等が内蔵されており、軸部12cを
中心とする連動部材12の回動運動が第二制御部17へ
伝わるようになっている。第3図に示すように、x′軸
を軸心として傘歯車22aとプーリ22bを有する伝達
歯車22が回転自在に設けられ、傘歯車22aは軸部1
2cと一体の傘歯車12dと噛み合う。一方、プーリ2
2bと第二制御部17の回転軸に取り付けられたプーリ
23との間にベルト24が巻き掛けられる。
第三制御部18内にはグリップ6の回動角度等を検出す
る第三検出手段等が内蔵されており、回転伝達手段を介
してねじり軸9に連動連結される。このように第三制御
部18をアーム1内に設けてねじり軸9と第三制御部1
8とを回転伝達手段を介して連動連結したのも、第一,
第二制御部16,17と同じ理由であり、ハンド6に取
り付けるとハンド6が重くなるからである。以下に回転
伝達手段について説明する。連動部材12の回動部12
a内には傘歯車25aを有する軸25が回転自在に具え
られ、一方、軸部12c内には傘歯車26aと26bと
を有する伝達歯車26が回転自在に具えられ、円弧部1
2b内に回転自在に具えられた傘歯車27,28を介し
て軸25の回転運動が伝達歯車26へ伝わるようになっ
ている。傘歯車26bは、x′軸を中心として回動自在
に具えられる伝達歯車29の傘歯車29aと噛み合う。
そして、傘歯車29aと一体のプーリ29bと第三制御
部18の回転軸に取り付けられたプーリ30との間にベ
ルト31が巻き掛けられる。一方、ねじり軸9と軸25
との上部は、連結部材15内に回転自在に具えられると
ともにプーリ32を有する一対の軸33の下端にユニバ
ーサルジョイント34を介して夫々結合され、プーリ3
2どうしの間にはベルト35が巻き掛けられる。なお、
プーリとベルトとに代えてスプロケットとチェンを用い
てもよい。
る第三検出手段等が内蔵されており、回転伝達手段を介
してねじり軸9に連動連結される。このように第三制御
部18をアーム1内に設けてねじり軸9と第三制御部1
8とを回転伝達手段を介して連動連結したのも、第一,
第二制御部16,17と同じ理由であり、ハンド6に取
り付けるとハンド6が重くなるからである。以下に回転
伝達手段について説明する。連動部材12の回動部12
a内には傘歯車25aを有する軸25が回転自在に具え
られ、一方、軸部12c内には傘歯車26aと26bと
を有する伝達歯車26が回転自在に具えられ、円弧部1
2b内に回転自在に具えられた傘歯車27,28を介し
て軸25の回転運動が伝達歯車26へ伝わるようになっ
ている。傘歯車26bは、x′軸を中心として回動自在
に具えられる伝達歯車29の傘歯車29aと噛み合う。
そして、傘歯車29aと一体のプーリ29bと第三制御
部18の回転軸に取り付けられたプーリ30との間にベ
ルト31が巻き掛けられる。一方、ねじり軸9と軸25
との上部は、連結部材15内に回転自在に具えられると
ともにプーリ32を有する一対の軸33の下端にユニバ
ーサルジョイント34を介して夫々結合され、プーリ3
2どうしの間にはベルト35が巻き掛けられる。なお、
プーリとベルトとに代えてスプロケットとチェンを用い
てもよい。
前記第一制御部16,第二制御部17,第三制御部18
の内部は次のような構造になっている。即ち、プーリ1
9,23,30の取り付けられた夫々の回転軸には減速
機を介してモータが接続されており、モータの回転軸に
は回転軸の回転角度を検出するための位置センサと回転
軸の回転トルクを検出するためのトルクセンサとが設け
られる。夫々の位置センサによる回転軸の回転角度の検
出によりハンド3の曲げ角度等を検出できる。また、夫
々のトルクセンサによる回転軸の回転トルクの検出によ
りハンド3の曲げトルク等を検出できる。本実施例のマ
スタースレーブマニプレータは、マスターマニプレー
タ,スレーブマニプレータの各軸まわりの回転角度及び
回転トルクを検出し、両者のデータを比較して夫々のモ
ータを駆動するバイラテラル制御方式のものであり、し
かもマスター側とスレーブ側とのトルクの差を小さくす
る向きに力を伝えるように構成された力帰還形となって
いる。
の内部は次のような構造になっている。即ち、プーリ1
9,23,30の取り付けられた夫々の回転軸には減速
機を介してモータが接続されており、モータの回転軸に
は回転軸の回転角度を検出するための位置センサと回転
軸の回転トルクを検出するためのトルクセンサとが設け
られる。夫々の位置センサによる回転軸の回転角度の検
出によりハンド3の曲げ角度等を検出できる。また、夫
々のトルクセンサによる回転軸の回転トルクの検出によ
りハンド3の曲げトルク等を検出できる。本実施例のマ
スタースレーブマニプレータは、マスターマニプレー
タ,スレーブマニプレータの各軸まわりの回転角度及び
回転トルクを検出し、両者のデータを比較して夫々のモ
ータを駆動するバイラテラル制御方式のものであり、し
かもマスター側とスレーブ側とのトルクの差を小さくす
る向きに力を伝えるように構成された力帰還形となって
いる。
次に、斯かるマスターマニプレータの作用を説明する。
なお、説明は操作者の手首をx軸まわりに曲げた場合、
y軸まわりに傾けた場合、z軸まわりにねじった場合の
夫々に分けて行う。
なお、説明は操作者の手首をx軸まわりに曲げた場合、
y軸まわりに傾けた場合、z軸まわりにねじった場合の
夫々に分けて行う。
操作者が把持部6aを握った状態で手首をx軸まわりに
曲げた場合、ハンド3がx軸まわりに回動すると同時に
連結部材15によって連結された連動部材12がx′軸
まわりにハンド3と同一方向へ回動する。本実施例では
x軸,ユニバーサルジョイント34,34,x′軸が平
行四辺形をなしており、そのために連動部材12はハン
ド3と同一方向へ同一角度だけ回動する。このとき中間
部材13もx′軸まわりに回動するので、中間部材13
と一体のプーリ13aが回転し、プーリ13aの回転運
動はベルト21,プーリ19を介して第一制御部16へ
伝わる。すると、第一制御部16内の第一検出手段とし
ての位置センサ,トルクセンサがハンド3の曲げ角度と
トルクとを検出する。
曲げた場合、ハンド3がx軸まわりに回動すると同時に
連結部材15によって連結された連動部材12がx′軸
まわりにハンド3と同一方向へ回動する。本実施例では
x軸,ユニバーサルジョイント34,34,x′軸が平
行四辺形をなしており、そのために連動部材12はハン
ド3と同一方向へ同一角度だけ回動する。このとき中間
部材13もx′軸まわりに回動するので、中間部材13
と一体のプーリ13aが回転し、プーリ13aの回転運
動はベルト21,プーリ19を介して第一制御部16へ
伝わる。すると、第一制御部16内の第一検出手段とし
ての位置センサ,トルクセンサがハンド3の曲げ角度と
トルクとを検出する。
操作者が把持部6aを握った状態で手首を傾けた場合、
ハンド3がy軸まわりに回動すると同時に連結部材15
を介して連結された連動部材12が軸部12cを中心と
してハンド3と同一方向へ回動する。この場合も連動部
材12はハンド3と一体になって回動し、連動部材12
は中間部材13を介してアーム1に取り付けられている
ので、x′軸まわりに回動した状態でかつ軸部12cま
わりに回動させることができる。連動部材12が軸部1
2cまわりに回動すると、連動部材12と一体の傘歯車
12dが回動し、傘歯車12dの回転運動は傘歯車22
a,プーリ22b,ベルト24,プーリ23を介して第
二制御部17へと伝わる。すると第二制御部17内の第
二検出手段としての位置センサ,トルクセンサがハンド
3の傾け角度とトルクとを検出する。
ハンド3がy軸まわりに回動すると同時に連結部材15
を介して連結された連動部材12が軸部12cを中心と
してハンド3と同一方向へ回動する。この場合も連動部
材12はハンド3と一体になって回動し、連動部材12
は中間部材13を介してアーム1に取り付けられている
ので、x′軸まわりに回動した状態でかつ軸部12cま
わりに回動させることができる。連動部材12が軸部1
2cまわりに回動すると、連動部材12と一体の傘歯車
12dが回動し、傘歯車12dの回転運動は傘歯車22
a,プーリ22b,ベルト24,プーリ23を介して第
二制御部17へと伝わる。すると第二制御部17内の第
二検出手段としての位置センサ,トルクセンサがハンド
3の傾け角度とトルクとを検出する。
操作者が把持部6aを握った状態で手首をねじった場
合、グリップ6がz軸まわりに回動し、グリップ6の回
転はねじり軸9,ユニバーサルジョイント34,軸3
3,プーリ32,ベルト35,プーリ32,軸33,ユ
ニバーサルジョイント34を介して軸25へ伝わる。軸
33とねじり軸9及び軸33と軸25はユニバーサルジ
ョイント34によって連結されているので、軸33とね
じり軸9及び軸33と軸25のなす角度が変わっても滑
らかに回転運動を伝えることができる。軸25の回転
は、傘歯車25a,27,28,26a,26b,29
a、プーリ29b,ベルト31,プーリ30を介して第
三制御部18へと伝わる。すると第三制御部18内の第
三検出手段としての位置センサ,トルクセンサがグリッ
プ6のねじり角度とトルクとを検出する。
合、グリップ6がz軸まわりに回動し、グリップ6の回
転はねじり軸9,ユニバーサルジョイント34,軸3
3,プーリ32,ベルト35,プーリ32,軸33,ユ
ニバーサルジョイント34を介して軸25へ伝わる。軸
33とねじり軸9及び軸33と軸25はユニバーサルジ
ョイント34によって連結されているので、軸33とね
じり軸9及び軸33と軸25のなす角度が変わっても滑
らかに回転運動を伝えることができる。軸25の回転
は、傘歯車25a,27,28,26a,26b,29
a、プーリ29b,ベルト31,プーリ30を介して第
三制御部18へと伝わる。すると第三制御部18内の第
三検出手段としての位置センサ,トルクセンサがグリッ
プ6のねじり角度とトルクとを検出する。
前述した手首の曲げ,傾け,ねじりに対するマスターマ
ニプレータの動きは夫々別個に独立しているので、これ
らの動きを組み合わせて操作者の手と同じ複雑な動きを
させることができ、その回動角度とトルクとを各検出手
段で検出し検出値に基づいた指令を図示しないスレーブ
マニプレータへ送って電気サーボ等で駆動させることが
できる。また、スレーブマニプレータに作業を行わせた
ときの反力をマスターマニプレータに送って夫々の制御
部内のモータを回転させることで操作者に反力を伝える
ことができる(バイラテラル制御方式)。
ニプレータの動きは夫々別個に独立しているので、これ
らの動きを組み合わせて操作者の手と同じ複雑な動きを
させることができ、その回動角度とトルクとを各検出手
段で検出し検出値に基づいた指令を図示しないスレーブ
マニプレータへ送って電気サーボ等で駆動させることが
できる。また、スレーブマニプレータに作業を行わせた
ときの反力をマスターマニプレータに送って夫々の制御
部内のモータを回転させることで操作者に反力を伝える
ことができる(バイラテラル制御方式)。
なお、本実施例では手首の曲げをハンド3のx軸まわり
の回動に対応させた場合を示したが手首の曲げをy軸ま
わりの回動に対応させるようにすることもできる。つま
り、第1図において、操作者の手2bの甲を紙面に対し
手前側あるいはむこう側へ向けて使用する構成にするこ
とが可能である。このほか、回転伝達手段は連結部材及
び連動部材の内部に具えているので、各部材の動きによ
って回転運動が妨害されることはない。
の回動に対応させた場合を示したが手首の曲げをy軸ま
わりの回動に対応させるようにすることもできる。つま
り、第1図において、操作者の手2bの甲を紙面に対し
手前側あるいはむこう側へ向けて使用する構成にするこ
とが可能である。このほか、回転伝達手段は連結部材及
び連動部材の内部に具えているので、各部材の動きによ
って回転運動が妨害されることはない。
H.考案の効果 以上説明したように本考案によれば、操作者の手首の曲
げ,傾け,ねじりの軸心として相互に一点(基準点)で
直交するx,y,z軸を中心として回動自在なハンドと
グリップとを操作者の腕の動きと対応して動くアームの
先端に具えるとともに曲げ,傾け,ねじりの角度等を検
出する検出手段を具えているので、操作者の手の動きを
そのままマスターマニプレータに追従させて手首の曲げ
角度等を正確に検出できる。つまり、手首の曲げ,傾
け,ねじりの方向と角度とトルクとがそのままマスター
マニプレータの手首の曲げ,傾け,ねじりの方向と角度
とトルクとであり、極めて直感的な操作が可能である。
また、曲げ,傾け,ねじりの角度等を検出する検出手段
をアームに設けハンドの先端部に配置していないので、
マスターマニプレータを操作する上での慣性が小さく、
操作性がよい。
げ,傾け,ねじりの軸心として相互に一点(基準点)で
直交するx,y,z軸を中心として回動自在なハンドと
グリップとを操作者の腕の動きと対応して動くアームの
先端に具えるとともに曲げ,傾け,ねじりの角度等を検
出する検出手段を具えているので、操作者の手の動きを
そのままマスターマニプレータに追従させて手首の曲げ
角度等を正確に検出できる。つまり、手首の曲げ,傾
け,ねじりの方向と角度とトルクとがそのままマスター
マニプレータの手首の曲げ,傾け,ねじりの方向と角度
とトルクとであり、極めて直感的な操作が可能である。
また、曲げ,傾け,ねじりの角度等を検出する検出手段
をアームに設けハンドの先端部に配置していないので、
マスターマニプレータを操作する上での慣性が小さく、
操作性がよい。
第1図〜第4図は本考案によるマスターマニプレータの
実施例に係り、第1図は一部破断して示す構造図、第2
図は第1図のI−I矢視図、第3図は手首を傾けた状態
を一部破断して示す第1図のII−II矢視図、第4図は拡
大して示す第3図のIII−III矢視断面図、第5図は従来
のマスターマニプレータの構造図である。 1……アーム、2a……腕、3……ハンド、4……補助
部材、6……グリップ、9……ねじり軸、12……連動
部材、13……中間部材、15……連結部材、16……
第一制御部、17……第二制御部、18……第三制御
部、25……軸、25a,27,28,26a……傘歯
車、26……伝達歯車、32……プーリ、34……ユニ
バーサルジョイント、35……ベルト。
実施例に係り、第1図は一部破断して示す構造図、第2
図は第1図のI−I矢視図、第3図は手首を傾けた状態
を一部破断して示す第1図のII−II矢視図、第4図は拡
大して示す第3図のIII−III矢視断面図、第5図は従来
のマスターマニプレータの構造図である。 1……アーム、2a……腕、3……ハンド、4……補助
部材、6……グリップ、9……ねじり軸、12……連動
部材、13……中間部材、15……連結部材、16……
第一制御部、17……第二制御部、18……第三制御
部、25……軸、25a,27,28,26a……傘歯
車、26……伝達歯車、32……プーリ、34……ユニ
バーサルジョイント、35……ベルト。
Claims (1)
- 【請求項1】操作者の手首の曲げの軸心,傾けの軸心,
ねじりの軸心を順に操作者の手首の基準点で相互に直交
するx,y,z軸として想定し、 操作者の腕の動きと対応して動くアームの先端に、x軸
に対してもy軸に対しても回動自在なハンドを結合する
とともに操作者の手で握るグリップをねじり軸を介して
z軸のまわりに回動自在にハンドに取り付ける一方、 アームの先端部に設けられるとともに基準点での曲げ,
傾けの動作を置き換える位置としての置換点で相互に直
交して前記x,y,z軸に平行なx′,y′,z′を想
定し、 z′軸上に具えられる連動部材を置換点を中心として
x′軸及びy′軸のまわりに回動自在にアームの先端部
に取り付け、ハンドの中心線と連動部材の中心線とが平
行四辺形の対向する二辺を形成するように、ハンドの中
心線及び連結部材の中心線を含む面と略直角なピンを介
して連結部材により、連動部材の先端部とハンドの先端
部とを連結し、 x′軸,y′軸まわりの連動部材の回動角度等を検出す
る第一,第二検出手段をアームに具え、z軸まわりのね
じり軸の回動角度等を検出する第三検出手段をアームに
具えるとともに連動部材及び連結部材にわたって設けら
れた回転伝達手段を介してねじり軸と第三検出手段とを
連動連結したことを特徴とするマスターマニプレータ。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP11968085U JPH0630378Y2 (ja) | 1985-08-03 | 1985-08-03 | マスタ−マニプレ−タ |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP11968085U JPH0630378Y2 (ja) | 1985-08-03 | 1985-08-03 | マスタ−マニプレ−タ |
Publications (2)
Publication Number | Publication Date |
---|---|
JPS6229285U JPS6229285U (ja) | 1987-02-21 |
JPH0630378Y2 true JPH0630378Y2 (ja) | 1994-08-17 |
Family
ID=31007276
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP11968085U Expired - Lifetime JPH0630378Y2 (ja) | 1985-08-03 | 1985-08-03 | マスタ−マニプレ−タ |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH0630378Y2 (ja) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2685602B2 (ja) * | 1988-10-19 | 1997-12-03 | 株式会社日立製作所 | マスタースレーブマニピュレータシステム |
-
1985
- 1985-08-03 JP JP11968085U patent/JPH0630378Y2/ja not_active Expired - Lifetime
Also Published As
Publication number | Publication date |
---|---|
JPS6229285U (ja) | 1987-02-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP0364947B1 (en) | Master slave manipulator system | |
JP2610094B2 (ja) | 産業用マニプレータの制御装置 | |
EP0044737B2 (en) | Articulated robot | |
JP4323056B2 (ja) | 多指ハンド装置の制御装置 | |
JPH0367839B2 (ja) | ||
JPH11156778A (ja) | ロボットハンド | |
JPH0443746B2 (ja) | ||
US11221642B2 (en) | Manipulating device | |
WO1999033617A1 (fr) | Structure de bras pour robots de travail a morphologie de type humain | |
JP3585419B2 (ja) | マスターアーム装置 | |
JP2019093502A (ja) | 操作装置 | |
JP2011062788A (ja) | マニピュレータ装置およびマニピュレータの制御方法 | |
JPH0630378Y2 (ja) | マスタ−マニプレ−タ | |
JPS61252093A (ja) | 産業用ロボツトの手首機構 | |
JPS59166493A (ja) | 工業用ロボツト | |
JPH07276265A (ja) | マニピュレータ操作装置 | |
JPH0540956Y2 (ja) | ||
JPH0677205B2 (ja) | ロボツトの制御方法 | |
JP3573731B2 (ja) | マスタアーム用手首機構 | |
JPH07124877A (ja) | マスタスレーブ形マニプレータのスレーブアーム | |
JPH0857779A (ja) | 遠隔操作装置 | |
JPH01234186A (ja) | マスタアーム | |
JPH0544073Y2 (ja) | ||
JPS5959365A (ja) | マスタスレ−ブ形マニピユレ−タの手首機構 | |
JPH035438Y2 (ja) |