(57)【特許請求の範囲】
【請求項１】
ロボットベース側に設置されたエンドエフェクタ駆動装置とロボットベースに支持されたロボットアームの先端部に支持されたエンドエフェクタとを、ロボットアームのリンクに沿って配設したプーリとワイヤとでなる伝達経路を介して連結したエンドエフェクタ用動力伝達装置において、
ロボットアームの関節角度をエンコーダで検出し、その値に基づいて伝達経路のワイヤの配設長を算出し、
この配設長と張力センサから得られた張力値とを用いて伝達経路のワイヤの延び長を算出し、
またエンドエフェクタ駆動装置のエンコーダ値によりエンドエフェクタ駆動装置から繰出された実際の繰出し長を算出し、
この繰出し長から前記配設長を減算すると共に前記延び長を加算する演算を行い、制御の目標値から該演算結果を減算して得られた指令値をエンドエフェクタ駆動装置に指示して該エンドエフェクタ駆動装置をフィードバック制御することを特徴とするエンドエフェクタ用動力伝達方法。
【請求項２】
請求項１のエンドエフェクタ用動力伝達方法において、エンドエフェクタ用動力伝達装置の伝達経路のロボットアームの旋回関節付近に取付けられるプーリが旋回関節の回転軸の外側に同軸に配置される中空形であることを特徴とするエンドエフェクタ用動力伝達方法。
【発明の詳細な説明】
【０００１】
【発明の属する技術分野】
本発明は、ロボットの作業端末を構成するエンドエフェクタに駆動の動力を伝達するエンドエフェクタ用動力伝達方法に係る技術分野に属する。
【０００２】
【従来の技術】
最近、ロボットアームを高速，円滑，正確に動作させる手段として、エンドエフェクタを駆動する動力を起生するエンドエフェクタ駆動装置をロボットベース側に設置し、ロボットアームの手先重量を構成しているエンドエフェクタを軽量化することが広く行われている。
【０００３】
従来、エンドエフェクタ用動力伝達方法としては、例えば、前述の従来のエンドエフェクタ用動力伝達装置について、伝達経路の状況からエンドエフェクタ駆動装置をフィードバック制御するものが知られている。この従来のエンドエフェクタ用動力伝達方法は、ロボットの高性能化等に寄与している。
【０００４】
【発明が解決しようとする課題】
前述の従来のエンドエフェクタ用動力伝達方法では、伝達経路にワイヤ，プーリの構成を含む場合、ロボットアームの駆動によってワイヤが伸縮する等して動力干渉を受けてしまうという問題点がある。
【０００５】
なお、伝達経路にワイヤ，プーリの構成を採用することは、ロボットアームを軽量化し伝達経路の製造コストを低減することができるという利点がある。
【０００６】
本発明は、このような問題点を考慮してなされたもので、ロボットアームの駆動によるエンドエフェクタへの動力干渉を解消するとともに、ロボットアームを軽量化し伝達経路の製造コストを低減することのできるエンドエフェクタ用動力伝達方法を提供することを課題とする。
【０００７】
【課題を解決するための手段】
前述の課題を解決するため、本発明に係るエンドエフェクタ用動力伝達方法は、次のような手段を採用する。
【０００８】
即ち、請求項１のエンドエフェクタ用動力伝達方法は、ロボットベース側に設置されたエンドエフェクタ駆動装置とロボットベースに支持されたロボットアームの先端部に支持されたエンドエフェクタとを、ロボットアームのリンクに沿って配設したプーリとワイヤとでなる伝達経路を介して連結したエンドエフェクタ用動力伝達装置において、ロボットアームの関節角度をエンコーダで検出し、その値に基づいて伝達経路のワイヤの配設長を算出し、この配設長と張力センサから得られた張力値とを用いて伝達経路のワイヤの延び長を算出し、またエンドエフェクタ駆動装置のエンコーダ値によりエンドエフェクタ駆動装置から繰出された実際の繰出し長を算出し、この繰出し長から前記配設長を減算すると共に前記延び長を加算する演算を行い、制御の目標値から該演算結果を減算して得られた指令値をエンドエフェクタ駆動装置に指示して該エンドエフェクタ駆動装置をフィードバック制御することを特徴とする。
【０００９】
この手段では、伝達経路をワイヤ，プーリのみで構成することで、ロボットアームを軽量化し伝達経路の製造コストを低減している。そして、動力干渉により生じたワイヤの変位とワイヤの張力とからエンドエフェクタ駆動装置をフィードバック制御する。
【００１０】
また、請求項２に記載のように、請求項４のエンドエフェクタ用動力伝達方法において、エンドエフェクタ用動力伝達装置の伝達経路１ロボットアームの旋回関節付近に取付けられるプーリが旋回関節の回転軸の外側に同軸に配置される中空形であることを特徴とする。
【００１１】
この手段では、ワイヤ，プーリからなる伝達経路が少なくとも旋回関節でロボットアームの外側に配設される。
【００１２】
【発明の実施の形態】
以下、本発明に係るエンドエフェクタ用動力伝達方法の実施の形態を図面に基づいて説明する。
【００１３】
図１〜図６は、エンドエフェクタ用動力伝達装置を示すものである。
【００１４】
図１に示すように、エンドエフェクタ１を駆動する動力を起生するエンドエフェクタ駆動装置２をロボットベース３に設置してある。そして、ロボットベース３に支持されたロボットアーム４の２本のリンク４ａ，４ｂに沿ってエンドエフェクタ１を駆動する動力を伝達するワイヤ５ａ，プーリ５ｂのみで構成される伝達経路５が配設されている。
【００１５】
エンドエフェクタ１と伝達経路５との間には、コントローラ６に接続した回避機構７が連結されている。なお、コントローラ６は、ロボットアーム４の駆動装置（図示せず）に接続して、ロボットアーム４の駆動の有無を判断することができるようになっている。
【００１６】
伝達経路５は、図２に示すように、ロボットアーム４の関節４ｃが伸転関節からなる場合、プーリ５ｂが関節４ｃの回転軸と同軸に取付けられる。また、図３，図４に示すように、ロボットアーム４の関節４ｃが旋回関節からなる場合、プーリ５ｂが中空形に形成されて関節４ｃの回転軸４ｄの外側に同軸に配置される。この中空形のプーリ５ｂは、中空形の軸受が一体的に組付けられてなるもので、軸受部分がロボットアーム４の一方のリンク４ａに支持された軸受部材５ｄに回転可能に支持される。また、ロボットアーム４の両リンク４ａ，４ｂには、軸線が回転軸４ｄと直交する方向へ位置された補助プーリ５ｅがそれぞれ取付けられる。
【００１７】
この伝達経路５の構造は、全配設ラインのロボットアーム４の外側への装備が可能となる。従って、既存の様々なマニピュレータへ容易に装備することができ、汎用性が高くなる。
【００１８】
回避機構７は、図５，図６に詳細に示されるように、クラッチ７ａとブレーキ７ｂとで構成されている。クラッチ７ａは、１面がロボットアーム４の端末側のリンク４ｂに回転可能に支持された軸７ｃに固定され、対面する他の１面が前記軸７ｃに遊嵌されるとともに伝達経路５の最端末のプーリ５ｂに固定されている。最端末のプーリ５ｂは、前記軸７ｃに遊嵌されている。ブレーキ７ｂは、前記軸７ｃに拘束，開放可能な構造を内蔵して嵌装され軸７ｃの回転を阻止，許容する。なお、エンドエフェクタ１は、ハンド１ａに同軸に支持された連結用プーリ１ｂと前記軸７ｃに固定された連結用プーリ１ｃとの間に張設された連結用ワイヤ１ｄによって回避機構７に連結されている。
【００１９】
ロボットアーム４の駆動装置の駆動情報によりロボットアーム４が駆動されていると判断された場合、コントローラ６の指示で回避機構７のクラッチ７ａが切断される。この結果、回避機構７の軸７ｃが回転せず、エンドエフェクタ１が駆動されず、ロボットアーム４からの動力干渉を回避することができる。なお、このとき、コントローラ６の指示で回避機構７のブレーキ７ｂが軸７ｃの回転を阻止しているため、エンドエフェクタ１の慣性，重力等による無用の動作が阻止される。
【００２０】
また、ロボットアーム４の駆動装置の駆動情報によりロボットアーム４が停止されていると判断された場合、ロボットアーム４からの動力干渉を受けないため、コントローラ６の指示で回避機構７のクラッチ７ａが接続される。この結果、回避機構７の軸７ｃが回転し、エンドエフェクタ１が駆動される。なお、このとき、コントローラ６の指示で回避機構７のブレーキ７ｂが軸７ｃの回転を許容する。
【００２１】
図７，図８は、本発明に係るエンドエフェクタ用動力伝達方法の実施の形態を示すものである。
【００２２】
この実施の形態は、図１に示すように、前述のエンドエフェクタ用動力伝達装置の回避機構７を除いてほぼ同様に構成されたものについて、伝達経路５のワイヤ５ａの張力を検出する張力センサ８をコントローラ６に接続し、コントローラ６でエンドエフェクタ駆動装置２をフィードバック制御するように構成してある。
【００２３】
さらに、この実施の形態では、ロボットアーム４の関節４ｃのエンコーダ９から得られたエンコーダ値により、ロボットアーム４のリンク４ａ，４ｂの角度からアームの順運動学計算処理，幾何計算処理１０を行って、伝達経路５のワイヤ５ａの配設長（経路長）ａを算出する。また、この配設長ａと張力センサ８から得られた張力値とから材力計算処理１１を行って、伝達経路５のワイヤ５ａの延び長ｂを算出する。また、エンドエフェクタ駆動装置２に接続されたエンコーダ１２から得られたエンコーダ値により、エンドエフェクタ駆動装置２から伝達経路５のワイヤ５ａが実際に繰出された繰出長ｃが算出される。
【００２４】
これ等の配設長ａ，延び長ｂ，繰出長ｃは、演算されて制御の目標値ｄとさらに演算される。この演算で得られた指令値ｅは、アンプ１３で増幅されてエンドエフェクタ駆動装置２に指示される。
【００２５】
この実施の形態によると、ロボットアーム４の動力干渉により生じた伝達経路５のワイヤ５ａの変位からと、ワイヤ５ａの張力からとのエンドエフェクタ駆動装置２のフィードバック制御が総合されることになる。従って、ロボットアーム４の動力干渉を排除して、エンドエフェクタ１に対して駆動の動力を正確に伝達することができる。
【００２６】
また、特殊な機器等を設備する必要がないため、低コストでの設備が可能である。
【００２７】
【発明の効果】
以上のように、本発明に係るエンドエフェクタ用動力伝達方法は、伝達経路をワイヤ，プーリのみで構成しているため、ロボットアームを軽量化し伝達経路の製造コストを低減することができる効果がある。
【００２８】
さらに、本発明に係るエンドエフェクタ用動力伝達方法は、フィードバック制御の動力干渉に掛かる要素を含めることでエンドエフェクタに対して駆動の動力を正確に伝達することができるため、ロボットアームの駆動による動力干渉を解消することができる効果がある。
【００２９】
さらに、請求項２として、ワイヤ，プーリからなる伝達経路が少なくとも旋回関節でロボットアームの外側に配設されるため、全配設ラインのロボットアームの外側への装備が可能となり、他のロボット等へも容易に装備することができて汎用性が高くなる効果がある。
【図面の簡単な説明】
【図１】  エンドエフェクタ用動力伝達装置を示す制御構成図である。
【図２】  図１の要部の拡大断面図である。
【図３】  図２の平面図である。
【図４】  図１の伸転関節付近の詳細図である。
【図５】  図１の旋回関節付近の詳細図である。
【図６】  図５の側面断面図である。
【図７】  本発明に係るエンドエフェクタ用動力伝達方法の実施の形態を示す制御構成図である。
【図８】  図７の制御のブロック線図である。
【符号の説明】
１            エンドエフェクタ
２            エンドエフェクタ駆動装置
３            ロボットベース
４            ロボットアーム
４ａ，４ｂ    リンク
４ｃ          関節
５            伝達経路
５ａ          ワイヤ
５ｂ          プーリ
６            コントローラ
７            回避機構
【図１】
0003791682.tif 000002
【図２】
0003791682.tif 000003
【図３】
0003791682.tif 000004
【図４】
0003791682.tif 000005
【図５】
0003791682.tif 000006
【図６】
0003791682.tif 000007
【図７】
0003791682.tif 000008
【図８】
0003791682.tif 000009