JP5929105B2 - Gripping device and robot - Google Patents

Gripping device and robot Download PDF

Info

Publication number
JP5929105B2
JP5929105B2 JP2011243127A JP2011243127A JP5929105B2 JP 5929105 B2 JP5929105 B2 JP 5929105B2 JP 2011243127 A JP2011243127 A JP 2011243127A JP 2011243127 A JP2011243127 A JP 2011243127A JP 5929105 B2 JP5929105 B2 JP 5929105B2
Authority
JP
Japan
Prior art keywords
component
contact
pair
circuit
wheatstone bridge
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Fee Related
Application number
JP2011243127A
Other languages
Japanese (ja)
Other versions
JP2013094951A (en
Inventor
郁夫 武田
郁夫 武田
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.)
Fujitsu Ltd
Original Assignee
Fujitsu 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 Fujitsu Ltd filed Critical Fujitsu Ltd
Priority to JP2011243127A priority Critical patent/JP5929105B2/en
Publication of JP2013094951A publication Critical patent/JP2013094951A/en
Application granted granted Critical
Publication of JP5929105B2 publication Critical patent/JP5929105B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Description

本発明は、把持装置及びロボットに関する。   The present invention relates to a gripping device and a robot.

産業用ロボットは、重量物又は危険物を扱う作業や、高精度の位置決めが必要な作業を中心に導入されてきた。一方、弾力性を有する部品や破損しやすい部品を扱う組み立て作業はロボットによる自動化が難しいことが多く、人間の手に頼っていることが多い。   Industrial robots have been introduced mainly for operations that handle heavy or dangerous objects and operations that require high-precision positioning. On the other hand, assembly operations that handle elastic parts or parts that are easily damaged are often difficult to automate by robots and often rely on human hands.

近年、主にコスト削減のために、弾力性を有する部品や破損しやすい部品を扱う組み立て作業など、ロボットが苦手とする分野までロボットを導入することが検討されている。そのような作業には、複雑な動きができる多関節ロボットが適しているといわれている。しかし、単に多関節ロボットを使えば人間と同じように作業が行えるわけではない。   In recent years, mainly for cost reduction, introduction of robots to fields where robots are not good, such as assembly work for handling elastic parts and parts that are easily damaged, has been studied. For such work, it is said that an articulated robot capable of complicated movement is suitable. However, simply using an articulated robot does not mean that work can be performed in the same way as a human being.

人間の場合は部品同士の接触具合を指先で感じながら作業を行っており、同じことがロボットにも求められる。そこで、ロボットによって部品同士の接触具合を検出するために、例えば多軸力覚センサを搭載することが提案されている。   In the case of humans, work is performed while feeling the contact between parts with the fingertips, and the same is required for robots. Therefore, in order to detect the contact state between components by a robot, for example, it has been proposed to mount a multi-axis force sensor.

特開2006−64408号公報JP 2006-64408 A

比較的簡単な構成で把持した部品と他の部品との接触具合を検出できる把持装置、及びその把持装置を備えたロボットを提供することを目的とする。   It is an object of the present invention to provide a gripping device that can detect the degree of contact between a gripped component and another component with a relatively simple configuration, and a robot including the gripping device.

開示の技術の一観点によれば、接触部と、屈曲部を介して前記接触部に連絡する連絡部とを有する屈曲した形状の2本の指部をそれぞれ備えた一対のハンド部材と、前記一対のハンド部材を相互に近接又は離隔する方向に移動させて第1の部品を前記接触部の間に挟んで把持するハンド部材駆動部と、前記連絡部及び前記接触部にそれぞれ配置された複数の歪みセンサを含んで構成された回路と、前記回路の出力から前記第1の部品と第2の部品との接触具合を検出する制御部とを有し、前記制御部は、前記一対のハンド部材が前記第1の部品を把持した状態で前記回路のキャリブレーションを行い、その後前記第1の部品を第2の部品に接触させ、前記回路の出力から前記第1の部品と前記第2の部品との接触具合を検出する把持装置が提供される。 According to one aspect of the disclosed technique, a pair of hand members each including two bent fingers having a contact portion and a communication portion that communicates with the contact portion via a bent portion; A hand member driving unit that moves the pair of hand members in a direction approaching or separating from each other and grips the first component between the contact units, and a plurality of hand member driving units disposed on the communication unit and the contact unit, respectively. a circuit which is configured to include a strain sensor, and a control unit for detecting the state of contact between the first part and the second part from the output of the circuit, the controller, the pair of hands The circuit is calibrated with a member holding the first component, and then the first component is brought into contact with the second component, and the first component and the second component are output from the output of the circuit. gripping device Hisage for detecting a state of contact with the part It is.

開示の技術の他の一観点によれば、アームと、前記アームに連結されて第1の部品を把持する把持部と、前記アームを制御して前記把持部を移動させる制御部と有し、前記把持部は、接触部と、屈曲部を介して前記接触部に連絡する連絡部とを有する屈曲した形状の2本の指部をそれぞれ備えた一対のハンド部材と、前記一対のハンド部材を相互に近接又は離隔する方向に移動させて第1の部品を前記接触部の間に挟んで把持するハンド部材駆動部と、前記連絡部及び前記接触部にそれぞれ配置された複数の歪みセンサを含んで構成される回路とを備え、前記制御部は、前記一対のハンド部材が前記第1の部品を把持した状態で前記回路のキャリブレーションを行い、その後前記第1の部品を第2の部品に接触させ、前記回路の出力から前記第1の部品と前記第2の部品との接触具合を検出するロボットが提供される。 According to another aspect of the disclosed technology, an arm, a gripping unit connected to the arm and gripping the first component, and a control unit that controls the arm and moves the gripping unit, The gripping part includes a pair of hand members each having two bent finger parts each having a contact part and a communication part that communicates with the contact part via a bending part, and the pair of hand members. includes a hand member driving unit for gripping the first component is moved in a direction coming close to or apart from each other in between the contact portions, a plurality of strain sensors disposed respectively on the contact portion and the contact portion The control unit calibrates the circuit with the pair of hand members gripping the first component, and then converts the first component into a second component. contact is, from said output of said circuit Robot to detect 1 part and the state of contact with the second component is provided.

上記一観点に係る把持装置及びロボットによれば、第1の部品と第2の部品との接触具合を歪みセンサにより検出する。それらの歪みセンサは、指部の内側及び外側の面に配置されているので、高速で移動させても大きな慣性力が加わることはなく、破損するおそれが少ない。また、簡単な構成で第1の部品と第2の部品との接触具合を検出することができる。   According to the gripping device and the robot according to the above aspect, the contact state between the first component and the second component is detected by the strain sensor. Since these strain sensors are arranged on the inner and outer surfaces of the finger part, a large inertia force is not applied even when the finger is moved at a high speed, and there is little risk of breakage. Moreover, the contact condition between the first component and the second component can be detected with a simple configuration.

図1は、多軸力覚センサを備えた多関節ロボットの一例を表した図である。FIG. 1 is a diagram illustrating an example of an articulated robot including a multi-axis force sensor. 図2は、ロボットにより行う作業の一例を説明する図である。FIG. 2 is a diagram illustrating an example of work performed by the robot. 図3は、第1の実施形態に係るロボットの一例を表した図である。FIG. 3 is a diagram illustrating an example of the robot according to the first embodiment. 図4は、第1の実施形態に係るロボットのハンド部材を示す斜視図である。FIG. 4 is a perspective view showing a hand member of the robot according to the first embodiment. 図5は、同じくそのハンド部材の正面図である。FIG. 5 is a front view of the hand member. 図6は、歪みセンサの接続状態を説明する図(その1)である。FIG. 6 is a diagram (part 1) illustrating a connection state of the strain sensor. 図7は、歪みセンサの接続状態を説明する図(その2)である。FIG. 7 is a diagram (part 2) for explaining the connection state of the strain sensor. 図8(a),(b)は、部品を挟持したハンド部材を示す図である。FIGS. 8A and 8B are views showing a hand member that holds a component. 図9(a),(b)は、第1の部品を第2の部品の凹部に挿入するときの状態を説明する図である。FIGS. 9A and 9B are views for explaining a state when the first component is inserted into the recess of the second component. 図10は、第1の実施形態に係るロボットの動作を説明するフローチャートである。FIG. 10 is a flowchart for explaining the operation of the robot according to the first embodiment. 図11は、X軸方向、Y軸方向、Z軸方向を規定する図である。FIG. 11 is a diagram defining the X-axis direction, the Y-axis direction, and the Z-axis direction. 図12(a),(b)は、角度θzの補正方法を説明する図である。12A and 12B are diagrams illustrating a method for correcting the angle θz. 図13は、角度θyの補正方法を説明する図(その1)である。FIG. 13 is a diagram (part 1) for explaining a method of correcting the angle θy. 図14は、角度θyの補正方法を説明する図(その2)である。FIG. 14 is a diagram (part 2) for explaining a method of correcting the angle θy. 図15は、第1の部品を把持した状態で第1の部品に上向きの応力が加えられた状態を示す図である。FIG. 15 is a diagram illustrating a state in which upward stress is applied to the first component while the first component is held. 図16は、X軸方向の補正方法を説明する図である。FIG. 16 is a diagram for explaining a correction method in the X-axis direction. 図17は、第2の実施形態に係るロボット(把持装置)の指部を示す模式図である。FIG. 17 is a schematic diagram illustrating a finger portion of the robot (gripping device) according to the second embodiment.

以下、実施形態について説明する前に、実施形態の理解を容易にするための予備的事項について説明する。   Hereinafter, before describing the embodiment, a preliminary matter for facilitating understanding of the embodiment will be described.

図1は、多軸力覚センサを備えた多関節ロボットの一例を表した図である。   FIG. 1 is a diagram illustrating an example of an articulated robot including a multi-axis force sensor.

この図1に例示した多関節ロボット10は、台座部11と、旋回支持部12と、第1のリンク部13と、第2のリンク部14と、第3のリンク部15と、多軸力覚センサ16と、把持部(ハンド)17と、制御部19とを有する。   The articulated robot 10 illustrated in FIG. 1 includes a pedestal part 11, a turning support part 12, a first link part 13, a second link part 14, a third link part 15, and a multiaxial force. It has a sense sensor 16, a gripping part (hand) 17, and a control part 19.

台座部11は、作業場の床等に固定されている。旋回支持部12は、台座部11の上に、垂直方向の軸を中心に旋回可能に配置されている。   The pedestal 11 is fixed to the floor of the work place. The turning support portion 12 is disposed on the pedestal portion 11 so as to be turnable about a vertical axis.

第1のリンク部13の一端側は旋回支持部12の上部に連結しており、ギヤドモータ又はエアシリンダー等の駆動装置(図示せず)により旋回支持部12との連結部を中心に回転する。また、第2のリンク部14の一端側は第1のリンク部13の他端側に連結しており、駆動装置(図示せず)により第1のリンク部13との連結部を中心に回転する。更に、第3のリンク部15の一端側は第2のリンク部14の他端側に連結しており、駆動装置(図示せず)により第2のリンク部14との連結部を中心に回転する。   One end side of the first link portion 13 is connected to the upper portion of the turning support portion 12 and is rotated around a connecting portion with the turning support portion 12 by a drive device (not shown) such as a geared motor or an air cylinder. In addition, one end side of the second link portion 14 is connected to the other end side of the first link portion 13 and is rotated around the connecting portion with the first link portion 13 by a driving device (not shown). To do. Further, one end side of the third link portion 15 is connected to the other end side of the second link portion 14 and is rotated around the connecting portion with the second link portion 14 by a driving device (not shown). To do.

把持部17は、多軸力覚センサ16を介して第3のリンク部15の他端側に連結している。この把持部17は、駆動装置(図示せず)により第3のリンク部15の中心軸に平行な軸を中心として回転する。また、把持部17は2本の指部17aを有し、駆動装置(図示せず)により駆動されてそれらの指部17a間の間隔が変化し、指部17a間に部品を把持したり、把持していた部品を離したりする。   The gripping part 17 is connected to the other end side of the third link part 15 via the multi-axis force sensor 16. The gripping portion 17 is rotated around an axis parallel to the central axis of the third link portion 15 by a driving device (not shown). In addition, the gripping part 17 has two finger parts 17a, and is driven by a driving device (not shown) to change the interval between the finger parts 17a to grip a component between the finger parts 17a, Release the gripped parts.

多軸力覚センサ16は、例えば複数の歪みゲージを有し、把持部17に印加される3軸(相互に直交するX軸、Y軸及びZ軸)方向の応力を検出して制御部19に出力する。制御部19は、予め設定されたプログラムと多軸力覚センサ16の出力とに基づいて、各駆動装置を制御する。   The multi-axis force sensor 16 has, for example, a plurality of strain gauges, detects a stress in three axes (X-axis, Y-axis, and Z-axis orthogonal to each other) applied to the gripping unit 17 and controls the control unit 19. Output to. The control unit 19 controls each drive device based on a preset program and the output of the multi-axis force sensor 16.

このような多関節ロボットを用いて細長い部品、例えば図2のように幅が数mm程度、厚さが2mm〜5mm程度、長さが15mm〜30mm程度のゴム製の第1の部品61をプラスチック等により形成された第2の部品62の凹部62aにはめ込む作業を行うものとする。この場合、第1の部品61と第2の部品62との接触具合を検出して把持部17の位置及び角度を補正することが重要であり、多軸力覚センサ16には高い感度が要求される。通常、多軸力覚センサ16の感度は歪みゲージを貼付する金属部品の厚さに関係し、金属部品の厚さを薄くすれば感度は高くなる。   Using such an articulated robot, an elongated part, for example, a first rubber part 61 having a width of about several mm, a thickness of about 2 mm to 5 mm, and a length of about 15 mm to 30 mm as shown in FIG. It is assumed that the operation of fitting into the recess 62a of the second component 62 formed by the above or the like is performed. In this case, it is important to correct the position and angle of the gripping portion 17 by detecting the contact state between the first component 61 and the second component 62, and the multi-axis force sensor 16 requires high sensitivity. Is done. Usually, the sensitivity of the multi-axis force sensor 16 is related to the thickness of the metal part to which the strain gauge is attached, and the sensitivity increases as the thickness of the metal part is reduced.

一方、多関節ロボット10では、作業効率を上げようとして旋回支持部12及びリンク部13,14,15を高速で動かすと、把持部17の質量に応じた大きな慣性力が多軸力覚センサ16に加わる。このため、多軸力覚センサ16(特に、歪みゲージを貼付した金属部品)が破損するおそれがある。また、作業中にリンク部13,14,15又は把持部17が何らかの障害物に衝突して多軸力覚センサ16に大きな力が加わり、多軸力覚センサ16が破損するおそれもある。   On the other hand, in the multi-joint robot 10, when the turning support unit 12 and the link units 13, 14, 15 are moved at a high speed in order to increase the work efficiency, a large inertia force according to the mass of the gripping unit 17 is generated. To join. For this reason, there exists a possibility that the multi-axis force sensor 16 (especially metal component which stuck the strain gauge) may be damaged. Further, during the work, the link parts 13, 14, 15 or the gripping part 17 may collide with some obstacles and a large force is applied to the multi-axis force sensor 16, and the multi-axis force sensor 16 may be damaged.

このため、多軸力覚センサ16には、強度が高いことが要求される。しかし、一般的に、強度が高い多軸力覚センサ16は感度が低く、前述したような組み立て作業において部品同士の接触具合を検出することは困難である。   For this reason, the multi-axis force sensor 16 is required to have high strength. However, in general, the multi-axis force sensor 16 having high strength has low sensitivity, and it is difficult to detect the contact state between components in the assembly operation as described above.

以下の実施形態では、比較的簡単な構成で把持した部品と他の部品との接触具合を検出できる把持装置、及びその把持装置を備えたロボットについて説明する。   In the following embodiments, a gripping device that can detect a contact state between a component gripped with a relatively simple configuration and another component, and a robot including the gripping device will be described.

(第1の実施形態)
図3は、第1の実施形態に係るロボットの一例を表した図である。この図3のように、本実施形態に係るロボット20は、台座部21と、旋回支持部22と、第1のリンク部23と、第2のリンク部24と、第3のリンク部25と、把持部26と、制御部29とを有する。なお、把持装置は、把持部26と制御部29とにより構成される。
(First embodiment)
FIG. 3 is a diagram illustrating an example of the robot according to the first embodiment. As shown in FIG. 3, the robot 20 according to this embodiment includes a pedestal portion 21, a turning support portion 22, a first link portion 23, a second link portion 24, and a third link portion 25. And a gripping portion 26 and a control portion 29. The gripping device includes a gripping unit 26 and a control unit 29.

台座部11は、作業場の床等に固定されている。旋回支持部22は、台座部21の上に、垂直方向の軸を中心に旋回可能に配置されている。   The pedestal 11 is fixed to the floor of the work place. The turning support portion 22 is disposed on the pedestal portion 21 so as to be turnable about a vertical axis.

第1のリンク部23の一端側は旋回支持部22の上部に連結しており、ギアドモータ又はエアシリンダー等の駆動装置(図示せず)により旋回支持部22との連結部を中心に回転する。また、第2のリンク部24の一端側は第1のリンク部23の他端側に連結しており、駆動装置(図示せず)により第1のリンク部23との連結部を中心に回転する。更に、第3のリンク部25の一端側は第2のリンク部24の他端側に接続されており、駆動装置(図示せず)により第2のリンク部24との連結部を中心に回転する。第1のリンク部23、第2のリンク部24及び第3のリンク部25は、把持装置26を任意の位置に移動させるためのアームである。   One end side of the first link portion 23 is connected to the upper portion of the turning support portion 22 and is rotated around a connecting portion with the turning support portion 22 by a drive device (not shown) such as a geared motor or an air cylinder. In addition, one end side of the second link portion 24 is connected to the other end side of the first link portion 23 and is rotated around the connecting portion with the first link portion 23 by a driving device (not shown). To do. Further, one end side of the third link portion 25 is connected to the other end side of the second link portion 24, and is rotated around a connecting portion with the second link portion 24 by a driving device (not shown). To do. The 1st link part 23, the 2nd link part 24, and the 3rd link part 25 are the arms for moving the holding | gripping apparatus 26 to arbitrary positions.

把持部26は、第3のリンク部25の他端側に連結している。この把持部26は、駆動装置(図示せず)により第3のリンク部25の中心軸に平行な軸を中心として回転する。   The grip portion 26 is connected to the other end side of the third link portion 25. The gripping portion 26 is rotated around an axis parallel to the central axis of the third link portion 25 by a driving device (not shown).

また、把持部26には、一対のハンド部材31と、それらのハンド部材31を相互に近接又は離隔する方向に移動させるハンド部材駆動部27と、後述する歪みセンサ37に接続された歪みゲージアンプ28とが設けられている。   In addition, the grip portion 26 includes a pair of hand members 31, a hand member driving portion 27 that moves the hand members 31 toward or away from each other, and a strain gauge amplifier connected to a strain sensor 37 described later. 28 are provided.

図4はハンド部材31を示す斜視図であり、図5は同じくその正面図である。   4 is a perspective view showing the hand member 31, and FIG. 5 is a front view thereof.

図4のように、把持部26には一対のハンド部材31が設けられており、各ハンド部材31は2本のボルト39によりハンド部材駆動部27(図3参照)に連結されている。また、各ハンド部材31は、ボルト39が挿通する穴が設けられた固定部32と、固定部32から導出する2本の指部33とを有する。ハンド部材駆動部27により一対のハンド部材31が相互に近接又は離隔する方向に移動することで、指部33の先端で部品を把持したり、把持していた部品を離したりする。   As shown in FIG. 4, the grip portion 26 is provided with a pair of hand members 31, and each hand member 31 is connected to the hand member driving portion 27 (see FIG. 3) by two bolts 39. Each hand member 31 has a fixing portion 32 provided with a hole through which the bolt 39 is inserted, and two finger portions 33 led out from the fixing portion 32. The hand member driving unit 27 moves the pair of hand members 31 in the direction of approaching or separating from each other, thereby gripping a component at the tip of the finger 33 or releasing the gripped component.

指部33は、図5のように、把持すべき部品に接触する接触部34と、接触部34と固定部32との間を連絡する連絡部35とを有する。本実施形態では、固定部32と連絡部35とのなす角度がほぼ90度であり、連絡部35と接触部34とのなす角度は90度よりも若干大きく設定されている。   As shown in FIG. 5, the finger part 33 includes a contact part 34 that contacts a component to be gripped, and a communication part 35 that communicates between the contact part 34 and the fixing part 32. In the present embodiment, the angle formed by the fixed portion 32 and the connecting portion 35 is approximately 90 degrees, and the angle formed by the connecting portion 35 and the contact portion 34 is set slightly larger than 90 degrees.

なお、ハンド部材31は例えば厚さが1.5mmのステンレス板により形成されており、指部33の幅は例えば5.5mm、固定部32の長さは例えば8mm、接触部34の長さは例えば11mm、連絡部35の長さは例えば8mmである。また、本実施形態では、図4のように各ハンド部材31の2本の指部33(接触部34)が補強部36により連結されており、これにより部品を把持したときの指部33のねじれを防止している。しかし、補強部36は必要に応じて設ければよく、補強部36がなくてもよい。   The hand member 31 is formed of, for example, a stainless steel plate having a thickness of 1.5 mm, the width of the finger portion 33 is, for example, 5.5 mm, the length of the fixing portion 32 is, for example, 8 mm, and the length of the contact portion 34 is For example, the length of the connecting portion 35 is 11 mm, for example, 11 mm. Further, in this embodiment, as shown in FIG. 4, the two finger portions 33 (contact portions 34) of each hand member 31 are connected by the reinforcing portion 36, whereby the finger portion 33 when the component is gripped. Prevents twisting. However, the reinforcing portion 36 may be provided as necessary, and the reinforcing portion 36 may not be provided.

連絡部35の内側及び外側の面にはそれぞれ連絡部35の歪みを検出する歪みセンサ37が配置されている。これと同様に、接触部34の外側の面にはそれぞれ接触部34の歪みを検出する歪みセンサ37が配置されている。これらの歪みセンサ37は、歪みゲージアンプ28を介して制御部29に接続されている。本実施形態では、歪みセンサ37として、歪みにより抵抗値が変化する歪みゲージを使用している。   Distortion sensors 37 that detect the distortion of the connecting portion 35 are disposed on the inner and outer surfaces of the connecting portion 35, respectively. Similarly, a strain sensor 37 that detects the strain of the contact portion 34 is disposed on the outer surface of the contact portion 34. These strain sensors 37 are connected to the control unit 29 via the strain gauge amplifier 28. In the present embodiment, a strain gauge whose resistance value changes due to strain is used as the strain sensor 37.

図6,図7は、各歪みセンサ37の接続状態を説明する図である。ここでは、説明の便宜上、図6における紙面手前側の接触部34及び連絡部35を第1の接触部34a及び第1の連絡部35aと呼び、紙面奥側の接触部34及び連絡部35を第2の接触部34b及び第2の連絡部35bと呼ぶ。   6 and 7 are diagrams illustrating the connection state of each strain sensor 37. FIG. Here, for convenience of explanation, the contact portion 34 and the contact portion 35 on the front side in FIG. 6 are referred to as a first contact portion 34a and a first contact portion 35a, and the contact portion 34 and the contact portion 35 on the back side of the paper surface are referred to. These are called the second contact portion 34b and the second contact portion 35b.

図6のように、各ハンド部材31の第1の連絡部35a及び第2の連絡部35bの外側にそれぞれ配置された4個の歪みセンサ37により、ホイートストンブリッジ回路41aが形成されている。このホイートストンブリッジ回路41aは、第3のホイートストンブリッジ回路の一例である。   As shown in FIG. 6, the Wheatstone bridge circuit 41 a is formed by the four strain sensors 37 that are respectively arranged outside the first connecting portion 35 a and the second connecting portion 35 b of each hand member 31. The Wheatstone bridge circuit 41a is an example of a third Wheatstone bridge circuit.

ここでは、一方のハンド部材(図6中の左側のハンド部材31)の第1の連絡部35a及び第2の連絡部35bの外側に配置された歪みセンサ37の抵抗値をR1,R2とする。また、他方のハンド部材(図6中の右側のハンド部材31)の第1の連絡部35a及び第2の連絡部35bの外側に配置された歪みセンサ37の抵抗値をR3,R4とする。   Here, the resistance values of the strain sensors 37 arranged outside the first connecting portion 35a and the second connecting portion 35b of one hand member (the left hand member 31 in FIG. 6) are R1 and R2. . Further, the resistance values of the strain sensors 37 arranged outside the first connecting portion 35a and the second connecting portion 35b of the other hand member (the right hand member 31 in FIG. 6) are R3 and R4.

また、図7(a)のように、各ハンド部材31の第1の接触部34aの外側に配置された2個の歪みセンサ37と、第1の連絡部35aの内側に配置された2個の歪みセンサ37とにより、ホイートストンブリッジ回路41bが形成されている。このホイートストンブリッジ回路41bは、第1のホイートストンブリッジ回路の一例である。   Further, as shown in FIG. 7A, two strain sensors 37 disposed outside the first contact portion 34a of each hand member 31 and two disposed inside the first connecting portion 35a. The Wheatstone bridge circuit 41b is formed by the strain sensor 37. The Wheatstone bridge circuit 41b is an example of a first Wheatstone bridge circuit.

ここでは、一方のハンド部材(図7(a)中の左側のハンド部材31)の第1の接触部34aの外側及び第1の連絡部35aの内側に配置された歪みセンサ37の抵抗値をR1,R2とする。また、他方のハンド部材(図7(a)中の右側のハンド部材31)の第1の接触部34aの外側及び第1の連絡部35aの内側に配置された歪みセンサ37の抵抗値をR3,R4とする。   Here, the resistance value of the strain sensor 37 arranged on the outside of the first contact portion 34a and the inside of the first connecting portion 35a of one hand member (the left hand member 31 in FIG. 7A) is set. Let R1, R2. Further, the resistance value of the strain sensor 37 disposed on the outside of the first contact portion 34a and the inside of the first connecting portion 35a of the other hand member (the right hand member 31 in FIG. 7A) is set to R3. , R4.

更に、図7(b)のように、各ハンド部材31の第2の接触部34bの外側に配置された2個の歪みセンサ37と、第2の連絡部35bの内側に配置された2個の歪みセンサ37とにより、ホイートストンブリッジ回路41cが形成されている。このホイートストンブリッジ回路41cは、第2のホイートストンブリッジ回路の一例である。   Further, as shown in FIG. 7B, two strain sensors 37 disposed outside the second contact portion 34b of each hand member 31, and two disposed inside the second connecting portion 35b. The Wheatstone bridge circuit 41 c is formed by the strain sensor 37. The Wheatstone bridge circuit 41c is an example of a second Wheatstone bridge circuit.

ここでは、一方のハンド部材(図7(a)中の左側のハンド部材31)の第2の接触部34bの外側及び第2の連絡部35bの内側に配置された歪みセンサ37の抵抗値をR1,R2とする。また、他方のハンド部材(図7(a)中の右側のハンド部材31)の第2の接触部34bの外側及び第2の連絡部35bの内側に配置された歪みセンサ37の抵抗値をR3,R4とする。   Here, the resistance value of the strain sensor 37 disposed on the outside of the second contact portion 34b and the inside of the second connecting portion 35b of one hand member (the left hand member 31 in FIG. 7A) is set. Let R1, R2. Further, the resistance value of the strain sensor 37 disposed on the outside of the second contact portion 34b and the inside of the second connecting portion 35b of the other hand member (the right hand member 31 in FIG. 7A) is set to R3. , R4.

各ホイートストンブリッジ回路41a,41b,41cの電源端子A,B間には歪みゲージアンプ28から所定の電圧が印加され、出力端子C,Dから出力される信号は歪みゲージアンプ28で増幅された後、制御部29に入力される。   A predetermined voltage is applied from the strain gauge amplifier 28 between the power supply terminals A and B of each Wheatstone bridge circuit 41a, 41b and 41c, and the signals output from the output terminals C and D are amplified by the strain gauge amplifier 28. Are input to the control unit 29.

ホイートストンブリッジ回路41a,41b,41cにおいて、端子Aと端子Bとの間の印加される電圧をVEXとし、端子Cと端子Dとの間に出力される電圧をVoutとすると、電圧Voutは下記(1)式により求めることができる。 In the Wheatstone bridge circuit 41a, 41b, 41c, when the voltage applied between the terminal A and the terminal B is V EX and the voltage output between the terminal C and the terminal D is Vout, the voltage Vout is (1) It can obtain | require by Formula.

Figure 0005929105
Figure 0005929105

ここで、各歪みセンサ37の抵抗値R1,R2,R3,R4が同一であるとすると、各ホイートストンブリッジ回路41a,41b,41cの出力電圧Vouta,Voutb,Voutcはいずれも0Vになる。   Here, assuming that the resistance values R1, R2, R3, and R4 of the strain sensors 37 are the same, the output voltages Vouta, Voutb, and Voutc of the Wheatstone bridge circuits 41a, 41b, and 41c are all 0V.

図8(a)のように第1の部品61を挟持して、一方のハンド部材31と他方のハンド部材31とに同じように歪みが発生したものとする。この場合、図8(b)のように、接触部34a,34bの外側の歪みセンサ37には圧縮応力が加わって抵抗値R1,R3が減少し、連絡部35a,35bの内側の歪みセンサ37には引張応力が加わって抵抗値R2,R4が増加する。手前側の接触部34a及び連絡部35aに加わる応力と奥側の接触部34b及び連絡部35bに加わる応力とは同じであるので、ホイートストンブリッジ回路41bの出力電圧Voutbとホイートストンブリッジ回路41cの出力電圧Voutcとは同じになる。   As shown in FIG. 8A, it is assumed that the first component 61 is sandwiched and distortion occurs in the same manner in one hand member 31 and the other hand member 31. In this case, as shown in FIG. 8B, compressive stress is applied to the strain sensor 37 outside the contact portions 34a and 34b to reduce the resistance values R1 and R3, and the strain sensor 37 inside the connecting portions 35a and 35b. A tensile stress is applied to the resistance values R2 and R4. Since the stress applied to the contact portion 34a and the connecting portion 35a on the near side is the same as the stress applied to the contact portion 34b and the connecting portion 35b on the far side, the output voltage Voutb of the Wheatstone bridge circuit 41b and the output voltage of the Wheatstone bridge circuit 41c. It becomes the same as Voutc.

図9(a)のように、第1の部品61を第2の部品62の凹部62aに挿入するときに第1の部品61の右側の部分が凹部62aの壁面を擦ると、第1の部品61には図9(a)中に矢印で示す方向に応力が加わる。その結果、抵抗値R1,R4が減少し、抵抗値R2,R3が増加して、ホイートストンブリッジ回路41b,41cの出力は増大(プラス側に変化)する。第1の部品61が凹部62aに対し右側にずれているほど、ホイートストンブリッジ回路41b,41cの出力は大きくなる。   As shown in FIG. 9A, when the first part 61 is inserted into the concave part 62a of the second part 62 and the right part of the first part 61 rubs against the wall surface of the concave part 62a, the first part Stress is applied to 61 in the direction indicated by the arrow in FIG. As a result, the resistance values R1 and R4 decrease, the resistance values R2 and R3 increase, and the outputs of the Wheatstone bridge circuits 41b and 41c increase (change to the plus side). As the first component 61 is shifted to the right side with respect to the recess 62a, the outputs of the Wheatstone bridge circuits 41b and 41c increase.

逆に、図9(b)のように、第1の部品61を第2の部品62の凹部62aに挿入するときに第1の部品61の左側の部分が凹部62aの壁面を擦ると、第1の部品61には図9(b)中に矢印で示す方向に応力が加わる。その結果、抵抗値R1,R4が増加し、抵抗値R2,R3が減少して、ホイートストンブリッジ回路41b,41cの出力は減少(マイナス側に変化)する。第1の部品61が凹部62aに対し左側にずれるほど、ホイートストンブリッジ回路41b,41cの出力は小さくなる。   Conversely, as shown in FIG. 9B, when the left part of the first component 61 rubs against the wall surface of the recess 62a when the first component 61 is inserted into the recess 62a of the second component 62, Stress is applied to the first component 61 in the direction indicated by the arrow in FIG. As a result, the resistance values R1, R4 increase, the resistance values R2, R3 decrease, and the outputs of the Wheatstone bridge circuits 41b, 41c decrease (change to the minus side). The output of the Wheatstone bridge circuits 41b and 41c decreases as the first component 61 shifts to the left with respect to the recess 62a.

図10は、上述の実施形態に係るロボット20の動作を説明するフローチャートである。ここでは、図2のように幅が数mm程度、厚さが2mm〜5mm程度、長さが15mm〜30mm程度のゴム製の第1の部品61をプラスチック等により形成された第2の部品62の凹部62aにはめ込む作業を行うものとする。   FIG. 10 is a flowchart for explaining the operation of the robot 20 according to the above-described embodiment. Here, as shown in FIG. 2, the first part 61 made of rubber having a width of about several mm, a thickness of about 2 mm to 5 mm, and a length of about 15 mm to 30 mm is made of plastic or the like. It is assumed that an operation for fitting into the recess 62a is performed.

なお、本実施形態のロボット20が把持する部品の形状及び大きさは、この例に限定されるものではない。   Note that the shape and size of the parts gripped by the robot 20 of the present embodiment are not limited to this example.

また、説明の便宜上、図11のように部品61の長さ方向の軸をX軸、幅方向の軸をY軸、厚さ方向の軸をZ軸とする。また、Z軸を中心とした回転方向の角度をθz、Y軸を中心とした回転方向の角度をθyとする。   For convenience of explanation, as shown in FIG. 11, the length direction axis of the component 61 is the X axis, the width direction axis is the Y axis, and the thickness direction axis is the Z axis. In addition, an angle in the rotation direction around the Z axis is θz, and an angle in the rotation direction around the Y axis is θy.

まず、ステップS11において、制御部29は、旋回支持部22、リンク部23,24,25の駆動装置及び把持部26のハンド部材駆動部27を制御して、第1の部品61を一対のハンド部材31間に挟持する。   First, in step S11, the control unit 29 controls the driving device of the turning support unit 22, the link units 23, 24, and 25 and the hand member driving unit 27 of the gripping unit 26, and moves the first component 61 to a pair of hands. It is sandwiched between the members 31.

次に、ステップS12において、制御部29は、把持部26の歪みゲージアンプ28に、ホイートストンブリッジ回路41a,41b,41cのキャリブレーション(平衡調整)を指示する。これにより、歪みゲージアンプ28は、ハンド部材31により第1の部品61を挟持した状態でホイートストンブリッジ回路41a,41b,41cの出力が0Vとなるように、キャリブレーションを開始する。   Next, in step S12, the control unit 29 instructs the strain gauge amplifier 28 of the gripping unit 26 to perform calibration (balance adjustment) of the Wheatstone bridge circuits 41a, 41b, and 41c. As a result, the strain gauge amplifier 28 starts calibration so that the outputs of the Wheatstone bridge circuits 41a, 41b, and 41c become 0V while the first component 61 is held by the hand member 31.

一般的に、ホイートストンブリッジ回路のキャリブレーション方法には、可変抵抗器を用いてホイートストンブリッジ回路の出力を物理的に0に調整する方法と、ソフトウェアにより調整する方法とがある。本実施形態では、どちらの方法を採用してもよい。   Generally, the Wheatstone bridge circuit calibration method includes a method of adjusting the output of the Wheatstone bridge circuit physically to 0 using a variable resistor and a method of adjusting by software. In this embodiment, either method may be adopted.

次に、ステップS13に移行し、制御部29は、旋回支持部22及びリンク部23,24,25の駆動装置を制御して、第1の部品61を第2の部品62の凹部62aの近傍まで移動させる。ホイートストンブリッジ回路41a,41b,41cのキャリブレーションが完了するまでの間には数秒間の時間が必要であるが、本実施形態ではこの間を利用して第1の部品61を第2の部品62の凹部62aの近傍まで移動させておく。   Next, the process proceeds to step S <b> 13, and the control unit 29 controls the drive device of the turning support unit 22 and the link units 23, 24, 25 to move the first component 61 in the vicinity of the recess 62 a of the second component 62. To move. It takes several seconds until calibration of the Wheatstone bridge circuits 41a, 41b, and 41c is completed. In this embodiment, the first component 61 is replaced with the second component 62 by using this interval. It is moved to the vicinity of the recess 62a.

その後、制御部29は、ステップS14でホイートストンブリッジ回路41a,41b,41cのキャリブレーションが完了するのを待つ。そして、ホイートストンブリッジ回路41a,41b,41cのキャリブレーションが完了すると、ステップS15に移行する。   Thereafter, the controller 29 waits for the calibration of the Wheatstone bridge circuits 41a, 41b, 41c to be completed in step S14. When calibration of the Wheatstone bridge circuits 41a, 41b, 41c is completed, the process proceeds to step S15.

ステップS15において、制御部29は、旋回支持部22、リンク部23,24,25の駆動装置及び把持部26を制御して、第1の部品61を第2の部品62の凹部62aに挿入する。このとき、制御部29は、以下に説明するように、角度θz、角度θy、Y軸方向の位置及びX軸方向の位置の補正を行う。   In step S <b> 15, the control unit 29 controls the drive device of the turning support unit 22, the link units 23, 24, and 25 and the grip unit 26 to insert the first component 61 into the recess 62 a of the second component 62. . At this time, the control unit 29 corrects the angle θz, the angle θy, the position in the Y-axis direction, and the position in the X-axis direction as described below.

(角度θzの補正)
図12(a)の平面図に示すように、第2の部品62の凹部62aに対し第1の部品61の角度θzが反時計方向にずれているとする。この状態で第1の部品61を第2の部品62の凹部62aに挿入すると、手前側(図12(a)では下側)では第1の部品61の右側が凹部62aの壁面を擦り、奥側(図12(a)では上側)では第1の部品61の左側が凹部62aの壁面を擦る。
(Correction of angle θz)
As shown in the plan view of FIG. 12A, it is assumed that the angle θz of the first component 61 is deviated counterclockwise with respect to the recess 62a of the second component 62. When the first component 61 is inserted into the recess 62a of the second component 62 in this state, the right side of the first component 61 rubs against the wall surface of the recess 62a on the near side (lower side in FIG. 12A). On the side (upper side in FIG. 12A), the left side of the first component 61 rubs against the wall surface of the recess 62a.

この場合、第1の部品61には、図12(a)中に矢印で示すように手前側と奥側とで反対方向に応力が加わる。このため、ホイートストンブリッジ回路41bの出力電圧Voutbは増大(プラス側に変化)し、ホイートストンブリッジ回路41cの出力電圧Voutcは減少(マイナス側に変化)する。従って、ホイートストンブリッジ回路41bの出力電圧Voutbとホイートストンブリッジ回路41cの出力電圧Voutcとの差(Voutb−Voutc)はプラスの値(>0)となり、制御部29は第1の部品61が凹部62aに対し反時計方向にずれていることがわかる。   In this case, stress is applied to the first component 61 in the opposite direction on the near side and the far side as indicated by arrows in FIG. For this reason, the output voltage Voutb of the Wheatstone bridge circuit 41b increases (changes to the plus side), and the output voltage Voutc of the Wheatstone bridge circuit 41c decreases (changes to the minus side). Therefore, the difference (Voutb−Voutc) between the output voltage Voutb of the Wheatstone bridge circuit 41b and the output voltage Voutc of the Wheatstone bridge circuit 41c becomes a positive value (> 0), and the control unit 29 causes the first component 61 to be in the recess 62a. On the other hand, it turns out that it has shifted | deviated counterclockwise.

一方、図12(b)の平面図に示すように、第2の部品62の凹部62aに対し第1の部品61の角度θzが時計方向にずれているとする。この状態で第1の部品61を凹部62aに挿入すると、手前側(図12(b)では下側)では第1の部品61の左側が凹部62aの壁面を擦り、奥側(図12(b)では上側)では第1の部品61の右側が凹部62aの壁面を擦る。   On the other hand, as shown in the plan view of FIG. 12B, it is assumed that the angle θz of the first component 61 is shifted in the clockwise direction with respect to the recess 62 a of the second component 62. When the first component 61 is inserted into the recess 62a in this state, the left side of the first component 61 rubs the wall surface of the recess 62a on the front side (lower side in FIG. 12B) and the back side (FIG. 12B). ), The right side of the first component 61 rubs against the wall surface of the recess 62a.

この場合、第1の部品61には図12(b)中に矢印で示す方向に応力が加わる。このため、ホイートストンブリッジ回路41bの出力電圧Voutbは減少(マイナス側に変化)し、ホイートストンブリッジ回路41cの出力電圧Voutcは増大(プラス側に変化)する。従って、ホイートストンブリッジ回路41bの出力電圧Voutbとホイートストンブリッジ回路41cの出力電圧Voutcとの差(Voutb−Voutc)はマイナスの値(<0)となり、制御部29は第1の部品61が凹部62aに対し時計方向にずれていることがわかる。   In this case, stress is applied to the first component 61 in the direction indicated by the arrow in FIG. For this reason, the output voltage Voutb of the Wheatstone bridge circuit 41b decreases (changes to the minus side), and the output voltage Voutc of the Wheatstone bridge circuit 41c increases (changes to the plus side). Accordingly, the difference (Voutb−Voutc) between the output voltage Voutb of the Wheatstone bridge circuit 41b and the output voltage Voutc of the Wheatstone bridge circuit 41c becomes a negative value (<0), and the control unit 29 causes the first component 61 to be in the recess 62a. It can be seen that it is shifted clockwise.

角度θzのずれ量が少ないほど、ホイートストンブリッジ回路41b,41cの出力の差は小さくなる。従って、制御部29では、ホイートストンブリッジ回路41bの出力電圧Voutbとホイートストンブリッジ回路41cの出力電圧Voutcとの差から第1の部品61の角度θzのずれ量を把握できる。制御部29は、リンク部23,24,25等を制御し、第1の部品61の角度θzを補正する。   The smaller the shift amount of the angle θz, the smaller the difference between the outputs of the Wheatstone bridge circuits 41b and 41c. Therefore, the control unit 29 can grasp the amount of deviation of the angle θz of the first component 61 from the difference between the output voltage Voutb of the Wheatstone bridge circuit 41b and the output voltage Voutc of the Wheatstone bridge circuit 41c. The control unit 29 controls the link units 23, 24, 25, etc., and corrects the angle θz of the first component 61.

(角度θyの補正)
図13のように、第2の部品62に対し第1の部品61の角度θyが時計方向又は反時計方向にずれているとする。ここでは、第1の部品61が、手前側(図13では右側)が低く、奥側(図13では左側)が高い状態で傾いているとする。
(Correction of angle θy)
As shown in FIG. 13, it is assumed that the angle θy of the first component 61 is shifted clockwise or counterclockwise with respect to the second component 62. Here, it is assumed that the first component 61 is inclined with the front side (right side in FIG. 13) low and the back side (left side in FIG. 13) high.

この状態で第1の部品61を第2の部品62の凹部62aに挿入すると、最初に第1の部品61の手前側の部分が第2の部品62に接触し、それによりホイートストンブリッジ回路41bの出力電圧Voutbが変化する。その後、第1の部品61の奥側の部分も第2の部品62に接触し、ホイートストンブリッジ回路41cの出力電圧Voutcが変化する。   When the first component 61 is inserted into the recess 62a of the second component 62 in this state, the portion on the near side of the first component 61 first comes into contact with the second component 62, whereby the Wheatstone bridge circuit 41b. The output voltage Voutb changes. Thereafter, the back part of the first component 61 also contacts the second component 62, and the output voltage Voutc of the Wheatstone bridge circuit 41c changes.

図14は、横軸に第1の部品61のZ軸方向の位置をとり、横軸にホイートストンブリッジ回路41b,41cの出力電圧Voutb,Voutcをとって、ホイートストンブリッジ回路41b,41cの出力の変化を示す図である。第2の部品62に対し第1の部品61の角度θyがずれている場合、図14に示すように、ホイートストンブリッジ回路41bの出力電圧Voutbが変化するタイミングとホイートストンブリッジ回路41cの出力電圧Voutcが変化するタイミングとの間にずれが生じる。   In FIG. 14, the horizontal axis indicates the position of the first component 61 in the Z-axis direction, the horizontal axis indicates the output voltages Voutb and Voutc of the Wheatstone bridge circuits 41b and 41c, and changes in the outputs of the Wheatstone bridge circuits 41b and 41c. FIG. When the angle θy of the first component 61 is shifted with respect to the second component 62, as shown in FIG. 14, the timing at which the output voltage Voutb of the Wheatstone bridge circuit 41b changes and the output voltage Voutc of the Wheatstone bridge circuit 41c are There is a deviation from the changing timing.

第1の部品61の挿入速度が一定であるとすると、ホイートストンブリッジ回路41bの出力電圧Voutbが変化するタイミングとホイートストンブリッジ回路41cの出力電圧Voutcが変化するタイミングとの時間差が大きいほど、角度θyが大きいということができる。すなわち、制御部29は、ホイートストンブリッジ回路41bの出力電圧Voutbが変化するタイミングとホイートストンブリッジ回路41cの出力電圧Voutcが変化するタイミングとの時間差から、第1の部品61の角度θyのずれ量を把握することができる。制御部29は、角度θyのずれ量に応じてリンク部23,24,25等を制御し、第1の部品61の角度θyを補正する。   Assuming that the insertion speed of the first component 61 is constant, the angle θy increases as the time difference between the timing at which the output voltage Voutb of the Wheatstone bridge circuit 41b changes and the timing at which the output voltage Voutc of the Wheatstone bridge circuit 41c changes increases. It can be said that it is big. That is, the control unit 29 grasps the shift amount of the angle θy of the first component 61 from the time difference between the timing when the output voltage Voutb of the Wheatstone bridge circuit 41b changes and the timing when the output voltage Voutc of the Wheatstone bridge circuit 41c changes. can do. The control unit 29 controls the link units 23, 24, 25, etc. according to the shift amount of the angle θy, and corrects the angle θy of the first component 61.

(Y軸方向の補正)
前述したように第1の部品61を把持した状態でキャリブレーションを行うと、ホイートストンブリッジ回路41a,41b,41cの出力電圧Vouta,Voutb,Voutcはいずれも0Vとなる。この状態で図9(a)のように第1の部品61を第2の部品62の凹部62aに挿入する際に第1の部品61の右側の部分が凹部62aの壁面を擦ると、ホイートストンブリッジ回路41b,41cの出力電圧Voutb,Voutcはいずれもプラスになる。凹部62aに対する第1の部品61のY軸方向のずれ量が大きいほど、ホイートストンブリッジ回路41b,41cの出力電圧Voutb,Voutcの値は大きくなる。
(Correction in the Y-axis direction)
When calibration is performed with the first component 61 held as described above, the output voltages Vouta, Voutb, and Voutc of the Wheatstone bridge circuits 41a, 41b, and 41c are all 0V. In this state, when the first part 61 is inserted into the recess 62a of the second part 62 as shown in FIG. 9A, the right part of the first part 61 rubs against the wall surface of the recess 62a. The output voltages Voutb and Voutc of the circuits 41b and 41c are both positive. The value of the output voltages Voutb and Voutc of the Wheatstone bridge circuits 41b and 41c increases as the amount of displacement of the first component 61 in the Y-axis direction with respect to the recess 62a increases.

逆に、図9(b)のように第1の部品61の左側の部分が凹部62aの壁面を擦ると、ホイートストンブリッジ回路41b,41cの出力電圧Voutb,Voutcはいずれもマイナスになる。凹部62aに対する第1の部品61のY軸方向のずれ量が大きいほど、ホイートストンブリッジ回路41b,41cの出力電圧Voutb,Voutcの値の絶対値は大きくなる。   Conversely, when the left part of the first component 61 rubs against the wall surface of the recess 62a as shown in FIG. 9B, the output voltages Voutb and Voutc of the Wheatstone bridge circuits 41b and 41c become negative. The absolute value of the output voltages Voutb and Voutc of the Wheatstone bridge circuits 41b and 41c increases as the amount of displacement in the Y-axis direction of the first component 61 with respect to the recess 62a increases.

制御部29は、ホイートストンブリッジ回路41b,41cの出力電圧Voutb,Voutcの平均値を演算することにより、第1の部品61のY軸方向のずれ量を知ることができる。制御部29は、このずれ量に応じてリンク部23,24,25等を制御し、第1の部品61のY軸方向のずれを補正する。   The control unit 29 can know the amount of displacement of the first component 61 in the Y-axis direction by calculating the average value of the output voltages Voutb and Voutc of the Wheatstone bridge circuits 41b and 41c. The control unit 29 controls the link units 23, 24, 25 and the like according to the amount of deviation, and corrects the deviation of the first component 61 in the Y-axis direction.

なお、図15のように第1の部品61を把持した状態で第1の部品61に上向きの応力が加えられても、ホイートストンブリッジ回路41b,41cの出力電圧Voutb,Voutcは変化しない。つまり、Y軸方向のずれ量を精度よく補正することができる。   Note that the output voltages Voutb and Voutc of the Wheatstone bridge circuits 41b and 41c do not change even when upward stress is applied to the first component 61 while the first component 61 is held as shown in FIG. That is, the deviation amount in the Y-axis direction can be corrected with high accuracy.

(X軸方向の補正)
図16のように、凹部62aに対し第1の部品61がX軸方向にずれているとする。この状態で第1の部品61を第2の部品62の凹部62aに挿入すると、第1の部品61の前端側(図16において下側)が凹部62aの壁面を擦り、第1の連絡部35aの外側に配置された歪みセンサ37の抵抗値R1,R4が増加する。これにより、ホイートストンブリッジ回路41aの出力電圧Voutaがマイナス側に変化する。
(X-axis direction correction)
As shown in FIG. 16, it is assumed that the first component 61 is displaced in the X-axis direction with respect to the recess 62a. When the first component 61 is inserted into the recess 62a of the second component 62 in this state, the front end side (lower side in FIG. 16) of the first component 61 rubs against the wall surface of the recess 62a, and the first connecting portion 35a. The resistance values R1 and R4 of the strain sensor 37 disposed outside the increase. As a result, the output voltage Vouta of the Wheatstone bridge circuit 41a changes to the negative side.

逆に、第1の部品61を第2の部品62の凹部62aにするときに第1の部品61の後端側(図16において上側)が凹部62aの壁面を擦ると、第2の連絡部35bの外側に配置された歪みセンサ37の抵抗値R2,R3が増加して、ホイートストンブリッジ回路41aの出力電圧Voutaがプラス側に変化する。   On the other hand, when the rear end side (upper side in FIG. 16) of the first component 61 rubs the wall surface of the recess 62a when the first component 61 is used as the recess 62a of the second component 62, the second connecting portion. The resistance values R2 and R3 of the strain sensor 37 arranged outside 35b increase, and the output voltage Vouta of the Wheatstone bridge circuit 41a changes to the plus side.

第1の部品61の凹部62aに対するX軸方向のずれ量が大きいほど、ホイートストンブリッジ回路41aの出力電圧Voutaの変化量が大きいので、制御部29はホイートストンブリッジ回路41aの出力電圧VoutaからX軸方向のずれ量を把握することができる。制御部29は、X軸方向のずれ量に応じて各リンク部23,24,25等を制御し、第1の部品61のX軸方向の位置を補正する。   Since the amount of change in the output voltage Vouta of the Wheatstone bridge circuit 41a increases as the amount of displacement in the X-axis direction with respect to the recess 62a of the first component 61 increases, the control unit 29 determines the output voltage Vouta of the Wheatstone bridge circuit 41a from the X-axis direction. The amount of deviation can be grasped. The control unit 29 controls each link unit 23, 24, 25, etc. according to the amount of deviation in the X-axis direction, and corrects the position of the first component 61 in the X-axis direction.

以上説明したように、本実施形態に係るロボット20では、把持部26に設けられた2対の指部33の内側及び外側に歪みセンサ37を配置し、それらの歪みセンサ37によりホイートストンブリッジ回路41a,41b,41cを形成している。これにより、指部33の各箇所における歪みを高精度に検出でき、部品同士の接触具合に応じて把持した部品の位置及び角度を補正することができる。また、本実施形態に係るロボット20の把持部26は、比較的簡単な構造で部品同士の接触具合を検出できるため、製造コストが低減される。   As described above, in the robot 20 according to the present embodiment, the strain sensors 37 are arranged inside and outside the two pairs of finger portions 33 provided in the grip portion 26, and the Wheatstone bridge circuit 41a is arranged by the strain sensors 37. , 41b, 41c are formed. Thereby, the distortion in each location of the finger | toe part 33 can be detected with high precision, and the position and angle of the components hold | gripped according to the contact condition of components can be correct | amended. In addition, since the grip portion 26 of the robot 20 according to the present embodiment can detect the contact state between components with a relatively simple structure, the manufacturing cost is reduced.

更に、本実施形態においては、歪みセンサ37が指部33に配置されている。このため、作業効率を上げようとして旋回支持部21及びリンク部23,24,25等を高速で動かしても歪みセンサ37、あるいはハンド部材31に大きな慣性力が加わることがなく、歪みセンサ37が破損、あるいはハンド部材31が塑性変形するおそれが少ない。また、作業中にリンク部23,24,25等が障害物に衝突したとしても、歪みセンサ37に大きな応力が加わることがなく、歪みセンサ37の破損を回避できる。   Further, in the present embodiment, the strain sensor 37 is disposed on the finger portion 33. For this reason, even if the turning support portion 21 and the link portions 23, 24, 25, etc. are moved at a high speed in order to increase the working efficiency, a large inertia force is not applied to the strain sensor 37 or the hand member 31, and the strain sensor 37 There is little risk of breakage or plastic deformation of the hand member 31. Further, even if the link portions 23, 24, 25, etc. collide with an obstacle during work, a large stress is not applied to the strain sensor 37, and damage to the strain sensor 37 can be avoided.

(第2の実施形態)
図17は、第2の実施形態に係るロボット(把持装置)の指部を示す模式図である。本実施形態に係るロボットが第1の実施形態と異なる点は指部の形状が異なることにあり、その他の構造は基本的に第1の実施形態と同様であるので、ここでは重複する部分の説明を省略する。
(Second Embodiment)
FIG. 17 is a schematic diagram illustrating a finger portion of the robot (gripping device) according to the second embodiment. The difference between the robot according to this embodiment and the first embodiment is that the shape of the finger is different, and the other structure is basically the same as that of the first embodiment. Description is omitted.

本実施形態では、ハンド部材駆動部27(図3参照)に固定される固定部から垂直方向に延びる2対の指部51を備えている。そして、ハンド部材駆動部27により相互に対向する指部51間の距離が変化し、指部51の間で第1の部品61を把持する。   In the present embodiment, two pairs of finger parts 51 extending in the vertical direction from a fixed part fixed to the hand member driving part 27 (see FIG. 3) are provided. Then, the distance between the finger parts 51 facing each other is changed by the hand member driving unit 27, and the first component 61 is gripped between the finger parts 51.

各指部51の内側及び外側の面にはそれぞれ歪みセンサ(歪みゲージ)57が配置されており、それらの歪みセンサ57により2つのホイートストンブリッジ回路53a,53bが形成されている。ホイートストンブリッジ回路53a,53bは、それぞれ第1の実施形態のホイートストンブリッジ回路41b,41cに対応し、これらのホイートストンブリッジ回路53a,53bにより把持した第1の部品61の角度θz,θy及びY軸方向の位置を補正することができる。   Strain sensors (strain gauges) 57 are arranged on the inner and outer surfaces of each finger 51, and two Wheatstone bridge circuits 53a and 53b are formed by these strain sensors 57. The Wheatstone bridge circuits 53a and 53b correspond to the Wheatstone bridge circuits 41b and 41c of the first embodiment, respectively, and the angles θz and θy and the Y-axis direction of the first component 61 gripped by these Wheatstone bridge circuits 53a and 53b. Can be corrected.

以上の諸実施形態に関し、更に以下の付記を開示する。   The following additional notes are disclosed with respect to the above embodiments.

(付記1)それぞれ2本の指部を有する一対のハンド部材と、
前記ハンド部材を相互に近接又は離隔する方向に移動させて第1の部品を把持するハンド部材駆動部と、
前記指部の内側及び外側の面にそれぞれ配置された複数の歪みセンサと、
前記歪みセンサの出力から前記第1の部品と第2の部品との接触具合を検出する制御部と
を有することを特徴とする把持装置。
(Supplementary Note 1) A pair of hand members each having two fingers,
A hand member driving unit that grips the first component by moving the hand members in directions close to or apart from each other;
A plurality of strain sensors respectively disposed on the inner and outer surfaces of the finger,
A gripping device comprising: a control unit configured to detect a contact state between the first component and the second component from an output of the strain sensor.

(付記2)前記歪みセンサが、歪みに応じて抵抗値が変化する歪みゲージであることを特徴とする付記1に記載の把持装置。   (Supplementary note 2) The gripping device according to supplementary note 1, wherein the strain sensor is a strain gauge whose resistance value changes according to strain.

(付記3)前記一対のハンド部材のうちの一方のハンド部材の各指部の内側及び外側の面にそれぞれ配置された前記歪みセンサと、他方のハンド部材の各指部の内側及び外側の面にそれぞれ配置された前記歪みセンサとにより、第1のホイートストンブリッジ回路及び第2のホイートストンブリッジ回路が形成されていることを特徴とする付記2に記載の把持装置。   (Supplementary Note 3) The strain sensors disposed on the inner and outer surfaces of each finger portion of one hand member of the pair of hand members, and the inner and outer surfaces of each finger portion of the other hand member The gripping apparatus according to appendix 2, wherein a first Wheatstone bridge circuit and a second Wheatstone bridge circuit are formed by the strain sensors respectively disposed in the first and second Wheatstone bridge circuits.

(付記4)前記指部が、前記第1の部品に接触する接触部と、前記接触部と前記ハンド部材駆動部との間を連絡する連絡部とを有し、
前記接触部と前記連絡部とのなす角度が90度よりも大きく、
前記第1のホイートストンブリッジ回路及び前記第2のホイートストンブリッジ回路は、前記連絡部の内側に配置された前記歪みセンサと、前記接触部の外側に配置された前記歪みセンサとにより形成されていることを特徴とする付記3に記載の把持装置。
(Supplementary Note 4) The finger portion includes a contact portion that contacts the first component, and a communication portion that communicates between the contact portion and the hand member driving portion,
An angle formed by the contact portion and the contact portion is greater than 90 degrees;
The first Wheatstone bridge circuit and the second Wheatstone bridge circuit are formed by the strain sensor disposed inside the connecting portion and the strain sensor disposed outside the contact portion. The gripping device according to appendix 3, characterized by:

(付記5)更に、前記一対のハンド部材の各指部の前記接触部の外側に配置された4個の前記歪みセンサにより第3のホイートストンブリッジ回路が形成されていることを特徴とする付記4に記載の把持装置。   (Additional remark 5) Furthermore, the 3rd Wheatstone bridge circuit is formed by the four said strain sensors arrange | positioned on the outer side of the said contact part of each finger | toe part of a pair of said hand member, The additional remark 4 characterized by the above-mentioned. The gripping device described in 1.

(付記6)アームと、
前記アームに連結されて第1の部品を把持する把持部と、
前記アームを制御して前記把持部を移動させる制御部と有し、
前記把持部は、それぞれ2本の指部を有する一対のハンド部材と、前記ハンド部材を相互に近接又は離隔する方向に移動させるハンド部材駆動部と、前記指部の内側及び外側の面にそれぞれ配置された複数の歪みセンサとを備え、
前記制御部は前記歪みセンサの出力から前記第1の部品と第2の部品との接触具合を検出することを特徴とするロボット。
(Appendix 6) Arm,
A gripping part connected to the arm for gripping the first part;
A control unit that controls the arm and moves the gripping unit;
The gripping portion includes a pair of hand members each having two finger portions, a hand member driving portion that moves the hand members in directions toward or away from each other, and inner and outer surfaces of the finger portions, respectively. A plurality of strain sensors arranged,
The said control part detects the contact condition of a said 1st component and a 2nd component from the output of the said strain sensor, The robot characterized by the above-mentioned.

(付記7)前記制御部は、前記第1の部品と前記第2の部品との接触具合の検出結果に応じて、前記第1の部品の位置又は角度を補正することを特徴とする付記6に記載のロボット。   (Additional remark 7) The said control part correct | amends the position or angle of a said 1st component according to the detection result of the contact condition of a said 1st component and a said 2nd component. The robot described in 1.

(付記8)前記歪みセンサが、歪みに応じて抵抗値が変化する歪みゲージであることを特徴とする付記7に記載のロボット。   (Supplementary note 8) The robot according to supplementary note 7, wherein the strain sensor is a strain gauge whose resistance value changes according to strain.

(付記9)前記一対のハンド部材のうちの一方のハンド部材の各指部の内側及び外側の面にそれぞれ配置された前記歪みセンサと、他方のハンド部材の各指部の内側及び外側の面にそれぞれ配置された前記歪みセンサとにより、第1のホイートストンブリッジ回路及び第2のホイートストンブリッジ回路が形成されていることを特徴とする付記8に記載のロボット。   (Additional remark 9) The said distortion | strain sensor respectively arrange | positioned on the inner side and outer surface of each finger part of one hand member of said pair of hand members, and the inner side and outer surface of each finger part of the other hand member 9. The robot according to appendix 8, wherein a first Wheatstone bridge circuit and a second Wheatstone bridge circuit are formed by the strain sensors respectively disposed on the robot.

(付記10)前記指部が、前記第1の部品に接触する接触部と、前記接触部と前記ハンド部材駆動部との間を連絡する連絡部とを有し、
前記接触部と前記連絡部とのなす角度が90度よりも大きく、
前記第1のホイートストンブリッジ回路及び前記第2のホイートストンブリッジ回路は、前記連絡部の内側に配置された前記歪みセンサと、前記接触部の外側に配置された前記歪みセンサとにより形成されていることを特徴とする付記9に記載のロボット。
(Supplementary Note 10) The finger unit includes a contact unit that contacts the first component, and a communication unit that communicates between the contact unit and the hand member driving unit,
An angle formed by the contact portion and the contact portion is greater than 90 degrees;
The first Wheatstone bridge circuit and the second Wheatstone bridge circuit are formed by the strain sensor disposed inside the connecting portion and the strain sensor disposed outside the contact portion. The robot according to appendix 9, characterized by:

10…ロボット、11…台座部、12…旋回支持部、13,14,15…リンク部、16…多軸力覚センサ、17…把持部、19…制御部、20…ロボット、21…台座部、22…旋回支持部、23,24,25…リンク部、26…把持部(把持装置)、27…ハンド部材駆動部、28…歪みゲージアンプ、29…制御部、31…ハンド部材、32…固定部、33…指部、34…接触部、35…連絡部、36…補強部、37…歪みセンサ、39…ボルト、41a,41b,41c…ホイートストンブリッジ回路、51…指部、53a,53b…ホイートストンブリッジ回路、61…第1の部品、62…第2の部品、62a…凹部。   DESCRIPTION OF SYMBOLS 10 ... Robot, 11 ... Base part, 12 ... Turning support part, 13, 14, 15 ... Link part, 16 ... Multi-axis force sensor, 17 ... Gripping part, 19 ... Control part, 20 ... Robot, 21 ... Base part , 22 ... turning support part, 23, 24, 25 ... link part, 26 ... gripping part (grip device), 27 ... hand member driving part, 28 ... strain gauge amplifier, 29 ... control part, 31 ... hand member, 32 ... Fixing part, 33 ... finger part, 34 ... contact part, 35 ... contact part, 36 ... reinforcing part, 37 ... strain sensor, 39 ... bolt, 41a, 41b, 41c ... Wheatstone bridge circuit, 51 ... finger part, 53a, 53b ... Wheatstone bridge circuit, 61 ... first part, 62 ... second part, 62a ... concave.

Claims (8)

接触部と、屈曲部を介して前記接触部に連絡する連絡部とを有する屈曲した形状の2本の指部をそれぞれ備えた一対のハンド部材と、
前記一対のハンド部材を相互に近接又は離隔する方向に移動させて第1の部品を前記接触部の間に挟んで把持するハンド部材駆動部と、
前記連絡部及び前記接触部にそれぞれ配置された複数の歪みセンサを含んで構成された回路と、
前記回路の出力から前記第1の部品と第2の部品との接触具合を検出する制御部とを有し、
前記制御部は、前記一対のハンド部材が前記第1の部品を把持した状態で前記回路のキャリブレーションを行い、その後前記第1の部品を第2の部品に接触させ、前記回路の出力から前記第1の部品と前記第2の部品との接触具合を検出する
ことを特徴とする把持装置。
A pair of hand members each provided with two bent finger parts each having a contact part and a communication part communicating with the contact part via a bent part;
A hand member driving unit that moves the pair of hand members in a direction approaching or separating from each other and holds the first component between the contact units; and
A circuit configured to include a plurality of strain sensors respectively disposed in the communication part and the contact part;
A controller that detects contact between the first component and the second component from the output of the circuit ;
The control unit calibrates the circuit in a state where the pair of hand members grips the first component, and then brings the first component into contact with a second component, and outputs the circuit from the output of the circuit. A gripping device that detects a contact state between a first component and the second component .
前記歪みセンサが、歪みに応じて抵抗値が変化する歪みゲージであることを特徴とする請求項1に記載の把持装置。   The gripping device according to claim 1, wherein the strain sensor is a strain gauge whose resistance value changes according to strain. 前記回路が、
前記一対のハンド部材のうちの一方の指部に配置された2つの歪センサと、前記一対のハンド部材のうちの他方の指部に配置された2つの歪センサとにより形成されたホイートストンブリッジ回路を有することを特徴とする請求項2に記載の把持装置。
The circuit is
A Wheatstone bridge circuit formed by two strain sensors arranged on one finger of the pair of hand members and two strain sensors arranged on the other finger of the pair of hand members gripping device according to claim 2, characterized in that it comprises a.
前記回路が、
前記一対のハンド部材のうちの一方の2本の指部の前記連絡部の外側に配置された2つの歪センサと、前記一対のハンド部材のうちの他方の2本の指部の前記連絡部の外側に配置された2つの歪センサとにより形成された第1のホイートストンブリッジ回路と、
前記一対のハンド部材のうちの一方の2本の指部の前記連絡部の内側に配置された2つの歪センサと、前記一対のハンド部材のうちの他方の2本の指部の前記接触部に配置された2つの歪センサとにより形成された第2のホイートストンブリッジ回路と
を有することを特徴とする請求項2に記載の把持装置。
The circuit is
Two strain sensors arranged outside the connecting portion of one two finger portions of the pair of hand members, and the connecting portion of the other two finger portions of the pair of hand members A first Wheatstone bridge circuit formed by two strain sensors arranged outside
Two strain sensors arranged inside the connecting portion of one two finger portions of the pair of hand members, and the contact portion of the other two finger portions of the pair of hand members The gripping device according to claim 2, further comprising: a second Wheatstone bridge circuit formed by two strain sensors arranged on the surface.
前記接触部と前記連絡部との屈曲角が固定であることを特徴とする請求項1乃至4のいずれか1項に記載の把持装置。The gripping device according to any one of claims 1 to 4, wherein a bending angle between the contact portion and the communication portion is fixed. アームと、
前記アームに連結されて第1の部品を把持する把持部と、
前記アームを制御して前記把持部を移動させる制御部と有し、
前記把持部は、
接触部と、屈曲部を介して前記接触部に連絡する連絡部とを有する屈曲した形状の2本の指部をそれぞれ備えた一対のハンド部材と、
前記一対のハンド部材を相互に近接又は離隔する方向に移動させて第1の部品を前記接触部の間に挟んで把持するハンド部材駆動部と、
前記連絡部及び前記接触部にそれぞれ配置された複数の歪みセンサを含んで構成される回路とを備え、
前記制御部は、前記一対のハンド部材が前記第1の部品を把持した状態で前記回路のキャリブレーションを行い、その後前記第1の部品を第2の部品に接触させ、前記回路の出力から前記第1の部品と前記第2の部品との接触具合を検出する
ことを特徴とするロボット。
Arm,
A gripping part connected to the arm for gripping the first part;
A control unit that controls the arm and moves the gripping unit;
The gripping part is
A pair of hand members each provided with two bent finger portions each having a contact portion and a communication portion communicating with the contact portion via a bent portion;
A hand member driving unit that moves the pair of hand members in a direction approaching or separating from each other and holds the first component between the contact units; and
A circuit including a plurality of strain sensors respectively disposed in the communication part and the contact part,
The control unit calibrates the circuit in a state where the pair of hand members grips the first component, and then brings the first component into contact with a second component, and outputs the circuit from the output of the circuit. robot and detecting a state of contact with the first component and the second component.
前記制御部は、前記第1の部品と前記第2の部品との接触具合の検出結果に応じて、前記第1の部品の位置又は角度を補正することを特徴とする請求項6に記載のロボット。   The said control part correct | amends the position or angle of a said 1st component according to the detection result of the contact condition of a said 1st component and a said 2nd component. robot. 前記接触部と前記連絡部との屈曲角が固定であることを特徴とする請求項6又は7に記載のロボット。The robot according to claim 6 or 7, wherein a bending angle between the contact portion and the communication portion is fixed.
JP2011243127A 2011-11-07 2011-11-07 Gripping device and robot Expired - Fee Related JP5929105B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2011243127A JP5929105B2 (en) 2011-11-07 2011-11-07 Gripping device and robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2011243127A JP5929105B2 (en) 2011-11-07 2011-11-07 Gripping device and robot

Publications (2)

Publication Number Publication Date
JP2013094951A JP2013094951A (en) 2013-05-20
JP5929105B2 true JP5929105B2 (en) 2016-06-01

Family

ID=48617448

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2011243127A Expired - Fee Related JP5929105B2 (en) 2011-11-07 2011-11-07 Gripping device and robot

Country Status (1)

Country Link
JP (1) JP5929105B2 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6457560B2 (en) 2017-01-06 2019-01-23 ファナック株式会社 Rotating shaft joint structure

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4478089A (en) * 1982-06-29 1984-10-23 International Business Machines Corporation Tri-axial force transducer for a manipulator gripper
JPH01107933A (en) * 1987-10-20 1989-04-25 Fujitsu Ltd Automatic forming/inserting system for wire rod
JPH05192887A (en) * 1992-01-20 1993-08-03 Ishikawajima Harima Heavy Ind Co Ltd Robot hand
JPH079368A (en) * 1993-06-24 1995-01-13 Matsushita Electric Works Ltd Manipulator for wire connection
JPH11165287A (en) * 1997-12-08 1999-06-22 Yukio Saito Position detection device, position control device and robot control device
US7654595B2 (en) * 2002-06-24 2010-02-02 Panasonic Corporation Articulated driving mechanism, method of manufacturing the mechanism, and holding hand and robot using the mechanism

Also Published As

Publication number Publication date
JP2013094951A (en) 2013-05-20

Similar Documents

Publication Publication Date Title
EP3341163B1 (en) Systems and methods for providing contact detection in an articulated arm
US7445260B2 (en) Gripping type hand
US9969088B2 (en) Force sensor correcting method
JP4625110B2 (en) Grasp type hand
JP6153316B2 (en) Robot system and control method of robot system
JP2010058256A (en) Arm position regulating method and apparatus and robot system
JP5924107B2 (en) Robot hand and robot
WO2011145713A1 (en) Force control robot
JP5218540B2 (en) Assembly robot and its control method
JP5929105B2 (en) Gripping device and robot
WO2020066063A1 (en) End effector device
WO2019017416A1 (en) Work robot and method for controlling work robot
JP6988757B2 (en) End effector and end effector device
JP2004066364A (en) Compliance mechanism
JP6983501B2 (en) Gripping device control method, program, recording medium, gripping device, robot device, and manufacturing method of parts
JP2005329512A (en) Method and device for detecting fingertip force of robot hand
JP2019010700A (en) Robot, robot system, and control method thereof
KR102448594B1 (en) Joint apparatus and robot comprising the same
US20230356414A1 (en) Gripper and robot having the same
US20230347530A1 (en) Robot hand
TW202210251A (en) Method for calibrating picking position of mechanical arm
JP2007185743A (en) Robot device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20140704

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20150430

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20150512

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20150622

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20151117

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20151215

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: 20160405

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20160418

R150 Certificate of patent or registration of utility model

Ref document number: 5929105

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

LAPS Cancellation because of no payment of annual fees