JPH0111434Y2 - - Google Patents

Description

【考案の詳細な説明】 この考案は上膊部と下膊部を有する多関節形マ
ニピユレータに関するもので、さらに詳しくは上
記上膊部と下膊部を枢支する肘関節部で受ける下
膊部、及び下膊部の先に付く端機構等の重力によ
る１次モーメント力を反対方向の力を加えてでき
るだけ消去し、肘関節部を駆動する電気モータの
負荷を軽減せんとするものである。

ここにいう多関節形マニピユレータとは基本的
には側面から見た場合に第１図の如き構造のもの
を指しており、第１図にあげた実施例では床面等
に固定されるベース１に対し床面に垂直な軸周り
に回転する本体２が取付けられており、これに肩
関節部３を介して上膊部４が接続され、これに肘
関節部５を介して下膊部６が接続され、その先に
回動可能な把持機構等の端機構７が接続されてい
る。

第１図において上膊部４は本体２に対して肩関
節部３においてそれを駆動する電気モータによつ
て矢印Ａ方向に回転し、下膊部６は上膊部４に対
して肘関節部５においてそれを駆動する電気モー
タによつて矢印Ｂ方向に回転するが、これらの駆
動用の電気モータとその駆動機構は第１図では省
略されている。

第１図の構成において、上膊部４および下膊部
６は静止状態でも肩関節部３および肘関節部５は
重力による時計方向の１次モーメント力をそれぞ
れを駆動する電気モータに与えており、運転状態
に入れば質量の２次モーメント力（慣性モーメン
ト力）の他に前述の１次モーメント力をも負荷さ
れるが、後者は無駄な負荷であるため前者だけを
駆動する場合に対して大きな出力を取り出せる電
気モータと駆動機構を使用せざるを得ず、製作費
用および駆動電力の無駄使いとなる。

この考案は、下膊部６の自重による１次モーメ
ント力を消去しようとするものである。この１次
モーメント力の消去方法としては空気圧、スプリ
ング等により重力と逆方向の補償力を加えるダイ
ナミツク・バランス方式と、関節部において重力
による１次モーメント力が殆んど発生しないよう
に質量分布を設計するスタテイツク・バランス方
式があるが、ここではダイナミツク・バランス方
式につき説明する。

さて、肘関節部５に働く１次モーメントは下膊
部６が水平の位置で最大となり、垂直の位置で零
となる。従つて、肩関節部３では本体２の上膊部
４のなす相対角度に応じて上膊部４が床面に水平
なとき最大となり、上膊部４が床面に垂直に上方
を向いたとき零となるような補償力を与えてやれ
ばほぼ満足な特性を持つダイナミツク・バラツス
方式を容易に実施できる。

しかしながら肘関節部５の場合は上膊部４自体
が床面に対しいかなる角度をとるが自由であるた
め上膊部４と下膊部６のなす相対角度に応じる補
償力では重力による１次モーメント力を消去する
ことができない。すなわち、肘関節部５でのダイ
ナミツク・バランスは床面に対する下膊部６の相
対角度に応じる補償力でなくてはならない。この
考案はこのような肘関節の１次モーメントのダイ
ナミツク・バランス方式を簡単な構成で、確実に
実現するものである。

以下にこの考案になる多関節形マニピユレータ
の構造の詳細について説明する。第２図はこの発
明の一実施例を示したものである。なお、第２図
では上膊部４の１次モーメント力を消去する手段
については省略してある。第２図において第１の
鎖車８はその中心を肘関節部５の回転中心と一致
させ、下膊部６に固定されている。

また第２の鎖車９は前述第１の鎖車８と同一
径、同一ピツチであるがその中心を肩関節部３の
回転中心と一致させかつ自由回転するものであ
る。

前述２個の鎖車８，９をこれらに適合するチエ
ーンあるいはタイミング・ベルト等の伝達機構１
０で連結することにより第２の鎖車９の回転は上
膊部４の床面に対する角度変化には全く無関係で
あるが、下膊部６の床面に対する角度変化に均等
な角度変化をなすようになる。

いま、本体２の一部に掛金１１を設け、これと
肩関節部３の回転中心を結ぶ直線１２に対して第
２図の如く下膊部６が床面に水平で相対角度零の
場合に第２の鎖車９自体あるいはそれに連結した
部分に前述回転中心を通り前述直線に直角な線上
に掛金１３を設け、前述２個の掛金１１，１３間
にこの位置関係で下膊部６の重力による１次モー
メントをほぼ消去できる力を発生するスプリング
１４を取付ける。

下膊部６が床面に対し上方向または下方向で垂
直な相対角度をとつた場合は第２の鎖車９は第２
図の状態より反時計方向に90゜または時計方向に
90゜回転して掛金１３は直線１２上に来るためス
プリング１４の引張力は第２の鎖車９に対して何
らのトルクも作用させることはない。

第２図の位置関係での相対角度を零と定義し、
スプリング１４は常に直線１２に平行に一定の力
で掛金１３を引張ると仮定すると第２の鎖車９に
作用するスプリング１４のトルクは余弦函数とし
て変化するが、一方、下膊部６が第２の鎖車９に
作用させる重力による１次モーメント力も余弦関
数として変化するので、この理想状態では肘関節
部５に加わる重力の１次モーメント力を完全に補
償できることとなる。

現実にはスプリング長が有限であるため引張力
は一定とならず、かつ掛金１３を直線１２に対し
て平行に引くことはできないため、前述理想状態
からは若干離れざるを得ないが、実用には支障の
ない１次モーメント力の軽減方式を得ることがで
きる。

なお、以上の実施例ではスプリングを使用した
が、一定の空気圧により作動する空気シリンダー
機構により同一の機能を実現することも可能であ
る。

以上、要するにこの考案によれば肘関節部での
重力による１次モーメント力を軽減することがで
き、肘障節部を駆動する電気モータの負荷を大巾
に軽減できる多関節形マニピユレータを得ること
ができる。

【図面の簡単な説明】

第１図は一般的な多関節形マニピユレータの主
要部分を示す概略側面図、第２図は第１図の多関
節形マニピユレータにこの考案を実施した場合の
一実施例を示すための概略側面図である。 １はベース、２は本体、３は肩関節部、４は上
膊部、５は肘関節部、６は下膊部、７は端機構、
８，９は鎖車、１０は伝達機構、１１は本体の掛
金、１３は鎖車の掛金、１４はスプリング。

Claims (1)

【実用新案登録請求の範囲】
1. 本体と枢支された上膊部および該上膊部と枢支
   された下膊部よりなる腕を備えた多関節マニピユ
   レータにおいて、上記上膊部と下膊部を枢支する
   肘関節部において上記下膊部に固定した第１の鎖
   車、上記本体と上膊部とを枢支する肩関節部にお
   いて自由回転する第２の鎖車を設け、上記２個の
   鎖車を同一角度回転するようにチエーンあるいは
   タイミングベルト等の伝達機構にて連結するとと
   もに、一端が本体側に固定され、他端が上記肩関
   節部の上記第２の鎖車あるいはそれに連結する部
   分に接続されて上記下膊部が重力方向に対し水平
   方向のとき上記第２の鎖車の回転中心と上記一端
   とを結ぶ直線に対してほぼ垂直な方向に上記他端
   が位置するよう設けられ、垂直方向のとき上記第
   ２の鎖車の回転中心と上記一端とを結ぶ直線上に
   上記他端が位置するよう設けられたスプリングあ
   るいは流体圧で一定力を発生するシリンダー機構
   を設けてなる多関節形マニピユレータ。