JP2024511833A - グリッパを制御する方法 - Google Patents
グリッパを制御する方法 Download PDFInfo
- Publication number
- JP2024511833A JP2024511833A JP2023560302A JP2023560302A JP2024511833A JP 2024511833 A JP2024511833 A JP 2024511833A JP 2023560302 A JP2023560302 A JP 2023560302A JP 2023560302 A JP2023560302 A JP 2023560302A JP 2024511833 A JP2024511833 A JP 2024511833A
- Authority
- JP
- Japan
- Prior art keywords
- sensor
- gripper
- gripping force
- center
- gripping
- 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.)
- Pending
Links
- 238000006073 displacement reaction Methods 0.000 claims abstract description 12
- 238000012544 monitoring process Methods 0.000 claims abstract description 7
- 238000000034 method Methods 0.000 claims description 38
- 238000012545 processing Methods 0.000 claims description 18
- 238000005259 measurement Methods 0.000 claims description 11
- 238000010586 diagram Methods 0.000 abstract description 5
- 238000001514 detection method Methods 0.000 description 5
- 230000007704 transition Effects 0.000 description 5
- 238000004364 calculation method Methods 0.000 description 4
- 238000013459 approach Methods 0.000 description 3
- 238000012986 modification Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 210000003811 finger Anatomy 0.000 description 2
- 210000004247 hand Anatomy 0.000 description 2
- 206010035148 Plague Diseases 0.000 description 1
- 241000607479 Yersinia pestis Species 0.000 description 1
- 230000006978 adaptation Effects 0.000 description 1
- 230000003044 adaptive effect Effects 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 239000013078 crystal Substances 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010348 incorporation Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 230000000717 retained effect Effects 0.000 description 1
- 238000012552 review Methods 0.000 description 1
- 238000001228 spectrum Methods 0.000 description 1
- 210000003813 thumb Anatomy 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1612—Programme controls characterised by the hand, wrist, grip control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
- B25J13/081—Touching devices, e.g. pressure-sensitive
- B25J13/082—Grasping-force detectors
- B25J13/083—Grasping-force detectors fitted with slippage detectors
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39484—Locate, reach and grasp, visual guided grasping
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39505—Control of gripping, grasping, contacting force, force distribution
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39514—Stability of grasped objects
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39528—Measuring, gripping force sensor build into hand
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39532—Gripping force sensor build into finger
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39543—Recognize object and plan hand shapes in grasping movements
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/40—Robotics, robotics mapping to robotics vision
- G05B2219/40053—Pick 3-D object from pile of objects
Abstract
グリッパによる物体の把持を制御する方法は、グリッパと一体の基準系に対して把持された物体の基準位置を計算すること、把持された物体の位置を監視すること、基準位置に対する把持された物体の変位を検出すると把持力を増加させるようにグリッパに命令すること、を提供する。【選択図】図4
Description
本発明は、特にロボット用途のための、物体を把持するためのグリッパを制御する方法に関する。
物体を把持して運ぶのに適した自動グリッパはよく知られている。一般に、グリッパは、グリッパ本体と、専門用語で「ジョー」とも呼ばれる少なくとも2つのグリッパ指とを備え、グリッパ指は、待機開位置と、物体を把持するための閉位置との間でグリッパ本体に対して移動可能である。
自動グリッパが悩まされる問題の1つは、ジョーの間で把持した物体の滑りを適時に検出し、輸送中に物体が紛失したり、意図した正確な位置から解放されたりするのを防ぐことである。
この目的のために、センサを備えたグリッパが提案されている。
義手に滑り測定機能を付加するというアイデアは、1960年代後半に初めて検討された。L.L.ソールズベリー(Salisbury)及びA.B.コールマン(Colman)、把持の自動比例制御を備えたメカニカルハンド(A mechanical hand with automatic proportional control of prehension)、1976年には、機械式の手の親指に圧電結晶を組み込むことが記載されている。ベイツらは、その直後にこのデバイスを二次元グリッパ上で複製した(J.ベイツ(Baits)ら、「人工把持のための適応的制御スキームの実現可能性(The Feasibility of an Adaptive Control Scheme for Artificial Prehension)、機械工学研究所議事録(Proceedings of the Institution of Mechanical Engineers)、1968年)。
どちらの場合も、目的は滑りによる振動を検出し、対応する信号をマニピュレータ制御ループに入力することであった。しかし、滑りを検出するためにセンサが取り付けられたこのようなシステムの能力を実証するための実験研究は行われていなかった。
M.フランコマーノ(Francomano)ら、滑りの人工感覚-レビュー(Artificial sense of slide - A review)、IEEEセンサ、2013年で報告されているように、その後の数十年間で他の多くのアプローチが提案された。これらには、圧力中心(CoP)を利用する1つのアプローチが含まれている。圧力中心は、ピエゾ抵抗圧力センサ(E.ホルウェーク(Holweg)ら、触覚センサによる滑り検出:アルゴリズムと実験結果(Slip detection by tactile sensors: algorithms and experimental results)、ICRA 1996年)又は静電容量センサ(X.ジャン(Zhang)及びR.リュー(Liu)、把持タスクのためのアレイ型圧力センサによる滑り検出(Slip detection by array-type pressure sensor for a grasp task)、ICMA 2021年)のアレイから再構築でき得、滑りの発生を評価するために、高速フーリエ変換(FFT)又はパワースペクトル等の技術を通じて周波数領域で分析され得る。あるいは、CoPは、加えられる総荷重も提供する特定のセンサによって測定され得る(D.グンジ(Gungji)ら、触覚センサを使用したスリップ検出に基づく多指ロボットハンドの把握力制御(Grasping force control of multi-fingered robot hand based on slip detection using tactile sensor)、日本ロボット学会誌、2007年)。センサの電圧出力はグリッパの制御回路に供給され、この電圧の大幅な低下が検出された場合、クランプは加えられる力を増加させた。このアプローチは、グリッパによって把持される物体の位置を測定する近接センサと統合されている(H.ハセガワ(Hasegawa)ら、近接、接触、及びスリップセンシングを使用したインテリジェントロボットハンドの開発(Development of Intelligent Robot Hand using Proximity, Contact and Slip sensing)、ICRA 2010)。
滑りはまた、光学センサを使用して推測され得る。例えば、前記のセンサは、モバイルロボットプラットフォーム(TUM-Rosie)の右腕に接続されたロボットハンド(DLR/HIT)の指先に組み込まれた(A.マルドナドら、指先認識によるロボット操作の改善(Improving robot manipulation through fingertip perception)、IROS 2012)。センサは、小型カメラとレーザエミッタで構成された。このように装備された指先は、把持した物体の表面がセンサ対象物に対して移動したときの滑りイベントの認識を可能にした。
米国特許第8515579号明細書では、グリッパは、把持された物体を操作するための器具類を備える。グリッパは、把持された物体上の様々な位置で測定された時間内の空間的に分布したデータに基づいてベクトル場を決定するためのセンサを備える。しかしながら、物体の位置は、把握動作の前には評価されない。
このように、クランプで把持した物体の滑りを正確かつ適時に検出するという問題は完全には解決されていない。
したがって、本発明の目的は、この問題を解決できるグリッパ、特にロボット用途のグリッパの制御方法を提案することである。
前記目的は、請求項1のグリッパを用いて物体の把持を制御する方法、及び、請求項9のグリッパによって達成される。
従属請求項には、制御方法及びグリッパの好ましい又は有利な実施の形態が記載されている。
一般的な実施の形態によれば、制御方法は、
ステップa)所定の把持力(F1)で物体を把持するようにグリッパに命令すること、
ステップb)有効把持力(Fm)を測定すること、
ステップc)所定の把持力と有効把持力との差が所定の閾値(ThF)を下回る場合、グリッパと一体の基準系に対して把持された物体の基準位置を計算すること、
ステップd)把持された物体の位置を監視すること、
ステップe)基準位置に対する把持された物体の変位が検出された場合、把持力を増加するようにグリッパに命令すること、
を含む、
ステップa)所定の把持力(F1)で物体を把持するようにグリッパに命令すること、
ステップb)有効把持力(Fm)を測定すること、
ステップc)所定の把持力と有効把持力との差が所定の閾値(ThF)を下回る場合、グリッパと一体の基準系に対して把持された物体の基準位置を計算すること、
ステップd)把持された物体の位置を監視すること、
ステップe)基準位置に対する把持された物体の変位が検出された場合、把持力を増加するようにグリッパに命令すること、
を含む、
一実施の形態では、ステップe)の後、方法は、ステップd)から繰り返される。
一実施の形態では、基準位置は、少なくとも1つの位置センサ及び/又は少なくとも1つの圧力中心センサを用いて検出される。
一実施の形態によれば、基準位置は、少なくとも1つの位置センサにより、及び/又は、少なくとも1つの圧力中心センサにより、所定の時間間隔で得られた一組の測定値の平均として計算される。
いくつかの実施の形態では、少なくとも1つの位置センサにより得られた位置データと基準位置との差が所定の閾値を上回った場合、及び/又は、少なくとも1つの圧力中心センサにより得られた位置データと基準位置との差が所定の閾値を上回った場合、基準位置に対する把持された物体の変位が検出される。
発明の一般的な態様によれば、
グリッパ本体と、
グリッパ本体に対して、アイドル開位置と、物体の把持のための閉位置との間で移動可能な少なくとも2つのグリッパジョーと、
少なくとも1つの近接センサであって、少なくとも1つ近接センサの視野内で把持対象の物体の存在を検出するのに適した少なくとも1つの近接センサと、
ジョーにより物体に与えられる把持力を測定するのに適した把持力センサと、
ジョーが物体に把持力を与えているときにグリッパジョー間の圧力中心の座標を検出するのに適した少なくとも1つの圧力中心センサと、
グリッパの制御方法を実行するようにプログラムされた処理ユニットと、
を備え、
制御方法は、
ステップa)所定の把持力(F1)で物体を把持するようにグリッパに命令すること、
ステップb)有効把持力(Fm)を把持力センサにより測定すること、
ステップc)所定の把持力と有効把持力との差が所定の閾値(ThF)を下回る場合、少なくとも1つの位置センサ及び/又は少なくとも1つの圧力中心センサから受け取った測定値を用いて、グリッパと一体の基準系に対して把持された物体の基準位置を計算すること、
ステップd)把持された物体の位置を監視すること、
ステップe)基準位置に対する物体の変位が検出された場合、把持力を増加するようにグリッパに命令すること、
を含む、
グリッパが提案される。
グリッパ本体と、
グリッパ本体に対して、アイドル開位置と、物体の把持のための閉位置との間で移動可能な少なくとも2つのグリッパジョーと、
少なくとも1つの近接センサであって、少なくとも1つ近接センサの視野内で把持対象の物体の存在を検出するのに適した少なくとも1つの近接センサと、
ジョーにより物体に与えられる把持力を測定するのに適した把持力センサと、
ジョーが物体に把持力を与えているときにグリッパジョー間の圧力中心の座標を検出するのに適した少なくとも1つの圧力中心センサと、
グリッパの制御方法を実行するようにプログラムされた処理ユニットと、
を備え、
制御方法は、
ステップa)所定の把持力(F1)で物体を把持するようにグリッパに命令すること、
ステップb)有効把持力(Fm)を把持力センサにより測定すること、
ステップc)所定の把持力と有効把持力との差が所定の閾値(ThF)を下回る場合、少なくとも1つの位置センサ及び/又は少なくとも1つの圧力中心センサから受け取った測定値を用いて、グリッパと一体の基準系に対して把持された物体の基準位置を計算すること、
ステップd)把持された物体の位置を監視すること、
ステップe)基準位置に対する物体の変位が検出された場合、把持力を増加するようにグリッパに命令すること、
を含む、
グリッパが提案される。
一実施の形態では、処理ユニットは、ステップe)を実行した後、ステップd)から制御方法を繰り返すようにプログラムされる。
一実施の形態では、処理ユニットは、基準位置を、少なくとも1つの位置センサにより、及び/又は、少なくとも1つの圧力中心センサにより、所定の時間間隔で得られた1組の測定値の平均として計算するようにプログラムされる。
本発明による制御方法およびグリッパのさらなる特徴および利点は、添付の図面を参照し、純粋に非限定的な例として提供される好ましい実施形態の以下の説明から容易に明らかになるであろう。
これらの図面において、本発明による物体を把持するためのグリッパは、全体として参照番号1で概略的に示される。
グリッパ1は、グリッパ本体10と、グリッパ本体10に対して、動いていない開位置と閉物体把持位置との間で移動可能な少なくとも2つのグリッパジョー12とを備える。
ジョー12は、電気、油圧、空気圧アクチュエータ、又は、それらの組み合わせによって移動させられ得る。
グリッパ1は、少なくとも1つの近接センサ14を備える。近接センサ14は、近接センサ14の視野14’内の把持対象の物体の存在を検出するのに適している。
例えば、近接センサ14は、2つのジョー12の間に、例えば円錐形状の視野14’を向けるように位置する。
図2の実施の形態では、グリッパ1は、グリッパの視野を拡大するために2つの近接センサ14を備える。
グリッパ1にはさらに、ジョー12によって物体に加えられる把持力を測定するのに適した把持力センサ16(「FS」)と、ジョーが物体に把持力を及ぼすときにグリッパのジョー12間の圧力中心(「CoP」)の座標を検出するのに適した少なくとも1つの圧力中心センサ18(「CoPS」)と、を備える。
一実施の形態では、力センサ16と圧力中心センサ18は同一である。
グリッパ1は、処理ユニット20により制御される。処理ユニット20は、近接センサ14、把持力センサ16、圧力中心センサ18、及びジョー駆動手段12に動作可能に接続され、センサから受け取った情報に基づいてグリッパを制御するための方法を実行するようにプログラムされている。
処理ユニット20は、グリッパ本体10内に配置されてもよいし、グリッパ1の外部に配置されてもよい。
以下に説明する制御方法は、グリッパ1が安定して物体を把持し、物体をジョーの間で保持する際の滑り現象を回避することを可能にする。
この説明の残りの部分では、以下の定義が使用される。
Fm:把持力センサで測定された把持力
F1、F2:所望の把持力の所定値。
ThF:下回ると把持が安定しているとみなされる把持力の閾値。
ThPos1、ThPos2:近接センサにより検出された位置の閾値
ThCoP:圧力中心の閾値
上述したように、一実施の形態では、少なくとも1つの圧力中心センサ18は、把握力センサ16と同一である。この場合、有効把握力(Fm)センサはトルクを測定することもできる。実際、図に示すようにX軸、Y軸及びZ軸を考慮すると、処理ユニット20は、圧力中心のCoPX座標及びCoPY座標を次のように計算するようにプログラムされている。
ここで、MX及びMYは、図に示すように、それぞれX軸及びY軸に沿った有効把握力センサ(Fm)の測定されたモーメントであり、|Z|は、Z軸に沿った有効把握力(Fm)の絶対値である。
一実施の形態では、近接センサ14は、超音波又は赤外線センサである。
一実施の形態では、力センサ16及び/又は圧力中心センサ18は、触覚皮膚を形成するために容量型のセンサユニットアレイを用いて、及び/又は、力/トルクセンサを用いて形成される。
図3のフローチャートを参照すると、一実施の形態において、グリッパを制御する方法は以下のステップを含む。
グリッパは、把持対象の物体の存在を検出するために近接センサ14によって把持領域を監視する(ステップ100)。
物体が検出されると、把持対象の物体の位置(Pos)と所定の把持位置(Pos1)とが比較される(ステップ102)。所定の把持位置は、物体が正しく把持されるためにとらなければならない位置として定義され得る。
物体の位置(Pos)と把持位置(Pos1)との間の距離が所定の閾値(ThPos1)を下回る場合、グリッパは、所定の把持力F1で物体を把持するように命令される(ステップ104)。
次に、有効把持力(Fm)が測定される(ステップ106)。把持力センサ16は、実際の把持力(Fm)を測定するために使用され得る。
次に、所定の把持力(F1)と有効把持力(Fm)とが比較される(ステップ107)。
所定の把持力(F1)と有効把持力(Fm)の差が所定の閾値(ThF)を下回る場合、グリッパと一体の基準系に対する把持対象の物体の基準位置(または「zero」位置)が計算される(ステップ108)。
次に、物体がピックアップ位置からリリース位置まで搬送される際に、把持した物体の位置が監視される(ステップ110)。
基準位置からの物体の変位が検出された場合(ステップ112)、グリッパは、例えば第2の所定の把持力値(F2)まで把持力を増加するように命令される(ステップ114)。
使い道によっては、把握領域を監視すること、及び、把握対象の物体の位置(Pos)を所定の把握位置(Pos1)と比較することが必要ですらない場合もある。これらの場合、制御方法は、第1ステップとして、所定の把持力F1で対象物を直接的に把持することを提供する(ステップ104)。
一実施の形態では、把持力を増加させた後、物体の基準位置が再び監視される。さらなる変位が検出されると、把持力はさらに増加される。この閉ループ制御は、グリッパが物体のリリース位置に到達するまで数回繰り返され得る。
いくつかの実施の形態では、把持力の増加は、例えばPID型制御を通じて連続的に実行される。これらの実施の形態では、例えば、グリッパは、把持力を連続的に制御するために処理ユニットによって制御可能な比例制御手段を備える。
一実施の形態では、基準位置は、前記の近接センサ14等の1以上の位置センサ、及び/又は、圧力中心センサ18によって検出される。
一実施の形態では、基準位置は、少なくとも1つの位置センサ及び/又は少なくとも1つの圧力中心センサから、例えば1秒又は2秒の所定の時間間隔で取得される一組の測定値の平均として計算される。
例えば、少なくとも1つの位置センサから得られた位置データと基準位置との間の差が所定の閾値よりも大きい場合、及び/又は、少なくとも1つの圧力中心センサから得られた位置データと基準位置との間の差が所定の閾値よりも大きい場合、基準位置に対する物体の変位が検出される。
一実施の形態では、上述の制御方法は、有限のステートマシンを用いて実装され、その状態図が図4及び図5に示されている。
5つの状態は以下の通りである。
-状態1-アイドル。グリッパのジョー12は開いており、動作は実行されない。近接センサ14は、把持対象の物体を検出するために把持領域を常時監視する。
-状態2-把持。処理ユニット20は、所望の力レベルF1を生成する。グリッパは物体を把持するが安定した把持はまだ得られておらず、つまり、|F1-Fm| > ThFである。
-状態3-zero計算。物体の基準位置(zero)が計算される。
-状態4-保持。グリッパが物体を把持し、把持が安定しているかどうかを確認する。
-状態5-締め付け。所望の力レベルF2が処理ユニット20によって生成される。グリッパは、物体の滑りを防止するために物体にかかる力を増加させる。
図4中の図に示される一実施の形態では、状態間の遷移条件が以下に説明される。
-物体が検出される。グリッパジョー間の物体の位置は、Pos < ThPos1であるように特定の閾値を下回る。いくつかの実施の形態では、他のパラメータ(例えば、Pos量の分散)も評価され得る。
-安定した把持。把握力は安定していると考えられ、つまり、|F1-Fm| < ThFである。
-zeroが計算される。「zero」位置は、把握力が安定であるときに計算される。いくつかの実施の形態では、zero位置は、近接センサ及び/又は圧力中心センサから1秒又は2秒等の所定の時間間隔にわたって得られた多数のサンプルの平均である。
-物体の動きが検出される-。物体の位置及び/又はCoPベクトルのノルムが「zero」基準位置から離れた場合、つまり、(Pos-Zero) > ThPos2及び/又は(||CoP||-Zero) > ThCoPである場合に、把持された物体の動きが検出される。
-リリースが要求される。グリッパは物体をリリースするように命令される。これは、把持動作が終了したときに起きる。この条件は、状態4に関係なく、すなわち基準位置からの物体の変位が検出されなくても発生する可能性がある。
図5の実施の形態では、以下の追加の遷移条件も示されている。
-安定した把持の失敗:把握力が不安定であると考えられる場合、つまり、|F1-Fm| > ThFである場合、ステートマシンはアイドル状態1に戻る。
-zero計算の失敗:「zero」位置の計算が正常に完了しない場合、把持デバイスは、加工対象物(workpiece)を把持して移動する動作を継続しない。その後、把持動作を再度開始する必要がある。ユーザが手動で再起動してもよいし、ロボットシステムが、アイドル状態1から再起動して自動的に把持動作を再開するようにプログラムされてもよい。例えば、zeroの計算が成功すると、制御モニタのインジケータライトが点灯する。前記のライトが、ユーザが定義可能な期間、例えば10秒間消灯したままである場合、把持動作は最初から再開される。
したがって、把握制御アルゴリズムでは次のことが可能になる。
-物体が把持のための正しい位置にあることを認識する。
-把持された物体がグリッパジョーの間に適切に保持されるときを認識する。
-物体の滑りを防止するために把持された物体が動いているかどうかを認識する。
そのため、アルゴリズムは、グリッパを、そのジョーの間の物体の存在を確認するステップから、したがって実際の把持動作を開始する前であっても、前記の把持動作の完了まで制御する。
アイドル状態では、グリッパは何もせず、把持動作を始めるまで「待機」する。物体の位置が正しいとみなされる場合、つまり近接センサの出力が許容範囲内にある場合、グリッパは物体を把持するように命令される。
次の状態に移る前に、把持の安定性が確認される。安定性は、測定された力を制御することによって確保される。測定された力は、所望の力(F1)に近くなければならない。
これが起こると、物体がグリッパジョーの間に安定して把持された状態で、基準位置が計算される。
この目的のために、物体の位置は、数秒等の所定の時間間隔で観測される。基準位置又は「zero」は、取得された対応する数の測定値の平均として計算され得る。その後、基準位置は「保持」状態で使用され、場合によっては「締め付け」状態でも使用されます。
この目的のために、物体の位置は、数秒等の所定の時間間隔で観測される。基準位置又は「zero」は、取得された対応する数の測定値の平均として計算され得る。その後、基準位置は「保持」状態で使用され、場合によっては「締め付け」状態でも使用されます。
実際、「保持」状態では、このように計算されたzero基準位置に対する物体の動きは、把持力を第2のレベルF2まで増加させることによって補償されるだろう。この目的のために、閉ループ力制御アルゴリズムが用いられる。
物体の動きが検出される遷移は複数回発生する可能性があり、第2の力レベルF2に対して複数の力レベルが大きい場合であっても、「締め付け」状態を繰り返すことによって補償され得る。
一実施の形態では、「zero」位置は次のように計算される。
ここで、CoPkは瞬間kにおけるCoPの2つの成分を含むベクトルであり、nは固定の時間間隔で蓄積されたCoPk値の総数であり、これもユーザ定義可能である。CoPのkノルム値で構成される観測窓の長さに関係なく、把持デバイスはzero位置を計算するためにこれらの値が収集されるまで待つ必要がある。したがって、zero位置は新しい把持動作ごとに更新される。
zero位置が利用可能になると、アルゴリズムは、ワークピースの把持(保持)を提供する。この時点でのみ、把持装置の処理ユニットは、ワークピースの滑りの可能性を瞬間毎に評価する。
一実施の形態では、CoPとzero位置との間の差分ベクトルのノルムDが、所定の閾値に対して評価される。数式では、これは次のようになる。
CoPiは、zero位置を計算した後のi番目の瞬間におけるCoPの値として定義される。Dが事前に定義された閾値を超えた場合に限り、把持されたワークピースの検出された滑りの結果として、物体の動きが検出される遷移が発生する。
提案された制御方法は、意図した目的を達成する。
技術水準の把持システムは、把持された物体が安定して把持されているかどうかを確認しない。 加えられた力が望ましい力と一致するかどうかがわからないまま、物体が持ち上げられて保持される(例えば、コスタンゾ(Costanzo)ら, 2000年を参照)。本発明による制御方法は、有効把持力が所定の把持力(安定な把持遷移:|F1-Fm| < ThF)に近いかどうかを確認することにより、この問題を解決する。
技術水準の把持システムは、把持された物体の基準位置を計算しない(例えば、ハセガワ(Hasegawa)ら、2010年参照)。これにより、把持に不確実性が生じる可能性がある。本発明は、物体が安定して把持されているときの物体の基準位置を計算することにより、この問題を解決する。この位置は、一度計算されると、グリッパの動作中に変更されない。
技術水準の把持システムでは、滑り現象を検出するために圧力中心が使用される場合、電圧出力を備えた追加のセンサによって圧力中心が測定される(例えば、ハセガワ(Hasegawa)ら、2010年参照)。好ましい実施の形態では、本発明は、把持力と圧力中心(CoP)の両方が同じセンサによって測定されるため、この問題を解決する。
本発明による制御方法により、物体が把握される正しい位置にあるときを認識することが可能になる。
圧力中心を検出することで、加えられた圧力が集中している箇所を知ることができる。
提案された制御方法では、物体が安定して把持されている場合にのみ、把持された物体の基準位置が計算され、その基準位置に対する変位が検出される。
本発明による方法は、物体が基準位置から移動するときを認識し、それに応じて力補正を適用する。
当業者は、付随的な要求を満たすために、本発明による物体の把持を制御する方法及びグリッパの実施の形態に対して、いくつかの変更、調整、適応、及び、要素の、機能的に同等の他の要素への置換を行い得る。可能な実施の形態に属するものとして説明される各特徴は、他の説明される実施の形態とは独立して取得され得る。
Claims (16)
- グリッパを用いた物体の把持を制御する方法であって、
ステップa)所定の把持力(F1)で前記物体を把持するように前記グリッパに命令すること、
ステップb)有効把持力(Fm)を測定すること、
ステップc)前記所定の把持力と前記有効把持力との差が所定の閾値(ThF)を下回る場合、前記グリッパと一体の基準系に対して前記把持された物体の基準位置を計算すること、
ステップd)前記把持された物体の位置を監視すること、
ステップe)前記基準位置に対する前記把持された物体の変位が検出された場合、把持力を増加するように前記グリッパに命令すること、
を含む、
方法。 - ステップe)の後、前記方法は、ステップd)から繰り返される、
請求項1の方法。 - 前記基準位置は、少なくとも1つの位置センサ及び/又は少なくとも1つの圧力中心センサを用いて検出される、
請求項1又は2の方法。 - 前記基準位置は、前記少なくとも1つの位置センサにより、及び/又は、前記少なくとも1つの圧力中心センサにより、所定の時間間隔で得られた一組の測定値の平均として計算される、
請求項3の方法。 - 前記少なくとも1つの位置センサにより得られた位置データと前記基準位置との差が所定の閾値を上回った場合、及び/又は、前記少なくとも1つの圧力中心センサにより得られた位置データと前記基準位置との差が所定の閾値を上回った場合、前記基準位置に対する前記把持された物体の変位が検出される、
請求項3又は4の方法。 - ステップa)の前に、
把持対象の前記物体の存在を検出するために把持領域を監視するステップ、
把持対象の前記物体の位置を所定の把持位置と比較するステップ、
があり、
前記所定の把持位置は、前記物体が把持されるためにとらなければならない位置であり、
前記物体の位置と前記把持位置との間の距離が所定の閾値を下回る場合に、ステップa)が実行される、
先行する請求項のいずれか1つの方法。 - ステップe)の間、前記把持力の増加は継続的に実行される、
先行する請求項のいずれか1つの方法。 - グリッパであって、
グリッパ本体と、
前記グリッパ本体に対して、アイドル開位置と、物体の把持のための閉位置との間で移動可能な少なくとも2つの把持ジョーと、
少なくとも1つの近接センサであって、前記少なくとも1つ近接センサの視野内で把持対象の前記物体の存在を検出するのに適した少なくとも1つの近接センサと、
前記ジョーにより前記物体に与えられる前記把持力を測定するのに適した把持力センサと、
前記ジョーが前記物体に把持力を与えているときに前記グリッパジョー間の圧力中心の座標を検出するのに適した少なくとも1つの圧力中心センサと、
前記グリッパの制御方法を実行するようにプログラムされた処理ユニットと、
を備え、
前記制御方法は、
ステップa)所定の把持力(F1)で前記物体を把持するように前記グリッパに命令すること、
ステップb)有効把持力(Fm)を前記把持力センサにより測定すること、
ステップc)前記所定の把持力と前記有効把持力との差が所定の閾値(ThF)を下回る場合、前記少なくとも1つの位置センサ及び/又は前記少なくとも1つの圧力中心センサから受け取った測定値を用いて、前記グリッパと一体の基準系に対して前記把持された物体の基準位置を計算すること、
ステップd)前記把持された物体の位置を監視すること、
ステップe)前記基準位置に対する前記物体の変位が検出された場合、把持力を増加するように前記グリッパに命令すること、
を含む、
グリッパ。 - 前記処理ユニットは、ステップe)を実行した後、ステップd)から前記制御方法を繰り返すようにプログラムされる、
請求項9のグリッパ。 - 前記処理ユニットは、前記基準位置を、前記少なくとも1つの位置センサにより、及び/又は、前記少なくとも1つの圧力中心センサにより、所定の時間間隔で得られた一組の測定値の平均として計算するようにプログラムされる、
請求項9又は10のグリッパ。 - 前記近接センサは、超音波又は赤外線センサである、
請求項9~12のいずれか1つのグリッパ。 - 前記力センサ及び/又は前記圧力中心センサは、触覚皮膚を提供するために、例えば、容量型のセンサユニットアレイを用いて、及び/又は、力/トルクセンサを用いて形成される、
先行する請求項のいずれか1つのグリッパ。 - 前記処理ユニットは、また、
前記少なくとも1つの近接センサを用いて、把持対象の前記物体の存在を検出するために把持領域を監視し、
把持対象の前記物体の位置を所定の把持位置と比較するように、
プログラムされ、
前記所定の把持位置は、前記物体が把持されるためにとらなければならない位置であり、
前記処理ユニットは、前記物体の位置と前記把持位置との間の距離が所定の閾値を下回る場合に、前記所定の把持力(F1)で前記物体を把持するように前記グリッパに命令するようにプログラムされる、
請求項9~14のいずれか1つのグリッパ。 - 前記処理ユニットにより、前記把持力を継続的に制御するように命令可能な比例制御手段を備える、
請求項9~15のいずれか1つのグリッパ。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
IT102021000008006A IT202100008006A1 (it) | 2021-03-31 | 2021-03-31 | Metodo di controllo di una pinza di presa |
IT102021000008006 | 2021-03-31 | ||
PCT/IB2022/052941 WO2022208384A1 (en) | 2021-03-31 | 2022-03-30 | Method for controlling a gripper |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2024511833A true JP2024511833A (ja) | 2024-03-15 |
Family
ID=77021720
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2023560302A Pending JP2024511833A (ja) | 2021-03-31 | 2022-03-30 | グリッパを制御する方法 |
Country Status (5)
Country | Link |
---|---|
EP (1) | EP4313511A1 (ja) |
JP (1) | JP2024511833A (ja) |
CN (1) | CN117279748A (ja) |
IT (1) | IT202100008006A1 (ja) |
WO (1) | WO2022208384A1 (ja) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115510727B (zh) * | 2022-11-15 | 2023-03-24 | 佛山科学技术学院 | 一种抓取机构稳定抓持力阈值计算及其控制方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5187552B2 (ja) * | 2007-09-13 | 2013-04-24 | ソニー株式会社 | 制御装置および方法、プログラム並びに記録媒体 |
KR101479232B1 (ko) * | 2008-05-13 | 2015-01-06 | 삼성전자 주식회사 | 로봇과 로봇 핸드, 로봇 핸드의 제어 방법 |
US8515579B2 (en) | 2009-12-09 | 2013-08-20 | GM Global Technology Operations LLC | Systems and methods associated with handling an object with a gripper |
JP7276318B2 (ja) * | 2018-03-27 | 2023-05-18 | ソニーグループ株式会社 | 制御装置、制御方法、および、プログラム |
US20220274262A1 (en) * | 2019-07-23 | 2022-09-01 | Sony Group Corporation | Control device, control method, and control program |
-
2021
- 2021-03-31 IT IT102021000008006A patent/IT202100008006A1/it unknown
-
2022
- 2022-03-30 CN CN202280026859.2A patent/CN117279748A/zh active Pending
- 2022-03-30 WO PCT/IB2022/052941 patent/WO2022208384A1/en active Application Filing
- 2022-03-30 JP JP2023560302A patent/JP2024511833A/ja active Pending
- 2022-03-30 EP EP22726167.4A patent/EP4313511A1/en active Pending
Also Published As
Publication number | Publication date |
---|---|
EP4313511A1 (en) | 2024-02-07 |
CN117279748A (zh) | 2023-12-22 |
IT202100008006A1 (it) | 2022-10-01 |
WO2022208384A1 (en) | 2022-10-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10564635B2 (en) | Human-cooperative robot system | |
US9694499B2 (en) | Article pickup apparatus for picking up randomly piled articles | |
CN113825598A (zh) | 物体抓取系统和方法 | |
KR20190073282A (ko) | 파지 장치, 학습 장치, 학습 완료 모델, 파지 시스템, 판정 방법, 및 학습 방법 | |
CN113483874A (zh) | 测定零件的重量的重量测定系统以及方法 | |
KR20120053274A (ko) | 로봇 제어방법 | |
JP2015208834A (ja) | ワークを把持して搬送するロボットの安全監視装置 | |
KR20190062583A (ko) | 파지력 설정 시스템, 파지력 설정 방법, 및 파지력 추정 시스템 | |
JP2010069587A5 (ja) | ロボットシステムおよびロボットの制御方法 | |
JP2024511833A (ja) | グリッパを制御する方法 | |
WO2021141039A1 (ja) | ワーク搬送システム | |
JP2012056074A (ja) | 力またはインピーダンス制御ロボットの作業空間安全動作 | |
JP6514260B2 (ja) | 制御装置及び機械学習装置 | |
US8483879B2 (en) | Human-robot interactive system having a human stiffness estimation control algorithm | |
KR102400668B1 (ko) | 매니퓰레이터와 입력 툴을 이용하여 대상물을 핸들링하는 방법 | |
JP2021194725A (ja) | 目標力上限値設定方法およびロボットシステム | |
JP4737099B2 (ja) | ロボットおよびロボットの制御装置と制御方法 | |
JPH06126684A (ja) | 物体把持装置及びその制御方法 | |
JPH10249767A (ja) | 移動型物体把持装置及びその制御方法 | |
WO2023180699A1 (en) | Grip force control in a surgical robotic system | |
CN111867791A (zh) | 控制装置、控制方法和程序 | |
JP2010271118A (ja) | 摩擦係数同定方法、把持制御方法、この把持制御方法を行うロボットハンド及びプログラム | |
WO2021065880A1 (ja) | ロボット制御システム、ロボット制御方法およびプログラム | |
JP2838582B2 (ja) | ロボットハンドの把持制御方法 | |
JP6532531B2 (ja) | 医療用マニピュレータ制御装置 |