JP3786305B2 - 把持物体計測装置 - Google Patents
把持物体計測装置 Download PDFInfo
- Publication number
- JP3786305B2 JP3786305B2 JP07852097A JP7852097A JP3786305B2 JP 3786305 B2 JP3786305 B2 JP 3786305B2 JP 07852097 A JP07852097 A JP 07852097A JP 7852097 A JP7852097 A JP 7852097A JP 3786305 B2 JP3786305 B2 JP 3786305B2
- Authority
- JP
- Japan
- Prior art keywords
- finger
- hand
- gripping
- fingers
- robot
- 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
- Length Measuring Devices With Unspecified Measuring Means (AREA)
- Manipulator (AREA)
Description
【０００１】
【発明の属する技術分野】
本発明は、三本以上の指を有する多指ハンドに関し、多指ハンドを用いて物体の中心位置及び外径を計測する装置に関する。
【０００２】
【従来の技術】
従来、ロボットが作業対象となる物体を把持する方法として、図４のような三本以上の指を備えた多指ハンドをロボットの手先に装着し、これを開閉することによって物体を把持する方法がある。
同図において、ロボット１の手先には三本の指を持つ多指ハンド２が取り付けられている。ロボット１を用いて円柱状の物体を把持させる場合、ロボット制御部５はあらかじめ与えられた作業環境の情報に基づいてロボット１の姿勢を変更し、多指ハンド２を物体の把持が可能な位置へ移動させ、多指ハンド制御部４に物体を把持する指令を送る。
【０００３】
図２に示すように多指ハンド２の各指の先端には力覚センサ３が取り付けられている。多指ハンド制御部４は各指を物体に徐々に近付けながら一定時間間隔で力覚センサ３からの入力を受け取る。各指の力覚センサ３からの入力があらかじめ与えられた閾値を越えると、多指ハンド制御部４はその指が物体と接触したものとし、その指に対して停止信号を送る。すべての指が物体と接触した時点で把持が完了したものとする。把持が完了すると、多指ハンド制御部４はロボット制御部５に把持が完了した信号を送る。
このように、三本以上の指を持つ多指ハンドを用いて、物体を三点以上で把持することにより、安定した把持を行うことができる。
【０００４】
【発明が解決しようとする課題】
従来の手法では、あらかじめ与えられた作業環境に関する情報に誤差が含まれる場合や把持動作の途中で物体との摩擦により物体を把持する指の位置が変化した場合などには、把持した物体の作業空間内での正確な位置を決定することができない。そのため、たとえば物体を穴へ挿入する動作を行わせる場合に、穴と物体との位置を正確にあわせることが困難となる。
これを補正するために、特開平６−１４３１８２号公報には、超音波センサや視覚センサ等の非接触型の位置検出器を用いることにより物体の位置を計測する方法が開示されているが、処理システムの構成が複雑になりシステム作成にかかるコストが大きくなるという問題がある。
そこで、本発明ではシステムの構成が簡単で計算処理量の少ない、把持物体の作業空間内での位置計測装置を提供することを目的とする。
【０００５】
【課題を解決するための手段】
上記課題を解決するために、本発明は、それぞれの先端に力覚センサを備えた三本以上の指を設けた多指ハンドの把持物体計測装置において、前記多指ハンドが円柱状の物体を把持し各指の力覚センサからの出力信号があらかじめ与えられた閾値を越えたときに多指ハンドによる前記物体の把持が完了したことを検知する制御手段と、前記物体の把持完了時点での各指の先端位置の位置信号を出力する位置検出手段と、この位置検出手段の出力信号に基づいて前記物体の中心位置及び外径を計測する手段とを設けたものである。
【０００６】
【発明の実施の態様】
以下、本発明の実施の態様を、図１に基づいて説明する。図１は概念ブロック図である。ロボット１の手先には三本の指を持つ多指ハンド２が取り付けられている。
以下、ロボット１を用いて円柱状の物体を把持し、穴へ挿入する作業をさせる場合を例にとって説明する。ロボット制御部５はあらかじめ与えられた作業環境の情報に基づいてロボット１の姿勢を変更し、多指ハンド２を物体の把持が可能な位置へ移動させ、多指ハンド制御部４に物体を把持する指令を送る。
図２に示すように多指ハンド２の各指の先端には力覚センサ３が取り付けられている。多指ハンド制御部４は各指を物体に徐々に近付けながら一定時間間隔で力覚センサ３からの入力を受け取る。各指の力覚センサ３からの入力があらかじめ与えられた閾値を越えると、多指ハンド制御部４は把持が完了したものとして多指ハンド２に停止信号を送り、ロボット制御部５に把持が完了した信号を送り、位置計算部に各指の先端位置の座標を送る。
【０００７】
この時点での物体と指先端位置の関係を図３に示す。このとき、各指８，９，１０の先端は円柱７の半径Ｒと指８，９，１０の半径ｒの和を半径とする円周上に位置する。このことを用いて円柱７の中心位置ＰＣ（ｘC，ｙC）と外径を求める方法を以下に示す。
指８の先端位置Ｐ０を基準とし、この点からみた指９と指１０の先端位置をＰ１（ｘ1，ｙ1）、Ｐ2（ｘ2，ｙ2）とし、円柱状物体７の中心位置をＰC（ｘC，ｙC）とすると、これらの座標間の関係は式（１）（２）で表される。
【数１】
【数２】
そこでＣの逆行列を求めることによりＰC（ｘC，ｙC）を決定することができる。多指ハンドの指が三本の場合は単純な連立方程式となり簡単に解を求めることができる。
【０００８】
指がｎ本（ｎ＞３）になった場合にはそれぞれの関係は式（３）（４）となるが、このときのＣの逆行列を求めることはできない。そこで、最小二乗法を利用した疑似逆行列を用いて解を求める。Ｃの擬似逆行列は式（５）で表される。
【数３】
【数４】
【数５】
【０００９】
以上のようにして、円柱の中心座標（ｘC，ｙC）が求まれば、円柱７の外径をＲ、指８，９，１０の外径をｒとすると円柱７の外径Ｒは式（６）で表わされる。
【数６】
図１の位置計算部６では、以上の手法を用いて指８の先端位置からみた円柱７の外径Ｒを求め、作業空間内での指９，１０の先端位置から作業空間内での円柱７の中心座標（ｘC，ｙC）を求め、これらをロボット制御部５へ送る。そこでロボット制御部５は、まず外径Ｒの計算結果と予め与えられた作業の対象となる物体の情報とを比較し、外径の値が一致しなければ物体が違っているとして作業を中断する。外径が一致するならば、これをもとにロボットの手先からの円柱７の中心位置の相対的な位置情報を修正し、円柱を挿入する穴の座標と円柱の中心位置が一致するようにロボットの手先の位置と姿勢を制御し、挿入動作を行う。
【００１０】
【発明の効果】
以上述べたように、本発明はロボットの手先に取り付けた多指ハンドによって円柱状の物体の把持を行う際に、その各指の先端位置から物体の中心位置と外径を計算するようにしたので、従来の手法に比べて、把持動作の結果から直接把持物体の中心位置を導出することが可能であり、多指ハンドでの把持が可能なロボットシステムならば新たなセンサを必要とせずに、単純な計算によって少ない計算処理で物体の中心位置が計測可能となり、容易に環境情報の修正が可能であるという効果がある。
【図面の簡単な説明】
【図１】 本発明の実施例を示すシステムの構成図である。
【図２】 三本指を備えた多指ハンドの例を示す説明図である。
【図３】 多指ハンドによる物体把持の例を示す説明図である。
【図４】 従来の物体把持システムの構成図である。
【符号の説明】
１ ロボット、２ 多指ハンド、３ 力覚センサ、４ 多指ハンド制御部、５ ロボット制御部、６ 位置計算部、７ 円柱状の把持対象物体、８，９，１０ 指
【発明の属する技術分野】
本発明は、三本以上の指を有する多指ハンドに関し、多指ハンドを用いて物体の中心位置及び外径を計測する装置に関する。
【０００２】
【従来の技術】
従来、ロボットが作業対象となる物体を把持する方法として、図４のような三本以上の指を備えた多指ハンドをロボットの手先に装着し、これを開閉することによって物体を把持する方法がある。
同図において、ロボット１の手先には三本の指を持つ多指ハンド２が取り付けられている。ロボット１を用いて円柱状の物体を把持させる場合、ロボット制御部５はあらかじめ与えられた作業環境の情報に基づいてロボット１の姿勢を変更し、多指ハンド２を物体の把持が可能な位置へ移動させ、多指ハンド制御部４に物体を把持する指令を送る。
【０００３】
図２に示すように多指ハンド２の各指の先端には力覚センサ３が取り付けられている。多指ハンド制御部４は各指を物体に徐々に近付けながら一定時間間隔で力覚センサ３からの入力を受け取る。各指の力覚センサ３からの入力があらかじめ与えられた閾値を越えると、多指ハンド制御部４はその指が物体と接触したものとし、その指に対して停止信号を送る。すべての指が物体と接触した時点で把持が完了したものとする。把持が完了すると、多指ハンド制御部４はロボット制御部５に把持が完了した信号を送る。
このように、三本以上の指を持つ多指ハンドを用いて、物体を三点以上で把持することにより、安定した把持を行うことができる。
【０００４】
【発明が解決しようとする課題】
従来の手法では、あらかじめ与えられた作業環境に関する情報に誤差が含まれる場合や把持動作の途中で物体との摩擦により物体を把持する指の位置が変化した場合などには、把持した物体の作業空間内での正確な位置を決定することができない。そのため、たとえば物体を穴へ挿入する動作を行わせる場合に、穴と物体との位置を正確にあわせることが困難となる。
これを補正するために、特開平６−１４３１８２号公報には、超音波センサや視覚センサ等の非接触型の位置検出器を用いることにより物体の位置を計測する方法が開示されているが、処理システムの構成が複雑になりシステム作成にかかるコストが大きくなるという問題がある。
そこで、本発明ではシステムの構成が簡単で計算処理量の少ない、把持物体の作業空間内での位置計測装置を提供することを目的とする。
【０００５】
【課題を解決するための手段】
上記課題を解決するために、本発明は、それぞれの先端に力覚センサを備えた三本以上の指を設けた多指ハンドの把持物体計測装置において、前記多指ハンドが円柱状の物体を把持し各指の力覚センサからの出力信号があらかじめ与えられた閾値を越えたときに多指ハンドによる前記物体の把持が完了したことを検知する制御手段と、前記物体の把持完了時点での各指の先端位置の位置信号を出力する位置検出手段と、この位置検出手段の出力信号に基づいて前記物体の中心位置及び外径を計測する手段とを設けたものである。
【０００６】
【発明の実施の態様】
以下、本発明の実施の態様を、図１に基づいて説明する。図１は概念ブロック図である。ロボット１の手先には三本の指を持つ多指ハンド２が取り付けられている。
以下、ロボット１を用いて円柱状の物体を把持し、穴へ挿入する作業をさせる場合を例にとって説明する。ロボット制御部５はあらかじめ与えられた作業環境の情報に基づいてロボット１の姿勢を変更し、多指ハンド２を物体の把持が可能な位置へ移動させ、多指ハンド制御部４に物体を把持する指令を送る。
図２に示すように多指ハンド２の各指の先端には力覚センサ３が取り付けられている。多指ハンド制御部４は各指を物体に徐々に近付けながら一定時間間隔で力覚センサ３からの入力を受け取る。各指の力覚センサ３からの入力があらかじめ与えられた閾値を越えると、多指ハンド制御部４は把持が完了したものとして多指ハンド２に停止信号を送り、ロボット制御部５に把持が完了した信号を送り、位置計算部に各指の先端位置の座標を送る。
【０００７】
この時点での物体と指先端位置の関係を図３に示す。このとき、各指８，９，１０の先端は円柱７の半径Ｒと指８，９，１０の半径ｒの和を半径とする円周上に位置する。このことを用いて円柱７の中心位置ＰＣ（ｘC，ｙC）と外径を求める方法を以下に示す。
指８の先端位置Ｐ０を基準とし、この点からみた指９と指１０の先端位置をＰ１（ｘ1，ｙ1）、Ｐ2（ｘ2，ｙ2）とし、円柱状物体７の中心位置をＰC（ｘC，ｙC）とすると、これらの座標間の関係は式（１）（２）で表される。
【数１】
【０００８】
指がｎ本（ｎ＞３）になった場合にはそれぞれの関係は式（３）（４）となるが、このときのＣの逆行列を求めることはできない。そこで、最小二乗法を利用した疑似逆行列を用いて解を求める。Ｃの擬似逆行列は式（５）で表される。
【数３】
以上のようにして、円柱の中心座標（ｘC，ｙC）が求まれば、円柱７の外径をＲ、指８，９，１０の外径をｒとすると円柱７の外径Ｒは式（６）で表わされる。
【数６】
【００１０】
【発明の効果】
以上述べたように、本発明はロボットの手先に取り付けた多指ハンドによって円柱状の物体の把持を行う際に、その各指の先端位置から物体の中心位置と外径を計算するようにしたので、従来の手法に比べて、把持動作の結果から直接把持物体の中心位置を導出することが可能であり、多指ハンドでの把持が可能なロボットシステムならば新たなセンサを必要とせずに、単純な計算によって少ない計算処理で物体の中心位置が計測可能となり、容易に環境情報の修正が可能であるという効果がある。
【図面の簡単な説明】
【図１】 本発明の実施例を示すシステムの構成図である。
【図２】 三本指を備えた多指ハンドの例を示す説明図である。
【図３】 多指ハンドによる物体把持の例を示す説明図である。
【図４】 従来の物体把持システムの構成図である。
【符号の説明】
１ ロボット、２ 多指ハンド、３ 力覚センサ、４ 多指ハンド制御部、５ ロボット制御部、６ 位置計算部、７ 円柱状の把持対象物体、８，９，１０ 指
Claims (1)
- それぞれの先端に力覚センサを備えた三本以上の指を設けた多指ハンドの把持物体計測装置において、前記多指ハンドが円柱状の物体を把持し各指の力覚センサからの出力信号があらかじめ与えられた閾値を越えたときに多指ハンドによる前記物体の把持が完了したことを検知する制御手段と、前記物体の把持完了時点での各指の先端位置の位置信号を出力する位置検出手段と、この位置検出手段の出力信号に基づいて前記物体の中心位置及び外径を計測する手段とを設けたことを特徴とする把持物体計測装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP07852097A JP3786305B2 (ja) | 1997-03-28 | 1997-03-28 | 把持物体計測装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP07852097A JP3786305B2 (ja) | 1997-03-28 | 1997-03-28 | 把持物体計測装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH10264072A JPH10264072A (ja) | 1998-10-06 |
| JP3786305B2 true JP3786305B2 (ja) | 2006-06-14 |
Family
ID=13664217
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP07852097A Expired - Fee Related JP3786305B2 (ja) | 1997-03-28 | 1997-03-28 | 把持物体計測装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3786305B2 (ja) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP5834491B2 (ja) * | 2011-05-24 | 2015-12-24 | セイコーエプソン株式会社 | ロボットハンド、およびロボット |
| CN107289887A (zh) * | 2017-07-07 | 2017-10-24 | 杭州电子科技大学 | 一种手套式关节臂坐标测量机及其测量方法 |
-
1997
- 1997-03-28 JP JP07852097A patent/JP3786305B2/ja not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| JPH10264072A (ja) | 1998-10-06 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| KR101308373B1 (ko) | 로봇 제어방법 | |
| CN105598987B (zh) | 借助机器人确定关于对象的抓取空间 | |
| JP2009269127A (ja) | 把持装置及びその制御方法 | |
| WO2007088735A1 (ja) | ロボットシステム | |
| JP2019181622A (ja) | ハンド制御装置およびハンド制御システム | |
| US11701775B2 (en) | Method of setting target force upper limit and robot system | |
| CN108818586B (zh) | 一种适用于机械手自动抓取的物体重心检测方法 | |
| CN114025928A (zh) | 末端执行器的控制系统以及末端执行器的控制方法 | |
| JP2849056B2 (ja) | 位置決め部を有する把持装置 | |
| JP3786305B2 (ja) | 把持物体計測装置 | |
| JP4600445B2 (ja) | ロボットハンド装置 | |
| JP4591043B2 (ja) | ロボットによる任意形状物体の把持方法 | |
| JP4737099B2 (ja) | ロボットおよびロボットの制御装置と制御方法 | |
| JP2007253266A (ja) | 滑り検出装置、滑り検出方法、及びロボットハンド装置 | |
| JP2005144573A (ja) | ロボットハンドの把持力制御方法 | |
| JP4055703B2 (ja) | ロボットハンド装置 | |
| JP2004160614A (ja) | 自動作業教示システム | |
| JP3151900B2 (ja) | 部品供給装置 | |
| CN117279748A (zh) | 用于控制夹具的方法 | |
| JPH05253876A (ja) | マニピュレータ | |
| CN111002295A (zh) | 一种二指抓取机器人的示教手套及示教系统 | |
| JP4012996B2 (ja) | マニピュレータの制御装置 | |
| Karahan et al. | Modelling and identification of STAUBLI RX-60 robot | |
| JPH04182710A (ja) | 相対位置決め方式 | |
| JP7442665B2 (ja) | 力検知装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20040109 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20060216 |
|
| 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: 20060303 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20060316 |
|
| 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: 20090331 Year of fee payment: 3 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100331 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110331 Year of fee payment: 5 |
|
| LAPS | Cancellation because of no payment of annual fees |