JP2022526351A - ロボットグリッパ、およびロボットグリッパの操作方法 - Google Patents

Abstract

本発明は、ロボットグリッパ（１００）、およびかかるロボットグリッパ（１００）の操作方法に関する。ロボットグリッパ（１００）は、Ｎ個の能動素子ＷＥｎ（１０３）を有するパワートレインＡＳ（１０２）を駆動するための少なくとも１の駆動ユニットＡＥ（１０１）であって、各能動素子ＷＥｎ（１０３）はロボットグリッパに対して本体が固定された形で配された作業領域ＡＢｎを有し、作業領域において能動素子ＷＥｎが運動可能であり、これが作業領域に到達する、少なくとも１の駆動ユニットＡＥ（１０１）と、少なくとも１の駆動ユニットＡＥ（１０１）を制御するための制御ユニット（１０４）と、制御ユニット（１０４）に接続され、各能動素子ＷＥｎ（１０３）に外部から与えられる、ｎ＝１，２，…，ＮおよびＮ≧１であるフォース／モーメントＦｅｘｔ，ＷＥｎ（ｔ）を確定するためのセンサーシステム（１０５）とを備える。制御ユニット（１０４）は、能動素子ＷＥｎ（１０３）の衝突監視が行われるよう構成され、能動素子ＷＥｎ（１０３）の衝突イベントが検知された場合には、指定の操作に従って駆動ユニットＡＥ（１０１）が動作されるよう構成される。この操作は、都度、能動素子ＷＥｎのそれぞれの作業領域ＡＢｎに定義領域Ｂｎを設け（２０１）、各能動素子ＷＥｎ（１０３）が割当領域Ｂの外部に位置するときのみ能動素子ＷＥｎ（１０３）の衝突監視を行い、各能動素子ＷＥｎが少なくとも部分的に割当領域Ｂｎ内に位置するときは能動素子ＷＥｎの衝突監視を停止する（２０２）。【選択図】図２

Description

本発明は、ロボットグリッパ、およびロボットグリッパの操作方法に関する。

ロボットグリッパ（「グリッパ」または「グリップシステム」または「エフェクタ」または「エンドエフェクタ」とも呼ぶ）は、先行技術において知られている。ロボットグリッパは、通常、ロボットマニピュレータの遠位端に配置されて、オブジェクト／ツールを把持および／または保持するタスクを行う。

ロボットグリッパは、通常、駆動ユニットと、能動素子を動かすパワートレイン（運動学的システムとも呼ぶ）と、例えばロボットマニピュレータへのロボットグリッパの取り外し可能な固定接続のための機械的インターフェースと、ロボットグリッパの操作に必要なエネルギーを供給するためのエネルギーインターフェースと、（例えば中央ロボット制御装置から）制御信号を供給するための制御信号インターフェースとを備える。

能動素子は、ロボットグリッパの要素であり、オブジェクトを把持および保持する際にオブジェクトに直接接触して、その過程でオブジェクトに対して把持力を与える。ロボットグリッパがどのようにオブジェクトを保持可能であるかについては様々な可能性がある。ここでは、例えば、フォースメイティング、形状メイティング、物質メイティングなどの、異なるアクティブメイティングを区別する。また能動素子自体についても、例えば、（平行ジョーグリッパの）グリッパジョーまたは（人工ハンドの）多部材フィンガーというような様々な形で存在する。

駆動ユニットは、把持または保持プロセスに必要な動力学的エネルギーを生成する。駆動ユニットは、パワートレインを駆動し、対応する能動素子の動作を生成する。これによって、ロボットグリッパによる開閉およびオブジェクトの保持が可能となる。

パワートレインは、駆動ユニットによって生成された動力学的エネルギーの能動素子への伝達に用いられ、これによって、駆動ユニットの運動を、ロボットグリッパの駆動動作、すなわち対応する能動素子の動作へと変換する。

本発明の目的は、安全性の向上した操作を可能とするロボットグリッパを提供することにある。

本発明は、独立請求項の特徴に由来する。好都合な発展形および実施形態は、従属請求項の主題である。本発明のさらなる特徴、適用可能性、および利点は、以下の説明および本発明の実施形態の説明に由来するものであり、これらは図面に示されている。

本発明の第一の局面は、ロボットグリッパの操作方法に関し、前記ロボットグリッパは、Ｎ個の能動素子ＷＥ_ｎを有するパワートレインＡＳを駆動するための少なくとも１の駆動ユニットＡＥであって、各能動素子ＷＥ_ｎは前記ロボットグリッパに対して本体が固定された形で配された作業領域ＡＢ_ｎを有し、前記作業領域において当該能動素子ＷＥ_ｎが運動可能であり、これらが前記作業領域に到達する、少なくとも１の駆動ユニットＡＥと、前記少なくとも１の駆動ユニットＡＥを制御するための制御ユニットと、前記制御ユニットに接続され、前記各能動素子ＷＥ_ｎに外部から与えられる、ｎ＝１，２，…，ＮおよびＮ≧１であるフォース／モーメントＦ_{ｅｘｔ，ＷＥｎ}（ｔ）を確定するためのセンサーシステムとを備え、前記制御ユニットは、前記能動素子ＷＥ_ｎの衝突監視が行われるよう構成され、能動素子ＷＥ_ｎの衝突イベントが検知された場合には、指定の操作に従って前記駆動ユニットＡＥが動作されるよう構成され、前記操作は、都度、前記能動素子ＷＥ_ｎのそれぞれの作業領域ＡＢ_ｎに定義領域Ｂ_ｎを設け、前記各能動素子ＷＥ_ｎが前記割当領域Ｂ_ｎの外部に位置するときのみ前記能動素子ＷＥ_ｎの前記衝突監視を行い、前記各能動素子ＷＥ_ｎが少なくとも部分的に前記割当領域Ｂ_ｎ内に位置するときは上記能動素子ＷＥ_ｎの前記衝突監視を停止する。

この場合、駆動ユニットＡＥは、ロボットグリッパから与えられたエネルギー（例えば、空気エネルギー、油圧エネルギー、または電気エネルギー）を機械的エネルギー、すなわち、運動に変換する。この運動は、好都合には、並進および／または回転運動である。好都合には、駆動ユニットは、与えられた電気エネルギー（電位Ｕ、電流Ｉ）を機械的回転に変換する電気モーターである。用途によっては、当然ながらその他の駆動ユニット、例えば、パワートレインを駆動する油圧モーターまたは空気モーターなどが適切である。好都合には、駆動ユニットは、複数の能動素子ＷＥ_ｎ、特に、２つの能動素子ＷＥ_{ｎ＝１，２}を駆動する。好都合には、ロボットグリッパは、それぞれ１つ以上の能動素子ＷＥ_ｎを駆動する複数の駆動ユニットを有する。駆動ユニットＡＥは、特に、回転運動を減速または加速するトランスミッションを備えてもよい。

パワートレインＡＳ（運動学的システムとも呼ぶ）は、駆動ユニットＡＥによって生じた機械的運動を、これに応じて動くように１つ以上の能動素子ＷＥ_ｎへ伝達する。パワートレインＡＳをロボットグリッパへ機械的に実装するための複数の実装方法が、先行技術において知られている。特に好都合には、パワートレインＡＳは、ベルト、特に歯付きベルトを備えている。

能動素子ＷＥ_ｎの作業領域ＡＢ_ｎは、それぞれ、ロボットグリッパに本体が固定された形で設けられ、能動素子ＷＥ_ｎが運動可能かつこれらが到達可能な領域を示している。よって、作業領域ＡＢ_ｎは、特に能動素子ＷＥ_ｎが最大限に開いているときの能動素子ＷＥ_ｎ同士の間に広がる領域によって定義される。作業領域ＡＢ_ｎがロボットグリッパに対して本体が固定された形で定義されるため、作業領域ＡＢ_ｎは、ロボットグリッパの位置および方向にかかわらず、常に同一のままである。

本発明によれば、ロボットグリッパは、各能動素子ＷＥ_ｎに外部から与えられ、ｎ＝１，２，…，ＮおよびＮ≧１であるフォース／モーメントＦ_{ｅｘｔ，ＷＥｎ}（ｔ）を確定するためのセンサーシステムを備える。従って、ロボットグリッパの他の部分、例えばロボットグリッパの筐体に与えられるフォース／モーメントは、このセンサーシステムによって取得されない。

好都合には、能動素子ＷＥ_ｎにセンサーが設けられていない。そのため、能動素子ＷＥ_ｎの各センサーに対するケーブル接続が省略される。好都合には、能動素子ＷＥ_ｎは交換可能である。よって、好都合には、例えば、フォースメイティング、形状メイティング、物質メイティングなどの異なるアクティブメイティングを把持または保持の間可能とするために、異なるタイプの能動素子ＷＥ_ｎをパワートレインＡＳに接続することができる。

作業領域ＡＢ_ｎにおける領域Ｂ_ｎの配置は、例えば、制御ユニットへの対応する入力、制御ユニットの対応するデータメモリの読み込み、ロボットグリッパのデータインターフェースを介した制御ユニットへのデータ伝送、ロボットグリッパに対する手動または自動の「ティーチイン」プロセスによって行われ、その後、制御ユニットのデータメモリに保存される。

本発明によれば、制御ユニットは、能動素子ＷＥ_ｎが割当領域Ｂ_ｎの外部に位置するときのみ能動素子ＷＥ_ｎの衝突監視が行われるよう構成され、能動素子ＷＥ_ｎが少なくとも部分的に割当領域Ｂ_ｎ内に位置するときにのみ能動素子ＷＥ_ｎの衝突監視を停止するよう構成される。

領域Ｂ_ｎは、好都合には、把持対象のオブジェクトの外部形状ＡＧに応じて定義される。ここで、外部形状ＡＧは、例えば球形のオブジェクトの場合には、オブジェクトの直径によって定義可能である。ここで、領域Ｂ_ｎは、好都合には、領域Ｂ_ｎが把持対象のオブジェクトの外部形状ＡＧ（オブジェクトの端部／表面）およびその外部に隣接する差分領域ΔＢ_ｎを含むように選択／定義され、Ｂ_ｎ＝ＡＧ＋ΔＢ_ｎである。ここで、差分領域ΔＢ_ｎの大きさは、課題の定義、適用される安全規格（例えば、ジャミング防止）、および／または把持対象のオブジェクトの繊細さ／破断強度に応じて選択される。

オブジェクトの把持を目的とする本方法を実行する際には、領域Ｂ_ｎ、すなわち把持に最適なように位置づけられたオブジェクト周囲のゾーン（差分領域ΔＢ_ｎ）の外部でのみ、衝突監視／衝突検出が適切に行われる。この例において、当該ゾーン内では衝突監視／衝突検出が停止される。

好都合には、各作業領域ＡＢ_ｎは、三次元または二次元または一次元の領域である。好都合には、各領域Ｂ_ｎは、三次元または二次元または一次元の領域である。

提案される方法の特に好適な発展形において、ロボットグリッパは、２つの能動素子ＷＥ_{ｎ＝１，２}を有する平行グリッパとして構成されており、共通作業領域ＡＢおよび共通領域Ｂは、能動素子ＷＥ_{ｎ＝１，２}のスペーシングレンジによって規定される。好都合には、作業領域ＡＢは、能動素子ＷＥ_{ｎ＝１，２}が互いに対してとることのできる最小スペーシングＡ_ＭＩＮから最大スペーシングＡ_ＭＡＸまでのスペーシングレンジとして定義される。課題の定義に応じて、これにしたがって本発展形の領域Ｂは、スペーシング最大値Ａ_Ｂによって指定され、よってＡ_ＭＩＮからスペーシングＡ_Ｂの全てのスペーシングＡを網羅する。

よって、領域Ｂは、能動素子ＷＥ_{ｎ＝１，２}の互いに対するスペーシングＡによって定義され、ここで、Ａ_ＭＩＮ≦Ａ＜Ａ_Ｂ、またはＡ_ＭＩＮ≦Ａ≦Ａ_Ｂ、およびＡ_Ｂ＜Ａ_ＭＡＸである。本発展形においては、能動素子ＷＥ_{ｎ＝１，２}のスペーシングＡがＡ＞Ａ_ＢまたはＡ≧Ａ_Ｂであるときのみ、能動素子ＷＥ_{ｎ＝１，２}の衝突監視が行われる。特に好適には、平行グリッパの能動素子（グリッパジョー）にセンサーがない。

本方法にかかる衝突監視の作動または停止は、能動素子ＷＥ_ｎの現在位置に応じて、また定義領域Ｂ_ｎに応じて、原則として、オブジェクトがロボットグリッパに対してこのロボットグリッパによって把持可能なように配置されているかどうかとは無関係に行われる。すなわち、能動素子ＷＥ_ｎの間にオブジェクトが配置されていない場合でも、各能動素子ＷＥ_ｎが割当領域Ｂ_ｎの外部に配置されているときのみ能動素子ＷＥ_ｎの衝突監視が行われ、各能動素子ＷＥ_ｎが少なくとも部分的に割当領域Ｂ_ｎ内に配置されているときは能動素子ＷＥ_ｎの衝突監視が停止される。

上記ロボットグリッパの好都合な発展形は、ロボットグリッパがセンサーを有し、このセンサーによってロボットグリッパの把持領域におけるオブジェクトの有無が取得されることに特徴づけられる。すなわち、当該センサーが、オブジェクトが現在ロボットグリッパによって把持可能なように配置されていることを取得することに特徴づけられる。このセンサーによって把持領域のオブジェクトが確定された場合、能動素子ＷＥ_ｎの衝突監視は、これら能動素子ＷＥ_ｎが少なくとも部分的に指定の領域Ｂ_ｎ内にあるならば、停止される。このセンサーによって把持領域にオブジェクトがないことが確定された場合、好都合には、領域Ｂ_ｎにおける衝突監視は停止されない。この場合、ロボットグリッパの全作業領域において衝突監視が行われる。

好都合には、ロボットグリッパの把持領域におけるオブジェクトを確定するセンサーは、例えば、カメラセンサー、超音波センサー、レーザーセンサー、赤外線センサー、容量センサー、誘導センサー、マイクロ波センサー、またはこれらの組み合わせである。

提案される方法の好都合な発展形は、衝突監視がロボットグリッパの指定の動的モデルに基づいて行われることに特徴づけられる。この動的モデルは、ロボットグリッパの要素およびそれらの動的相互作用をシミュレーションすることができる数学モデルである。特に、駆動ユニットのクローズドループおよびオープンループ制御の制御ユニットは、この動的モデルに基づく。

提案される方法の発展形によれば、この操作は、以下の非包括的なリストの可能性から選択される。
・駆動ユニットＡＥを停止する。
・重力補正のために駆動ユニットＡＥを作動させる。
・摩擦補償のために駆動ユニットＡＥを作動させる。
・能動素子ＷＥ_ｎから離れる制御された連続動作が行われるように、駆動ユニットＡＥを作動させる。
・能動素子ＷＥ_ｎから離れる反射的な動作が行われるように、駆動ユニットＡＥを作動させる。

好都合には、作業領域ＡＢ_ｎにおける領域Ｂ_ｎの定義は、ロボットグリッパに対する手動または自動のティーチインプロセスによって行われる。好都合には、ティーチインプロセスは、以下のステップを含む。
・各能動素子ＷＥ_ｎがオブジェクトに機械的に接触するようにオブジェクトを把持し、この過程で能動素子ＷＥ_ｎに包囲された領域が領域ＡＧ_ｎを定義する。
・領域Ｂ_ｎであって、領域ＡＧ_ｎが指定のデルタ領域ΔＢ_ｎによって外向きに広がる領域Ｂ_ｎを、Ｂ_ｎ＝ＡＧ_ｎ＋ΔＢ_ｎとなるように確定する。
・Ｂ_ｎを保存する。

好ましくは、Ｂ_ｎの保存は、ロボットグリッパのメモリユニットに対して行われる。

領域Ｂ_ｎを適切に選択することにより、特に人間と共同で行われるグリッパの操作中、特にロボットグリッパの把持プロセスを自動で行う際の、ジャミングのリスクを予防または少なくとも大幅に低減することができる。

例えば、直径５ｃｍ（ＡＧ＝５ｃｍ）の球体を平行グリッパによって把持しようとする場合、２個のグリッパジョーについて、共通領域Ｂ＝ＡＧ＋ΔＢは、好都合には、５．５ｃｍのグリッパジョーのスペーシングによって定義される。これにより、球体がグリッパジョーの間の中央に配置される場合、グリッパジョーが互いに向かってさらに移動する際の衝突監視が停止される前に、球体の両側に２．５ｍｍ（＝ΔＢ／２）が残ることになる。好都合には、球体の両側の２．５ｍｍは、グリッパジョーと球体の間に人間の指が入らないように測定される。

よって、提案される方法は、特に、ロボットグリッパと操作者の共同作業中における安全性を向上させる。

ロボットグリッパは、ロボットのマニピュレータに接続されていれば、ロボットの中央制御装置からの制御コマンドを受信することができる。これらの制御コマンドは、ロボットグリッパの制御ユニットに伝達される。ロボットグリッパの制御ユニットは、これら制御コマンドを変換し、原則としてこれにしたがって駆動ユニットを作動させて、本発明にかかる衝突監視ならびに本発明にかかる衝突監視の作動および停止をロボットグリッパの制御ユニットでローカルに行う。好都合には、能動素子ＷＥ_ｎについて検出された衝突が、ロボットグリッパの制御ユニットによってロボットの中央制御装置に伝達される。

本発明のさらなる局面は、ロボットグリッパであって、Ｎ個の能動素子ＷＥ_ｎを有するパワートレインＡＳを駆動するための少なくとも１の駆動ユニットＡＥであって、前記能動素子ＷＥ_ｎのそれぞれは、前記ロボットグリッパに対して本体が固定された形で配され、前記能動素子ＷＥ_ｎが運動可能であり、これらが達する作業領域ＡＢ_ｎを有する、少なくとも１の駆動ユニットＡＥと、上記少なくとも１の駆動ユニットＡＥのクローズドループおよびオープンループ制御のための制御ユニットと、上記制御ユニットに接続され、前記各能動素子ＷＥ_ｎに外部から与えられる、ｎ＝１，２，…，ＮおよびＮ≧１であるフォース／モーメントＦ_{ｅｘｔ，ＷＥｎ}（ｔ）確定するためのセンサーシステムとを備え、前記制御ユニットは、前記能動素子ＷＥ_ｎの衝突監視を行うことができるよう構成され、前記各能動素子ＷＥ_ｎが前記作業領域ＡＢ_ｎ内の指定された割当領域Ｂ_ｎの外部に位置するときのみ、前記能動素子ＷＥ_ｎの前記衝突監視が行われるよう構成され、能動素子ＷＥ_ｎが少なくとも部分的に前記割当領域Ｂ_ｎ内に位置するときは、前記能動素子ＷＥ_ｎの前記衝突監視が停止されるよう構成され、能動素子ＷＥ_ｎの衝突イベントが検知された場合には、指定の操作に従って前記駆動ユニットが動作されるよう構成される、ロボットグリッパに関する。

上記駆動ユニットＡＥは、好都合には、電気モーター、または油圧アクチュエータ、または空気圧式アクチュエータである。また、駆動ユニットＡＥは、伝達ユニットを備えてもよい。

好都合には、各駆動領域ＡＢ_ｎは、三次元または二次元または一次元領域である。好都合には、各領域Ｂ_ｎは、三次元または二次元または一次元領域である。

特に好適な発展形において、ロボットグリッパは、２つの能動素子ＷＥ_{ｎ＝１，２}を有する平行グリッパとして構成され、共通作業領域ＡＢおよび共通領域Ｂは能動素子ＷＥ_{ｎ＝１，２}のスペーシングレンジにより定義される。作業領域ＡＢは、好都合には、能動素子ＷＥ_{ｎ＝１，２}が互いに対してとることのできる最小スペーシングＡ_ＭＩＮから最大スペーシングＡ_ＭＡＸまでのスペーシングレンジとして定義される。課題の定義に応じて、本発展形の領域Ｂは、スペーシング最大値Ａ_Ｂによって相応に指定され、よってＡ_ＭＩＮからスペーシングＡ_ＢまでのスペーシングＡをすべて網羅する。

よって、領域Ｂは、能動素子ＷＥ_{ｎ＝１，２}の互いに対するスペーシングＡによって定義され、ここで、Ａ_ＭＩＮ≦Ａ＜Ａ_Ｂ、またはＡ_ＭＩＮ≦Ａ≦Ａ_Ｂ、およびＡ_Ｂ＜Ａ_ＭＡＸである。本発展形において、能動素子ＷＥ_{ｎ＝１，２}の衝突監視は、能動素子ＷＥ_{ｎ＝１，２}のスペーシングＡがＡ＞Ａ_ＢまたはＡ≧Ａ_Ｂであるときのみ行われる。特に好適には、平行グリッパの能動素子（グリッパジョー）はセンサーを有さない。

提案されるロボットグリッパの好都合な発展形において、制御ユニットは、ロボットグリッパの指定の動的モデルに基づいて衝突監視がおこなわれるよう構成される。

好都合には、制御ユニットは、外乱変数オブザーバ、特にパフォーマンスオブザーバまたはパルスオブザーバまたは速度オブザーバまたは加速度オブザーバを用いて、衝突監視がおこなわれるよう構成される。

好都合には、制御ユニットは、この操作が、以下の非包括的なリストの可能性から選択されるよう構成される。
・駆動ユニットＡＥを停止する。
・重力補正のために駆動ユニットＡＥを作動させる。
・摩擦補償のために駆動ユニットＡＥを作動させる。
・能動素子ＷＥ_ｎから離れる制御された連続動作が行われるように、駆動ユニットＡＥを作動させる。
・能動素子ＷＥ_ｎから離れる反射的な動作が行われるように、駆動ユニットＡＥを作動させる。

好都合には、ロボットグリッパは筐体を有し、筐体内部で少なくとも駆動ユニットＡＥと制御ユニットとが統合される。好都合には、制御ユニットは、プロセッサと、メモリユニットと、例えばロボットグリッパが接続されるロボットを制御する中央コンピュータの目標制御変数を指定するインターフェースと、を備える。

最後に、本発明は、上記のロボットグリッパを備えるロボットまたは人型ロボットに関する。

さらなる利点、特徴、および詳細は、任意に図面を参照し、少なくとも１の実施形態が詳細に記載される以下の説明から得られる。同一、類似、および／または機能的に等価な要素には、同一の参照符号をつける。

以下のとおり図に示す。

図１は、高度に模式化された方法の手順である。 図２は、提案されるロボットグリッパの高度に模式化された上記構成である。

図１は、ロボットグリッパの操作方法の手順を高度に模式化して示すものであり、ロボットグリッパは、Ｎ個の能動素子ＷＥ_ｎを有するパワートレインＡＳを駆動するための少なくとも１の駆動ユニットＡＥであって、各能動素子ＷＥ_ｎはロボットグリッパに対して本体が固定された形で配された作業領域を有し、作業領域において当該能動素子ＷＥ_ｎが運動可能であり、これらが作業領域に到達する、少なくとも１の駆動ユニットＡＥと、駆動ユニットＡＥを制御するための制御ユニットと、センサーユニットに接続され、各能動素子ＷＥ_ｎに外部から与えられる、ｎ＝１，２，…，ＮおよびＮ≧１であるフォース／モーメントＦ_{ｅｘｔ，ＷＥｎ}（ｔ）を確定するためのセンサーシステムとを備える。

制御ユニットは、能動素子ＷＥ_ｎについて、衝突監視が自律的およびローカルに（すなわち、外部制御ユニット、および／または外部プロセッサの必要なく）行われ、能動素子ＷＥ_ｎについて衝突が検出されたときは指定の操作にしたがって駆動ユニットが自律的およびローカルに作動されるよう構成される。

本方法は、ロボットグリッパの操作中、特にロボットグリッパによってオブジェクトが把持されている間に行われる、以下のステップを含む。第１のステップ２０１において、能動素子ＷＥ_ｎについて、それぞれ、割り当てられた作業領域ＡＢ_ｎ内への定義領域Ｂ_ｎの配置が行われる。

把持タスクを行うためにロボットグリッパが作動されている間、例えば、ロボットグリッパが接続されたロボットの外部中央制御装置によって制御されている間、ステップ２０２において、ロボットグリッパの制御ユニットによる能動素子ＷＥ_ｎの衝突監視の自律的な実行は、各能動素子ＷＥ_ｎが領域Ｂの外部に位置するときに常に行われ、能動素子ＷＥ_ｎの衝突監視はそれぞれの能動素子ＷＥ_ｎが少なくとも部分的に領域Ｂの外に位置するときに常に停止される。

好都合には、ロボットグリッパの制御ユニットは、能動素子ＷＥ_ｎの一つについて衝突が検出されたとき、衝突信号を生成する。好都合には、ロボットグリッパの制御ユニットは、能動素子ＷＥ_ｎの衝突監視が停止されたとき、停止信号を生成する。好都合には、ロボットグリッパは、これらの信号が外部制御ユニットに伝達されるように、インターフェースに衝突信号および／または停止信号を与える。

提案される方法の一実施形態において、少なくとも１の能動素子ＷＥ_ｎが少なくとも部分的に割当領域Ｂ_ｎの内部に位置するとき、全ての能動素子ＷＥ_ｎについて衝突監視が停止される。

図２は、平行グリッパとして実施される提案されたロボットグリッパ１００の高度に模式化された構成を示す。ロボットグリッパ１００は駆動ユニット１０１を備え、この場合、この駆動ユニットは、下流トランスミッション１１０を有する電気モーターとして構成され、Ｎ＝２個の能動素子ＷＥ_{ｎ＝１，２}１０３（グリッパジョーとも呼ぶ）を有するパワートレイン１０２の駆動に用いられる。駆動ユニット１０１は、互いに向かってまたは互いから離れるように運動し、これに応じて能動素子ＷＥ_{ｎ＝１，２}１０３のスペーシングＡが変化するようにパワートレイン１０２を介して能動素子ＷＥ_{ｎ＝１，２}１０３を駆動する。

２つの能動素子ＷＥ_{ｎ＝１，２}１０３は、ロボットグリッパに対して本体が固定された形で設けられた共通作業領域ＡＢを有し、能動素子ＷＥ_{ｎ＝１，２}１０３はこの領域内で移動可能またはこの領域をとることができる。この場合、作業領域ＡＢは、図２に示す、表示される位置Ａ_{ＭＡＸ，ｎ＝１}から中央（二点鎖線）に到達する、上部グリッパジョー１０３ａの第１作業領域ＡＢ_ｎ＝１と、図２に示す、表示される位置Ａ_{ＭＡＸ，ｎ＝２}から中央（二点鎖線）に到達する、下部グリッパジョー１０３ｂの第２作業領域ＡＢ_ｎ＝２とからなる。

よって、この場合、平行グリッパの構成された作業領域ＡＢは、能動素子ＷＥ_{ｎ＝１，２}１０３が互いに対してとることのできる、Ａ＝０（能動素子ＷＥ_{ｎ＝１，２}の最小スペーシング）から最大スペーシングＡ_ＭＡＸ＝｜Ａ_{ＭＡＸ，ｎ＝１}－Ａ_{ＭＡＸ，ｎ＝２}｜までの能動素子ＷＥ_{ｎ＝１，２}１０３のすべてのスペーシングＡに相当する（図２にＡＢで示す）。

また、平行グリッパは、駆動ユニット１０１を制御するための制御ユニット１０４と、制御ユニット１０４に接続され、各能動素子ＷＥ_{ｎ＝１，２}に外部から与えられる、ｎ＝１，２，…，Ｎ、およびＮ≧１であるフォース／モーメントＦ_{ｅｘｔ，ＷＥｎ}（ｔ）を確定するためのセンサーシステム１０５とを有する。

また、平行グリッパ１００は、電気エネルギーおよび外部制御ユニットからの制御信号用のインターフェース１１１を有する。インターフェース１１１は、少なくとも１の信号線１１２と少なくとも１の送電線１１３とによって制御ユニット１０４に接続されている。

平行グリッパ１００が、例えばエフェクタとしてロボットのマニピュレータに接続されている場合、例えば制御信号および平行グリッパ１００のエネルギーが、インターフェース１１１を介してロボットの中央制御装置に与えられる。

制御ユニット１０４は、能動素子ＷＥ_{ｎ＝１，２}１０３の衝突監視が行われるよう構成され、能動素子ＷＥ_{ｎ＝１，２}１０３の衝突監視は各能動素子ＷＥ_{ｎ＝１，２}１０３が作業領域ＡＢ内に位置する指定の領域Ｂの外に位置する場合にのみ行われ、各能動素子ＷＥ_{ｎ＝１，２}１０３が少なくとも部分的に領域Ｂの内部に位置するときは能動素子ＷＥ_{ｎ＝１，２}１０３の衝突監視が停止され、能動素子ＷＥ_{ｎ＝１，２}の衝突が検出された場合には指定の操作にしたがって駆動ユニット１０１が作動される。

この衝突監視は、原則として、制御コマンド、例えば外部のロボットの誤動作とは無関係に行われる。

領域Ｂ、すなわち本発明にかかる衝突監視が停止される領域は、この場合、課題の定義に応じて、スペーシング限界値Ａ_Ｂによって指定され、領域ＢはここでＡ＜Ａ_ＢまたはＡ≦Ａ_ＢおよびＡ_Ｂ＜Ａ_ＭＡＸである能動素子ＷＥ_{ｎ＝１，２}のスペーシングＡによって定義される。本発展形において、能動素子ＷＥ_{ｎ＝１，２}の衝突監視は、能動素子ＷＥ_{ｎ＝１，２}においてスペーシングが、＞または≧Ａ_Ｂである場合にのみ行われる。特に好適には、平行グリッパの能動素子（グリッパジョー）にはセンサーがない。

図２において、上記の領域において、球体（断面）がグリッパジョー１０３ａ，１０３ｂの間の中心部に配置されている状態を示しており、グリッパジョー１０３ａ，１０３ｂは、それぞれ最大限に移動した位置にある、すなわち最大スペーシングをとっている。示されるグリッパジョーの最大スペーシングは、作業領域ＡＢを定義する。作業領域ＡＢ内に位置する領域Ｂは、衝突監視が停止される領域を示す。この場合、球体の直径Ｄ＝ＡＧおよび球体の両側にあるセイフティゾーンΔＢ／２によって、領域Ｂが定義される。

球体を把持している間、グリッパジョーが図に示す位置から互いに向かって移動するときに、外部フォース／モーメントがグリッパジョーに加えられると、グリッパジョーがそれぞれ領域Ｂの外に位置する場合には対応する衝突が検出される。検出された衝突が、指定の操作、特に駆動ユニットの停止の原因となる。また、衝突信号がインターフェース１１１に与えられて外部制御ユニットに伝達される。

制御ユニット１０４における衝突監視は、平行グリッパ１００の指定の動的モデルに基づいて行われる。また、制御ユニット１０４の衝突監視は、外乱変数オブザーバを用いて行われる。

１００：ロボットグリッパ
１０１：駆動ユニット
１０２：パワートレイン
１０３：能動素子ＷＥ_ｎ
１０４：制御ユニット
１０５：センサーシステム
１１０：トランスミッション
１１１：電気エネルギーおよび外部制御ユニットの制御信号用のインターフェース
１１２：制御信号線
１１３：電気エネルギー線
２０１，２０２：方法のステップ

Claims (12)

1. ロボットグリッパの操作方法であって、
   前記ロボットグリッパ（１００）は、
   ・Ｎ個の能動素子ＷＥ_ｎ（１０３）を有するパワートレインＡＳ（１０２）を駆動するための少なくとも１の駆動ユニットＡＥ（１０１）であって、各能動素子ＷＥ_ｎ（１０３）は前記ロボットグリッパに対して本体が固定された形で配された作業領域ＡＢ_ｎを有し、前記作業領域において前記能動素子ＷＥ_ｎが運動可能であり、これが前記作業領域に到達する、少なくとも１の駆動ユニットＡＥ（１０１）と、
   ・前記少なくとも１の駆動ユニットＡＥ（１０１）を制御するための制御ユニット（１０４）と、
   ・前記制御ユニット（１０４）に接続され、前記各能動素子ＷＥ_ｎ（１０３）に外部から与えられる、ｎ＝１，２，…，ＮおよびＮ≧１であるフォース／モーメントＦ_{ｅｘｔ，ＷＥｎ}（ｔ）を確定するためのセンサーシステム（１０５）とを備え、
   前記制御ユニット（１０４）は、
   前記能動素子ＷＥ_ｎ（１０３）の衝突監視が行われるよう構成され、能動素子ＷＥ_ｎ（１０３）の衝突イベントが検知された場合には、指定の操作に従って前記駆動ユニットＡＥ（１０１）が動作されるよう構成され、
   前記操作は、
   ・都度、前記能動素子ＷＥ_ｎのそれぞれの作業領域ＡＢ_ｎに定義領域Ｂ_ｎを設け（２０１）、
   ・前記各能動素子ＷＥ_ｎ（１０３）が前記割当領域Ｂ_ｎの外部に位置するときのみ前記能動素子ＷＥ_ｎ（１０３）の衝突監視を行い、前記各能動素子ＷＥ_ｎが少なくとも部分的に前記割当領域Ｂ_ｎ内に位置するときは前記能動素子ＷＥ_ｎの衝突監視を停止する（２０２）、
   ロボットグリッパの操作方法。
2. 請求項１に記載の方法であって、
   前記ロボットグリッパ（１００）は、２つの能動素子ＷＥ_{ｎ＝１，２}（１０３）を有する平行グリッパであり、
   ・前記２つの能動素子ＷＥ_{ｎ＝１，２}（１０３）の共通作業領域ＡＢと、共通領域Ｂとは、前記能動素子ＷＥ_{ｎ＝１，２}（１０３）のお互いからのスペーシングＡを示すそれぞれのスペーシングレンジによって規定され、
   ・前記作業領域ＡＢは、前記能動素子ＷＥ_{ｎ＝１，２}が互いに対してとることのできる前記能動素子ＷＥ_{ｎ＝１，２}（１０３）の最小スペーシングＡ_ＭＩＮから最大スペーシングＡ_ＭＡＸのすべてのスペーシングＡを含み、
   ・前記領域Ｂは、前記能動素子ＷＥ_{ｎ＝１，２}（１０３）のＡ_ＭＩＮから指定のスペーシングＡ_ＢのすべてのスペーシングＡを含み、ここでＡ_ＭＩＮ≦Ａ＜Ａ_Ｂ、またはＡ_ＭＩＮ≦Ａ≦Ａ_Ｂ、およびＡ_Ｂ＜Ａ_ＭＡＸであり、
   ・前記能動素子ＷＥ_{ｎ＝１，２}（１０３）においてスペーシングＡ＞または≧Ａ_Ｂのときのみ前記能動素子ＷＥ_{ｎ＝１，２}（１０３）の衝突監視が行われる、方法。
3. 請求項１または請求項２のいずれかに記載の方法であって、
   前記衝突監視が、前記ロボットグリッパ（１００）の指定された動的モデルに基づいて行われる、方法。
4. 請求項１から請求項３のいずれか一項に記載の方法であって、
   前記衝突監視が、外乱変数オブザーバを用いて行われ、特にパフォーマンスオブザーバ、またはパルスオブザーバ、または速度オブザーバ、または加速度オブザーバによって行われる、方法。
5. 
6. 
7. 請求項１から請求項６のいずれか一項に記載の方法であって、
   前記操作は、
   ・前記駆動ユニットＡＥ（１０１）を停止する、
   ・重力補正のために前記駆動ユニットＡＥ（１０１）を作動させる、
   ・前記駆動ユニットＡＥ（１０１）－パワートレインＡＳ（１０２）システムにおける摩擦補償のために前記駆動ユニットＡＥ（１０１）を作動させる、
   ・前記能動素子ＷＥ_ｎから離れる制御された連続動作が行われるように、前記駆動ユニットＡＥ（１０１）を作動させる、
   ・前記能動素子ＷＥ_ｎから離れる反射的な動作が行われるように、前記駆動ユニットＡＥ（１０１）を作動させる、
   操作から選択される、方法。
8. 請求項１から請求項７のいずれか一項に記載の方法であって、
   前記作業領域ＡＢ_ｎにおける前記領域Ｂ_ｎの前記定義（２０１）は、前記ロボットグリッパに対する手動または自動のティーチインプロセスによって行われ、
   前記ティーチインプロセスは、
   ・前記能動素子ＷＥ_ｎ（１０３）のそれぞれがオブジェクトに機械的に接触するようにオブジェクトを把持し、この過程で前記能動素子ＷＥ_ｎ（１０３）に包囲された領域が領域ＡＧ_ｎを定義し、
   ・領域Ｂ_ｎであって、前記領域ＡＧ_ｎが指定のデルタ領域ΔＢ_ｎによって外向きに広がる領域Ｂ_ｎを、Ｂ_ｎ＝ＡＧ_ｎ＋ΔＢ_ｎとなるように確定し、
   ・Ｂ_ｎを保存する、
   ステップを含む、方法。
9. ロボットグリッパ（１００）であって、
   ・Ｎ個の能動素子ＷＥ_ｎ（１０３）を有するパワートレインＡＳ（１０２）を駆動するための少なくとも１の駆動ユニットＡＥ（１０１）であって、前記能動素子ＷＥ_ｎ（１０３）のそれぞれは、前記ロボットグリッパ（１００）に対して本体が固定された形で配され、前記能動素子ＷＥ_ｎ（１０３）が運動可能であり、これらが達する作業領域ＡＢ_ｎを有する、少なくとも１の駆動ユニットＡＥ（１０１）と、
   ・前記少なくとも１の駆動ユニットＡＥ（１０１）のクローズドループおよびオープンループ制御のための制御ユニット（１０４）と、
   ・前記制御ユニット（１０４）に接続され、前記各能動素子ＷＥ_ｎ（１０３）に外部から与えられる、ｎ＝１，２，…，ＮおよびＮ≧１であるフォース／モーメントＦ_{ｅｘｔ，ＷＥｎ}（ｔ）確定するためのセンサーシステム（１０５）とを備え、
   前記制御ユニット（１０４）は、
   ・前記能動素子ＷＥ_ｎ（１０３）の衝突監視を行うことができるよう構成され、
   ・前記各能動素子ＷＥ_ｎ（１０３）が前記作業領域ＡＢ_ｎ内に位置する指定された割当領域Ｂ_ｎの外部に位置するときのみ、前記能動素子ＷＥ_ｎ（１０３）の衝突監視が行われるよう構成され、
   ・前記各能動素子ＷＥ_ｎ（１０３）が少なくとも部分的に前記割当領域Ｂ_ｎ内に位置するときは、前記能動素子ＷＥ_ｎ（１０３）の衝突監視が停止されるよう構成され、
   ・能動素子ＷＥ_ｎ（１０３）の衝突イベントが検知された場合には、指定の操作に従って前記駆動ユニット（１０１）が動作されるよう構成される、
   ロボットグリッパ（１００）。
10. 
11. 
12. 請求項９から請求項１１のいずれか一項に記載のロボットグリッパ（１００）を備えるロボットまたは人型ロボット。
    

Images