JP7035935B2 - End effector device - Google Patents
End effector device Download PDFInfo
- Publication number
- JP7035935B2 JP7035935B2 JP2018179299A JP2018179299A JP7035935B2 JP 7035935 B2 JP7035935 B2 JP 7035935B2 JP 2018179299 A JP2018179299 A JP 2018179299A JP 2018179299 A JP2018179299 A JP 2018179299A JP 7035935 B2 JP7035935 B2 JP 7035935B2
- Authority
- JP
- Japan
- Prior art keywords
- gripping
- finger
- end effector
- determination
- movement
- 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.)
- Active
Links
Images
Classifications
-
- 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J15/00—Gripping heads and other end effectors
- B25J15/08—Gripping heads and other end effectors having finger members
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Manipulator (AREA)
Description
本開示は、エンドエフェクタ装置に関する。 The present disclosure relates to an end effector device.
特許文献1には、把持部を備えたロボットシステムが開示されている。このロボットシステムでは、把持部は、対向するように配置されかつ相互に接近または開離可能に可動する2つの板状の指部を有し、各指部の相互に対向する面に近接センサが設けられている。
前記ロボットシステムでは、各指部の相互に対向する面に近接センサが設けられているため、各指部間に位置する把持対象物の接近または開離については検出できる。しかし、各指部の延在方向には、何らセンサが設けられていないため、例えば、各指部の延在方向から各指部の先端に接近する物体については検出することができない。その結果、把持部を指部の延在方向から把持対象物に向かって接近させたときに、各指がその延在方向から接近する把持対象物および周辺環境の物体などに接触して破損してしまうおそれがある。 In the robot system, since the proximity sensors are provided on the surfaces of the fingers facing each other, the approach or opening of the gripping object located between the fingers can be detected. However, since no sensor is provided in the extending direction of each finger, for example, an object approaching the tip of each finger from the extending direction of each finger cannot be detected. As a result, when the grip portion is brought closer to the gripping object from the extending direction of the finger portion, each finger comes into contact with the gripping object approaching from the extending direction and an object in the surrounding environment and is damaged. There is a risk that it will end up.
そこで、本開示は、把持対象物および周辺環境の物体に接触することなく、把持対象物を把持可能な位置に配置可能なエンドエフェクタ装置を提供することを課題とする。 Therefore, it is an object of the present disclosure to provide an end effector device capable of arranging a gripping object at a gripping position without contacting the gripping object and an object in the surrounding environment.
本開示の一例のエンドエフェクタ装置は、
掌部と、延在方向の一端部が前記掌部に接続されていると共に、前記延在方向に交差する方向でかつ互いに接近する方向にそれぞれ移動して把持対象物を把持する把持動作可能な複数の指部とを有し、前記複数の指部の各々における前記延在方向の他端部に近接センサ部がそれぞれ設けられ、前記近接センサ部が、前記延在方向において、前記把持対象物および周辺環境の物体に対する前記複数の指部の少なくとも1つの接近または開離を検出可能であると共に、前記複数の指部の少なくとも1つに対する前記把持対象物および前記物体の接近または開離を検出可能に配置されたエンドエフェクタと、
前記エンドエフェクタの前記掌部および前記複数の指部の各々を駆動させる駆動装置と、
前記エンドエフェクタで前記把持対象物を把持する場合に、前記近接センサ部により検出された検出結果に基づいて、前記把持対象物における前記掌部が前記把持対象物に接近する掌接近方向まわりでかつ前記複数の指部の全てが前記把持対象物と前記物体との間に位置する把持位置に、前記エンドエフェクタを前記把持対象物および前記物体に接触することなく配置可能か否かの配置判定を行う指配置判定部と、
前記配置判定において、前記把持対象物および前記物体に接触することなく前記エンドエフェクタを前記把持位置に配置可能であるとする配置可判定がなされた場合、前記駆動装置を制御して前記エンドエフェクタを前記把持位置に移動させると共に、前記把持対象物および前記物体に接触することなく前記エンドエフェクタを前記把持位置に配置不可能であるとする配置不可判定がなされた場合、前記駆動装置を制御して前記複数の指部の各々を前記延在方向に交差する方向に移動させる移動制御部と
を備える。
The end effector device of one example of the present disclosure is
A palm portion and one end portion in the extending direction are connected to the palm portion, and the gripping operation is possible by moving in a direction intersecting the extending direction and in a direction approaching each other to grip the gripping object. It has a plurality of fingers, and each of the plurality of fingers is provided with a proximity sensor unit at the other end in the extending direction, and the proximity sensor unit is the gripping object in the extending direction. And at least one approach or detachment of the plurality of fingers to an object in the surrounding environment can be detected, and the approach or detachment of the gripping object and the object to at least one of the plurality of fingers can be detected. Possible end effectors and
A drive device for driving each of the palm portion and the plurality of finger portions of the end effector, and
When gripping the gripping object with the end effector, based on the detection result detected by the proximity sensor unit, the palm portion of the gripping object is around the palm approaching direction in which the gripping object approaches the gripping object. It is determined whether or not the end effector can be arranged at the gripping position where all of the plurality of fingers are located between the gripping object and the object without contacting the gripping object and the object. The finger placement judgment unit to be performed and
In the arrangement determination, when it is determined that the end effector can be arranged at the gripping position without coming into contact with the gripping object and the object, the drive device is controlled to control the end effector. When it is determined that the end effector cannot be placed at the gripping position without moving to the gripping position and without contacting the gripping object and the object, the drive device is controlled. A movement control unit for moving each of the plurality of finger portions in a direction intersecting the extending direction is provided.
前記エンドエフェクタ装置によれば、複数の指部の各々に近接センサ部が設けられたエンドエフェクタと、エンドエフェクタの掌部および各指部を駆動させる駆動装置と、エンドエフェクタを把持対象物および周辺環境の物体に接触することなく把持位置に配置可能か否かの配置判定を行う指配置判定部と、配置判定において配置可判定がなされたときにエンドエフェクタを把持位置に移動させ、配置判定において配置不可判定がなされた場合、各指部をその延在方向に交差する方向に移動させる移動制御部とを備えている。このような構成により、把持対象物および周辺環境の物体に接触することなく、把持対象物を把持可能な位置に配置可能なエンドエフェクタ装置を実現できる。 According to the end effector device, an end effector in which a proximity sensor unit is provided for each of a plurality of fingers, a drive device for driving the palm and each finger of the end effector, and an object for gripping the end effector and its surroundings. A finger placement determination unit that determines whether or not it can be placed in the grip position without touching an object in the environment, and an end effector that is moved to the grip position when the placement determination is made in the placement judgment, in the placement judgment. When it is determined that the finger cannot be arranged, it is provided with a movement control unit that moves each finger in a direction intersecting the extending direction. With such a configuration, it is possible to realize an end effector device capable of arranging the gripping object at a gripping position without contacting the gripping object and an object in the surrounding environment.
以下、本開示の一例を添付図面に従って説明する。なお、以下の説明では、必要に応じて特定の方向あるいは位置を示す用語(例えば、「上」、「下」、「右」、「左」を含む用語)を用いるが、それらの用語の使用は図面を参照した本開示の理解を容易にするためであって、それらの用語の意味によって本開示の技術的範囲が限定されるものではない。また、以下の説明は、本質的に例示に過ぎず、本開示、その適用物、あるいは、その用途を制限することを意図するものではない。さらに、図面は模式的なものであり、各寸法の比率等は現実のものとは必ずしも合致していない。 Hereinafter, an example of the present disclosure will be described with reference to the accompanying drawings. In the following description, terms indicating a specific direction or position (for example, terms including "top", "bottom", "right", and "left") are used as necessary, but the use of these terms is used. Is for facilitating the understanding of the present disclosure with reference to the drawings, and the meaning of those terms does not limit the technical scope of the present disclosure. Further, the following description is merely an example and is not intended to limit the present disclosure, its application, or its use. Furthermore, the drawings are schematic, and the ratios of each dimension do not always match the actual ones.
本開示の一実施形態のエンドエフェクタ10は、例えば、図1に示すように、マニピュレータなどのエンドエフェクタ装置1の一部を構成する。エンドエフェクタ装置1は、一例として、エンドエフェクタ10と、エンドエフェクタ10に接続されたアーム20と、エンドエフェクタ10およびアーム20を駆動する駆動装置30と、駆動装置30を制御する制御装置100と、制御装置100に接続された操作部40と、駆動装置30および制御装置100に電力を供給する電源50とを備えている。制御装置100は、操作部40で受け付けられた操作に基づいて、駆動装置30に指令を出力することで、エンドエフェクタ10およびアーム20の駆動を制御する。アーム20は、エンドエフェクタ10の後述する掌部11に接続され、駆動装置30によって、エンドエフェクタ10の位置および姿勢を任意に変更可能に運動することができる。駆動装置30は、掌部11および各指部12を駆動させる図示しないモータと、このモータの回転を検出する図示しないエンコーダとを有し、エンコーダで検出された情報が制御装置100に出力されるように構成されている。
The
エンドエフェクタ10は、図2に示すように、掌部11と、掌部11に接続された複数の指部12(この実施形態では、2本の指部12)とを備えている。各指部12は、その延在方向の基端部121(図4参照)が掌部11に接続されていると共に、その延在方向に交差する方向でかつ互いに接近する方向にそれぞれ移動して把持対象物60を把持する把持動作可能に構成されている。
As shown in FIG. 2, the
各指部12は、一例として、略矩形の板状を有し、板面同士が対向するように配置されて、駆動装置30によって、板面に直交する方向に移動可能に構成されている。すなわち、各指部12の相互に対向する面は、各指部12の延在方向に交差(例えば、直交)し、把持対象物60に対向する把持面123(図4参照)を構成している。なお、各指部12を駆動するモータは、例えば、リニアモータで構成することができる。
As an example, each
図3に示すように、各指部12は、その延在方向の先端部122(図4参照)に設けられた近接センサ部13を有している。各近接センサ部13は、一例として、容量式近接センサで構成され、各指部12の延在方向における近接センサ部13の物体に対する接近および開離を検出可能であると共に、各指部12の延在方向における物体の近接センサ部13に対する接近および開離を検出可能に構成されている。
As shown in FIG. 3, each
詳しくは、各近接センサ部13は、図5に示すように、各指部12の延在方向から見て、各指部12の略矩形状の先端面124の縁部に沿って配置された枠状の電極131を有している。この電極131は、把持面123に直交しかつ把持面123の中心を通る中心線CLに対して対称に配置されている。すなわち、この電極131により、各指部12の先端面124の縁部を覆う第1検出領域14と、この第1検出領域14の内側に配置された第2検出領域15とが形成される。第1検出領域14および第2検出領域15で、各指部12の先端面124の略全体を覆っている。
Specifically, as shown in FIG. 5, each
なお、前記エンドエフェクタ10では、各指部12のその延在方向の長さは略同一であり、各指部12の先端面124は、各指部の延在方向に直交する同一平面上に配置されている。すなわち、各指部12の近接センサ部13は、各指部12の延在方向における把持対象物60に対する距離が略同一になるように配置されている。
In the
このように、前記エンドエフェクタ10によれば、各指部12が、その延在方向の先端部に近接センサ部13を有し、この近接センサ部13が、各指部12の延在方向から見て、各指部12の延在方向の先端部122の縁部を覆う枠状の第1検出領域14を有している。この近接センサ部13により、各指部12の延在方向において、各指部12の先端部122に対する物体(例えば、図20に示す把持対象物60または周辺環境の物体70)の接近および開離を検出可能であると共に、物体に対する各指部の先端部122の接近および開離を検出可能なエンドエフェクタ10を実現できる。
As described above, according to the
また、各指部12の延在方向の先端部122の縁部を覆う枠状の第1検出領域14を有しているので、各指部12の先端部122の縁部の任意の位置において、把持対象物60あるいは周辺環境の物体70の接近または開離を検出して、各指部12の延在方向における各指部12と物体との位置関係を高い精度で把握することができる。その結果、例えば、エンドエフェクタ10を把持対象物50に向かって接近させているときに、各指部12が把持対象物50に接触することなく接近することができるか否かを高い精度で検出することができる。
Further, since it has a frame-shaped
また、近接センサ部13が、容量式近接センサで構成されている。これにより、簡単な構成で、各指部12の延在方向において、各指部12の先端部122に対する物体の接近および開離を検出できると共に、物体に対する各指部の先端部122の接近および開離を検出できる。
Further, the
また、近接センサ部13が、各指部12の延在方向から見て、各指部12の先端部122の縁部に配置された枠状の電極131を有している。これにより、簡単な構成で、各指部12の延在方向において、各指部12の先端部122に対する物体の接近および開離を検出できると共に、物体に対する各指部の先端部122の接近および開離を検出できる。
Further, the
また、前記エンドエフェクタ装置1によれば、前記エンドエフェクタ10によって、各指部12の延在方向において、各指部12の先端部122に対する物体の接近および開離を検出可能であると共に、物体に対する各指部12の先端部122の接近および開離を検出可能なエンドエフェクタ装置1を実現できる。
Further, according to the
なお、前記エンドエフェクタ10は、複数の指部12を備えていればよく、2本の指部12を備えている場合に限らない。例えば、図6に示すように、前記エンドエフェクタ10は、3本の指部12を備えるように構成することもできる。
The
各指部12の先端部122は、各指部12の延在方向から見て、略矩形状を有する場合に限らない。例えば、図7に示すように、各指部12の先端部122は、各指部12の延在方向から見て、円弧形状を有するように構成することもできる。また、先端部122の端面124は、指部の延在方向に直交する平面で構成されている場合に限らない。例えば、図8および図9に示すように、先端部122の端面124は、各指部の延在方向の先端部122側に突出する湾曲面125で構成してもよいし、各指部の延在方向に交差する傾斜面126で構成してもよい。
The
近接センサ部13は、複数の指部12の少なくとも1つに設けられていればよく、複数の指部12の各々に設けられている場合に限らない。
The
また、近接センサ部13は、少なくとも第1検出領域14、すなわち、各指部の延在方向から見て、各指部12の先端部122の縁部を覆う枠状の検出領域を有していればよく、枠状の電極131を有する容量式近接センサで構成されている場合に限らない。例えば、図10~図18に示すように、任意の形状の電極131を有する1以上の容量式センサで構成することもできる。
Further, the
図10の近接センサ部13は、各指部12の先端面124の略全体を覆う1つのベタ電極131で構成されている。図11の近接センサ部13は、大きさの異なる2つの枠状の電極131で構成され、一方の電極131の内側に他方の電極131が配置されている。図12および図13の近接センサ部13は、同じ大きさの2つの直線状の電極131で構成されている。図14および図15の近接センサ部13は、同じ大きさの2つの略C字状の電極131で構成されている。図16の近接センサ部13は、同じ大きさの2つの枠状の電極131で構成されている。図17および図18の近接センサ部13は、同じ大きさの2つのベタ電極131で構成されている。図12、図14および図17の近接センサ部13は、各電極131が、各指部12の先端面124における中心線CLに直交する一対の辺の各々に沿って配置され、図13、図15および図18の近接センサ部13は、各電極131が、各指部12の先端面124における中心線CLに平行な一対の辺の各々に沿って配置されている。
The
なお、図11~図18の近接センサ部13では、各電極131が、各指部12の延在方向から見て、把持面123に直交しかつ把持面123の中心を通る中心線CLに対して対称に配置されている。このように、近接センサ部13は、各指部12の寸法構成、あるいは、把持対象物60の形状および大きさなどに応じて、その構成を任意に変更することができるので、設計の自由度の高いエンドエフェクタ10を実現できる。
In the
また、近接センサ部13は、容量式近接センサに限らず、光学式、誘導式、磁気式および超音波式などの任意の形式の近接センサで構成できる。
Further, the
図5、図7および図11~図15の近接センサ部13は、ループ電極であり、近接センサ部13の寄生容量を減らして、検出感度を高めることができる。図10および図16~図18の近接センサ部13は、ベタ電極であり、電極面積を大きくして検出感度を高めることができる。図5、図7および図10の近接センサ部13は、単一の電極を有する自己容量式の近接センサであり、電極面積を大きくして検出感度を高めることができる。また、図11~図18の近接センサ部13は、複数の電極を有し、複数の自己容量式近接センサ、または、1以上の相互容量式近接センサで構成することができる。例えば、図12に示す近接センサ部13を複数の自己容量式近接センサで構成した場合、検出領域14の面画素を増やすことができるので、検出領域14に把持対象物60または周辺環境の物体70のエッジ部分が位置しているときに、各指部12をいずれの方向に動かせば把持対象物60または周辺環境の物体70に対する接触を回避できるかを判定することができる。
The
図19に示すように、各指部12の少なくとも1つが、第1の補助近接センサ部16および第2の補助近接センサ部17のいずれか1つまたは両方を有するように構成してもよい。第1の補助近接センサ部16は、把持面123に設けられて、把持面123に対する把持対象物60の接近および開離を検出可能に配置されている。この第1の補助近接センサ部16により、把持対象物50を把持するときに、各指部12の把持面123と把持対象物50との間の位置関係をより正確に把握することができる。また、第2の補助近接センサ部17は、各指部12の延在方向に交差する方向において把持面123とは反対側の面127に設けられて、把持面123とは反対側の面127に対する物体(例えば、周辺環境の障害物)の接近および開離を検出可能に配置されている。この第2の補助近接センサ部17により、例えば、各指部12と周辺環境の障害物との間の位置関係をより正確に把握することができる。
As shown in FIG. 19, at least one of each
なお、第1および第2の補助近接センサ部16、17は、近接センサ部13と同様に、容量式、光学式、誘導式、磁気式および超音波式などの任意の形式の近接センサで構成できる。また、第1および第2の補助近接センサ部16、17は、容量式で構成する場合、任意の形状の電極を有する1以上の容量式センサで構成することができる。第1および第2の補助近接センサ部16、17で検出された検出結果は、例えば、制御装置100に出力される。
The first and second auxiliary
次に、前記エンドエフェクタ装置1の制御装置100について説明する。
Next, the
前記制御装置100は、演算等を行うCPU、エンドエフェクタ10の制御などに必要なプログラムあるいはデータ等を記憶しておくROMおよびRAMなどの記憶媒体と、エンドエフェクタ装置1の外部との間で信号の入出力を行うインターフェース部とで構成され、図1に示すように、接近位置決定部110と、指配置判定部120と、指移動判定部130と、移動制御部140とを有している。なお、接近位置決定部110、指配置判定部120、指移動判定部130および移動制御部140の各部は、CPUが所定のプログラムを実行することにより実現される機能である。
The
なお、以下、図20~図24を参照して、制御装置100を構成する各部についての説明を行っているが、図20~図24では、エンドエフェクタ装置1の各構成のうち、エンドエフェクタ10のみを示し、その他の構成については省略している。
Hereinafter, each part constituting the
接近位置決定部110は、エンドエフェクタ10の掌部11が把持対象物60に接近する掌接近方向(すなわち、図21の矢印A方向)における近接センサ部13の把持対象物60に対する位置であって、後述する把持位置P2(図24参照)よりも掌接近方向Aにおいて把持対象物60から離れた接近位置P1(図22参照)を決定する。接近位置P1は、エンドエフェクタ10が対象物60および周辺環境の物体70に接触しない位置であり、要求されるエンドエフェクタ10の接近位置P1から把持位置P2までの移動時間、各近接センサ部13の性能、各指部12の寸法構成、あるいは、把持対象物60の形状および大きさなどに応じて決定される。なお、掌接近方向は、一例として、エンドエフェクタ10の各指部12の延在方向と略一致している。
The approach position determining unit 110 is a position of the
また、接近位置決定部110は、掌接近方向Aにおいて、接近位置P1よりも把持対象物60から離れた速度変更位置P3を決定する。速度変更位置P3は、掌部11を把持対象物60に接近させて接近位置P1まで移動させるときに、移動制御部140によって、速度変更位置P3よりも把持対象物60から離れた位置P0と速度変更位置P3との間の掌部11の移動速度である第1移動速度から、第1移動速度よりも小さい第2移動速度に変更される位置である。この速度変更位置P3は、要求されるエンドエフェクタ10の接近位置P1から把持位置P2までの移動時間、駆動装置30の性能、各指部12の寸法構成、あるいは、把持対象物60の形状および大きさなどに応じて決定される。
Further, the approach position determination unit 110 determines the speed change position P3 which is farther from the gripping
なお、接近位置P1、速度変更位置P3、第1移動速度および第2移動速度の各々は、ユーザの入力により決定してもよいし、接近位置決定部110が予め記憶されている複数の値の中から選択することにより決定してもよいし、接近位置決定部110がユーザの入力により決定あるいは接近位置決定部110により選択された値を近接センサ部13により検出された検出結果に基づいて補正することにより決定してもよい。また、第2移動速度は、例えば、接近位置P1でエンドエフェクタ10が停止可能な範囲で、要求されるエンドエフェクタ10の接近位置P1から把持位置P2までの移動時間に応じて決定される。
Each of the approach position P1, the speed change position P3, the first movement speed, and the second movement speed may be determined by the input of the user, or a plurality of values stored in advance by the approach position determination unit 110. It may be determined by selecting from among them, or the approach position determination unit 110 determines by input of the user or corrects the value selected by the approach position determination unit 110 based on the detection result detected by the
指配置判定部120は、エンドエフェクタ10で把持対象物60を把持するときに、近接センサ部13により検出された検出結果に基づいて、把持対象物60における掌部11が把持対象物60に接近する方向まわりでかつ複数の指部12の全てが把持対象物60と周辺環境の物体70との間の空間80に位置する把持位置P2(図24参照)に、エンドエフェクタ10を物体70に接触することなく配置可能か否かの配置判定を行う。配置判定は、各指部12に対して、一例として、接近位置P1で行われる。なお、把持位置P2は、各指部12を把持動作させることで把持対象物60を把持可能な位置であり、例えば、エンドエフェクタ10の各指部12の寸法構成、あるいは、把持対象物60の大きさなどに基づいて予め決定される。
When the finger placement determination unit 120 grips the
例えば、指配置判定部120は、予め入力された把持対象物60の形状および大きさなどの情報から、掌接近方向Aにおける決定された接近位置P1から把持対象物60までの距離を算出する。そして、指配置判定部120は、各指部12の寸法構成の情報と、算出された距離と、各指部12の近接センサ部13によって検出された検出結果とに基づいて、掌接近方向Aに直交する方向における各指部12と、把持対象物60および周辺環境の物体70との間の位置関係を把握する。これにより、指配置判定部120は、把持対象物60と周辺環境の物体70との間の空間80に、各指部12を把持対象物60および周辺環境の物体70に接触することなく挿入可能か否かを判定する。この判定は、例えば、エンドエフェクタ10を接近位置P1に移動させる前、および、エンドエフェクタ10を接近位置P1に移動させた後、把持位置P2に移動させる前に行われる。
For example, the finger placement determination unit 120 calculates the distance from the determined approach position P1 in the palm approach direction A to the
また、指配置判定部120は、配置判定において、把持対象物60および周辺環境の物体70に接触することなく複数の指部12の各々を把持位置P2に配置不可能であるとする配置不可判定が複数の指部12の一部に対してなされた場合、移動制御部140によって後述する第1移動が行われた後、第1移動前に配置可判定がなされていた指部12が、第1移動後に把持対象物60または周辺環境の物体70に接触することなく把持位置P2に配置可能か否かの第1再配置判定を行う。第1再配置判定は、配置判定と同様の方法で行われる。
Further, in the arrangement determination, the finger arrangement determination unit 120 determines that each of the plurality of
第1再配置判定において、第1移動前に配置可判定がなされていた指部12が、第1移動後に把持位置P2に配置可能であるとする再配置可判定がなされた場合、指配置判定部120は、第1移動前に配置不可判定がなされていた指部12が、第1移動後に把持対象物60または周辺環境の物体70に接触することなく把持位置P2に配置可能か否かの第2再配置判定を行う。第2再配置判定は、配置判定と同様の方法で行われる。
In the first relocation determination, when the relocation possible determination is made that the
なお、指配置判定部120は、例えば、接近位置P1において、移動制御部140により各指部12の移動が行われる毎に、配置判定を行う。
The finger arrangement determination unit 120 determines the arrangement each time the movement control unit 140 moves each
指移動判定部130は、指配置判定部120により行われた配置判定または第2再配置判定において配置不可判定がなされた場合に、複数の指部12の把持面123間に把持対象物60を配置できるように複数の指部12の各々を各指部12の延在方向に交差する方向に移動させることが可能か否かの移動判定を行う。この移動判定において、複数の指部12の把持面123間に把持対象物60を配置できるように複数の指部12の各々を各指部12の延在方向に交差する方向に移動させることができないとする移動不可判定がなされた場合、指移動判定部130は、把持対象物60を把持不可能であると判定する。
The finger movement determination unit 130 holds the
なお、この実施形態では、図21に示すように、複数の指部12の各々を把持方向B1(すなわち、各指部12の延在方向に交差する方向でかつ相互に接近する方向)に互いに接近させて閉じた状態で、エンドエフェクタ10を接近位置P1まで移動させるように構成されている。このため、移動制御部140は、配置判定において配置不可判定がなされた場合、複数の指部12の各々が相互に開離する方向を複数の指部12の移動方向として決定し、決定された方向に沿って複数の指部12の各々を段階的に移動させる。すなわち、配置可判定がなされることなく、複数の指部12が移動制御部140により決定された方向に移動できなくなった場合に、移動不可判定がなされる。
In this embodiment, as shown in FIG. 21, each of the plurality of
移動制御部140は、接近位置決定部110、指配置判定部120および指移動判定部130で行われた判定の結果に基づいて駆動装置30を制御して、掌部11および各指部12を駆動させる。
The movement control unit 140 controls the
例えば、エンドエフェクタ10の接近位置P1への移動処理(以下、第1アプローチ処理という。)において、移動制御部140は、次のように掌部11および各指部を駆動させる。
For example, in the movement process of the
移動制御部140は、掌接近方向Aにおいて、接近位置P1よりも把持対象物60から離れた位置(例えば、図20および図21に示す位置P0)から、把持対象物60にエンドエフェクタ10を移動させる場合、近接センサ部13により検出された検出結果に基づいて、エンドエフェクタ10が接近位置P1まで移動したか否かを判定し、エンドエフェクタ10が接近位置P1まで移動したと判定された場合、エンドエフェクタ10の移動を停止させる。このとき、図21に示すように、複数の指部12の各々を把持方向B1に互いに接近させて閉じた状態で、エンドエフェクタ10を接近位置P1まで移動させる。なお、エンドエフェクタ10が接近位置P1まで移動したか否かについては、近接センサ部13により検出された掌接近方向Aにおける把持対象物60までの距離に基づいて決定される。
The movement control unit 140 moves the
移動制御部140は、エンドエフェクタ10を接近位置P1に移動させる前に、指配置判定部120によって、掌接近方向Aにおけるエンドエフェクタ10に対する把持対象物60の位置が把握できないと判定された場合、掌接近方向Aにおけるエンドエフェクタ10に対する把持対象物60の位置が把握できると判定されるまで、掌部11を掌接近方向Aに交差(例えば、直交)する方向に移動させる。
When the movement control unit 140 determines that the position of the
移動制御部140は、掌接近方向Aにおいて、掌部11を把持対象物60に向かって接近移動させてエンドエフェクタ10を接近位置P1まで移動させるときに、近接センサ部13により検出された検出結果に基づいて、掌部11および各指部12に対して把持対象物60および周辺環境の物体70が接触する可能性があるか否かを判定する。掌部11および各指部12に対して把持対象物60および周辺環境の物体70が接触する可能性があると判定された場合、移動制御部140は、掌接近方向Aにおける掌部11の把持対象物60への接近移動を停止させる。また、移動制御部140は、近接センサ部13により検出された検出結果に基づいて、エンドエフェクタ10が接近位置P1よりも把持対象物60から離れた速度変更位置P3(図21参照)まで移動したか否かを判定し、エンドエフェクタ10が速度変更位置P3まで移動したと判定された場合、速度変更位置P3よりも把持対象物60から離れた位置P0(図21に示す)と速度変更位置P3との間のエンドエフェクタ10の移動速度である第1移動速度から、第1移動速度よりも小さい第2移動速度に変更する。
The movement control unit 140 moves the
また、例えば、エンドエフェクタ10の把持位置P2への移動処理(以下、第2アプローチ処理という。)において、移動制御部140は、次のように掌部11および各指部を駆動させる。第2アプローチ処理は、第1アプローチ処理の終了後に行われる。
Further, for example, in the movement process of the
移動制御部140は、配置判定または第2再配置判定において配置可判定がなされた場合、駆動装置30を制御して、掌部11を掌接近方向Aにおいて把持対象物60に接近移動させつつ、把持対象物60と周辺環境の物体70との間の空間80に、各指部12を把持対象物60および周辺環境の物体70に接触することなく挿入して、エンドエフェクタ10を把持位置P2に移動させる。
When the arrangement determination is made in the arrangement determination or the second rearrangement determination, the movement control unit 140 controls the
移動制御部140は、配置判定において全てまたは一部の指部12に対して配置不可判定がなされた場合、駆動装置30を制御して、複数の指部12の全てを各指部12の延在方向に交差(例えば、直交)する方向に移動させる第1移動を行う。この実施形態では、第1移動は、各指部12の延在方向に交差する方向において、各指部12を相互に離れる方向B2に移動させて開く。
The movement control unit 140 controls the
移動制御部140は、第1再配置判定において配置不可判定がなされた場合、第1再配置判定が行われる前に配置不可判定された指部12が、指部12の延在方向に交差する方向において把持対象物60から離れるように(すなわち、第1再配置判定が行われる前に配置不可判定された指部12が、第1移動において移動した方向B2と同じ方向に)、掌部11を掌接近方向Aに交差する方向に移動させる第2移動を行う。
In the movement control unit 140, when the non-arrangement determination is made in the first rearrangement determination, the
なお、エンドエフェクタ10が接近位置P1、把持位置P2および速度変更位置P3に到達したか否かは、例えば、複数の近接センサ部13のうち、掌接近方向Aにおいて最も把持対象物60に近い近接センサ部13により検出された検出結果(すなわち、各近接センサ部13から把持対象物60までの距離)に基づいて判断する。この実施形態では、各指部12の近接センサ部13は、各指部12の延在方向における把持対象物60に対する距離が略同一になるように配置されているため、エンドエフェクタ10が各位置P1、P2、P3に到達したか否かの判断に、いずれの近接センサ部13を用いても構わない。
Whether or not the
また、エンドエフェクタ10が把持位置P2に到達したか否かの判断については、第1の補助近接センサ部16を用いることができる。例えば、第1の補助近接センサ部16が把持対象物60を認識したときに、移動制御部140は、エンドエフェクタ10が把持位置P2に到達したと判定する。
Further, the first auxiliary
続いて、図25~図27を参照して、第1アプローチ処理および第2アプローチ処理について説明する。なお、以下に説明するこれらの処理は、制御装置100が所定のプログラムを実行することで実施される。また、第1アプローチ処理および第2アプローチ処理において、各指部12の互いに接近または開離させる方向B1、B2における移動量は、微小な量(例えば、1mm)であるとする。
Subsequently, the first approach process and the second approach process will be described with reference to FIGS. 25 to 27. It should be noted that these processes described below are carried out by the
(第1アプローチ処理)
図25に示すように、第1アプローチ処理が開始されると、接近位置決定部110が、接近位置P1および速度変更位置P3を決定すると共に、第1移動速度および第2移動速度を併せて決定する(ステップS1)。
(First approach processing)
As shown in FIG. 25, when the first approach process is started, the approach position determination unit 110 determines the approach position P1 and the speed change position P3, and also determines the first movement speed and the second movement speed. (Step S1).
接近位置P1および速度変更位置P3が決定されると、移動制御部140は、エンドエフェクタ10の複数の指部12の各々を把持方向B1に互いに接近させて閉じて(ステップS2)、近接センサ部13による検出を開始する。近接センサ部13による検出が開始されると、指配置判定部120が、近接センサ部13により検出された検出結果に基づいて、掌接近方向Aにおける掌部11に対する把持対象物60の位置が把握できるか否かの判定を行う(ステップS3)。
When the approach position P1 and the speed change position P3 are determined, the movement control unit 140 closes each of the plurality of
掌接近方向Aにおけるエンドエフェクタ10に対する把持対象物60の位置が把握できないと判定された場合、移動制御部140は、掌部11を掌接近方向Aに交差する方向に移動させ(ステップS4)、掌接近方向Aにおけるエンドエフェクタ10に対する把持対象物60の位置が把握できると判定されるまで、ステップS3およびS4を繰り返す。
When it is determined that the position of the
掌接近方向Aにおける掌部11に対する把持対象物60の位置が把握できると判定された場合、移動制御部140は、掌接近方向Aにおいて、掌部11を把持対象物60に接近させてエンドエフェクタ10の接近位置P1への移動を開始させる(ステップS5)。
When it is determined that the position of the
エンドエフェクタ10の接近位置P1への移動が開始されると、移動制御部140は、まず、近接センサ部13により検出された検出結果に基づいて、掌部11および各指部12に対して把持対象物60および周辺環境の物体70が接触する可能性があるか否かを判定しつつ、エンドエフェクタ10が速度変更位置P3に到達したか否かを判定する(ステップS6)。このステップS6は、エンドエフェクタ10が速度変更位置P3に到達するまで繰り返される。なお、掌部11および各指部12に対して把持対象物60および周辺環境の物体70が接触する可能性があると判定された場合、移動制御部140は、掌接近方向Aにおける掌部11の把持対象物60への接近移動を停止させる。
When the movement of the
エンドエフェクタ10が速度変更位置P3に到達したと判定されると、移動制御部140は、エンドエフェクタ10の移動速度を第1移動速度から、第1移動速度よりも小さい第2移動速度に変更する(ステップS7)。
When it is determined that the
エンドエフェクタ10の移動速度が第1移動速度から第2移動速度に変更されると、移動制御部140は、近接センサ部13により検出された検出結果に基づいて、エンドエフェクタ10が接近位置P1に到達したか否かを判定する(ステップS8)。このステップS8は、エンドエフェクタ10が接近位置P1に到達するまで繰り返される。
When the movement speed of the
エンドエフェクタ10が接近位置P1に到達したと判定されると、移動制御部140は、エンドエフェクタ10の移動を停止させ(ステップS9)、第1アプローチ処理が終了する。
When it is determined that the
このように、前記エンドエフェクタ装置1では、複数の指部12の各々に近接センサ部13が設けられたエンドエフェクタ10と、エンドエフェクタ10の掌部11および各指部12を駆動させる駆動装置30と、掌部11を把持対象物60に接近させる移動制御部140と、把持対象物60における掌接近方向Aまわりでかつ複数の指部12の全てが把持対象物60と周辺環境の物体70との間に位置して把持動作により把持対象物60を把持可能な把持位置P2よりも、掌接近方向Aにおいて把持対象物60から離れた接近位置P1を決定する接近位置決定部110とを備え、移動制御部140が、近接センサ部13により検出された検出結果に基づいて、掌部11および各指部12に対して把持対象物60および周辺環境の物体70が接触する可能性がある場合には、掌部11の把持対象物60への接近移動を停止させる。このような構成により、把持対象物60および周辺環境の物体70に接触することなく、エンドエフェクタ10を接近位置に移動させることが可能なエンドエフェクタ装置1を実現できる。
As described above, in the
また、移動制御部140は、各指部12をその延在方向に交差する方向において互いに接近させて閉じた状態で、エンドエフェクタ10を接近位置P1まで移動させる。このような構成により、各指部12の近接センサ部13をアレイとして用いることができるので、掌接近方向Aのエンドエフェクタ10に対する把持対象物60および周辺環境の物体70の接近または開離をより正確に検出することができる。
Further, the movement control unit 140 moves the
また、移動制御部140は、エンドエフェクタ10を把持対象物60に接近させる前に、近接センサ部13により検出された検出結果に基づいて、掌接近方向Aにおけるエンドエフェクタ10に対する把持対象物60の位置が把握できるか否かの判定を行う。掌接近方向Aにおけるエンドエフェクタ10に対する把持対象物60の位置が把握できないと判定した場合、移動制御部140は、掌接近方向Aにおけるエンドエフェクタ10に対する把持対象物60の位置が把握できると判定されるまで、エンドエフェクタ10を掌接近方向Aに交差する方向Bに移動させる。このような構成により、エンドエフェクタ10を把持対象物60に向かってより正確に移動させることができる。
Further, the movement control unit 140 of the
また、移動制御部140は、エンドエフェクタ10を把持対象物60に接近させて接近位置P1まで移動させるときに、掌接近方向Aにおいて、エンドエフェクタ10が接近位置P1よりも把持対象物60から離れた速度変更位置P3まで移動したときに、速度変更位置P3よりも把持対象物60から離れた位置P0と速度変更位置P3との間のエンドエフェクタ10の移動速度である第1移動速度から、第1移動速度よりも小さい第2移動速度に変更する。このような構成により、エンドエフェクタ10を接近位置P1まで移動させるときにおけるエンドエフェクタ10の把持対象物60に対する意図しない接触をより確実に回避することができる。
Further, when the movement control unit 140 brings the
なお、第1アプローチ処理において、ステップS2~ステップS7は、必要に応じて、省略することができる。すなわち、エンドエフェクタ10を接近位置P1に移動させるときに、各指部12を閉じなくてもよいし、掌接近方向Aにおける掌部11に対する把持対象物60の位置が把握できるか否かの判定を行わなくてもよいし、エンドエフェクタ10の移動速度を変更しなくてもよい。また、ステップS2~ステップS7のいずれか1つまたは複数を省略してもよいし、ステップS2~ステップS7の全てを省略してもよい。
In the first approach process, steps S2 to S7 can be omitted if necessary. That is, when the
例えば、第1アプローチ処理のステップS3を省略する場合、画像センサを用いて掌部11に対する把持対象物60の位置を把握するように構成することができる。
For example, when step S3 of the first approach process is omitted, the position of the
また、近接センサ部13は、複数の指部12の少なくとも1つに設けられていればよく、複数の指部12の各々に設けられている場合に限らない。
Further, the
また、速度変更位置P3は、1つに限らず、2つ以上設けてもよい。すなわち、エンドエフェクタ10を接近位置P1まで移動させるときに、2箇所以上でエンドエフェクタ10の速度変更を行ってもよい。さらに、速度変更位置P3は、接近位置P1と同じ位置(すなわち、P1=P3)であっても構わない。この場合、第1アプローチ処理において、ステップS6およびステップS7が省略され、移動制御部140が、第2アプローチ処理において、第1アプローチ処理におけるエンドエフェクタ10の移動速度と同じか遅い速度で、エンドエフェクタ10を移動させる。
Further, the speed change position P3 is not limited to one, and two or more may be provided. That is, when moving the
また、ステップS3において、掌接近方向Aにおけるエンドエフェクタ10に対する把持対象物60の位置が把握できないと判定された場合、掌接近方向Aにおけるエンドエフェクタ10に対する把持対象物60の位置が把握できると判定されるまで、ステップS6を繰り返すのではなく、その時点で、第1アプローチ処理を終了するように構成してもよい。
Further, in step S3, when it is determined that the position of the
(第2アプローチ処理)
図26および図27に示すように、第2アプローチ処理では、移動制御部140が、入力された把持対象物60の情報に基づいて、エンドエフェクタ10の複数の指部12の各々を互いに離れる方向B2に移動させて開いた後(ステップS11)、指配置判定部120が、全ての指部12が把持位置P2に配置可能か否かの配置判定を行う(ステップS12)。この配置判定において、全ての指部12に対して配置不可判定がなされた場合の処理を図26に示し、複数の指部12の一部に対して配置不可判定がなされた場合の処理を図27に示す。
(Second approach processing)
As shown in FIGS. 26 and 27, in the second approach process, the movement control unit 140 separates each of the plurality of
なお、例えば、第1アプローチ処理が各指部12を閉じずに開いたままで行われた場合、移動制御部140は、ステップS11で、各指部12を互いに接近する把持方向B1に段階的に移動させて閉じるように構成される。
For example, when the first approach process is performed with each
図26に示すように、ステップS12の配置判定において、全ての指部12に対して配置可判定がなされた場合、移動制御部140は、エンドエフェクタ10を把持位置P2に移動させて(ステップS13)、第2アプローチ処理が終了する。
As shown in FIG. 26, when the arrangement determination is made for all the
一方、ステップS12の配置判定において、全ての指部12に対して配置不可判定がなされた場合、指移動判定部130は、各指部12を互いに離れる方向に移動させて開くことができるか否かの移動判定を行う(ステップS14)。この移動判定において、各指部12を互いに離れる方向B2に移動させて開くことができるとする移動可判定がなされた場合、移動制御部140が、各指部12を互いに離れる方向B2に移動させて開き(ステップS15)、ステップS12に戻って、再び指配置判定部120によって配置判定が行われる。
On the other hand, in the arrangement determination of step S12, when the arrangement impossible determination is made for all the
移動判定により、各指部12を互いに離れる方向B2に移動させて開くことができないとする移動不可判定がなされた場合、指移動判定部130は、把持対象物60を把持不可能であると判定して(ステップS16)、第2アプローチ処理が終了する。
When the movement determination determines that the fingers cannot be moved by moving the
図27に示すように、ステップS12の配置判定において、一部の指部12に対して配置不可判定がなされた場合、指移動判定部130が、各指部12を互いに離れる方向に移動させて開くことができるか否かの移動判定を行う(ステップS21)。この移動判定において移動可判定がなされた場合、移動制御部140が、各指部12を互いに離れる方向B2に移動させて開く第1移動を行う(ステップS22)。
As shown in FIG. 27, in the arrangement determination of step S12, when the arrangement impossible determination is made for some
第1移動が行われると、指配置判定部120は、第1移動前に配置可判定がなされていた指部12が、第1移動後に把持対象物60または周辺環境の物体70に接触することなく把持位置P2に配置可能か否かの第1再配置判定を行う(ステップS23)。この第1再配置判定において配置可判定がなされた場合、指配置判定部120は、第1移動前に配置不可判定がなされていた指部12が、第1移動後に把持対象物60または周辺環境の物体70に接触することなく把持位置P2に配置可能か否かの第2再配置判定を行う(ステップS24)。
When the first movement is performed, the finger placement determination unit 120 causes the
第2再配置判定において配置可判定がなされた場合、あるいは、ステップS12およびステップS24において、全ての指部12に対して配置可判定がなされた場合、移動制御部140は、エンドエフェクタ10を把持位置P2に移動させて(ステップS13)、第2アプローチ処理が終了する。
When the arrangement possible determination is made in the second relocation determination, or when the arrangement possible determination is made for all the
ステップS21の移動判定において移動不可判定がなされた場合、指移動判定部130は、把持対象物60を把持不可能であると判定して(ステップS16)、第2アプローチ処理が終了する。
When the movement determination in step S21 determines that the movement is not possible, the finger movement determination unit 130 determines that the gripping
ステップS23の第1再配置判定において配置不可判定がなされた場合、移動制御部140は、第1再配置判定が行われる前に配置不可判定された指部12が、指部12の延在方向に交差する方向において把持対象物60から離れるように、掌部11を掌接近方向Aに交差する方向に移動させる第2移動を行う(ステップS25)。これは、配置判定において配置可判定されかつ第1再配置判定において配置不可判定された指部12が、把持対象物60と周辺環境の物体70との間の空間80上から周辺環境の物体70上に移動した可能性が高いためである。第2移動が行われると、ステップS12に戻って、再び指配置判定部120によって配置判定が行われる。
When the non-arrangement determination is made in the first rearrangement determination in step S23, the movement control unit 140 has the
ステップS24の第2再配置判定において配置不可判定がなされた場合、ステップS21に戻って、再び指移動判定部130によって移動判定が行われる。 If the non-arrangement determination is made in the second rearrangement determination in step S24, the process returns to step S21, and the finger movement determination unit 130 makes a movement determination again.
なお、ステップS11において、各指部12を互いに接近する把持方向B1に段階的に移動させて閉じる場合、ステップS25では、第1再配置判定が行われる前に配置不可判定された指部12が、指部12の延在方向に交差する方向において把持対象物60に接近するように第2移動が行われる。これは、配置判定において配置可判定されかつ第1再配置判定において配置不可判定された指部12が、把持対象物60と周辺環境の物体70との間の空間80上から把持対象物60上に移動した可能性が高いためである。
In step S11, when each
このように、前記エンドエフェクタ装置1では、複数の指部12の各々に近接センサ部13が設けられたエンドエフェクタ10と、エンドエフェクタ10の掌部11および各指部12を駆動させる駆動装置30と、複数の指部12の各々を把持対象物60および周辺環境の物体70に接触することなく把持位置P2に配置可能か否かの配置判定を行う指配置判定部120と、配置判定において配置可判定がなされたときにエンドエフェクタ10を把持位置P2に移動させ、配置判定において配置不可判定がなされた場合、各指部12をその延在方向に交差する方向に移動させる移動制御部140とを備えている。このような構成により、把持対象物60および周辺環境の物体に接触することなく、把持対象物60を把持可能な位置(すなわち、把持位置P2)に配置可能なエンドエフェクタ装置1を実現できる。
As described above, in the
また、指配置判定部120は、配置判定において、配置不可判定が複数の指部12の一部に対してなされた場合に複数の指部12の全てをその延在方向に交差する方向に移動させる第1移動が、移動制御部140によって行われた場合に、第1移動前に配置可判定がなされていた指部12が、第1移動後に把持対象物60または周辺環境の物体70に接触することなく把持位置P2に配置可能か否かの再配置判定を行う。また、移動制御部140は、再配置判定において、配置不可判定がなされた場合、再配置判定が行われる前に配置不可判定された指部12がその延在方向に交差する方向において把持対象物60に対して接近または開離するように、掌部11を掌接近方向Aに交差する方向に移動させる第2移動を行う。このような構成により、エンドエフェクタ10を把持位置P2に移動させるときのアーム20の駆動量を低減することができる。
Further, the finger placement determination unit 120 moves all of the plurality of
また、配置判定において配置不可判定がなされた場合に、複数の指部12間に把持対象物60を配置できるように、複数の指部12の各々をその延在方向に交差する方向に移動させることが可能か否かの移動判定を行う指移動判定部130をさらに備える。この指移動判定部130は、移動判定により移動不可判定がなされた場合、把持対象物60を把持不可能であると判定する。このような構成により、把持対象物60を把持可能か否かについて正確かつ迅速に判定することができる。
Further, when the arrangement determination is made, each of the plurality of
なお、第2アプローチ処理において、ステップS16およびステップS25については、省略することができる。すなわち、指移動判定部130を省略してもよいし、また、第1再配置判定において配置不可判定がなされた場合に第2移動を行わないようにしてもよい。 In the second approach process, steps S16 and S25 can be omitted. That is, the finger movement determination unit 130 may be omitted, or the second movement may not be performed when the arrangement impossible determination is made in the first rearrangement determination.
また、ステップS12で配置判定が行われて、一部の指部12に対して配置不可判定がなされた場合、ステップS22で第1移動を行わずに、配置可判定がされた指部12が把持対象物60に接近するように掌部11を掌接近方向Aに交差する方向に移動させるようにしてもよい。このように構成することで、第2アプローチ処理を簡略して、制御装置100の負荷を軽減することができる。
Further, when the placement determination is made in step S12 and the placement impossible judgment is made for some of the
以上、図面を参照して本開示における種々の実施形態を詳細に説明したが、最後に、本開示の種々の態様について説明する。なお、以下の説明では、一例として、参照符号も添えて記載する。 The various embodiments of the present disclosure have been described in detail with reference to the drawings, and finally, various aspects of the present disclosure will be described. In the following description, a reference reference numeral is also described as an example.
本開示の第1態様のエンドエフェクタ装置1は、
掌部11と、延在方向の一端部121が前記掌部11に接続されていると共に、前記延在方向に交差する方向でかつ互いに接近する方向にそれぞれ移動して把持対象物60を把持する把持動作可能な複数の指部12とを有し、前記複数の指部12の各々における前記延在方向の他端部122に近接センサ部13がそれぞれ設けられ、前記近接センサ部13が、前記延在方向における前記近接センサ部13の前記把持対象物60および周辺環境の物体70に対する接近または開離を検出可能であると共に、前記延在方向における前記把持対象物60および前記物体の前記近接センサ部13に対する接近または開離を検出可能に配置されたエンドエフェクタ10と、
前記エンドエフェクタ10の前記掌部11および前記複数の指部12の各々を駆動させる駆動装置30と、
前記エンドエフェクタ10で前記把持対象物60を把持するときに、前記近接センサ部13により検出された検出結果に基づいて、前記把持対象物60における前記掌部11が前記把持対象物60に接近する掌接近方向Aまわりでかつ前記複数の指部12の全てが前記把持対象物60と前記物体70との間に位置して前記把持動作により前記把持対象物を把持可能な把持位置P2に、前記エンドエフェクタ10を前記把持対象物60および前記物体70に接触することなく配置可能か否かの配置判定を行う指配置判定部120と、
前記配置判定において、前記把持対象物60および前記物体70に接触することなく前記エンドエフェクタを前記把持位置P2に配置可能であるとする配置可判定がなされた場合、前記駆動装置30を制御して前記エンドエフェクタ10を前記把持位置P2に移動させると共に、前記把持対象物60および前記物体70に接触することなく前記エンドエフェクタ10を前記把持位置P2に配置不可能であるとする配置不可判定がなされた場合、前記駆動装置30を制御して前記複数の指部12の各々を前記延在方向に交差する方向に移動させる移動制御部140と
を備える。
The
The
A
When the
When it is determined in the arrangement determination that the end effector can be arranged at the gripping position P2 without coming into contact with the gripping
第1態様のエンドエフェクタ装置1によれば、把持対象物60および周辺環境の物体に接触することなく、把持対象物60を把持可能な位置(すなわち、把持位置P2)に配置可能なエンドエフェクタ装置1を実現できる。
According to the
本開示の第2態様のエンドエフェクタ装置1は、
前記移動制御部140が、
前記配置判定において、前記配置不可判定が前記複数の指部12の一部に対してなされた場合、前記配置不可判定された前記指部12が前記把持対象物60に接近または開離するように、前記掌接近方向Aに交差する方向に前記掌部11を移動させる。
The
The movement control unit 140
In the arrangement determination, when the arrangement impossible determination is made for a part of the plurality of
第2態様のエンドエフェクタ装置1によれば、エンドエフェクタ10の把持位置P2への移動処理を簡略化して、制御装置100の負荷を軽減することができる。
According to the
本開示の第3態様のエンドエフェクタ装置1は、
前記指配置判定部120が、
前記配置判定において、前記配置不可判定が前記複数の指部12の一部に対してなされて、前記第1移動制御部140が前記複数の指部12の全てを前記延在方向に交差する方向に移動させる第1移動を行った場合に、前記第1移動前に前記配置可判定がなされていた前記指部12が、前記第1移動後に前記把持対象物60または前記物体70に接触することなく前記把持位置P2に配置可能か否かの再配置判定を行い、
前記移動制御部140が、
前記再配置判定において、前記配置不可判定がなされた場合、前記再配置判定が行われる前に前記配置不可判定された前記指部12が前記延在方向に交差する方向において前記把持対象物60に対して接近または開離するように、前記掌部11を前記掌接近方向Aに交差する方向に移動させる第2移動を行う。
The
The finger placement determination unit 120
In the arrangement determination, the arrangement impossible determination is made for a part of the plurality of
The movement control unit 140
When the non-arrangement determination is made in the rearrangement determination, the gripping
第3態様のエンドエフェクタ装置1によれば、エンドエフェクタ10を把持位置P2に移動させるときのアーム20の駆動量を低減することができる。
According to the
本開示の第4態様のエンドエフェクタ装置1は、
前記配置判定において前記配置不可判定がなされた場合に、前記複数の指部12間に前記把持対象物60を配置できるように、前記複数の指部12の各々を前記延在方向に交差する方向に移動させることが可能か否かの移動判定を行う指移動判定部130をさらに備え、
前記指移動判定部130は、
前記移動判定により、前記複数の指部12間に前記把持対象物60を配置できるように前記複数の指部12の各々を前記延在方向に交差する方向に移動させることができないとする移動不可判定がなされた場合、前記把持対象物60を把持不可能であると判定する。
The
A direction in which each of the plurality of
The finger movement determination unit 130 is
According to the movement determination, it is impossible to move each of the plurality of
第4態様のエンドエフェクタ装置1によれば、把持対象物60を把持可能か否かについてより正確に判定することができる。
According to the
なお、前記様々な実施形態または変形例のうちの任意の実施形態または変形例を適宜組み合わせることにより、それぞれの有する効果を奏するようにすることができる。また、実施形態同士の組み合わせまたは実施例同士の組み合わせまたは実施形態と実施例との組み合わせが可能であると共に、異なる実施形態または実施例の中の特徴同士の組み合わせも可能である。 By appropriately combining any of the various embodiments or modifications thereof, the effects of each can be achieved. Further, a combination of embodiments, a combination of examples, or a combination of an embodiment and an embodiment is possible, and a combination of features in different embodiments or examples is also possible.
本開示のエンドエフェクタは、例えば、産業用ロボットのエンドエフェクタ装置に適用できる。 The end effector of the present disclosure can be applied to, for example, an end effector device of an industrial robot.
本開示のエンドエフェクタ装置は、例えば、産業用ロボットに適用できる。 The end effector device of the present disclosure can be applied to, for example, an industrial robot.
1 エンドエフェクタ装置
10 エンドエフェクタ
11 掌部
12 指部
121 基端部
122 先端部
123 把持面
124 先端面
13 近接センサ部
131 電極
14 第1検出領域
15 第2検出領域
16 第1の補助近接センサ部
17 第2の補助近接センサ部
20 アーム
30 駆動装置
40 操作部
50 電源
60 把持対象物
100 制御装置
110 接近位置決定部
120 指配置判定部
130 指移動判定部
140 移動制御部
CL 中心線
P1 接近位置
P2 把持位置
P3 速度変更位置
1
Claims (1)
前記エンドエフェクタの前記掌部および前記複数の指部の各々を駆動させる駆動装置と、
前記エンドエフェクタで前記把持対象物を把持する場合に、前記近接センサ部により検出された検出結果に基づいて、前記把持対象物における前記掌部が前記把持対象物に接近する掌接近方向まわりでかつ前記複数の指部の全てが前記把持対象物と前記物体との間に位置して前記把持動作により前記把持対象物を把持可能な把持位置に、前記エンドエフェクタを前記把持対象物および前記物体に接触することなく配置可能か否かの配置判定を行う指配置判定部と、
前記配置判定において、前記把持対象物および前記物体に接触することなく前記エンドエフェクタを前記把持位置に配置可能であるとする配置可判定がなされた場合、前記駆動装置を制御して前記エンドエフェクタを前記把持位置に移動させると共に、前記把持対象物および前記物体に接触することなく前記エンドエフェクタを前記把持位置に配置不可能であるとする配置不可判定がなされた場合、前記駆動装置を制御して前記複数の指部の各々を前記延在方向に交差する方向に移動させる移動制御部と
を備え、
前記移動制御部は、
前記配置判定において、前記配置不可判定が前記複数の指部の一部に対してなされた場合、前記配置不可判定された前記指部が前記把持対象物に接近または開離するように、前記掌接近方向に交差する方向に前記掌部を移動させ、
前記指配置判定部は、
前記配置判定において、前記配置不可判定が前記複数の指部の一部に対してなされて、前記移動制御部が前記複数の指部の全てを前記延在方向に交差する方向に移動させる第1移動を行った場合に、前記第1移動前に前記配置可判定がなされていた前記指部が、前記第1移動後に前記把持対象物または前記物体に接触することなく前記把持位置に配置可能か否かの再配置判定を行い、
前記移動制御部は、
前記再配置判定において、前記配置不可判定がなされた場合、前記再配置判定が行われる前に前記配置不可判定された前記指部が前記延在方向に交差する方向において前記把持対象物に対して接近または開離するように、前記掌部を前記掌接近方向に交差する方向に移動させる第2移動を行い、
前記配置判定において前記配置不可判定がなされた場合に、前記複数の指部間に前記把持対象物を配置できるように、前記複数の指部の各々を前記延在方向に交差する方向に移動させることが可能か否かの移動判定を行う指移動判定部をさらに備え、
前記指移動判定部は、
前記移動判定により、前記複数の指部間に前記把持対象物を配置できるように前記複数の指部の各々を前記延在方向に交差する方向に移動させることができないとする移動不可判定がなされた場合、前記把持対象物を把持不可能であると判定する、エンドエフェクタ装置。 The palm portion and one end portion in the extending direction are connected to the palm portion, and the gripping operation is possible by moving in a direction intersecting the extending direction and in a direction approaching each other to grip the gripping object. It has a plurality of finger portions, and each of the plurality of finger portions is provided with a proximity sensor unit at the other end in the extending direction, and the proximity sensor unit is the proximity sensor unit in the extending direction. The approach or separation to the gripping object and the object in the surrounding environment can be detected, and the approach or separation of the gripping object and the object to the proximity sensor portion in the extending direction can be detected. With the end effector,
A drive device for driving each of the palm portion and the plurality of finger portions of the end effector, and
When gripping the gripping object with the end effector, based on the detection result detected by the proximity sensor unit, the palm portion of the gripping object is around the palm approaching direction in which the gripping object approaches the gripping object. All of the plurality of fingers are located between the gripping object and the object, and the end effector is placed on the gripping object and the object at a gripping position where the gripping object can be gripped by the gripping operation. A finger placement determination unit that determines placement of whether or not it can be placed without contact,
In the arrangement determination, when it is determined that the end effector can be arranged at the gripping position without coming into contact with the gripping object and the object, the drive device is controlled to control the end effector. When it is determined that the end effector cannot be placed at the gripping position without moving to the gripping position and without contacting the gripping object and the object, the drive device is controlled. A movement control unit for moving each of the plurality of finger portions in a direction intersecting the extending direction is provided .
The movement control unit
In the arrangement determination, when the arrangement impossible determination is made for a part of the plurality of finger portions, the palm is such that the finger portion determined to be unarrangeable approaches or opens the gripping object. Move the palm in a direction that intersects in the approaching direction,
The finger placement determination unit is
In the arrangement determination, the arrangement impossible determination is made for a part of the plurality of fingers, and the movement control unit moves all of the plurality of fingers in a direction intersecting the extending direction. Is it possible to place the finger portion, which has been determined to be able to be placed before the first movement, at the gripping position without touching the gripping object or the object after the first movement? Make a relocation judgment to see if
The movement control unit
When the non-arrangement determination is made in the rearrangement determination, the gripping object is in a direction in which the finger portion determined to be non-arrangement intersects in the extending direction before the rearrangement determination is performed. A second movement is performed to move the palm portion in a direction intersecting the palm approaching direction so as to approach or separate.
When the unarrangement determination is made in the arrangement determination, each of the plurality of fingers is moved in a direction intersecting the extending direction so that the gripping object can be arranged between the plurality of fingers. It also has a finger movement determination unit that determines the movement of whether or not it is possible.
The finger movement determination unit is
According to the movement determination, the immovability determination is made that each of the plurality of fingers cannot be moved in the direction intersecting the extending direction so that the gripping object can be arranged between the plurality of fingers. If so, the end effector device determines that the gripping object cannot be gripped .
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2018179299A JP7035935B2 (en) | 2018-09-25 | 2018-09-25 | End effector device |
PCT/JP2019/009916 WO2020066065A1 (en) | 2018-09-25 | 2019-03-12 | End effecter device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2018179299A JP7035935B2 (en) | 2018-09-25 | 2018-09-25 | End effector device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2020049566A JP2020049566A (en) | 2020-04-02 |
JP7035935B2 true JP7035935B2 (en) | 2022-03-15 |
Family
ID=69951289
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2018179299A Active JP7035935B2 (en) | 2018-09-25 | 2018-09-25 | End effector device |
Country Status (2)
Country | Link |
---|---|
JP (1) | JP7035935B2 (en) |
WO (1) | WO2020066065A1 (en) |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009142902A (en) | 2007-12-11 | 2009-07-02 | Toyota Industries Corp | Robot hand control device |
JP2016203293A (en) | 2015-04-21 | 2016-12-08 | 株式会社豊田自動織機 | Picking device and picking method |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63120092A (en) * | 1986-11-06 | 1988-05-24 | 日立建機株式会社 | Gripper |
JPH04159094A (en) * | 1990-10-23 | 1992-06-02 | Natl Space Dev Agency Japan<Nasda> | Automatic manipulator hand |
JPH06335887A (en) * | 1993-05-28 | 1994-12-06 | Sanyo Electric Co Ltd | Recognition of object clamped by robot hand |
JPH08141956A (en) * | 1994-11-17 | 1996-06-04 | Sanyo Electric Co Ltd | Method for controlling object gripping robot |
-
2018
- 2018-09-25 JP JP2018179299A patent/JP7035935B2/en active Active
-
2019
- 2019-03-12 WO PCT/JP2019/009916 patent/WO2020066065A1/en active Application Filing
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009142902A (en) | 2007-12-11 | 2009-07-02 | Toyota Industries Corp | Robot hand control device |
JP2016203293A (en) | 2015-04-21 | 2016-12-08 | 株式会社豊田自動織機 | Picking device and picking method |
Also Published As
Publication number | Publication date |
---|---|
JP2020049566A (en) | 2020-04-02 |
WO2020066065A1 (en) | 2020-04-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6947145B2 (en) | End effector device | |
JP6661001B2 (en) | System and method for determining work offset | |
JP6454960B2 (en) | Robot, robot system, robot controller | |
US9919424B1 (en) | Analog control switch for end-effector | |
JP6663978B2 (en) | System and method for determining tool offset | |
US10675767B2 (en) | Robot system and robot controller | |
JP7147419B2 (en) | end effector device | |
CN113165187A (en) | Image information processing device, gripping system, and image information processing method | |
KR20120053274A (en) | Method of controlling robot | |
CN110636924B (en) | Gripping system | |
JP7014114B2 (en) | End effector and end effector device | |
KR101740898B1 (en) | Robot teaching apparatus | |
JP7035935B2 (en) | End effector device | |
JP2015071207A (en) | Robot hand and control method thereof | |
JPH04240087A (en) | Gripping method and device | |
JP2015085481A (en) | Robot, robot system, robot control device and gripping method | |
JP6988757B2 (en) | End effector and end effector device | |
JPWO2019065426A1 (en) | Robot hand and robot hand control method | |
US11400583B2 (en) | Robot | |
US20190143533A1 (en) | Gripping tongs | |
US20230219218A1 (en) | Robot System with Casing Elements | |
JPH04159094A (en) | Automatic manipulator hand | |
Su et al. | A new, simple and universal four-finger gripper for 3D objects grasping | |
TW202210252A (en) | Robot system and picking method | |
JP2015104763A (en) | Control method of robot device and robot device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20201215 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20210629 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20210823 |
|
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: 20220201 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20220214 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7035935 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |