JP3791682B2 - エンドエフェクタ用動力伝達方法 - Google Patents
エンドエフェクタ用動力伝達方法 Download PDFInfo
- Publication number
- JP3791682B2 JP3791682B2 JP2002099162A JP2002099162A JP3791682B2 JP 3791682 B2 JP3791682 B2 JP 3791682B2 JP 2002099162 A JP2002099162 A JP 2002099162A JP 2002099162 A JP2002099162 A JP 2002099162A JP 3791682 B2 JP3791682 B2 JP 3791682B2
- Authority
- JP
- Japan
- Prior art keywords
- end effector
- robot arm
- power transmission
- transmission path
- driving device
- 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 - Fee Related
Links
Images
Landscapes
- Manipulator (AREA)
Description
【発明の属する技術分野】
本発明は、ロボットの作業端末を構成するエンドエフェクタに駆動の動力を伝達するエンドエフェクタ用動力伝達方法に係る技術分野に属する。
【０００２】
【従来の技術】
最近、ロボットアームを高速，円滑，正確に動作させる手段として、エンドエフェクタを駆動する動力を起生するエンドエフェクタ駆動装置をロボットベース側に設置し、ロボットアームの手先重量を構成しているエンドエフェクタを軽量化することが広く行われている。
【０００３】
従来、エンドエフェクタ用動力伝達方法としては、例えば、前述の従来のエンドエフェクタ用動力伝達装置について、伝達経路の状況からエンドエフェクタ駆動装置をフィードバック制御するものが知られている。この従来のエンドエフェクタ用動力伝達方法は、ロボットの高性能化等に寄与している。
【０００４】
【発明が解決しようとする課題】
前述の従来のエンドエフェクタ用動力伝達方法では、伝達経路にワイヤ，プーリの構成を含む場合、ロボットアームの駆動によってワイヤが伸縮する等して動力干渉を受けてしまうという問題点がある。
【０００５】
なお、伝達経路にワイヤ，プーリの構成を採用することは、ロボットアームを軽量化し伝達経路の製造コストを低減することができるという利点がある。
【０００６】
本発明は、このような問題点を考慮してなされたもので、ロボットアームの駆動によるエンドエフェクタへの動力干渉を解消するとともに、ロボットアームを軽量化し伝達経路の製造コストを低減することのできるエンドエフェクタ用動力伝達方法を提供することを課題とする。
【０００７】
【課題を解決するための手段】
前述の課題を解決するため、本発明に係るエンドエフェクタ用動力伝達方法は、次のような手段を採用する。
【０００８】
即ち、請求項１のエンドエフェクタ用動力伝達方法は、ロボットベース側に設置されたエンドエフェクタ駆動装置とロボットベースに支持されたロボットアームの先端部に支持されたエンドエフェクタとを、ロボットアームのリンクに沿って配設したプーリとワイヤとでなる伝達経路を介して連結したエンドエフェクタ用動力伝達装置において、ロボットアームの関節角度をエンコーダで検出し、その値に基づいて伝達経路のワイヤの配設長を算出し、この配設長と張力センサから得られた張力値とを用いて伝達経路のワイヤの延び長を算出し、またエンドエフェクタ駆動装置のエンコーダ値によりエンドエフェクタ駆動装置から繰出された実際の繰出し長を算出し、この繰出し長から前記配設長を減算すると共に前記延び長を加算する演算を行い、制御の目標値から該演算結果を減算して得られた指令値をエンドエフェクタ駆動装置に指示して該エンドエフェクタ駆動装置をフィードバック制御することを特徴とする。
【０００９】
この手段では、伝達経路をワイヤ，プーリのみで構成することで、ロボットアームを軽量化し伝達経路の製造コストを低減している。そして、動力干渉により生じたワイヤの変位とワイヤの張力とからエンドエフェクタ駆動装置をフィードバック制御する。
【００１０】
また、請求項２に記載のように、請求項４のエンドエフェクタ用動力伝達方法において、エンドエフェクタ用動力伝達装置の伝達経路１ロボットアームの旋回関節付近に取付けられるプーリが旋回関節の回転軸の外側に同軸に配置される中空形であることを特徴とする。
【００１１】
この手段では、ワイヤ，プーリからなる伝達経路が少なくとも旋回関節でロボットアームの外側に配設される。
【００１２】
【発明の実施の形態】
以下、本発明に係るエンドエフェクタ用動力伝達方法の実施の形態を図面に基づいて説明する。
【００１３】
図１〜図６は、エンドエフェクタ用動力伝達装置を示すものである。
【００１４】
図１に示すように、エンドエフェクタ１を駆動する動力を起生するエンドエフェクタ駆動装置２をロボットベース３に設置してある。そして、ロボットベース３に支持されたロボットアーム４の２本のリンク４ａ，４ｂに沿ってエンドエフェクタ１を駆動する動力を伝達するワイヤ５ａ，プーリ５ｂのみで構成される伝達経路５が配設されている。
【００１５】
エンドエフェクタ１と伝達経路５との間には、コントローラ６に接続した回避機構７が連結されている。なお、コントローラ６は、ロボットアーム４の駆動装置（図示せず）に接続して、ロボットアーム４の駆動の有無を判断することができるようになっている。
【００１６】
伝達経路５は、図２に示すように、ロボットアーム４の関節４ｃが伸転関節からなる場合、プーリ５ｂが関節４ｃの回転軸と同軸に取付けられる。また、図３，図４に示すように、ロボットアーム４の関節４ｃが旋回関節からなる場合、プーリ５ｂが中空形に形成されて関節４ｃの回転軸４ｄの外側に同軸に配置される。この中空形のプーリ５ｂは、中空形の軸受が一体的に組付けられてなるもので、軸受部分がロボットアーム４の一方のリンク４ａに支持された軸受部材５ｄに回転可能に支持される。また、ロボットアーム４の両リンク４ａ，４ｂには、軸線が回転軸４ｄと直交する方向へ位置された補助プーリ５ｅがそれぞれ取付けられる。
【００１７】
この伝達経路５の構造は、全配設ラインのロボットアーム４の外側への装備が可能となる。従って、既存の様々なマニピュレータへ容易に装備することができ、汎用性が高くなる。
【００１８】
回避機構７は、図５，図６に詳細に示されるように、クラッチ７ａとブレーキ７ｂとで構成されている。クラッチ７ａは、１面がロボットアーム４の端末側のリンク４ｂに回転可能に支持された軸７ｃに固定され、対面する他の１面が前記軸７ｃに遊嵌されるとともに伝達経路５の最端末のプーリ５ｂに固定されている。最端末のプーリ５ｂは、前記軸７ｃに遊嵌されている。ブレーキ７ｂは、前記軸７ｃに拘束，開放可能な構造を内蔵して嵌装され軸７ｃの回転を阻止，許容する。なお、エンドエフェクタ１は、ハンド１ａに同軸に支持された連結用プーリ１ｂと前記軸７ｃに固定された連結用プーリ１ｃとの間に張設された連結用ワイヤ１ｄによって回避機構７に連結されている。
【００１９】
ロボットアーム４の駆動装置の駆動情報によりロボットアーム４が駆動されていると判断された場合、コントローラ６の指示で回避機構７のクラッチ７ａが切断される。この結果、回避機構７の軸７ｃが回転せず、エンドエフェクタ１が駆動されず、ロボットアーム４からの動力干渉を回避することができる。なお、このとき、コントローラ６の指示で回避機構７のブレーキ７ｂが軸７ｃの回転を阻止しているため、エンドエフェクタ１の慣性，重力等による無用の動作が阻止される。
【００２０】
また、ロボットアーム４の駆動装置の駆動情報によりロボットアーム４が停止されていると判断された場合、ロボットアーム４からの動力干渉を受けないため、コントローラ６の指示で回避機構７のクラッチ７ａが接続される。この結果、回避機構７の軸７ｃが回転し、エンドエフェクタ１が駆動される。なお、このとき、コントローラ６の指示で回避機構７のブレーキ７ｂが軸７ｃの回転を許容する。
【００２１】
図７，図８は、本発明に係るエンドエフェクタ用動力伝達方法の実施の形態を示すものである。
【００２２】
この実施の形態は、図１に示すように、前述のエンドエフェクタ用動力伝達装置の回避機構７を除いてほぼ同様に構成されたものについて、伝達経路５のワイヤ５ａの張力を検出する張力センサ８をコントローラ６に接続し、コントローラ６でエンドエフェクタ駆動装置２をフィードバック制御するように構成してある。
【００２３】
さらに、この実施の形態では、ロボットアーム４の関節４ｃのエンコーダ９から得られたエンコーダ値により、ロボットアーム４のリンク４ａ，４ｂの角度からアームの順運動学計算処理，幾何計算処理１０を行って、伝達経路５のワイヤ５ａの配設長（経路長）ａを算出する。また、この配設長ａと張力センサ８から得られた張力値とから材力計算処理１１を行って、伝達経路５のワイヤ５ａの延び長ｂを算出する。また、エンドエフェクタ駆動装置２に接続されたエンコーダ１２から得られたエンコーダ値により、エンドエフェクタ駆動装置２から伝達経路５のワイヤ５ａが実際に繰出された繰出長ｃが算出される。
【００２４】
これ等の配設長ａ，延び長ｂ，繰出長ｃは、演算されて制御の目標値ｄとさらに演算される。この演算で得られた指令値ｅは、アンプ１３で増幅されてエンドエフェクタ駆動装置２に指示される。
【００２５】
この実施の形態によると、ロボットアーム４の動力干渉により生じた伝達経路５のワイヤ５ａの変位からと、ワイヤ５ａの張力からとのエンドエフェクタ駆動装置２のフィードバック制御が総合されることになる。従って、ロボットアーム４の動力干渉を排除して、エンドエフェクタ１に対して駆動の動力を正確に伝達することができる。
【００２６】
また、特殊な機器等を設備する必要がないため、低コストでの設備が可能である。
【００２７】
【発明の効果】
以上のように、本発明に係るエンドエフェクタ用動力伝達方法は、伝達経路をワイヤ，プーリのみで構成しているため、ロボットアームを軽量化し伝達経路の製造コストを低減することができる効果がある。
【００２８】
さらに、本発明に係るエンドエフェクタ用動力伝達方法は、フィードバック制御の動力干渉に掛かる要素を含めることでエンドエフェクタに対して駆動の動力を正確に伝達することができるため、ロボットアームの駆動による動力干渉を解消することができる効果がある。
【００２９】
さらに、請求項２として、ワイヤ，プーリからなる伝達経路が少なくとも旋回関節でロボットアームの外側に配設されるため、全配設ラインのロボットアームの外側への装備が可能となり、他のロボット等へも容易に装備することができて汎用性が高くなる効果がある。
【図面の簡単な説明】
【図１】 エンドエフェクタ用動力伝達装置を示す制御構成図である。
【図２】 図１の要部の拡大断面図である。
【図３】 図２の平面図である。
【図４】 図１の伸転関節付近の詳細図である。
【図５】 図１の旋回関節付近の詳細図である。
【図６】 図５の側面断面図である。
【図７】 本発明に係るエンドエフェクタ用動力伝達方法の実施の形態を示す制御構成図である。
【図８】 図７の制御のブロック線図である。
【符号の説明】
１ エンドエフェクタ
２ エンドエフェクタ駆動装置
３ ロボットベース
４ ロボットアーム
４ａ，４ｂ リンク
４ｃ 関節
５ 伝達経路
５ａ ワイヤ
５ｂ プーリ
６ コントローラ
７ 回避機構
Claims (2)
- ロボットベース側に設置されたエンドエフェクタ駆動装置とロボットベースに支持されたロボットアームの先端部に支持されたエンドエフェクタとを、ロボットアームのリンクに沿って配設したプーリとワイヤとでなる伝達経路を介して連結したエンドエフェクタ用動力伝達装置において、
ロボットアームの関節角度をエンコーダで検出し、その値に基づいて伝達経路のワイヤの配設長を算出し、
この配設長と張力センサから得られた張力値とを用いて伝達経路のワイヤの延び長を算出し、
またエンドエフェクタ駆動装置のエンコーダ値によりエンドエフェクタ駆動装置から繰出された実際の繰出し長を算出し、
この繰出し長から前記配設長を減算すると共に前記延び長を加算する演算を行い、制御の目標値から該演算結果を減算して得られた指令値をエンドエフェクタ駆動装置に指示して該エンドエフェクタ駆動装置をフィードバック制御することを特徴とするエンドエフェクタ用動力伝達方法。 - 請求項１のエンドエフェクタ用動力伝達方法において、エンドエフェクタ用動力伝達装置の伝達経路のロボットアームの旋回関節付近に取付けられるプーリが旋回関節の回転軸の外側に同軸に配置される中空形であることを特徴とするエンドエフェクタ用動力伝達方法。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2002099162A JP3791682B2 (ja) | 2002-04-01 | 2002-04-01 | エンドエフェクタ用動力伝達方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2002099162A JP3791682B2 (ja) | 2002-04-01 | 2002-04-01 | エンドエフェクタ用動力伝達方法 |
Related Parent Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP37298499A Division JP3312176B2 (ja) | 1999-12-28 | 1999-12-28 | エンドエフェクタ用動力伝達装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2003001581A JP2003001581A (ja) | 2003-01-08 |
| JP3791682B2 true JP3791682B2 (ja) | 2006-06-28 |
Family
ID=19193647
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2002099162A Expired - Fee Related JP3791682B2 (ja) | 2002-04-01 | 2002-04-01 | エンドエフェクタ用動力伝達方法 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3791682B2 (ja) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113662673A (zh) * | 2021-08-25 | 2021-11-19 | 深圳市精锋医疗科技有限公司 | 机械臂、从操作设备及手术机器人 |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR100914431B1 (ko) | 2008-04-22 | 2009-08-28 | 한국원자력연구원 | 케이블 구동 시스템의 케이블 디커플 장치 |
| JP4469925B2 (ja) | 2008-06-27 | 2010-06-02 | パナソニック株式会社 | ロボットハンド及びロボットアーム |
Family Cites Families (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS62282887A (ja) * | 1986-05-28 | 1987-12-08 | 株式会社東芝 | ロボツトア−ム |
| JPS62282889A (ja) * | 1986-05-29 | 1987-12-08 | 株式会社東芝 | ロボツトア−ム |
| JPH05134759A (ja) * | 1991-11-14 | 1993-06-01 | Fujitsu Ltd | 垂直方向運搬制御方式 |
| JPH05285871A (ja) * | 1992-04-08 | 1993-11-02 | Kobe Steel Ltd | トルク制御装置 |
| JPH0631662A (ja) * | 1992-07-14 | 1994-02-08 | Kobe Steel Ltd | マニピュレータの制御方法とその装置 |
| JPH09131687A (ja) * | 1995-11-08 | 1997-05-20 | Fujitsu Ltd | ロボットアーム |
| JP3664807B2 (ja) * | 1996-05-23 | 2005-06-29 | 三菱重工業株式会社 | 海洋浮動体の操船制御装置及び方法 |
| JP2800970B1 (ja) * | 1997-04-30 | 1998-09-21 | 川崎重工業株式会社 | ワイヤ駆動機構の制御パラメータ調整方法及び装置 |
-
2002
- 2002-04-01 JP JP2002099162A patent/JP3791682B2/ja not_active Expired - Fee Related
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113662673A (zh) * | 2021-08-25 | 2021-11-19 | 深圳市精锋医疗科技有限公司 | 机械臂、从操作设备及手术机器人 |
| CN113662673B (zh) * | 2021-08-25 | 2023-08-22 | 深圳市精锋医疗科技股份有限公司 | 机械臂、从操作设备及手术机器人 |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2003001581A (ja) | 2003-01-08 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US6696810B2 (en) | Wrist structure for a robot | |
| KR101382815B1 (ko) | 수평 다관절 로봇 | |
| KR101683325B1 (ko) | 관절형 로봇 손목 | |
| JP3578375B2 (ja) | ロボットアーム駆動装置およびロボットハンド | |
| US4712971A (en) | Control arm assembly | |
| JP4181995B2 (ja) | ロボットアームに使用可能なケーブルレジューサを備えた関節接続機構 | |
| KR101149953B1 (ko) | 로봇 암에 있어서의 케이블들의 배치구조 및 그것을 구비한산업용 로봇 | |
| JP2019162700A (ja) | ケーブルクランプおよびロボット | |
| WO1993017839A1 (en) | Balancer for robot arms | |
| EP1520661A1 (en) | Cable laying structure with clamping means for a robot | |
| JP3791682B2 (ja) | エンドエフェクタ用動力伝達方法 | |
| KR20200019950A (ko) | 로봇 암의 손목 및 듀얼 암 로봇 | |
| KR101796799B1 (ko) | 관절형 로봇 손목 | |
| JP2009034755A (ja) | パワーアシスト装置及びその制御方法 | |
| JPH07214482A (ja) | 多関節アーム機構 | |
| JP7420543B2 (ja) | 遠隔操縦装置 | |
| JPH11156769A (ja) | 双腕型スカラロボット | |
| KR101812026B1 (ko) | 6축 다관절 로봇 | |
| JP3777783B2 (ja) | 水平アームを有するロボット | |
| JP2001179676A (ja) | エンドエフェクタ用動力伝達装置および方法 | |
| JPH08161015A (ja) | 多関節型ロボットの駆動制御方法 | |
| JPH07214435A (ja) | 自動ネジ締め装置 | |
| JP2016120537A (ja) | マニピュレータ装置及び駆動制御プログラム | |
| JPS6048276A (ja) | リンク式ロボット | |
| JP4730511B2 (ja) | 多関節ロボット |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20041214 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20050405 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20050527 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20050816 |
|
| RD02 | Notification of acceptance of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7422 Effective date: 20050909 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A821 Effective date: 20050909 Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20051011 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A821 Effective date: 20051011 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20060328 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20060329 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090414 Year of fee payment: 3 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100414 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110414 Year of fee payment: 5 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120414 Year of fee payment: 6 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120414 Year of fee payment: 6 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130414 Year of fee payment: 7 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130414 Year of fee payment: 7 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140414 Year of fee payment: 8 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140414 Year of fee payment: 8 |
|
| LAPS | Cancellation because of no payment of annual fees |