JP2017052094A - Article taking-out system for taking out bulked articles, and method - Google Patents

Article taking-out system for taking out bulked articles, and method Download PDF

Info

Publication number
JP2017052094A
JP2017052094A JP2016249969A JP2016249969A JP2017052094A JP 2017052094 A JP2017052094 A JP 2017052094A JP 2016249969 A JP2016249969 A JP 2016249969A JP 2016249969 A JP2016249969 A JP 2016249969A JP 2017052094 A JP2017052094 A JP 2017052094A
Authority
JP
Japan
Prior art keywords
robot hand
article
manipulator
robot
control unit
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.)
Granted
Application number
JP2016249969A
Other languages
Japanese (ja)
Other versions
JP6426690B2 (en
Inventor
鈴木 忠則
Tadanori Suzuki
忠則 鈴木
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.)
Fanuc Corp
Original Assignee
Fanuc Corp
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 Fanuc Corp filed Critical Fanuc Corp
Priority to JP2016249969A priority Critical patent/JP6426690B2/en
Publication of JP2017052094A publication Critical patent/JP2017052094A/en
Application granted granted Critical
Publication of JP6426690B2 publication Critical patent/JP6426690B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Manipulator (AREA)

Abstract

PROBLEM TO BE SOLVED: To provide a technique which arranges direction of taken-out articles and places them at a specified place with a simpler structure.SOLUTION: An article taking-out system 10 comprises: a robot hand 16; a manipulator 18; a visual sensor 46; an arrangement determining unit which determines a position and an attitude of the robot hand 16 when the robot hand holds an article W; a manipulator controller which controls the manipulator; and a robot hand controller which controls the robot hand. The manipulator controller arranges the robot hand 16 at the position and the attitude to produce a moment of the article W. The robot hand controller prevents falling of the article W from the robot hand 16 so that the article W is rotated by the action of the weight.SELECTED DRAWING: Figure 1

Description

本発明は、バラ積みされた物品を取り出すための物品取出システム、および方法に関する。   The present invention relates to an article take-out system and method for taking out stacked articles.

容器内にバラ積みされた物品を取り出して、物品の方向を揃えた状態で所定の場所に載置することのできる物品取出システムが知られている(例えば、特許文献1)。   2. Description of the Related Art An article take-out system is known that can take out articles stacked in a container and place them in a predetermined place with the direction of the articles aligned (for example, Patent Document 1).

特開2014−87913号公報JP 2014-87913 A

従来技術においては、物品を取り出す動作を行うための視覚センサと、取り出した物品の方向を揃える動作を行うための視覚センサとが必要とされていたので、装置が複雑化してしまう。したがって、より簡単な構成によって、取り出した物品の方向を揃えて所定の場所に載置することができる技術が求められている。   In the prior art, since a visual sensor for performing an operation of taking out an article and a visual sensor for performing an operation of aligning the direction of the taken-out article are required, the apparatus becomes complicated. Therefore, there is a need for a technique that can be placed in a predetermined place with the direction of the removed article aligned with a simpler configuration.

本発明の一態様において、バラ積みされた物品を取り出すための物品取出システムは、物品を把持可能なロボットハンドと、ロボットハンドを移動させるマニピュレータと、物品の位置および姿勢を検出可能な視覚センサと、視覚センサによって検出された物品の位置および姿勢に基づいて、物品を把持するときのロボットハンドの位置および姿勢を決定する配置決定部とを備える。   In one embodiment of the present invention, an article pickup system for taking out stacked articles includes a robot hand that can hold an article, a manipulator that moves the robot hand, and a visual sensor that can detect the position and posture of the article. And an arrangement determining unit that determines the position and orientation of the robot hand when gripping the article based on the position and orientation of the article detected by the visual sensor.

また、物品取出システムは、マニピュレータを制御して、配置決定部によって決定されたロボットハンドの位置および姿勢に該ロボットハンドを配置させるマニピュレータ制御部と、ロボットハンドを制御して物品を把持するロボットハンド制御部とを備える。   In addition, the article take-out system includes a manipulator control unit that controls the manipulator to place the robot hand in the position and posture of the robot hand determined by the arrangement determination unit, and a robot hand that controls the robot hand to hold the article. And a control unit.

マニピュレータ制御部は、物品を把持したロボットハンドが該物品を持ち上げたときに該物品にモーメントが生じる位置および姿勢に該ロボットハンドを配置するように、マニピュレータを制御する。   The manipulator control unit controls the manipulator so as to place the robot hand in a position and posture where a moment is generated in the article when the robot hand holding the article lifts the article.

ロボットハンド制御部は、ロボットハンドが物品にモーメントが生じる位置および姿勢に配置されたときに、ロボットハンドから物品が脱落するのを防止しつつ、該物品が重力の作用によって該ロボットハンドに対して回転するのを許容するように、ロボットハンドを制御する。   The robot hand control unit is configured to prevent the article from dropping from the robot hand when the robot hand is arranged at a position and posture where the article generates a moment, and the article is applied to the robot hand by the action of gravity. Control the robot hand to allow it to rotate.

物品には、該物品の重心から離隔した位置に貫通孔が形成されてもよい。ロボットハンドは、複数の爪部と、該複数の爪部を互いに対して接近および離反する方向へ移動させる爪部駆動部とを有してもよい。   A through hole may be formed in the article at a position separated from the center of gravity of the article. The robot hand may include a plurality of claw parts and a claw part driving unit that moves the plurality of claw parts in directions toward and away from each other.

配置決定部は、複数の爪部を貫通孔の内部に配置することができるロボットハンドの位置および姿勢を決定してもよい。ロボットハンド制御部は、爪部駆動部を制御して、複数の爪部を互いに離反する方向へ移動させ、貫通孔を画定する壁面に対して複数の爪部を押し当てて該複数の爪部で物品を把持してもよい。   The arrangement determining unit may determine the position and posture of the robot hand that can arrange the plurality of claw parts inside the through hole. The robot hand control unit controls the claw drive unit to move the plurality of claw units in directions away from each other, and presses the plurality of claw units against the wall surface defining the through-hole to The article may be gripped with.

ロボットハンド制御部は、ロボットハンドが物品にモーメントが生じる位置および姿勢に配置されたときに、爪部駆動部を制御して、複数の爪部を互いに接近する方向へ移動させて、物品がロボットハンドに対して回転するのを許容してもよい。   The robot hand control unit controls the claw drive unit to move the plurality of claw parts in a direction approaching each other when the robot hand is arranged at a position and posture where the moment is generated in the article, so that the article moves to the robot It may be allowed to rotate with respect to the hand.

ロボットハンドが物品にモーメントが生じる位置および姿勢に配置されたとき、爪部は、水平に配置されるか、または、該爪部の先端部が基端部よりも鉛直上方に位置するように水平方向に対して傾斜して配置されてもよい。   When the robot hand is placed in a position and posture where an article generates moment, the claw portion is placed horizontally, or horizontally so that the tip portion of the claw portion is located vertically above the base end portion. You may arrange | position with inclination with respect to a direction.

ロボットハンドは、マニピュレータに取り付けられ、複数の爪部を保持するアーム部をさらに有してもよい。複数の爪部は、アーム部に対して傾斜するように延在してもよい。   The robot hand may further include an arm unit that is attached to the manipulator and holds a plurality of claw units. The plurality of claw portions may extend so as to be inclined with respect to the arm portion.

配置決定部は、ロボットハンドおよびマニピュレータが周囲の部材と干渉することなくロボットハンドが物品を把持することができるように、ロボットハンドの位置および姿勢を決定してもよい。   The arrangement determining unit may determine the position and posture of the robot hand so that the robot hand and the manipulator can grip the article without interfering with surrounding members.

ロボットハンド制御部は、物品の回転が停止したときに、ロボットハンドを制御して、物品がロボットハンドに対して移動不能となるように該ロボットハンドによって物品を把持してもよい。   The robot hand control unit may control the robot hand when the rotation of the article is stopped and hold the article by the robot hand so that the article cannot move with respect to the robot hand.

本発明の他の態様において、バラ積みされた物品をロボットハンドで把持して取り出す方法は、物品の位置および姿勢を検出することと、検出された物品の位置および姿勢に基づいて、物品を把持するときのロボットハンドの位置および姿勢を決定することと、決定されたロボットハンドの位置および姿勢に該ロボットハンドを配置させることと、ロボットハンドによって物品を把持することとを備える。   In another aspect of the present invention, a method for gripping and taking out stacked articles with a robot hand includes detecting the position and orientation of the article and gripping the article based on the detected position and orientation of the article. Determining the position and posture of the robot hand when performing, positioning the robot hand at the determined position and posture of the robot hand, and holding an article by the robot hand.

また、この方法は、物品を把持したロボットハンドが該物品を持ち上げたときに該物品にモーメントが生じる位置および姿勢に該ロボットハンドを配置することと、ロボットハンドが物品にモーメントが生じる位置および姿勢に配置されたときに、ロボットハンドから物品が脱落するのを防止しつつ、該物品を重力の作用によって該ロボットハンドに対して回転させることとを備える。   In addition, this method arranges the robot hand at a position and posture where a moment is generated in the article when the robot hand holding the article lifts the article, and a position and posture where the robot hand generates a moment in the article. And rotating the article relative to the robot hand by the action of gravity while preventing the article from falling off the robot hand.

本発明の一実施形態に係る物品取出システムの斜視図である。It is a perspective view of the article taking-out system concerning one embodiment of the present invention. 図1に示す物品取出システムのブロック図である。It is a block diagram of the article taking-out system shown in FIG. 図1に示すロボットハンドの拡大図である。It is an enlarged view of the robot hand shown in FIG. 図3に示すロボットハンドでワークを把持した状態の一例を示す。An example of the state which hold | gripped the workpiece | work with the robot hand shown in FIG. 図1に示す物品取出システムの動作フローの一例を示すフローチャートである。It is a flowchart which shows an example of the operation | movement flow of the goods extraction system shown in FIG. 図5に示すステップS2のフローチャートである。It is a flowchart of step S2 shown in FIG. 図5に示すステップS6のフローチャートである。It is a flowchart of step S6 shown in FIG. ロボットハンドが容器と干渉している状態を示す。The state where the robot hand is interfering with the container is shown. 図8の要部を拡大した拡大図である。It is the enlarged view to which the principal part of FIG. 8 was expanded. ロボットハンドが再設定後の位置座標系に配置された状態を示す。The state where the robot hand is arranged in the position coordinate system after resetting is shown. 図10の要部を拡大した拡大図である。It is the enlarged view to which the principal part of FIG. 10 was expanded. 図5中のステップS5におけるロボットハンドの姿勢の一例を示す。An example of the posture of the robot hand in step S5 in FIG. 5 is shown. 図12に示すロボットハンドおよびワークの拡大図である。It is an enlarged view of the robot hand and workpiece | work shown in FIG. 図13に示すロボットハンドを図13中のy軸方向から見た側方図である。It is the side view which looked at the robot hand shown in FIG. 13 from the y-axis direction in FIG. 図5中のステップS6を実行した後のロボットハンドおよびワークを示す図である。It is a figure which shows the robot hand and workpiece | work after performing step S6 in FIG. 図5中のステップS7を実行した後のロボットハンドおよびワークを示す。The robot hand and workpiece | work after performing step S7 in FIG. 5 are shown. 図5中のステップS8を実行した後の物品取出システムの斜視図である。FIG. 6 is a perspective view of the article take-out system after step S8 in FIG. 5 is executed. 図5中のステップS5の他の実施例を説明するための図である。It is a figure for demonstrating the other Example of step S5 in FIG. 本発明の他の実施形態に係るロボットハンドの図である。It is a figure of the robot hand which concerns on other embodiment of this invention. 図19に示すロボットハンドによってワークを把持した状態を示す。The state which hold | gripped the workpiece | work with the robot hand shown in FIG. 19 is shown.

以下、本発明の実施の形態を図面に基づいて詳細に説明する。まず、図1および図2を参照して、本発明の一実施形態に係る物品取出システム10について説明する。物品取出システム10は、容器A内にバラ積みにされたワーク(物品)Wを取り出し、取り出したワークWを載置台Bの上に載置するためのシステムである。   Hereinafter, embodiments of the present invention will be described in detail with reference to the drawings. First, an article take-out system 10 according to an embodiment of the present invention will be described with reference to FIGS. 1 and 2. The article take-out system 10 is a system for taking out workpieces (articles) W stacked in a container A and placing the taken workpieces W on a mounting table B.

物品取出システム10は、ロボット12と、ロボット12を制御するロボット制御部14とを備える。ロボット12は、例えば垂直多関節ロボットであって、ロボットハンド16と、該ロボットハンド16を移動させるマニピュレータ18とを有する。   The article take-out system 10 includes a robot 12 and a robot control unit 14 that controls the robot 12. The robot 12 is, for example, a vertical articulated robot, and includes a robot hand 16 and a manipulator 18 that moves the robot hand 16.

マニピュレータ18は、ロボットベース20、旋回胴22、およびロボットアーム24を有する。ロボットベース20は、ワークセルの床Cの上に固定されている。旋回胴22は、ロボットベース20に鉛直軸周りに旋回可能に取り付けられている。   The manipulator 18 has a robot base 20, a swivel drum 22, and a robot arm 24. The robot base 20 is fixed on the floor C of the work cell. The turning drum 22 is attached to the robot base 20 so as to be turnable around the vertical axis.

ロボットアーム24は、旋回胴22に回転可能に取り付けられた下腕部26と、該下腕部26の先端に回転可能に取り付けられた前腕部28とを有する。ロボットハンド16は、手首部30を介して、前腕部28の先端に取り付けられている。   The robot arm 24 includes a lower arm portion 26 that is rotatably attached to the revolving barrel 22, and a forearm portion 28 that is rotatably attached to the distal end of the lower arm portion 26. The robot hand 16 is attached to the tip of the forearm portion 28 via the wrist portion 30.

次に、図1〜図3を参照して、ロボットハンド16について説明する。ロボットハンド16は、ワークWを把持し、解放することができる。ロボットハンド16は、アーム部32、第1の爪部34、第2の爪部36、および爪部駆動部38を有する。   Next, the robot hand 16 will be described with reference to FIGS. The robot hand 16 can grip and release the workpiece W. The robot hand 16 includes an arm part 32, a first claw part 34, a second claw part 36, and a claw part driving part 38.

アーム部32は、手首部30に連結された基端部32a、および該基端部32aとは反対側の先端部32bを有し、基端部32aから先端部32bまで、軸線O(図3)に沿って、直線状に延在する。アーム部32の先端部32bには、レール部40が設けられている。このレール部40には、図3中のy軸方向に沿って延びる溝40aが形成されている。 The arm portion 32 has a base end portion 32a connected to the wrist portion 30 and a tip end portion 32b opposite to the base end portion 32a. From the base end portion 32a to the tip end portion 32b, an axis O 1 (FIG. It extends in a straight line along 3). A rail portion 40 is provided at the distal end portion 32 b of the arm portion 32. The rail portion 40 is formed with a groove 40a extending along the y-axis direction in FIG.

第1の爪部34は、爪部保持部42を介して、レール部40に取り付けられている。第1の爪部34は、図3中のz軸方向に沿って直線状に延びる棒部材である。第1の爪部34は、爪部保持部42の先端部に固定された基端部34aと、該基端部34aとは反対側の先端部34bとを有する。   The first claw part 34 is attached to the rail part 40 via the claw part holding part 42. The 1st nail | claw part 34 is a rod member extended linearly along the z-axis direction in FIG. The first claw portion 34 has a base end portion 34a fixed to the tip end portion of the claw portion holding portion 42 and a tip end portion 34b opposite to the base end portion 34a.

爪部保持部42は、アーム部32(すなわち、軸線O)と略平行に延在している。爪部保持部42は、レール部40の溝40aに沿って摺動可能となるように、レール部40に取り付けられている。 Claw portion holding portion 42, the arm portion 32 (i.e., the axis O 1) extend substantially parallel to the. The nail | claw part holding | maintenance part 42 is attached to the rail part 40 so that it can slide along the groove | channel 40a of the rail part 40. FIG.

第2の爪部36は、爪部保持部44を介して、レール部40に取り付けられている。第2の爪部36は、図3中のz軸方向に沿って直線状に延びる棒部材である。第2の爪部36は、第1の爪部34に対して、図3中のy軸方向に離隔した位置に配置されている。第2の爪部36は、爪部保持部44の先端部に固定された基端部36aと、該基端部36aとは反対側の先端部36bとを有する。   The second claw part 36 is attached to the rail part 40 via the claw part holding part 44. The 2nd nail | claw part 36 is a bar member extended linearly along the z-axis direction in FIG. The 2nd nail | claw part 36 is arrange | positioned with respect to the 1st nail | claw part 34 in the position spaced apart in the y-axis direction in FIG. The second claw portion 36 has a base end portion 36a fixed to the tip end portion of the claw portion holding portion 44, and a tip end portion 36b opposite to the base end portion 36a.

爪部保持部44は、アーム部32(すなわち、軸線O)と略平行に延在しており、レール部40の溝40aに沿って摺動可能となるように、レール部40に取り付けられている。 The claw holding portion 44 extends substantially parallel to the arm portion 32 (that is, the axis O 1 ), and is attached to the rail portion 40 so as to be slidable along the groove 40 a of the rail portion 40. ing.

爪部駆動部38は、例えば、空圧式または油圧式のシリンダ、もしくは、サーボモータから構成される。爪部駆動部38は、ロボット制御部14からの指令に応じて、爪部保持部42および44を、互いに接近する方向、および互いから離れる方向へ、図3中のy軸に沿って移動させる。   The claw drive unit 38 is constituted by, for example, a pneumatic or hydraulic cylinder, or a servo motor. The claw drive unit 38 moves the claw holding units 42 and 44 along the y axis in FIG. 3 in a direction approaching and away from each other in response to a command from the robot control unit 14. .

このようにして、第1の爪部34および第2の爪部36は、爪部駆動部38によって、互いに接近する方向、および互いから離反する方向へ、y軸に沿って移動される。   Thus, the 1st nail | claw part 34 and the 2nd nail | claw part 36 are moved along the y-axis by the nail | claw part drive part 38 in the direction which mutually approaches, and the direction which leaves | separates from each other.

一例として、爪部駆動部38がシリンダから構成される場合、爪部駆動部38は、筒状のシリンダ本体と、該シリンダ本体内に往復動可能に配置されるピストンロッドと、ピストンロッドの往復動を、爪部保持部42および44のy軸方向の開閉運動へ変換する運動変換機構とを有する。ピストンロッドには、磁石が埋設されている。一方、シリンダ本体には、磁気センサ(いわゆる、リードスイッチ)が取り付けられている。   As an example, when the claw drive unit 38 is formed of a cylinder, the claw drive unit 38 includes a cylindrical cylinder body, a piston rod that is reciprocally movable in the cylinder body, and a reciprocation of the piston rod. A movement converting mechanism that converts the movement into opening and closing movements in the y-axis direction of the claw holding sections 42 and 44. A magnet is embedded in the piston rod. On the other hand, a magnetic sensor (so-called reed switch) is attached to the cylinder body.

磁気センサは、ピストンロッドの変位に応じて変化する、該ピストンロッドに埋設された磁石の磁界を検知し、ロボット制御部14に磁界に係るデータを送信する。ロボット制御部14は、磁気センサから受信したデータに基づいて、第1の爪部34および第2の爪部36の間の距離を検知することができる。   The magnetic sensor detects the magnetic field of the magnet embedded in the piston rod, which changes according to the displacement of the piston rod, and transmits data related to the magnetic field to the robot control unit 14. The robot control unit 14 can detect the distance between the first claw unit 34 and the second claw unit 36 based on the data received from the magnetic sensor.

本実施形態においては、第1の爪部34および第2の爪部36は、アーム部32に対して傾斜するように延在している。具体的には、第1の爪部34および第2の爪部36の延在方向(すなわち、z軸方向)は、アーム部32の軸線Oに対して、角度θだけ傾斜している。この角度θは、例えば、0°<θ<90°に設定される。 In the present embodiment, the first claw portion 34 and the second claw portion 36 extend so as to be inclined with respect to the arm portion 32. Specifically, the extending direction of the first claw part 34 and the second claw part 36 (that is, the z-axis direction) is inclined with respect to the axis O 1 of the arm part 32 by an angle θ 1 . . This angle θ 1 is set to 0 ° <θ 1 <90 °, for example.

ロボット制御部14は、図3に示す直交座標系を、ロボットハンド16のツール座標系として予め記憶する。このツール座標系の原点Oの3次元座標と、x軸、y軸、およびz軸の方向とによって、3次元空間におけるロボットハンド16の位置および姿勢を規定することができる。原点Oは、第1の爪部34と第2の爪部36との間、且つ、基端部34a(基端部36a)と先端部34b(先端部36b)との間の位置に、配置される。   The robot control unit 14 stores in advance the orthogonal coordinate system shown in FIG. 3 as the tool coordinate system of the robot hand 16. The position and posture of the robot hand 16 in the three-dimensional space can be defined by the three-dimensional coordinates of the origin O of the tool coordinate system and the directions of the x-axis, y-axis, and z-axis. The origin O is disposed between the first claw portion 34 and the second claw portion 36 and at a position between the base end portion 34a (base end portion 36a) and the tip end portion 34b (tip end portion 36b). Is done.

図4は、ロボットハンド16によってワークWを把持している状態の一例を示している。図4に示すように、本実施形態においては、ワークWは、長手方向の軸線Oに沿って延在する細長い部材である。 FIG. 4 shows an example of a state where the workpiece W is gripped by the robot hand 16. As shown in FIG. 4, in the present embodiment, the workpiece W is an elongated member that extends along the longitudinal axis O 2 .

図4に示す例においては、ロボットハンド16は、ワークWに対して、ツール座標系のx軸がワークWの長手方向の軸線Oと平行となるように、位置決めされている。また、ロボットハンド16のツール座標系のz軸は、ワークWの厚さ方向と平行となり、且つ、ツール座標系のy軸がワークWの幅方向に平行となっている。 In the example shown in FIG. 4, the robot hand 16 is positioned with respect to the workpiece W such that the x axis of the tool coordinate system is parallel to the longitudinal axis O 2 of the workpiece W. In addition, the z axis of the tool coordinate system of the robot hand 16 is parallel to the thickness direction of the workpiece W, and the y axis of the tool coordinate system is parallel to the width direction of the workpiece W.

ワークWには、円形の貫通孔Dが形成されている。この貫通孔Dは、ワークWの重心から離隔した位置に形成され、ワークWを厚さ方向(すなわち、図4におけるz軸方向)に貫通している。   A circular through hole D is formed in the workpiece W. The through hole D is formed at a position separated from the center of gravity of the workpiece W, and penetrates the workpiece W in the thickness direction (that is, the z-axis direction in FIG. 4).

図4に示すように、ロボットハンド16によってワークWを把持するとき、第1の爪部34および第2の爪部36は、貫通孔Dの内部に挿入され、次いで、爪部駆動部38によって、互いから離れる方向へ移動される。   As shown in FIG. 4, when the workpiece W is gripped by the robot hand 16, the first claw portion 34 and the second claw portion 36 are inserted into the through hole D, and then, by the claw portion driving portion 38. , Moved away from each other.

その結果、第1の爪部34および第2の爪部36は、貫通孔Dを画定する壁面に押し当てられる。こうして、ワークWは、第1の爪部34および第2の爪部36によって把持される。   As a result, the first claw portion 34 and the second claw portion 36 are pressed against the wall surface that defines the through hole D. Thus, the workpiece W is gripped by the first claw portion 34 and the second claw portion 36.

再度、図1および図2を参照して、物品取出システム10は、視覚センサ46をさらに備える。視覚センサ46は、保持フレーム48によって、容器Aの鉛直上方に保持されている。視覚センサ46は、例えば3次元視覚センサであり、ロボット制御部14からの指令に応じて、容器A内にバラ積みされたワークWの位置および姿勢を検出する。   Again referring to FIGS. 1 and 2, the article removal system 10 further includes a visual sensor 46. The visual sensor 46 is held vertically above the container A by a holding frame 48. The visual sensor 46 is, for example, a three-dimensional visual sensor, and detects the position and orientation of the workpieces W stacked in the container A in response to a command from the robot control unit 14.

具体的には、視覚センサ46は、容器A内のワークWを複数回撮像し、撮像された画像データに基づいて、視覚センサ46からワークWまでの距離を計測する。そして、視覚センサ46は、ワークWの3次元座標を算出し、これにより、ワークWの3次元空間内での位置および姿勢を検出する。視覚センサ46は、検出したワークWの位置および姿勢に関するデータを、ロボット制御部14へ送信する。   Specifically, the visual sensor 46 images the workpiece W in the container A a plurality of times, and measures the distance from the visual sensor 46 to the workpiece W based on the captured image data. The visual sensor 46 calculates the three-dimensional coordinates of the workpiece W, and thereby detects the position and orientation of the workpiece W in the three-dimensional space. The visual sensor 46 transmits data regarding the detected position and posture of the workpiece W to the robot control unit 14.

次に、図1〜図7を参照して、物品取出システム10の動作について説明する。図5は、物品取出システム10の動作フローの一例を示している。図5に示すフローは、ロボット制御部14がユーザまたは上位コントローラからワークWの取り出し作業指令を受け付けたときに、開始する。   Next, the operation of the article take-out system 10 will be described with reference to FIGS. FIG. 5 shows an example of the operation flow of the article removal system 10. The flow shown in FIG. 5 starts when the robot control unit 14 receives a work W take-out command from the user or the host controller.

ステップS1において、ロボット制御部14は、視覚センサ46を介して、ワークWの位置および姿勢を検出する。具体的には、ロボット制御部14は、視覚センサ46に指令を送り、容器A内にバラ積みされたワークWを撮像し、該ワークWの3次元空間内での位置および姿勢を検出する。視覚センサ46は、検出したワークWの位置および姿勢に関するデータを、ロボット制御部14へ送信する。   In step S <b> 1, the robot control unit 14 detects the position and posture of the workpiece W via the visual sensor 46. Specifically, the robot control unit 14 sends a command to the visual sensor 46, images the workpiece W stacked in the container A, and detects the position and posture of the workpiece W in the three-dimensional space. The visual sensor 46 transmits data regarding the detected position and posture of the workpiece W to the robot control unit 14.

ステップS2において、ロボット制御部14は、ステップS1にて検出されたワークWの位置および姿勢に基づいて、ロボットハンド16がワークWのうちの1つを適切に把持することができるロボットハンド16の位置および姿勢を決定する。   In step S2, the robot control unit 14 determines whether the robot hand 16 can properly hold one of the workpieces W based on the position and posture of the workpiece W detected in step S1. Determine position and orientation.

このステップS2について、図6を参照して説明する。ステップS2が開始された後、ステップS11において、ロボット制御部14は、ワークWの貫通孔Dの位置を取得する。具体的には、ロボット制御部14は、ステップS1にて視覚センサ46から受信したデータを参照して、取り出し対象とする1つのワークWを特定し、該1つのワークWの貫通孔Dの中心位置の座標を取得する。   Step S2 will be described with reference to FIG. After step S2 is started, in step S11, the robot control unit 14 acquires the position of the through hole D of the workpiece W. Specifically, the robot control unit 14 refers to the data received from the visual sensor 46 in step S <b> 1, identifies one workpiece W to be taken out, and the center of the through hole D of the one workpiece W Get the coordinates of the position.

ステップS12において、ロボット制御部14は、取り出し対象とするワークWの貫通孔Dに対して、ワークWの位置座標系を設定する。ワークWの位置座標系は、ロボットハンド16によってワークWを把持するときにロボットハンド16のツール座標系を配置させる目的となる座標系である。一例として、ロボット制御部14は、貫通孔Dに対して、ワークWの位置座標系を、図4に示す直交座標系のように設定する。   In step S12, the robot control unit 14 sets the position coordinate system of the workpiece W with respect to the through hole D of the workpiece W to be taken out. The position coordinate system of the workpiece W is a coordinate system for the purpose of arranging the tool coordinate system of the robot hand 16 when the workpiece W is gripped by the robot hand 16. As an example, the robot control unit 14 sets the position coordinate system of the workpiece W with respect to the through hole D like the orthogonal coordinate system shown in FIG.

この場合、位置座標系の原点Oは、ステップS11にて取得した貫通孔Dの中心位置の座標に一致している。また、位置座標系のx軸方向は、ワークWの長手方向の軸線Oの方向と平行となっている。また、位置座標系のz軸方向は、ワークWの厚み方向と平行となり、位置座標系のy軸方向は、ワークWの幅方向と平行となっている。 In this case, the origin O of the position coordinate system coincides with the coordinates of the center position of the through hole D acquired in step S11. The x-axis direction of the position coordinate system is parallel to the direction of the longitudinal axis O 2 of the workpiece W. Further, the z-axis direction of the position coordinate system is parallel to the thickness direction of the workpiece W, and the y-axis direction of the position coordinate system is parallel to the width direction of the workpiece W.

ステップS13において、ロボット制御部14は、ロボットハンド16およびマニピュレータ18が周囲の部材と干渉するか否かを判断する。この動作について、図8および図9を参照して説明する。   In step S13, the robot control unit 14 determines whether the robot hand 16 and the manipulator 18 interfere with surrounding members. This operation will be described with reference to FIGS.

ここで、ロボット制御部14は、容器A内にバラ積みされた複数のワークWのうち、ワークWを、取り出し対象として特定したものとする。ロボット制御部14は、ロボットハンド16をワークWに対して位置決めする場合、ロボットハンド16のツール座標系をワークWに対して設定した位置座標系に一致させるように、ロボットハンド16を移動させる。 Here, it is assumed that the robot control unit 14 specifies the workpiece Wt as a take-out object among the plurality of workpieces W stacked in the container A. When positioning the robot hand 16 with respect to the workpiece W, the robot control unit 14 moves the robot hand 16 so that the tool coordinate system of the robot hand 16 matches the position coordinate system set with respect to the workpiece W t . .

仮に、取り出し対象のワークWの貫通孔Dに対して、図4に示すように位置座標系を設定し、該位置座標系にツール座標系を一致させるように、ロボットハンド16をワークWに対して位置決めした場合、図9に示す状態となる。 Assuming that the position coordinate system is set as shown in FIG. 4 with respect to the through hole D of the workpiece W t to be taken out, the robot hand 16 is moved to the workpiece W t so that the tool coordinate system matches the position coordinate system. When the positioning is performed, the state shown in FIG. 9 is obtained.

このようにロボットハンド16を位置決めすると、図9中の点線Eで示されたロボットハンド16の部分が、容器Aの側壁Aと干渉してしまうことなる。したがって、ワークWに対して図9に示すようにワークWの位置座標系を設定した場合、ロボットハンド16をワークWに対して適切に配置させることができない。 When the robot hand 16 is thus positioned, the portion of the robot hand 16 indicated by the dotted line E in FIG. 9 interferes with the side wall A 1 of the container A. Therefore, when the position coordinate system of the workpiece W is set with respect to the workpiece W t as shown in FIG. 9, the robot hand 16 cannot be properly arranged with respect to the workpiece W t .

そこで、本実施形態においては、このステップS13において、ロボット制御部14は、ステップS12にて設定された位置座標系にツール座標系を一致させるようにロボットハンド16を配置させた場合に、上述のような干渉が発生するか否かを判断する。   Therefore, in the present embodiment, in step S13, the robot control unit 14 arranges the robot hand 16 so that the tool coordinate system matches the position coordinate system set in step S12. It is determined whether or not such interference occurs.

一例として、容器Aをモデル化したデータ(すなわち、容器Aの3次元座標のデータ)が、予め記憶部(図示せず)に記憶される。一方、ロボット制御部14は、ステップS12にて設定された位置座標系に配置した場合のロボットハンド16をモデル化したデータ(すなわち、ロボットハンド16の3次元座標のデータ)を算出する。   As an example, data obtained by modeling the container A (that is, three-dimensional coordinate data of the container A) is stored in advance in a storage unit (not shown). On the other hand, the robot control unit 14 calculates data that models the robot hand 16 when placed in the position coordinate system set in step S12 (that is, data of the three-dimensional coordinates of the robot hand 16).

そして、ロボット制御部14は、容器Aのモデルデータと、ロボットハンド16のモデルデータとを照らし合わせて、容器Aとロボットハンド16との間で干渉が生じるか否かを、データ上で判断する。   Then, the robot control unit 14 compares the model data of the container A with the model data of the robot hand 16 and determines whether or not interference occurs between the container A and the robot hand 16 on the data. .

同様に、記憶部は、容器Aの他にロボット12の周囲に存在している部材(例えば保持フレーム48)をモデル化したデータを、予め記憶部(図示せず)に記憶する。そして、ロボット制御部14は、周囲の部材のモデルデータと、ロボットハンド16のモデルデータとを照らし合わせて、該周囲の部材とロボットハンド16との間で干渉が生じるか否かを判断する。   Similarly, the storage unit stores, in advance in the storage unit (not shown), data obtained by modeling a member (for example, the holding frame 48) existing around the robot 12 in addition to the container A. Then, the robot control unit 14 compares the model data of the surrounding members and the model data of the robot hand 16 to determine whether interference occurs between the surrounding members and the robot hand 16.

ロボット制御部14は、ロボットハンド16が容器Aを含む周囲の部材と干渉する(すなわちYES)と判断した場合、ステップS14へ進む。一方、ロボット制御部14は、
ロボットハンド16が周囲の部材と干渉しない(すなわちNO)と判断した場合、図6に示すフローを終了する。
If the robot control unit 14 determines that the robot hand 16 interferes with surrounding members including the container A (that is, YES), the robot control unit 14 proceeds to step S14. On the other hand, the robot control unit 14
When it is determined that the robot hand 16 does not interfere with surrounding members (that is, NO), the flow shown in FIG. 6 ends.

ステップS14において、ロボット制御部14は、ワークWの位置座標系を再設定する。具体的には、ロボット制御部14は、図9に示すように設定された位置座標系を、該位置座標系のz軸周りに回転させる。   In step S14, the robot control unit 14 resets the position coordinate system of the workpiece W. Specifically, the robot control unit 14 rotates the position coordinate system set as shown in FIG. 9 around the z axis of the position coordinate system.

そして、ロボット制御部14は、位置座標系をz軸周りに回転させるのに追随して、回転させた位置座標系に配置されたときのロボットハンド16のモデルデータを随時算出し、ロボットハンド16のモデルデータと、容器Aを含む周囲の部材のモデルデータとの間の干渉を判断する。   Then, the robot control unit 14 follows the rotation of the position coordinate system around the z-axis, calculates model data of the robot hand 16 when it is arranged in the rotated position coordinate system, and the robot hand 16 And the model data of surrounding members including the container A are determined.

そして、ロボット制御部14は、ロボットハンド16のモデルデータと周囲の部材のモデルデータとの干渉が発生しない位置まで位置座標系を回転させたときに、回転後の位置座標系を、新たな位置座標系として再設定する。   Then, when the robot control unit 14 rotates the position coordinate system to a position where interference between the model data of the robot hand 16 and the model data of surrounding members does not occur, the robot control unit 14 converts the rotated position coordinate system to a new position. Reset as coordinate system.

このように再設定された位置座標系の例を図10および図11に示す。図10および図11に示す再設定後の位置座標系は、図9に示す元の位置座標系から、図9中のz軸プラス方向の側から見て、z軸周りに約150°回転されている。   Examples of the position coordinate system reset in this way are shown in FIGS. The position coordinate system after reset shown in FIGS. 10 and 11 is rotated about 150 ° around the z-axis from the original position coordinate system shown in FIG. 9 when viewed from the z-axis plus direction side in FIG. ing.

この再設定後の位置座標系にツール座標系を一致させるようにロボットハンド16を位置決めした場合、図10および図11に示すように、ロボットハンド16およびマニピュレータ18は、もはや、容器Aの側壁Aと干渉しない。そして、第1の爪部34および第2の爪部36を、ワークWの貫通孔Dの内部に適切に配置することができる。 When the robot hand 16 is positioned so that the tool coordinate system matches the position coordinate system after the resetting, the robot hand 16 and the manipulator 18 are no longer in the side wall A of the container A as shown in FIGS. No interference with 1 . Then, it is possible to the first pawl portion 34 and the second claw portion 36 is properly positioned in the through-holes D of the workpiece W t.

このように、ロボット制御部14は、ステップS2において、視覚センサ46によって検出されたワークWの位置および姿勢に基づいて、ワークWを適切に把持することができるロボットハンド16の位置および姿勢を決定する。したがって、本実施形態においては、ロボット制御部14は、ロボットハンド16の位置および姿勢を決定する配置決定部50(図2)の機能を有する。 As described above, the robot control unit 14 determines the position and posture of the robot hand 16 that can appropriately hold the workpiece W based on the position and posture of the workpiece W t detected by the visual sensor 46 in step S2. decide. Therefore, in the present embodiment, the robot control unit 14 has a function of an arrangement determining unit 50 (FIG. 2) that determines the position and posture of the robot hand 16.

再度、図5を参照して、ステップS3において、ロボット制御部14は、マニピュレータ18を制御して、ステップS2にて決定したロボットハンド16の位置および姿勢に、該ロボットハンド16を配置させる。   Referring to FIG. 5 again, in step S3, the robot control unit 14 controls the manipulator 18 to place the robot hand 16 at the position and posture of the robot hand 16 determined in step S2.

その結果、ロボットハンド16は、図10および図11に示すように、把持対象のワークWに対して位置決めされ、第1の爪部34および第2の爪部36は、ワークWの貫通孔Dの内部に挿入される。このように、本実施形態においては、ロボット制御部14は、マニピュレータを制御するマニピュレータ制御部52(図2)の機能を有する。 As a result, as shown in FIGS. 10 and 11, the robot hand 16 is positioned with respect to the workpiece W t to be grasped, and the first claw portion 34 and the second claw portion 36 penetrate the workpiece W t . It is inserted into the hole D. Thus, in this embodiment, the robot control unit 14 has the function of the manipulator control unit 52 (FIG. 2) that controls the manipulator.

ステップS4において、ロボット制御部14は、ロボットハンド16を制御してワークWを把持する。具体的には、ロボット制御部14は、爪部駆動部38に指令を送り、第1の爪部34および第2の爪部36を、互いから離れる方向へ移動させる。 In step S4, the robot control unit 14, holds the workpiece W t by controlling the robot hand 16. Specifically, the robot control unit 14 sends a command to the claw drive unit 38 to move the first claw unit 34 and the second claw unit 36 in directions away from each other.

その結果、第1の爪部34および第2の爪部36は、ワークWの貫通孔Dを画定する壁面に対して押し当てられる。これにより、ワークWは、第1の爪部34および第2の爪部36によって把持される。このように、本実施形態においては、ロボット制御部14は、ロボットハンド16を制御するロボットハンド制御部54(図2)の機能を有する。 As a result, the first claw portion 34 and the second claw portion 36 are pressed against the wall surface that defines the through hole D of the work W t . Thereby, the workpiece W t is gripped by the first claw portion 34 and the second claw portion 36. Thus, in the present embodiment, the robot control unit 14 has the function of the robot hand control unit 54 (FIG. 2) that controls the robot hand 16.

ステップS5において、ロボット制御部14は、ロボットハンド16が予め定められた姿勢となるように、マニピュレータ18を制御して該ロボットハンド16を移動させる。図12〜図14に、ステップS5にてロボットハンド16を配置させる姿勢の一例を示す。   In step S5, the robot control unit 14 moves the robot hand 16 by controlling the manipulator 18 so that the robot hand 16 assumes a predetermined posture. FIGS. 12-14 shows an example of the attitude | position which arrange | positions the robot hand 16 in step S5.

図12〜図14に示す状態においては、第1の爪部34および第2の爪部36は、略水平に配置されている。換言すれば、ロボットハンド16は、そのツール座標系のz軸およびy軸が略水平となり、且つ、ツール座標系のx軸方向が鉛直下方に一致するように、配置されている。このとき、図13に示すように、ワークWの長手方向の軸線Oは、鉛直方向(すなわち、x軸)に対して、角度θだけ傾斜している。 In the state shown in FIGS. 12-14, the 1st nail | claw part 34 and the 2nd nail | claw part 36 are arrange | positioned substantially horizontally. In other words, the robot hand 16 is arranged so that the z-axis and y-axis of the tool coordinate system are substantially horizontal, and the x-axis direction of the tool coordinate system coincides vertically downward. At this time, as shown in FIG. 13, the longitudinal axis O 2 of the workpiece W is inclined by an angle θ 2 with respect to the vertical direction (that is, the x axis).

ステップS5において、ロボット制御部14は、マニピュレータ18を制御して、ワークWを把持したロボットハンド16を、図10に示す位置から図12に示す位置へ移動させる。これとともに、ロボット制御部14は、ロボットハンド16の姿勢を、図13および図14に示す姿勢とする。 In step S5, the robot control unit 14 controls the manipulator 18, the robot hand 16 gripping the workpiece W t, it is moved to the position shown in FIG. 12 from the position shown in FIG. 10. At the same time, the robot control unit 14 sets the posture of the robot hand 16 to the posture shown in FIGS. 13 and 14.

ここで、上記したように、ワークWの貫通孔Dは、ワークWの重心から離隔した位置に形成されている。したがって、図13に示す姿勢で第1の爪部34および第2の爪部36によって貫通孔Dの壁面を把持した場合、図13中の矢印Mに示すように、原点Oを中心とした回転モーメントMが重力の作用によってワークWに発生することになる。 Here, as described above, the through hole D of the workpiece W t is formed at a position separated from the center of gravity of the workpiece W. Therefore, when the wall surface of the through hole D is gripped by the first claw portion 34 and the second claw portion 36 in the posture shown in FIG. 13, the rotation about the origin O as shown by the arrow M in FIG. 13. A moment M is generated in the workpiece W t by the action of gravity.

ステップS6において、ロボット制御部14は、ワークWが重力の作用によってロボットハンド16に対して回転するのを許容するように、ロボットハンド16を動作させる。 In step S6, the robot control unit 14 operates the robot hand 16 so as to allow the workpiece W t to rotate with respect to the robot hand 16 by the action of gravity.

このステップS6について、図7を参照して説明する。ステップS6が開始された後、ステップS21において、ロボット制御部14は、第1の爪部34および第2の爪部36を移動させる。具体的には、ロボット制御部14は、爪部駆動部38に指令を送り、第1の爪部34および第2の爪部36を、互いに接近する方向へ移動させる。   Step S6 will be described with reference to FIG. After step S6 is started, in step S21, the robot controller 14 moves the first claw part 34 and the second claw part 36. Specifically, the robot control unit 14 sends a command to the claw drive unit 38 to move the first claw unit 34 and the second claw unit 36 toward each other.

ステップS22において、ロボット制御部14は、第1の爪部34および第2の爪部36を目的位置に適切に配置したか否かを判断する。一例として、爪部駆動部38がシリンダから構成されている場合、ロボット制御部14は、このステップS22において、上述した磁気センサから、ピストンロッドに埋設された磁石の磁界に係るデータを受信する。   In step S <b> 22, the robot control unit 14 determines whether or not the first claw unit 34 and the second claw unit 36 are appropriately arranged at the target position. As an example, when the claw drive unit 38 is composed of a cylinder, the robot control unit 14 receives data relating to the magnetic field of the magnet embedded in the piston rod from the above-described magnetic sensor in step S22.

そして、ロボット制御部14は、磁気センサから受信したデータに基づいて、第1の爪部34および第2の爪部36の間の距離が予め定められた目標距離となったか否かを判断する。第1の爪部34および第2の爪部36の間の距離が目標距離となったとき、第1の爪部34および第2の爪部36は、ステップS4の終了時に比べて、所定の距離だけ、互いに僅かに接近する。   Then, the robot control unit 14 determines whether the distance between the first claw unit 34 and the second claw unit 36 has reached a predetermined target distance based on the data received from the magnetic sensor. . When the distance between the first claw part 34 and the second claw part 36 becomes the target distance, the first claw part 34 and the second claw part 36 have a predetermined distance compared to the end of step S4. Slightly closer to each other by distance.

ロボット制御部14は、第1の爪部34および第2の爪部36の間の距離が目標距離となったことを検知した場合、第1の爪部34および第2の爪部36が目的位置に適切に配置されたものと判断する。   When the robot control unit 14 detects that the distance between the first claw part 34 and the second claw part 36 has reached the target distance, the first claw part 34 and the second claw part 36 Judged to be properly positioned.

また、他の例として、爪部駆動部38がサーボモータから構成されている場合、ロボット制御部14は、このステップS22において、サーボモータが、ステップS21の開始時から、予め定められた回転数だけ第1の方向へ回転したか否かを判断する。   As another example, when the claw drive unit 38 is formed of a servo motor, the robot control unit 14 determines that the servo motor in step S22 has a predetermined rotation speed from the start of step S21. It is determined whether or not it is rotated in the first direction.

サーボモータが予め定められた回転数だけ第1の方向へ回転したとき、第1の爪部34および第2の爪部36は、ステップS4の終了時に比べて、所定の距離だけ、互いに僅かに接近する。   When the servo motor rotates in the first direction by a predetermined number of rotations, the first claw portion 34 and the second claw portion 36 are slightly different from each other by a predetermined distance compared to the end of step S4. approach.

ロボット制御部14は、サーボモータが予め定められた回転数だけ第1の方向へ回転したことを検出した場合に、第1の爪部34および第2の爪部36が目的位置に適切に配置されたものと判断する。   When the robot control unit 14 detects that the servo motor has rotated in the first direction by a predetermined number of rotations, the first claw unit 34 and the second claw unit 36 are appropriately arranged at the target position. Judge that it was done.

また、さらに他の例として、爪部駆動部38がサーボモータから構成されている場合において、ロボット制御部14は、サーボモータの負荷トルク(またはフィードバック電流)が、予め定められた目標値になったか否かを判断する。   As yet another example, when the claw drive unit 38 is configured by a servo motor, the robot control unit 14 determines that the load torque (or feedback current) of the servo motor becomes a predetermined target value. It is determined whether or not.

サーボモータの負荷トルクが該目標値になったとき、第1の爪部34および第2の爪部36は、ステップS7の終了時に比べて、所定の距離だけ、互いに僅かに接近することになる。すなわち、負荷トルクの目標値は、ステップS7の終了時における負荷トルクよりも小さい値に設定される。   When the load torque of the servo motor reaches the target value, the first claw portion 34 and the second claw portion 36 are slightly closer to each other by a predetermined distance than at the end of step S7. . That is, the target value of the load torque is set to a value smaller than the load torque at the end of step S7.

ロボット制御部14は、サーボモータの負荷トルクが目標値になったことを検出した場合に、第1の爪部34および第2の爪部36が目的位置に適切に配置されたものと判断する。なお、上述の予め定められた目標距離、サーボモータの回転数、負荷トルクの目標値は、実験的手法またはシミュレーション等によって、予め定められる。   When the robot control unit 14 detects that the load torque of the servo motor has reached the target value, the robot control unit 14 determines that the first claw unit 34 and the second claw unit 36 are appropriately arranged at the target position. . Note that the above-described predetermined target distance, servo motor speed, and load torque target value are determined in advance by an experimental method, simulation, or the like.

ロボット制御部14は、第1の爪部34および第2の爪部36を目的位置に適切に配置した(すなわちYES)と判断した場合、ステップS23へ進む。一方、ロボット制御部14は、第1の爪部34および第2の爪部36を目的位置に適切に配置されていない(すなわちNO)と判断した場合、ステップS22をループする。   If the robot control unit 14 determines that the first claw unit 34 and the second claw unit 36 are appropriately arranged at the target position (that is, YES), the process proceeds to step S23. On the other hand, when the robot control unit 14 determines that the first claw unit 34 and the second claw unit 36 are not properly disposed at the target position (that is, NO), the robot control unit 14 loops step S22.

ステップS23において、ロボット制御部14は、爪部駆動部38に指令を送り、第1の爪部34および第2の爪部36の移動を停止させる。   In step S <b> 23, the robot control unit 14 sends a command to the claw drive unit 38 to stop the movement of the first claw unit 34 and the second claw unit 36.

ステップS21〜S23を実行することによって、第1の爪部34および第2の爪部36は、所定の距離だけ互いに僅かに接近し、これにより、第1の爪部34および第2の爪部36を、ワークWの貫通孔Dを画定する壁面に押し当てる力が、低減されることになる。 By executing steps S21 to S23, the first claw portion 34 and the second claw portion 36 slightly approach each other by a predetermined distance, whereby the first claw portion 34 and the second claw portion 36, the force pressing on the wall surface defining the through hole D of the workpiece W t is, will be reduced.

ここで、上記したように、ステップS5の終了時においては、第1の爪部34および第2の爪部36は、略水平に配置されており、且つ、図13に示す回転モーメントMがワークWに発生している。 Here, as described above, at the end of step S5, the first claw portion 34 and the second claw portion 36 are disposed substantially horizontally, and the rotational moment M shown in FIG. It has occurred in the W t.

したがって、第1の爪部34および第2の爪部36を貫通孔Dの壁面に押し当てる力を低減させると、ワークWは、第1の爪部34および第2の爪部36に係止された状態で、重力の作用によって図13の矢印Mの方向へ回転することになる。 Therefore, when the force for pressing the first claw portion 34 and the second claw portion 36 against the wall surface of the through hole D is reduced, the workpiece W t is engaged with the first claw portion 34 and the second claw portion 36. In the stopped state, it rotates in the direction of arrow M in FIG. 13 by the action of gravity.

このように、本実施形態においては、第1の爪部34および第2の爪部36からワークWが脱落するのを防止しつつ、重力の作用によって、該ワークWがロボットハンド16に対して回転することが許容される。その結果、ワークWは、図15に示すように、第1の爪部34および第2の爪部36に吊り下げられた状態となる。 Thus, in the present embodiment, the work W t is applied to the robot hand 16 by the action of gravity while preventing the work W t from dropping off from the first claw part 34 and the second claw part 36. It is allowed to rotate with respect to it. As a result, the workpiece W t is suspended from the first claw portion 34 and the second claw portion 36 as shown in FIG.

この状態においては、ワークWの重心は、第1の爪部34および第2の爪部36(原点O)の鉛直下方に位置し、ワークWの長手方向の軸線Oは、ロボットハンド16のツール座標系のx軸(すなわち、鉛直方向)と平行となる。 In this state, the center of gravity of the workpiece W t is located vertically below the first claw portion 34 and the second claw portion 36 (origin O), and the longitudinal axis O 2 of the workpiece W t is It is parallel to the x axis (ie, the vertical direction) of the 16 tool coordinate systems.

また、ロボットハンド16のツール座標系のz軸は、ワークWの厚さ方向と平行となり、且つ、ツール座標系のy軸がワークWの幅方向に平行となっている。すなわち、図15に示すワークWのロボットハンド16(またはツール座標系)に対する姿勢は、図4に示す姿勢と同じとなる。 In addition, the z axis of the tool coordinate system of the robot hand 16 is parallel to the thickness direction of the workpiece W, and the y axis of the tool coordinate system is parallel to the width direction of the workpiece W. That is, the posture of the workpiece W t shown in FIG. 15 with respect to the robot hand 16 (or the tool coordinate system) is the same as the posture shown in FIG.

ステップS24において、ロボット制御部14は、ロボットハンド16に対するワークWの回転動作が終了したか否かを判断する。一例として、ロボット制御部14は、ステップS22にてYESと判断したとき、または、ステップS23が終了したときから、予め定められた時間(例えば、1秒)が経過したときに、ロボットハンド16に対するワークWの回転動作が終了したものと判断する。 In step S <b> 24, the robot control unit 14 determines whether or not the rotation operation of the work W t with respect to the robot hand 16 has been completed. As an example, when the robot control unit 14 determines YES in Step S22 or when a predetermined time (for example, 1 second) has elapsed since Step S23 is completed, the robot control unit 14 It is determined that the rotation operation of the workpiece W t has been completed.

また、他の例として、ロボット制御部14は、ステップS23の終了時から、マニピュレータ18に内蔵されたサーボモータの負荷トルクの変動を監視し、該負荷トルクの変動が収束したときに、ロボットハンド16に対するワークWの回転動作が終了したものと判断する。 As another example, the robot control unit 14 monitors the load torque variation of the servo motor built in the manipulator 18 from the end of step S23, and when the load torque variation converges, the robot hand 14 16, it is determined that the rotation operation of the work W t with respect to 16 has been completed.

また、さらに他の例として、マニピュレータ18に負荷される力を計測可能な力センサが取り付けられる。そして、ロボット制御部14は、ステップS23の終了時から、該力センサによって計測される力を監視し、該力の変動が収束したときに、ロボットハンド16に対するワークWの回転動作が終了したものと判断する。 As yet another example, a force sensor capable of measuring a force applied to the manipulator 18 is attached. Then, the robot control unit 14 monitors the force measured by the force sensor from the end of step S23, and when the fluctuation of the force has converged, the rotation operation of the work W t with respect to the robot hand 16 is completed. Judge that.

このように、図7に示すステップS6を実行することによって、ロボットハンド16に対するワークWの姿勢を、図13に示す姿勢から図15に示す姿勢に変更することができる。 Thus, by executing step S6 shown in FIG. 7, the posture of the workpiece W t with respect to the robot hand 16 can be changed from the posture shown in FIG. 13 to the posture shown in FIG.

再度、図5を参照して、ステップS7において、ロボット制御部14は、ロボットハンド16を制御して、ワークWを、ロボットハンド16に対して移動不能となるように、把持する。具体的には、ロボット制御部14は、爪部駆動部38に指令を送り、第1の爪部34および第2の爪部36を、互いから離れる方向へ移動させる。 Referring again to FIG. 5, in step S <b> 7, the robot control unit 14 controls the robot hand 16 to grip the workpiece W t so that it cannot move with respect to the robot hand 16. Specifically, the robot control unit 14 sends a command to the claw drive unit 38 to move the first claw unit 34 and the second claw unit 36 in directions away from each other.

その結果、第1の爪部34および第2の爪部36は、ステップS4と同様に、ワークWの貫通孔Dを画定する壁面に対して押し当てられる。これにより、ワークWは、図16に示すように、第1の爪部34および第2の爪部36によって移動不能に把持される。 As a result, the first pawl portion 34 and the second pawl portion 36, similarly to step S4, forced against the wall surface defining the through hole D of the workpiece W t. As a result, the work W t is gripped by the first claw portion 34 and the second claw portion 36 so as not to move, as shown in FIG.

ステップS8において、ロボット制御部14は、マニピュレータ18およびロボットハンド16を制御して、ワークWを載置台Bの上に載置する。具体的には、ロボット制御部14は、マニピュレータ18を制御して、ロボットハンド16の姿勢を、そのツール座標系のx軸およびy軸が水平となり、且つz軸方向が鉛直上方に一致する姿勢(すなわち、図4に示す姿勢)とする。 In step S <b> 8, the robot control unit 14 controls the manipulator 18 and the robot hand 16 to place the work W t on the mounting table B. Specifically, the robot control unit 14 controls the manipulator 18 to change the posture of the robot hand 16 so that the x-axis and y-axis of the tool coordinate system are horizontal and the z-axis direction coincides vertically upward. (That is, the posture shown in FIG. 4).

そして、ロボット制御部14は、ワークWを載置台Bの上に配置させる。この状態を、図17に示す。次いで、ロボット制御部14は、爪部駆動部38に指令を送り、第1の爪部34および第2の爪部36を互いに接近する方向へ移動させ、第1の爪部34および第2の爪部36を、貫通孔Dの壁面から離脱させる。これにより、ワークWは、図17に示す姿勢で、載置台Bの上に載置される。 Then, the robot control unit 14 places the work W t on the mounting table B. This state is shown in FIG. Next, the robot control unit 14 sends a command to the claw drive unit 38 to move the first claw unit 34 and the second claw unit 36 in a direction in which the first claw unit 34 and the second claw unit 36 approach each other. The claw portion 36 is detached from the wall surface of the through hole D. Thereby, the workpiece W t is placed on the placing table B in the posture shown in FIG.

ステップS9において、ロボット制御部14は、全てのワークWの取り出し作業が完了したか否かを判断する。ロボット制御部14は、容器Aから取り出すべきワークWが在る(すなわちNO)と判断した場合、ステップS1へ戻る。一方、ロボット制御部14は、全てのワークWを容器Aから取り出した(すなわち、YES)と判断した場合、図5に示すフローを終了する。   In step S9, the robot control unit 14 determines whether or not all the workpieces W have been taken out. When the robot control unit 14 determines that there is a workpiece W to be taken out from the container A (that is, NO), the robot control unit 14 returns to step S1. On the other hand, when it is determined that all the workpieces W have been taken out from the container A (that is, YES), the robot control unit 14 ends the flow shown in FIG.

本実施形態によれば、ロボット制御部14は、ステップS6において、ロボットハンド16に対するワークWの姿勢を、重力の作用によって変更している。この構成によれば、ロボットハンド16によって容器AからワークWを様々な姿勢で取り出したとしても、ロボットハンド16に対するワークWの姿勢を、容易に揃えることができる。 According to the present embodiment, the robot control unit 14 changes the posture of the work W t with respect to the robot hand 16 by the action of gravity in step S6. According to this configuration, even if the workpiece W t is taken out from the container A by the robot hand 16 in various postures, the posture of the workpiece W t with respect to the robot hand 16 can be easily aligned.

より具体的に述べると、ステップS2において、ロボット制御部14は、ロボットハンド16およびマニピュレータ18と周囲の部材とが干渉しないように、ワークWの位置座標系を設定し、該位置座標系にツール座標系を一致させるように、ロボットハンド16を配置している。この場合、容器A内にバラ積みされたワークW毎に、ロボットハンド16によって取り出したときのワークWの姿勢、すなわち、図13に示す角度θが、異なることになる。 More specifically, in step S2, the robot control unit 14 sets the position coordinate system of the workpiece W so that the robot hand 16 and the manipulator 18 do not interfere with surrounding members, and a tool is added to the position coordinate system. The robot hand 16 is arranged so that the coordinate systems match. In this case, for each rose stacked been workpiece W in the container A, the attitude of the workpiece W when taken out by the robot hand 16, i.e., the angle theta 2 shown in FIG. 13 will be different.

このように角度θが異なっていたとしても、ロボット制御部14は、ステップS6を実行することによって、ロボットハンド16に対するワークWの姿勢を、図16に示す姿勢に揃えることができる。これにより、ロボット制御部14は、ステップS8において、ワークWを載置台Bの上に同じ姿勢(向き)で載置することができる。 Even if the angle θ 2 is different in this way, the robot control unit 14 can align the posture of the workpiece W with respect to the robot hand 16 to the posture shown in FIG. 16 by executing step S6. Thereby, the robot control part 14 can mount the workpiece | work W on the mounting base B with the same attitude | position (direction) in step S8.

また、本実施形態によれば、取り出したワークWの姿勢を、重力の作用によって揃えているので、ワークWの姿勢を揃える動作のために、視覚センサ等の追加の装置を要することがない。したがって、より簡単な装置で、ワークWの姿勢を揃える動作を実行できる。   Further, according to the present embodiment, since the posture of the workpiece W taken out is aligned by the action of gravity, an additional device such as a visual sensor is not required for the operation of aligning the posture of the workpiece W. Therefore, the operation of aligning the posture of the workpiece W can be executed with a simpler apparatus.

なお、ロボット制御部14は、ステップS5において、第1の爪部34および第2の爪部36の先端部34bおよび36bが、基端部34aおよび36aよりも鉛直上方にそれぞれ位置するように、第1の爪部34および第2の爪部36を水平方向に対して傾斜して配置してもよい。   In step S5, the robot controller 14 determines that the tip portions 34b and 36b of the first claw portion 34 and the second claw portion 36 are positioned vertically above the base end portions 34a and 36a, respectively. You may arrange | position the 1st nail | claw part 34 and the 2nd nail | claw part 36 inclining with respect to a horizontal direction.

この構成によれば、ステップS6にてワークWをロボットハンド16に対して回転させたときに、ワークWが第1の爪部34および第2の爪部36から脱落してしまうのを防止することができる。 According to this arrangement, when rotating the workpiece W t to the robot hand 16 at step S6, that the workpiece W t is falls off from the first pawl portion 34 and the second claw portion 36 Can be prevented.

また、ロボット制御部14は、ステップS5において、第1の爪部34および第2の爪部36の先端部34bおよび36bを、他の部材に突き当ててもよい。このような実施形態を、図18に示す。   Further, in step S5, the robot controller 14 may abut the tip portions 34b and 36b of the first claw portion 34 and the second claw portion 36 against other members. Such an embodiment is shown in FIG.

この実施形態においては、ロボット制御部14は、ステップS5において、第1の爪部34および第2の爪部36の先端部34bおよび36bを、固定物56の外面に突き当てている。この固定物56の外面は、ワークWの貫通孔Dよりも大きな面積を有する。   In this embodiment, the robot controller 14 abuts the front end portions 34b and 36b of the first claw portion 34 and the second claw portion 36 against the outer surface of the fixed object 56 in step S5. The outer surface of the fixed object 56 has a larger area than the through hole D of the workpiece W.

この構成によれば、ステップS6にてワークWをロボットハンド16に対して回転させたときに、ワークWが第1の爪部34および第2の爪部36から脱落してしまうのを効果的に防止することができる。 According to this arrangement, when rotating the workpiece W t to the robot hand 16 at step S6, that the workpiece W t is falls off from the first pawl portion 34 and the second claw portion 36 It can be effectively prevented.

また、第1の爪部34および第2の爪部36に、ワークWの脱落を防止するための要素を形成してもよい。このような実施形態を、図19および図20に示す。本実施形態においては、ロボットハンド16’は、第1の爪部34’および第2の爪部36’を有する。 Further, an element for preventing the workpiece W t from dropping off may be formed on the first claw portion 34 and the second claw portion 36. Such an embodiment is shown in FIGS. In the present embodiment, the robot hand 16 ′ has a first claw portion 34 ′ and a second claw portion 36 ′.

第1の爪部34’および第2の爪部36’の先端部34bおよび36bには、それぞれ、外方へ突出する鉤部34cおよび36cが形成されている。本実施形態において、上述のステップS4においてロボットハンド16’がワークWを把持したとき、図20に示すように、鉤部34cおよび36cがワークWと係合する。 At the tip portions 34b and 36b of the first claw portion 34 'and the second claw portion 36', flange portions 34c and 36c projecting outward are formed, respectively. In the present embodiment, when the robot hand 16 ′ grips the workpiece W t in step S4 described above, the collar portions 34c and 36c engage with the workpiece W t as shown in FIG.

この構成によれば、ロボットハンド16’によってワークWを把持しているときに、ワークWが第1の爪部34’および第2の爪部36’から脱落してしまうのを効果的に防止することができる。 According to this configuration, when the workpiece W t is gripped by the robot hand 16 ′, it is effective that the workpiece W t falls off from the first claw portion 34 ′ and the second claw portion 36 ′. Can be prevented.

なお、上述の爪部34、34’、36、36’の外面に、ワークWとの摩擦係数を高めるために、ゴム等からなる摩擦係数増加層を形成してもよい。この構成によれば、ワークWをロボットハンド16、16’に対して回転させたときに、ワークWが爪部34、34’、36、36’から脱落してしまうのを効果的に防止することができる。   In order to increase the friction coefficient with the workpiece W, a friction coefficient increasing layer made of rubber or the like may be formed on the outer surfaces of the claw portions 34, 34 ', 36, 36'. According to this configuration, when the workpiece W is rotated with respect to the robot hands 16 and 16 ', the workpiece W is effectively prevented from falling off the claw portions 34, 34', 36 and 36 '. be able to.

また、ロボット制御部14は、上述のステップS23の後、または、ステップS21〜S23と並行して、ロボットハンド16を小さな幅で揺動するように、マニピュレータ18を制御してもよい。この構成によれば、ロボットハンド16に対してワークWが回転する動作を補助することができる。   Further, the robot control unit 14 may control the manipulator 18 so as to swing the robot hand 16 with a small width after the above-described step S23 or in parallel with steps S21 to S23. According to this configuration, the operation of rotating the workpiece W relative to the robot hand 16 can be assisted.

より具体的には、例えば、図13に示す角度θが0°である場合、ステップS21を実行したとしても、ワークWが回転しない可能性がある。このような場合において、ロボットハンド16を揺動させることによって、ワークWの回転を促進させることは、有利である。 More specifically, for example, when the angle theta 2 shown in FIG. 13 is 0 °, even if executing the step S21, there is a possibility that the workpiece W is not rotated. In such a case, it is advantageous to promote the rotation of the workpiece W by swinging the robot hand 16.

また、上述の実施形態においては、ロボットハンド16が2個の爪部34、36を有している場合について述べた。しかしながら、ロボットハンド16は、3個以上の複数の爪部を有してもよい。   In the above-described embodiment, the case where the robot hand 16 has the two claw portions 34 and 36 has been described. However, the robot hand 16 may have three or more claw portions.

以上、発明の実施形態を通じて本発明を説明したが、上述の実施形態は、特許請求の範囲に係る発明を限定するものではない。また、本発明の実施形態の中で説明されている特徴を組み合わせた形態も本発明の技術的範囲に含まれ得るが、これら特徴の組み合わせの全てが、発明の解決手段に必須であるとは限らない。さらに、上述の実施形態に、多様な変更または改良を加えることが可能であることも当業者に明らかである。   As mentioned above, although this invention was demonstrated through embodiment of invention, the above-mentioned embodiment does not limit the invention based on a claim. In addition, a combination of the features described in the embodiments of the present invention can also be included in the technical scope of the present invention, but all of these combinations of features are essential to the solution of the invention. Not exclusively. Furthermore, it will be apparent to those skilled in the art that various modifications or improvements can be added to the above-described embodiments.

また、特許請求の範囲、明細書、および図面中において示した装置、システム、プログラム、および方法における動作、手順、ステップ、工程、および段階等の各処理の実行順序は、特段「より前に」、「先立って」等と明示しておらず、また、前の処理の出力を後の処理で用いるのでない限り、任意の順序で実現しうることに留意すべきである。特許請求の範囲、明細書、および図面中の動作フローに関して、便宜上「まず、」、「次に、」、「次いで」等を用いて説明したとしても、この順で実施することが必須であることを意味するものではない。   Further, the execution order of each process such as operation, procedure, step, process, and stage in the apparatus, system, program, and method shown in the claims, the specification, and the drawings is particularly “before”. It should be noted that it may be implemented in any order unless it is explicitly stated as “prior to” or the like, and the output of the previous process is not used in the subsequent process. Even if the operation flow in the claims, the description, and the drawings is described using “first,” “next,” “next,” etc. for the sake of convenience, it is essential to implement them in this order. It doesn't mean that.

10 物品取出システム
14 ロボット制御部
16 ロボットハンド
18 マニピュレータ
46 視覚センサ
DESCRIPTION OF SYMBOLS 10 Item pick-up system 14 Robot control part 16 Robot hand 18 Manipulator 46 Visual sensor

Claims (5)

バラ積みされた物品を取り出すための物品取出システムであって、
物品を把持可能なロボットハンドと、
前記ロボットハンドを移動させるマニピュレータと、
前記物品の位置および姿勢を検出可能な視覚センサと、
前記視覚センサによって検出された前記物品の位置および姿勢に基づいて、前記物品を把持するときの前記ロボットハンドの位置および姿勢を決定する配置決定部と、
前記マニピュレータを制御して、前記配置決定部によって決定された前記ロボットハンドの位置および姿勢に該ロボットハンドを配置させるマニピュレータ制御部と、
前記ロボットハンドを制御して前記物品を把持するロボットハンド制御部と、を備え、
前記マニピュレータ制御部は、前記物品を把持した前記ロボットハンドが該物品を持ち上げたときに該物品にモーメントが生じる位置および姿勢に該ロボットハンドを配置するように、前記マニピュレータを制御し、
前記ロボットハンド制御部は、前記ロボットハンドが前記物品にモーメントが生じる前記位置および姿勢に配置されたときに前記ロボットハンドを制御して、前記ロボットハンドから前記物品が脱落するのを防止しつつ、該物品が重力の作用によって該ロボットハンドに対して回転するのを許容し、
前記物品取出システムは、前記ロボットハンド制御部が前記物品の回転を許容するために前記ロボットハンドを制御する動作を実行したときからの経過時間または前記マニピュレータに作用する力に基づいて、前記物品の回転が終了したか否かを判断する回転判断部をさらに備える、物品取出システム。
An article take-out system for taking out stacked articles,
A robot hand capable of gripping an article;
A manipulator for moving the robot hand;
A visual sensor capable of detecting the position and orientation of the article;
An arrangement determining unit that determines the position and orientation of the robot hand when gripping the article based on the position and orientation of the article detected by the visual sensor;
A manipulator control unit that controls the manipulator to place the robot hand in the position and posture of the robot hand determined by the placement determination unit;
A robot hand control unit for controlling the robot hand and gripping the article,
The manipulator control unit controls the manipulator so as to place the robot hand in a position and posture where a moment is generated in the article when the robot hand holding the article lifts the article;
The robot hand control unit controls the robot hand when the robot hand is arranged at the position and posture where the article generates moment, and prevents the article from falling off the robot hand, Allowing the article to rotate relative to the robot hand by the action of gravity;
The article take-out system is based on an elapsed time from when the robot hand control unit executes an operation to control the robot hand to allow rotation of the article or a force acting on the manipulator. An article take-out system further comprising a rotation determination unit that determines whether or not the rotation has ended.
前記回転判断部は、前記経過時間が予め定められた時間となったときに、前記物品の回転が終了したと判断する、請求項1に記載の物品取出システム。   The article extraction system according to claim 1, wherein the rotation determination unit determines that the rotation of the article has ended when the elapsed time reaches a predetermined time. 前記回転判断部は、
前記マニピュレータに作用する前記力として、該マニピュレータに内蔵されたサーボモータに掛かる負荷トルクを監視し、該負荷トルクの変動が収束したときに、前記物品の回転が終了したと判断し、または、
前記マニピュレータに取り付けられた力センサが計測する前記マニピュレータに作用する前記力を監視し、該力の変動が収束したときに、前記物品の回転が終了したと判断する、請求項1に記載の物品取出システム。
The rotation determination unit
As the force acting on the manipulator, the load torque applied to the servo motor built in the manipulator is monitored, and when the fluctuation of the load torque has converged, it is determined that the rotation of the article has ended, or
The article according to claim 1, wherein the force acting on the manipulator measured by a force sensor attached to the manipulator is monitored, and when the fluctuation of the force is converged, it is determined that the rotation of the article is finished. Take-out system.
前記ロボットハンド制御部は、前記回転判断部が前記物品の回転が終了したと判断したときに、前記ロボットハンドを制御して、前記物品が前記ロボットハンドに対して移動不能となるように該ロボットハンドによって前記物品を把持し、
前記マニピュレータ制御部は、前記ロボットハンドが前記物品を移動不能に把持したときに、前記マニピュレータを制御して、前記ロボットハンドによって把持されている前記物品を予め定められた場所まで搬送する、請求項1〜3のいずれか1項に記載の物品取出システム。
The robot hand control unit controls the robot hand when the rotation determination unit determines that the rotation of the article is finished, so that the robot cannot move relative to the robot hand. Holding the article by a hand,
The said manipulator control part controls the said manipulator when the said robot hand hold | grips the said article so that a movement is impossible, The said article currently hold | gripped by the said robot hand is conveyed to the predetermined place. The article take-out system according to any one of 1 to 3.
バラ積みされた物品をロボットハンドで把持して取り出す方法であって、
前記物品の位置および姿勢を検出することと、
検出された前記物品の位置および姿勢に基づいて、前記物品を把持するときの前記ロボットハンドの位置および姿勢を決定することと、
決定された前記ロボットハンドの位置および姿勢に該ロボットハンドを配置させることと、
前記ロボットハンドによって前記物品を把持することと、
前記物品を把持した前記ロボットハンドが該物品を持ち上げたときに該物品にモーメントが生じる位置および姿勢に該ロボットハンドを配置することと、
前記ロボットハンドが前記物品にモーメントが生じる前記位置および姿勢に配置されたときに前記ロボットハンドを制御して、前記ロボットハンドから前記物品が脱落するのを防止しつつ、該物品を重力の作用によって該ロボットハンドに対して回転させることと、
前記物品を回転させるために前記ロボットハンドを制御する動作を実行したときからの経過時間、または前記ロボットハンドを移動させるマニピュレータに作用する力に基づいて、前記物品の回転が終了したか否かを判断することと、を備える、方法。
A method of grasping and taking out stacked items with a robot hand,
Detecting the position and orientation of the article;
Determining the position and orientation of the robot hand when gripping the article based on the detected position and orientation of the article;
Placing the robot hand in the determined position and orientation of the robot hand;
Holding the article by the robot hand;
Disposing the robot hand in a position and posture where a moment is generated in the article when the robot hand holding the article lifts the article;
Controlling the robot hand when the robot hand is placed at the position and posture where the moment is generated in the article to prevent the article from falling off the robot hand, Rotating with respect to the robot hand;
Whether or not the rotation of the article has been completed based on the elapsed time from the time when the operation for controlling the robot hand is performed to rotate the article or the force acting on the manipulator that moves the robot hand. Determining.
JP2016249969A 2016-12-22 2016-12-22 Article picking system and method for picking out piled articles Active JP6426690B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2016249969A JP6426690B2 (en) 2016-12-22 2016-12-22 Article picking system and method for picking out piled articles

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2016249969A JP6426690B2 (en) 2016-12-22 2016-12-22 Article picking system and method for picking out piled articles

Related Parent Applications (1)

Application Number Title Priority Date Filing Date
JP2015098069A Division JP6117853B2 (en) 2015-05-13 2015-05-13 Article removal system and method for removing loosely stacked items

Publications (2)

Publication Number Publication Date
JP2017052094A true JP2017052094A (en) 2017-03-16
JP6426690B2 JP6426690B2 (en) 2018-11-21

Family

ID=58316773

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2016249969A Active JP6426690B2 (en) 2016-12-22 2016-12-22 Article picking system and method for picking out piled articles

Country Status (1)

Country Link
JP (1) JP6426690B2 (en)

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05127724A (en) * 1991-10-30 1993-05-25 Nippondenso Co Ltd High-speed picking device for stacked component
JPH06285783A (en) * 1992-06-15 1994-10-11 Sanyo Electric Co Ltd Automonously conveying device
JP2011011330A (en) * 2009-06-03 2011-01-20 Canon Inc Robot with camera
JP2011115930A (en) * 2009-10-26 2011-06-16 Yaskawa Electric Corp Robot device, workpiece taking-out system, and workpiece taking-out method
JP2012171018A (en) * 2011-02-17 2012-09-10 Seiko Epson Corp Robot hand, and robot device
JP2012206206A (en) * 2011-03-29 2012-10-25 Seiko Epson Corp Method for controlling robot, and robot
JP2013136141A (en) * 2011-11-30 2013-07-11 Canon Inc Grip apparatus, robot apparatus and method for controlling grip apparatus
JP2014087913A (en) * 2012-10-31 2014-05-15 Fanuc Ltd Article takeout apparatus and article takeout method
JP2015009308A (en) * 2013-06-27 2015-01-19 富士通株式会社 Determination device, determination program, and determination method
JP2015089590A (en) * 2013-11-05 2015-05-11 ファナック株式会社 Method and apparatus for taking out bulked article by using robot

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05127724A (en) * 1991-10-30 1993-05-25 Nippondenso Co Ltd High-speed picking device for stacked component
JPH06285783A (en) * 1992-06-15 1994-10-11 Sanyo Electric Co Ltd Automonously conveying device
JP2011011330A (en) * 2009-06-03 2011-01-20 Canon Inc Robot with camera
JP2011115930A (en) * 2009-10-26 2011-06-16 Yaskawa Electric Corp Robot device, workpiece taking-out system, and workpiece taking-out method
JP2012171018A (en) * 2011-02-17 2012-09-10 Seiko Epson Corp Robot hand, and robot device
JP2012206206A (en) * 2011-03-29 2012-10-25 Seiko Epson Corp Method for controlling robot, and robot
JP2013136141A (en) * 2011-11-30 2013-07-11 Canon Inc Grip apparatus, robot apparatus and method for controlling grip apparatus
JP2014087913A (en) * 2012-10-31 2014-05-15 Fanuc Ltd Article takeout apparatus and article takeout method
JP2015009308A (en) * 2013-06-27 2015-01-19 富士通株式会社 Determination device, determination program, and determination method
JP2015089590A (en) * 2013-11-05 2015-05-11 ファナック株式会社 Method and apparatus for taking out bulked article by using robot

Also Published As

Publication number Publication date
JP6426690B2 (en) 2018-11-21

Similar Documents

Publication Publication Date Title
JP6117853B2 (en) Article removal system and method for removing loosely stacked items
KR101795847B1 (en) Method for programming an industrial robot and related industrial robot
EP3457241A1 (en) Gripping device and conveying apparatus
JP5304469B2 (en) Bin picking system
JP5616478B1 (en) Robot system equipped with a robot for transporting workpieces
JP6725565B2 (en) Robot hand capable of gripping a work, a robot, a robot system, and a method of inserting a work into a hole
JP2018176334A5 (en)
US20150127141A1 (en) Robot, control device, robot system and robot control method
JP5522298B2 (en) Bin picking system
JP5895346B2 (en) Robot, robot control apparatus, robot control method, and robot control program
US10507584B2 (en) Fixture manipulation systems and methods
JP6741222B2 (en) Robot work transfer method and work transfer device
CN106625654B (en) Robot control device, robot system and method thereof
JP2009255191A (en) Robot manipulator
JP2015085497A (en) Robot, robot system and controller
JP2007222951A5 (en)
JP2014512979A (en) Method and apparatus for moving and positioning a gripping unit, and a robot including the gripping unit
JP6696341B2 (en) Control method
KR20160144424A (en) Method for handling an object by means of a manipulator and by means of an input tool
JP6387599B2 (en) Robot, robot system, control apparatus and control method
JP6916157B2 (en) Robot systems that collaborate with people and robot control methods
JP2015186834A (en) Robot control apparatus, holding unit control device, robot, holding unit, robot control method and program
JP6325507B2 (en) Method of fitting a fitting part and a fitting part by a robot
JP6426690B2 (en) Article picking system and method for picking out piled articles
JP2017056525A (en) Robot device robot control method, program, recording medium, and method of manufacturing assembling component

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20170118

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20171108

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20171121

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20180118

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20180403

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20180518

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20181025

R150 Certificate of patent or registration of utility model

Ref document number: 6426690

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150