JP2007222980A - Robot hand, and griping method with robot hand - Google Patents

Robot hand, and griping method with robot hand Download PDF

Info

Publication number
JP2007222980A
JP2007222980A JP2006046094A JP2006046094A JP2007222980A JP 2007222980 A JP2007222980 A JP 2007222980A JP 2006046094 A JP2006046094 A JP 2006046094A JP 2006046094 A JP2006046094 A JP 2006046094A JP 2007222980 A JP2007222980 A JP 2007222980A
Authority
JP
Japan
Prior art keywords
fingers
gripping
robot hand
joint
pairs
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
Application number
JP2006046094A
Other languages
Japanese (ja)
Inventor
Minoru Komachi
実 小町
Tsutomu Matsukawa
勉 松川
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nissan Motor Co Ltd
Original Assignee
Nissan Motor Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Nissan Motor Co Ltd filed Critical Nissan Motor Co Ltd
Priority to JP2006046094A priority Critical patent/JP2007222980A/en
Publication of JP2007222980A publication Critical patent/JP2007222980A/en
Pending legal-status Critical Current

Links

Images

Abstract

<P>PROBLEM TO BE SOLVED: To simultaneously grip two parts when small parts are gripped on the premise of a multi-finger griping type robot hand, in which two sets of two one-finger two-node type fingers are aligned in an overlaying direction relative to a hand body. <P>SOLUTION: One of fingers 2A, 2B and the remaining fingers 3A, 3B can grip separate parts W2, respectively. When the separate parts W2 are gripped by the fingers 2A, 2B and 3A, 3B, one of the fingers 2A, 2B grips the part W2, one of the fingers 2A, 2B gripping the part W2 is retreated in advance into a condition that a plane perpendicular to the overlaying direction of the fingers 2A, 2B and 3A, 3B is offset from the remaining fingers 3A, 3B prior to the griping action of the other fingers 3A, 3B. <P>COPYRIGHT: (C)2007,JPO&INPIT

Description

本発明は、ロボットハンドとロボットハンドによる把持方法に関し、特に対向配置した二つで一組の1指につき少なくとも2関節タイプのフィンガーをハンド本体に対し重合方向に複数組並べて配置してあるいわゆる多指タイプのロボットハンドとロボットハンドによる把持方法に関するものである。   The present invention relates to a robot hand and a gripping method using a robot hand, and in particular, a so-called multi-purpose configuration in which a plurality of pairs of at least two joint-type fingers are arranged side by side in a superposition direction with respect to a hand body. The present invention relates to a finger type robot hand and a gripping method using a robot hand.

例えば部品棚あるいは部品箱等に整列してある複数種類の部品のピッキングのために、対向配置した二つで一組の1指2関節タイプのフィンガーをハンド本体に対し重合方向に複数組並べて配置してある汎用多指タイプのロボットハンドが使用されており、その代表的なものとして例えば特許文献1,2に記載のものが知られている。   For example, for picking multiple types of parts that are aligned on a parts shelf or parts box, two pairs of one-finger and two-joint-type fingers that are placed opposite to each other are placed side by side in the overlapping direction on the hand body. A general-purpose multi-finger type robot hand is used, and typical examples thereof are those described in Patent Documents 1 and 2, for example.

そして、小物部品から長尺または大物部品までの複数種類の部品を把持するために、例えば対向配置した二つで一組の1指2関節タイプのフィンガーをハンド本体に対し重合方向に二組並べて配置してあるロボットハンドでは、並べて配置してある小物部品を把持する場合には一組のフィンガーを使用して部品を把持する一方、長尺または大物の部品を把持する場合には二組全部のフィンガーを使用して部品を把持するようにしている。
特開平2002−264066号公報 特開平2004−50378号公報
Then, in order to grip a plurality of types of parts from small parts to long or large parts, for example, two pairs of one-finger and two-joint type fingers arranged opposite to each other are arranged in the superposition direction with respect to the hand body. With a robot hand that is placed, when gripping small parts that are placed side by side, a pair of fingers is used to grip the part, while when gripping a long or large part, all two sets The finger is used to grip the part.
Japanese Patent Laid-Open No. 2002-264066 Japanese Patent Laid-Open No. 2004-50378

上記のようなロボットハンドの使用を前提として同じ小物部品の把持動作を繰り返し行う場合には、一組のフィンガーのみを使用しているだけであるため、残る一組のフィンガーはいわゆる遊んでいる状態にあり、したがって仕事効率を上げるために残る一組のフィンガーで二つ目の部品を把持しようとしても、最初に把持した部品が邪魔になって二つ目の部品を把持するができないという問題があった。   If the same small parts are repeatedly gripped on the premise of using the robot hand as described above, only one set of fingers is used, so the remaining set of fingers is in a so-called idle state. Therefore, even if you try to grip the second part with a pair of remaining fingers to increase work efficiency, the first part you gripped will interfere with you and you will not be able to grip the second part. there were.

本発明はこのような課題に着目してなされたものであり、上記のように対向配置した二つで一組の1指につき少なくとも2関節タイプのフィンガーをハンド本体に対し重合方向に複数組並べて配置してあるいわゆる多指タイプのロボットハンドを前提として、特に小物部品の把持に際して二つ以上部品を同時に把持することができるようにしたロボットハンドと把持方法を提供するものである。   The present invention has been made paying attention to such a problem, and at least two joint-type fingers per pair of two fingers arranged opposite to each other as described above are arranged side by side in the overlapping direction with respect to the hand body. On the premise of a so-called multi-finger type robot hand arranged, a robot hand and a gripping method are provided which can grip two or more parts at the same time, especially when gripping small parts.

請求項1に記載の発明は、対向配置した二つで一組の1指につき少なくとも2関節タイプのフィンガーをハンド本体に対し重合方向に複数組並べて配置し、それら複数組のフィンガーは重合状態のままで相互協調動作により単一の把持対象物を把持することができるようになっている一方、一部の組のフィンガーと残りの組のフィンガーがそれぞれ別個の把持対象物を把持することができるようになっているロボットハンドであることを前提としている。   According to the first aspect of the present invention, a plurality of at least two joint-type fingers are arranged side by side in the overlapping direction with respect to the hand body, and two or more pairs of fingers arranged in a superposed state. While it is possible to grip a single gripping object by mutual cooperative operation, a part of the fingers and a remaining pair of fingers can grip separate gripping objects. It is assumed that the robot hand is.

その上で、複数組のフィンガーにてそれぞれ別個の把持対象物を把持する際には、一部の組のフィンガーが把持対象物を把持したならば、残りの組のフィンガーによる把持動作に先行して、把持対象部物を把持した一部の組のフィンガーがフィンガー同士の重合方向と直交する平面内を残りの組のフィンガーに対しオフセット状態となるように予め退避動作するようになっていることを特徴とする。   In addition, when gripping objects to be gripped by a plurality of pairs of fingers, if some of the fingers grip the object to be gripped, the gripping operation by the remaining pairs of fingers is preceded. The part of the fingers gripping the object to be gripped is retracted in advance so as to be offset with respect to the rest of the fingers in a plane orthogonal to the overlapping direction of the fingers. It is characterized by.

この場合、請求項3に記載のように、対向配置した二つで一組の1指2関節タイプのフィンガーをハンド本体に対し重合方向に少なくとも二組並べて配置してあれば足りる。   In this case, as described in claim 3, it is sufficient that at least two pairs of one-finger and two-joint type fingers arranged opposite to each other are arranged side by side in the overlapping direction with respect to the hand body.

請求項4に記載の発明は、請求項1に記載の事項を把持方法として捉えたものであって、対向配置した二つで一組のフィンガーをハンド本体に対し重合方向に複数組並べて配置し、それら複数組のフィンガーは重合状態のままで相互協調動作により単一の把持対象物を把持することができるようになっている一方、一部の組のフィンガーと残りの組のフィンガーがそれぞれ別個の把持対象物を把持することができるようになっているロボットハンドによる把持方法であることを前提としている。   The invention described in claim 4 captures the matter described in claim 1 as a gripping method, and two sets of opposing fingers are arranged side by side in a superposition direction with respect to the hand body. The plurality of pairs of fingers can be held in a superposed state so that a single object can be gripped by a mutual cooperative operation, while a part of the fingers and the rest of the fingers are separated from each other. It is assumed that this is a gripping method by a robot hand that can grip a gripping object.

その上で、複数組のフィンガーにてそれぞれ別個の把持対象物を把持する際には、一部の組のフィンガーが把持対象物を把持したならば、残りの組のフィンガーによる把持動作に先行して、把持対象部物を把持した一部の組のフィンガーがフィンガー同士の重合方向と直交する平面内を残りの組のフィンガーに対しオフセット状態となるように予め退避動作させることを特徴とする。   In addition, when gripping objects to be gripped by a plurality of pairs of fingers, if some of the fingers grip the object to be gripped, the gripping operation by the remaining pairs of fingers is preceded. Then, a part of the fingers holding the object to be grasped is retracted in advance so as to be offset with respect to the rest of the fingers in a plane perpendicular to the overlapping direction of the fingers.

したがって、請求項1,4に記載の発明では、例えば対向配置した二つで一組の1指2関節タイプのフィンガーをハンド本体に対し重合方向に二組並べて配置してあるタイプのロボットハンドの場合、二組のフィンガーにてそれぞれ別個の把持対象物を把持する際には、一方の組のフィンガーが把持対象物を把持したならば、他方の組のフィンガーによる把持動作に先行して、把持対象部物を把持した一方の組のフィンガーがフィンガー同士の重合方向と直交する平面内を他方の組のフィンガーに対しオフセット状態となるように予め退避動作させるものとする。   Therefore, according to the first and fourth aspects of the present invention, for example, a robot hand of a type in which two pairs of one-finger and two-joint-type fingers arranged opposite to each other are arranged side by side in the overlapping direction with respect to the hand body. In this case, when gripping separate gripping objects by two pairs of fingers, if one pair of fingers grips the gripping object, the gripping operation is performed prior to the gripping operation by the other pair of fingers. One set of fingers holding the object part is retracted in advance so as to be in an offset state with respect to the other set of fingers in a plane perpendicular to the overlapping direction of the fingers.

こうすることにより、部品同士の干渉が回避されて、一つ目の把持対象物を把持した状態でありながら二つ目の部品を無理なく把持することが可能となる。その結果として、例えば部品箱からその内部に整列してある部品をピッキングする場合に、部品箱に対するロボットハンドの一回のアプローチ動作で複数の部品を把持することができ、作業効率の向上に寄与できるようになる。   By doing so, interference between the components is avoided, and the second component can be gripped without difficulty while the first gripping target is being gripped. As a result, for example, when picking parts that are aligned inside the parts box, multiple parts can be gripped with a single approach of the robot hand to the parts box, contributing to improved work efficiency. become able to.

請求項1,4に記載の発明によれば、複数組のフィンガーの自由度を有効利用して、一部の組のフィンガーと残りの組のフィンガーとでそれぞれ別個の把持対象物を把持するにあたり、一部の組のフィンガーが把持対象物を把持したならば、残りの組のフィンガーによる把持動作に先行して、把持対象部物を把持した一部の組のフィンガーがフィンガー同士の重合方向と直交する平面内を残りの組のフィンガーに対しオフセット状態となるように予め退避動作することにより、部品同士の干渉が回避されて、一つ目の把持対象物を把持した状態でありながら二つ目の部品を無理なく把持することが可能となり、その結果として、例えば部品箱からその内部に整列してある部品をピッキングする場合に、部品箱に対するロボットハンドの一回のアプローチ動作で複数の部品を把持することができ、作業効率が向上する。   According to the first and fourth aspects of the present invention, when a plurality of sets of fingers are used effectively, a partial set of fingers and a remaining set of fingers are used to hold separate objects. If some of the fingers grasp the object to be grasped, prior to the grasping operation by the remaining pairs of fingers, some of the fingers that grasp the object to be grasped By retreating in advance so as to be in an offset state with respect to the remaining pairs of fingers in an orthogonal plane, interference between components is avoided, and the two gripping objects are in a state of gripping the first gripping object. As a result, it is possible to grip the part of the eye without any difficulty. For example, when picking a part that is aligned inside the part box from the part box, Can grip the plurality of parts approach operation, thereby improving work efficiency.

図1は本発明に係るロボットハンドのより具体的な実施の形態を示す図で、特に図示しない部品箱等に整列収納されている各種部品のピッキングに用いられる汎用型のロボットハンドの例を示しており、同図(A)はその正面図を、同図(B)はその右側面図をそれぞれ示している。   FIG. 1 is a view showing a more specific embodiment of a robot hand according to the present invention, and shows an example of a general-purpose robot hand used for picking various parts arranged and stored in a parts box (not shown). FIG. 2A shows a front view thereof, and FIG. 2B shows a right side view thereof.

図1の(A),(B)に示すように、ロボットハンド1は、対向配置することで左右で対をなす二つ一組のいわゆる二指把持タイプの二組のフィンガー2A,2Bおよび3A,3Bを互いに重合するように所定距離隔ててハンド本体4に並べて支持させたもので、ロボットハンド1全体として合計で4本のフィンガー2A,2B,3A,3Bを有している、そして、それぞれのフィンガー2A,2B,3A,3Bは一つにつき根元側関節5aまたは6aと指先側関節5bまたは6bとを有していて、いわゆる1指2関節タイプのものとなっている。   As shown in FIGS. 1A and 1B, the robot hand 1 has two sets of two fingers 2A, 2B and 3A of a so-called two-finger grip type that are paired on the left and right sides by being opposed to each other. , 3B are arranged and supported on the hand body 4 at a predetermined distance so as to overlap each other, and the robot hand 1 as a whole has a total of four fingers 2A, 2B, 3A, 3B, and Each finger 2A, 2B, 3A, 3B has a root side joint 5a or 6a and a fingertip side joint 5b or 6b, and is of a so-called one-finger / two-joint type.

各関節5a,5b,6a,6bに後述するようには駆動モータとしてそれぞれに独立したサーボモータを内蔵してあり、それぞれに独立した関節動作、すなわち各々のフィンガー構成要素7a,7bの独立した開閉動作が可能となっている。   As will be described later, each joint 5a, 5b, 6a, 6b incorporates independent servo motors as drive motors, and independent joint operations, that is, independent opening / closing of each finger component 7a, 7b. Operation is possible.

このように構成されたロボットハンド1によれば、把持対象物として例えば小物部品から大物または長尺な部品までの各種部品のピッキングに共通して使用するものとし、また部品箱に対するロボットハンド1の一回のアプローチ動作で一つの部品を把持するものと仮定した場合、図2の(A)に示すように大物または長尺な部品W1を把持する場合には4本のフィンガー2A,2B,3A,3Bの全てを使って把持する一方、小物部品W2の場合には同図(B)に示すようにいずれか一組のフィンガー、例えばフィンガー3A,3Bのみを使って小物部品W2を把持することとなり、残る一組のフィンガー2A,2Bは実質的に遊んでいて有効活用できないことになる。   According to the robot hand 1 configured as described above, it is commonly used for picking various parts from small parts to large parts or long parts as a gripping object, and the robot hand 1 with respect to a parts box is used. Assuming that one part is gripped by one approach operation, when gripping a large or long part W1 as shown in FIG. 2A, four fingers 2A, 2B, 3A , 3B, and in the case of the small component W2, as shown in FIG. 5B, the small component W2 is gripped using only one pair of fingers, for example, the fingers 3A, 3B. Thus, the remaining pair of fingers 2A and 2B are substantially idle and cannot be used effectively.

そこで、フィンガー2A,2Bの有効活用のために、例えば図3に示すように部品箱8に整列収納されている小物部品W2を一方のフィンガー2A,2Bと他方のフィンガー3A,3Bとで別々に把持していわゆる2個取りしようとしても、整列収納されている部品W2,W2同士の間隔とフィンガー2A,3Aおよび2B,3B同士の間隔が必ずしも一致せず、また隣りの部品W2が邪魔となっていわゆる2個取りすることができない。   Therefore, in order to effectively use the fingers 2A and 2B, for example, as shown in FIG. 3, the accessory parts W2 aligned and stored in the parts box 8 are separately provided for one finger 2A and 2B and the other finger 3A and 3B. Even if it is tried to grasp and take two so-called, the interval between the parts W2 and W2 stored in alignment and the interval between the fingers 2A, 3A and 2B and 3B do not always match, and the adjacent part W2 becomes an obstacle. So-called two cannot be taken.

そこで、本実施の形態では、特に把持対象物がいわゆる小物部品W2である場合にその2個取りを可能にしようとするもので、図4,5に示すように、一方の組のフィンガー2A,2Bが小物部品W2を把持したならばその部品把持状態のままで一方の組のフィンガー2A,2Bを破線で示す把持完了位置P1から退避位置P2まで一旦退避させ、その状態で図4に示すように他方の組のフィンガー3A,3Bにて小物部品W2を把持するものである。   Therefore, in the present embodiment, particularly when the object to be grasped is a so-called accessory part W2, two pieces are to be obtained. As shown in FIGS. If 2B grips the small part W2, one pair of fingers 2A, 2B is temporarily retracted from the gripping completion position P1 indicated by the broken line to the retracted position P2 while maintaining the part gripping state, and in this state, as shown in FIG. The small part W2 is held by the other pair of fingers 3A and 3B.

ここで、図6,7は図1において個々にサーボモータ10が内蔵された各関節5a,5bおよび6a,6bのフィードバック制御系のフロック回路図を示し、各フィンガー2A,2Bおよび3A,3Bの根元側関節5a,6aおよび指先側関節5b,6bそれぞれの関節動作はコントローラ9によって制御されるようになっている。そして、各フィンガー2A,2Bおよび3A,3Bの根元側関節5a,6aはサーボモータ10のほかフィードバック要素としてのロータリーエンコーダ11を備えていて、それぞれに位置、速度および電流のフィードバックループを形成している。これにより、根元側関節5a,6aのそれぞれは少なくとも位置フィードバック制御(位置制御)による関節動作が可能となっている。   Here, FIGS. 6 and 7 show flock circuit diagrams of feedback control systems of the joints 5a, 5b and 6a, 6b in which the servo motors 10 are individually incorporated in FIG. 1, and the fingers 2A, 2B and 3A, 3B are shown. The joint operations of the base side joints 5a and 6a and the fingertip side joints 5b and 6b are controlled by the controller 9. The base joints 5a and 6a of the fingers 2A and 2B and 3A and 3B are provided with a rotary encoder 11 as a feedback element in addition to the servo motor 10, and form a feedback loop of position, speed and current respectively. Yes. Accordingly, each of the root side joints 5a and 6a can perform a joint operation by at least position feedback control (position control).

他方、各フィンガー2A,2Bおよび3A,3Bの指先側関節5b,6bは同様にしてサーボモータ10のほかフィードバック要素としてのロータリーエンコーダ11を備えていて、それぞれに位置、速度および電流のフィードバックループを形成しているほか、ゲイン調整器12または13と切替器(切替器1)14または切替器(切替器2)15とをそれぞれに有している。これにより、指先側関節5b,6bのそれぞれは少なくとも位置フィードバック制御(位置制御)による関節動作のほか、位置フィードバック制御に依存せずにゲイン調整器12または13の出力をトルク指令値とするいわゆるトルク制御による関節動作が選択切替可能となっている。   On the other hand, the fingertip side joints 5b and 6b of the fingers 2A, 2B and 3A, 3B are similarly provided with a rotary encoder 11 as a feedback element in addition to the servo motor 10, and each has a position, speed and current feedback loop. In addition, the gain adjuster 12 or 13 and the switch (switch 1) 14 or switch (switch 2) 15 are provided. As a result, each of the fingertip side joints 5b and 6b is a so-called torque that uses the output of the gain adjuster 12 or 13 as a torque command value without depending on position feedback control in addition to at least joint motion by position feedback control (position control). The joint motion by control can be selected and switched.

より詳しくは、図7に示すように、それぞれのゲイン調整器12,13は入力された指令値のゲインが1よりも小さくなるように調整する機能を有しており(ゲインをどの程度小さくするかは予め設定されている)、一方の指先側関節5bにおけるゲイン調整器12の出力は他方の指先側関節6bのトルク制御時のトルク指令値としてその他方の指先側関節6b側の切替器15に、他方の指先側関節6bにおけるゲイン調整器13の出力は一方の指先側関節5bのトルク制御時のトルク指令値としてその一方の指先側関節5b側の切替器14にそれぞれ入力されるようになっている。そして、各切替器14,15ではコントローラ9からの切替信号S1またはS2により切替操作されるようになっており、該当する指先側関節5bまたは6bの位置指令値としてコントローラ9から出力される本来の位置フィードバック制御時の指令値と、反対側の指先側関節6bまたは5bに付帯するゲイン調整器13または12の出力であるところのトルク制御時のトルク指令値とのいずれかを選択意的にサーボモータ10側に付与することができるようになっている。そして、各切替器14,15の状態と各指先側関節5b,6bの制御形態(位置フィードバック制御(位置制御)であるかトルク制御であるか)の組み合わせを整理すると表1のようになる。   More specifically, as shown in FIG. 7, each of the gain adjusters 12 and 13 has a function of adjusting the gain of the input command value to be smaller than 1 (how much the gain is reduced). The output of the gain adjuster 12 at one fingertip side joint 5b is used as a torque command value at the time of torque control of the other fingertip side joint 6b, and the switch 15 on the other fingertip side joint 6b side. In addition, the output of the gain adjuster 13 in the other fingertip side joint 6b is input to the switch 14 on the one fingertip side joint 5b side as a torque command value at the time of torque control of the one fingertip side joint 5b. It has become. Each of the switches 14 and 15 is switched by a switching signal S1 or S2 from the controller 9, and is output from the controller 9 as a position command value of the corresponding fingertip side joint 5b or 6b. Selectively servo between the command value at the time of position feedback control and the torque command value at the time of torque control which is the output of the gain adjuster 13 or 12 attached to the opposite fingertip side joint 6b or 5b. It can be applied to the motor 10 side. Table 1 summarizes the combinations of the states of the switches 14 and 15 and the control forms (whether position feedback control (position control) or torque control) of the fingertip side joints 5b and 6b.

Figure 2007222980
Figure 2007222980

ここで、上記トルク制御との呼称は、図7の各切替器14,15においてゲイン調整器12,13の出力がトルク指令値として選択されている時には、ロータリーエンコーダ11をフィードバック要素とする位置および速度のフィードバックループは何ら機能せずに電流のフィードバックループのみが機能することに基づいている。   Here, when the output of the gain adjusters 12 and 13 is selected as a torque command value in each of the switches 14 and 15 in FIG. The speed feedback loop is based on the fact that only the current feedback loop works, with no function.

したがって、このように構成されたロボットハンド1によれば、図2に示すように長尺または大物の部品W1であるか小物部品W2であるかにかかわらず、その把持に先立つ部品W1またはW2へのアプローチ動作時には、図8の(A)に示すように根元側関節5a,6aおよび指先側関節5b,6b共に位置フィードバック制御のもとで行う。つまり、根元側関節5a,6aでは図6のフィードバックループのもとで位置制御を行うとともに、指先側関節5b,6bでは図7に示す各切替器14,15をA接点側に切り替えて各関節5b,6bの位置制御を行う(表1のパターン1)。   Therefore, according to the robot hand 1 configured in this way, regardless of whether it is a long or large part W1 or a small part W2, as shown in FIG. At the time of this approach operation, as shown in FIG. 8A, both the base side joints 5a and 6a and the fingertip side joints 5b and 6b are performed under position feedback control. That is, the base side joints 5a and 6a perform position control under the feedback loop of FIG. 6, and the fingertip side joints 5b and 6b switch the switches 14 and 15 shown in FIG. Position control of 5b and 6b is performed (pattern 1 in Table 1).

その一方、アプローチ動作に続く図8の(B)の実際の把持動作時には、根元側関節5a,6aでは図6に基づいて位置フィードバック制御を行う一方、指先側関節5b,6bでは図7に示す各切替器14,15をB接点側に切り替えて各関節5b,6bのトルク制御を同期して行うことで把持対象となる例えば小物部品W2を把持する(表1のパターン4)。   On the other hand, at the time of the actual gripping operation shown in FIG. 8B following the approach operation, the base side joints 5a and 6a perform position feedback control based on FIG. 6, while the fingertip side joints 5b and 6b show FIG. For example, the small component W2 to be gripped is gripped by switching the switches 14 and 15 to the B contact side and performing the torque control of the joints 5b and 6b in synchronization (pattern 4 in Table 1).

図7の各切替器14,15をB接点側に切り替えて各関節5b,6bのトルク制御を行う場合には、先に述べたようにそのトルク指令値はゲイン調整器12または13にてゲインが1よりも小さくなるように予め調整されていることから、そのトルク値は位置フィードバック制御時のものよりも小さくなる。また、図7から明らかなように、各指先側関節5b,6bは対となっている反対側の指先側関節6bまたは5bに付帯するゲイン調整器13または12の出力をトルク指令値として作動するものであるから、双方の指先側関節5b,6bが同期して作動するとともに、各指先側関節5b,6bは反対側の指先側関節が作動している限り作動し続けて上記トルク制御に基づく一定の力で例えば小物部品W2を押さえ付けることになる。そして、各指先側関節5b,6bの動きがなくなった時点で小物部品W2の把持が完了し(これは、各サーボモータ10に付帯のロータリーエンコーダ11の出力を監視することで確認可能)、以降はその把持状態を維持することになる。   When the respective switches 14 and 15 in FIG. 7 are switched to the B contact side to perform torque control of the joints 5b and 6b, the torque command value is gained by the gain adjuster 12 or 13 as described above. Is previously adjusted to be smaller than 1, the torque value is smaller than that at the time of position feedback control. Further, as is apparent from FIG. 7, each fingertip side joint 5b, 6b operates with the output of the gain adjuster 13 or 12 attached to the opposite fingertip side joint 6b or 5b as a torque command value. Therefore, both the fingertip side joints 5b and 6b operate synchronously, and each fingertip side joint 5b and 6b continues to operate as long as the opposite fingertip side joint operates, and is based on the above torque control. For example, the accessory part W2 is pressed with a constant force. Then, when the movements of the fingertip side joints 5b and 6b cease, the gripping of the accessory parts W2 is completed (this can be confirmed by monitoring the output of the rotary encoder 11 attached to each servo motor 10), and thereafter Will maintain its gripping state.

一方、図4,5のような形態で小物部品W2をいわゆる2個取りする際には、最初に一組のフィンガー2A,2Bのみを作動させて、図8の場合と全く同じ手順で部品W2を把持する。そして、一組のフィンガー2A,2Bが小物部品W2を把持したならば、その部品把持状態のままで図5に破線で示すように一組のフィンガー2A,2Bを退避位置P2まで退避動作させる。この退避動作の際には、根元側関節5a,6aを図6の位置フィードバック制御とするとともに、一方の指先側関節6bも図7のように位置フィードバック制御に切り替える一方で、他方の指先側関節5bについてのみ図7のようにトルク制御に切り替えて(表1のパターン3)、既に小物部品W2を把持している一組のフィンガー2A,2Bを退避位置P2まで移動させる。つまり、フィンガー3A,3bによる部品W2の把持動作に先行して、部品W2を把持している一組のフィンガー2A,2Bがフィンガー2A,2Bと3A,3Bとの重合方向と直交する平面内を他方の組のフィンガー3A,3Bに対しオフセット状態となるように予め退避動作させるものとする。   On the other hand, when two so-called two small parts W2 are taken in the form as shown in FIGS. 4 and 5, only the pair of fingers 2A and 2B are first operated, and the part W2 is exactly the same as in FIG. Grip. Then, if the pair of fingers 2A and 2B grips the accessory part W2, the pair of fingers 2A and 2B is retracted to the retracted position P2 as shown by the broken line in FIG. In this retracting operation, the root side joints 5a and 6a are set to the position feedback control of FIG. 6, and one fingertip side joint 6b is also switched to the position feedback control as shown in FIG. Only 5b is switched to the torque control as shown in FIG. 7 (pattern 3 in Table 1), and the pair of fingers 2A and 2B already holding the accessory part W2 are moved to the retracted position P2. That is, prior to the gripping operation of the component W2 by the fingers 3A and 3b, the pair of fingers 2A and 2B gripping the component W2 is in a plane perpendicular to the overlapping direction of the fingers 2A and 2B and 3A and 3B. It is assumed that the other pair of fingers 3A and 3B is retracted in advance so as to be in an offset state.

より具体的には、既に小物部品W2を把持している一組のフィンガー2A,2Bを図5の退避位置P2まで移動させる際に、上記のように一方の指先側関節5bのみをいわゆるトルク制御に切り替え、それ以外の関節5a,6a,5bを位置フィードバック制御にて作動させると、特に他方の指先側関節6bは既に部品W2に押し付けられているフィンガー2Bのフィンガー構成要素7と部品W2との相対位置関係が変わらないような一定の角度姿勢を保つように位置制御され、これに対してトルク制御に切り替えられた一方の指先側関節2Aでは、図7に示すように指先側関節6b側ゲイン調整器13の出力をトルク指令値としている故に、その指先側関節6bが作動しているかぎりは一定の力でフィンガー構成要素7を部品W2に押し付けていることになり、したがって小物部品W2を確実に把持したままで干渉エリア外である退避位置P2まで一組のフィンガー2A,2Bを移動させることができる。   More specifically, when the pair of fingers 2A and 2B that have already grasped the accessory part W2 are moved to the retracted position P2 in FIG. When the other joints 5a, 6a, 5b are operated by position feedback control, particularly the other fingertip side joint 6b is formed between the finger component 7 of the finger 2B already pressed against the part W2 and the part W2. In the one fingertip side joint 2A that has been position-controlled so as to maintain a constant angular posture so that the relative positional relationship does not change, and that is switched to torque control, the gain on the fingertip side joint 6b is shown in FIG. Since the output of the adjuster 13 is a torque command value, the finger component 7 is pressed against the component W2 with a constant force as long as the fingertip side joint 6b is operating. Will be that, thus can move a set of finger 2A to the retracted position P2 is outside the interference area while reliably grasping the small parts W2, the 2B.

図4,5に示すように、一組のフィンガー2A,2Bが退避位置P2に移動し終えたならば、代わって他方の組のフィンガー3A,3Bを隣の部品W2を把持可能な位置まで移動させて、図8と同様の手順でその2個目の部品W2を把持する。この2個目の部品W2を把持する際には、既に1個目の部品W2を把持している一方の組のフィンガー2A,2Bが退避位置P2にあることから、この他方の組のフィンガー3A,3Bは1個目の部品W2や部品箱8等と干渉することなく、スムーズに2個目の部品W2を把持することができる。   As shown in FIGS. 4 and 5, when one pair of fingers 2A, 2B has moved to the retracted position P2, instead move the other pair of fingers 3A, 3B to a position where the adjacent part W2 can be gripped. Then, the second component W2 is gripped in the same procedure as in FIG. When gripping the second component W2, one set of fingers 2A, 2B that has already gripped the first component W2 is in the retracted position P2, so this other set of fingers 3A , 3B can smoothly grip the second component W2 without interfering with the first component W2, the component box 8, and the like.

このように本実施に形態によれば、例えば部品箱8に整列収納されている小物部品W2のピッキングに際して、その部品箱8に対するロボットハンド1の一回のアプローチ動作で部品W2をいわゆる2個取りすることが可能となり、ピッキング作業効率が大幅に向上することになる。   Thus, according to this embodiment, for example, when picking small parts W2 aligned and stored in the parts box 8, two so-called two parts W2 are picked up by one approach operation of the robot hand 1 with respect to the parts box 8. Thus, picking work efficiency is greatly improved.

ここで、上記実施の形態では、各関節5a,5b,6a,6bの駆動源であるサーボモータ10を関節5a,5b,6a,6bに内蔵している場合の例を示しているが、例えば各サーボモータ10をハンド本体4内に内蔵していて、各サーボモータ10から巻掛伝達手段等を介して各関節5a,5b,6a,6bに動力を伝達して作動させるタイプのロボットハンドにも本発明を適用することができることは言うまでもない。   Here, in the above embodiment, an example is shown in which the servo motor 10 that is the drive source of each joint 5a, 5b, 6a, 6b is built in the joint 5a, 5b, 6a, 6b. Each servo motor 10 is built in the hand body 4 and is a type of robot hand that is operated by transmitting power from each servo motor 10 to each joint 5a, 5b, 6a, 6b via a winding transmission means or the like. Needless to say, the present invention can also be applied.

また、1指につき3以上の関節を有するようなフィンガーを用いたロボットハンドにも本発明は適用可能である。   The present invention can also be applied to a robot hand using fingers that have three or more joints per finger.

本発明に係るロボットハンドの一例を示す図で、(A)はその正面図、(B)は同図(A)の見語側面図。It is a figure which shows an example of the robot hand which concerns on this invention, (A) is the front view, (B) is a word side view of the figure (A). (A)は図1に示したロボットハンドにて長尺または大型の部品を把持し状態を示す説明図、(B)は同じく小物部品を把持した状態を示す説明図。(A) is explanatory drawing which shows the state which hold | grips a long or large component with the robot hand shown in FIG. 1, (B) is explanatory drawing which shows the state which hold | gripped the accessory component similarly. いわゆる小物部品の2個取り時の干渉状態を示す説明図。Explanatory drawing which shows the interference state at the time of taking two so-called small parts. いわゆる小物部品の2個取り時の干渉回避状態を示す説明図。Explanatory drawing which shows the interference avoidance state at the time of taking two so-called small parts. 図4の正面説明図。Front explanatory drawing of FIG. 図4,5における根元側関節のフィードバック制御系のブロック回路図。6 is a block circuit diagram of the feedback control system for the proximal joint in FIGS. 図4,5における指先側関節のフィードバック制御系のブロック回路図。The block circuit diagram of the feedback control system of the fingertip side joint in FIGS. (A)は部品に対するロボットハンドのアプローチ時の説明図、(B)は上記アプローチ動作に続く実際の把持時の説明図。(A) is explanatory drawing at the time of approach of the robot hand with respect to components, (B) is explanatory drawing at the time of the actual holding | grip following the said approach operation | movement.

符号の説明Explanation of symbols

1…ロボットハンド
2A,2B…フィンガー
3A,3B…フィンガー
4…ハンド本体
5a,6a…根元側関節
5b,6b…指先側関節
7a,7b…フィンガー構成要素
9…コントローラ
10…サーボモータ
12,13…ゲイン調整器
14,15…切替器
P2…退避位置
W1,W2…部品(把持対象物)
DESCRIPTION OF SYMBOLS 1 ... Robot hand 2A, 2B ... Finger 3A, 3B ... Finger 4 ... Hand main body 5a, 6a ... Base side joint 5b, 6b ... Fingertip side joint 7a, 7b ... Finger component 9 ... Controller 10 ... Servo motor 12, 13 ... Gain adjusters 14, 15 ... Switch P2 ... Retraction position W1, W2 ... Part (object to be gripped)

Claims (4)

対向配置した二つで一組の1指につき少なくとも2関節タイプのフィンガーをハンド本体に対し重合方向に複数組並べて配置し、
それら複数組のフィンガーは重合状態のままで相互協調動作により単一の把持対象物を把持することができるようになっている一方、
一部の組のフィンガーと残りの組のフィンガーがそれぞれ別個の把持対象物を把持することができるようになっていて、
複数組のフィンガーにてそれぞれ別個の把持対象物を把持する際には、一部の組のフィンガーが把持対象物を把持したならば、残りの組のフィンガーによる把持動作に先行して、把持対象部物を把持した一部の組のフィンガーがフィンガー同士の重合方向と直交する平面内を残りの組のフィンガーに対しオフセット状態となるように予め退避動作するようになっていることを特徴とするロボットハンド。
A pair of at least two joint-type fingers per one pair of fingers arranged opposite to each other are arranged side by side in the overlapping direction with respect to the hand body,
While these multiple pairs of fingers can be held in a superposed state and can hold a single object by mutual cooperation,
Some sets of fingers and the remaining sets of fingers can each hold a separate object to be gripped,
When gripping separate gripping objects with a plurality of pairs of fingers, if some pairs of fingers grip the gripping object, the gripping object precedes the gripping operation by the remaining pairs of fingers. It is characterized in that a part of the fingers holding the part is retracted in advance so as to be offset with respect to the rest of the fingers in a plane perpendicular to the overlapping direction of the fingers. Robot hand.
各フィンガーの関節はそれぞれに独立した駆動モータを備えていて、少なくとも最も指先側の関節は位置制御による関節動作とトルク制御による関節動作とが選択切換可能となっていることを特徴とする請求項1に記載のロボットハンド。   The joint of each finger is provided with an independent drive motor, and at least the joint on the most fingertip side can be selectively switched between joint operation by position control and joint operation by torque control. The robot hand according to 1. 対向配置した二つで一組の1指2関節タイプのフィンガーをハンド本体に対し重合方向に二組並べて配置してあることを特徴とする請求項1または2に記載のロボットハンド。   The robot hand according to claim 1 or 2, wherein two sets of one-finger and two-joint type fingers arranged opposite to each other are arranged side by side in the overlapping direction with respect to the hand body. 対向配置した二つで一組のフィンガーをハンド本体に対し重合方向に複数組並べて配置し、
それら複数組のフィンガーは重合状態のままで相互協調動作により単一の把持対象物を把持することができるようになっている一方、
一部の組のフィンガーと残りの組のフィンガーがそれぞれ別個の把持対象物を把持することができるようになっているロボットハンドによる把持方法であって、
複数組のフィンガーにてそれぞれ別個の把持対象物を把持する際には、一部の組のフィンガーが把持対象物を把持したならば、残りの組のフィンガーによる把持動作に先行して、把持対象部物を把持した一部の組のフィンガーがフィンガー同士の重合方向と直交する平面内を残りの組のフィンガーに対しオフセット状態となるように予め退避動作させることを特徴とするロボットハンドによる把持方法。
A set of two fingers arranged opposite each other are arranged side by side in the polymerization direction with respect to the hand body,
While these multiple pairs of fingers can be held in a superposed state and can hold a single object by mutual cooperation,
A gripping method by a robot hand in which a part of fingers and a remaining pair of fingers can grip separate objects to be grasped,
When gripping separate gripping objects with a plurality of pairs of fingers, if some pairs of fingers grip the gripping object, the gripping object precedes the gripping operation by the remaining pairs of fingers. A method of gripping with a robot hand, wherein a part of fingers holding a part is retracted in advance so that the fingers are offset in a plane perpendicular to the overlapping direction of the fingers. .
JP2006046094A 2006-02-23 2006-02-23 Robot hand, and griping method with robot hand Pending JP2007222980A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2006046094A JP2007222980A (en) 2006-02-23 2006-02-23 Robot hand, and griping method with robot hand

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2006046094A JP2007222980A (en) 2006-02-23 2006-02-23 Robot hand, and griping method with robot hand

Publications (1)

Publication Number Publication Date
JP2007222980A true JP2007222980A (en) 2007-09-06

Family

ID=38545260

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2006046094A Pending JP2007222980A (en) 2006-02-23 2006-02-23 Robot hand, and griping method with robot hand

Country Status (1)

Country Link
JP (1) JP2007222980A (en)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2012086313A (en) * 2010-10-20 2012-05-10 Toyota Motor Corp Robot hand control device, control method, and program for control
WO2013042184A1 (en) * 2011-09-20 2013-03-28 株式会社安川電機 Robot, handling system and method for creating article-containing container
WO2019065426A1 (en) * 2017-09-26 2019-04-04 倉敷紡績株式会社 Robot hand and robot hand control method
WO2019065427A1 (en) * 2017-09-26 2019-04-04 倉敷紡績株式会社 Method for controlling robot hand system and robot hand system
WO2019065425A1 (en) * 2017-09-26 2019-04-04 倉敷紡績株式会社 Robot hand and robot hand control method
JP7313868B2 (en) 2019-04-04 2023-07-25 キヤノン株式会社 ROBOT HAND, ROBOT SYSTEM, PRODUCTION SYSTEM, PRODUCT MANUFACTURING METHOD, CONTROL METHOD, TERMINAL DEVICE, CONTROL PROGRAM, AND RECORDING MEDIUM

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2012086313A (en) * 2010-10-20 2012-05-10 Toyota Motor Corp Robot hand control device, control method, and program for control
WO2013042184A1 (en) * 2011-09-20 2013-03-28 株式会社安川電機 Robot, handling system and method for creating article-containing container
CN103764352A (en) * 2011-09-20 2014-04-30 株式会社安川电机 Robot, handling system and method for creating article-containing container
WO2019065426A1 (en) * 2017-09-26 2019-04-04 倉敷紡績株式会社 Robot hand and robot hand control method
WO2019065427A1 (en) * 2017-09-26 2019-04-04 倉敷紡績株式会社 Method for controlling robot hand system and robot hand system
WO2019065425A1 (en) * 2017-09-26 2019-04-04 倉敷紡績株式会社 Robot hand and robot hand control method
JP7313868B2 (en) 2019-04-04 2023-07-25 キヤノン株式会社 ROBOT HAND, ROBOT SYSTEM, PRODUCTION SYSTEM, PRODUCT MANUFACTURING METHOD, CONTROL METHOD, TERMINAL DEVICE, CONTROL PROGRAM, AND RECORDING MEDIUM

Similar Documents

Publication Publication Date Title
JP2007222980A (en) Robot hand, and griping method with robot hand
JP2005511334A5 (en)
KR102463600B1 (en) Medical robotic system with remote current controller for controlling a plurality of distally housed motors
CN108942880B (en) Robot system
JP2012143835A (en) Robot hand
WO2019116891A1 (en) Robot system and robot control method
JP2009148845A (en) Small-size production equipment
EP2739230A1 (en) Manipulator system
JP2007148527A (en) Method for avoiding interference of robot and robot
JP2010069584A (en) Device and method for controlling manipulator
US11958188B2 (en) Modular end effector
KR20200030209A (en) Multi degree-of-freedom laparoscopic apparatus using disposable surgical robot tool
JPH0596477A (en) Control method for master and slave manipulators
JP5011507B2 (en) Robot teaching system and robot teaching method
JP2009012132A (en) Polyarticular robot and method for handing over work
JP2015085481A (en) Robot, robot system, robot control device and gripping method
WO2019065427A1 (en) Method for controlling robot hand system and robot hand system
JP6314429B2 (en) Robot, robot system, and robot controller
JP2007216367A (en) Device and method for holding object
US9987756B2 (en) Hand device, robot arm, and robot
JP2009196040A (en) Robot system
JP6527654B2 (en) Arm operating method and operating device
Bai et al. Development of a new control system for the robotic single port surgery
JPH02271402A (en) Controlling method for double arm robot
KR20140140155A (en) Multi-joint robot and method for controlling multi-joint robot