Work Picking System

FIELD

0001The embodiments discussed herein are directed to a work picking system.

BACKGROUND

0002Conventionally, there is known a work picking system that performs an operation of gripping and moving works, which are randomly piled up, by a hand provided on a terminal movable unit of a multi-axis robot, that is, a pick operation.

0003This work picking system determines a work to be gripped next by measuring each position of works by using a two-dimensional measuring instrument or a three-dimensional measuring instrument and instructs a multi-axis robot to grip the determined work. Then, the multi-axis robot transfers the gripped work to a predetermined position.

0004Examples of documents related to the above-described conventional technology include Japanese Patent Laid-open Publication No. <patcit id="pcit0001" dnum="JP2010120141A"><text>2010-120141</text></patcit>.

0005However, the above-described conventional work picking system has a problem in that the gripping attitude of a work gripped by a hand varies. Therefore, the conventional work picking system is difficult to perform an operation subsequent to the pick operation.

0006For example, when the gripping attitude of a work gripped by a hand varies, the attitude of the hand itself needs to be changed for changing the attitude of a work to a predetermined attitude, so that the operation of the multi-axis robot becomes complicated.

0007An object of an aspect of the embodiments is to provide a work picking system capable of maintaining a fixed work gripping attitude regardless of the attitude of a work to be a gripping target.

SUMMARY

0008A work picking system according to an aspect of embodiments includes a three-dimensional measuring unit, a hand, a calculating unit, a determining unit, and an instructing unit. The three-dimensional measuring unit measures a three-dimensional shape of a work that is a gripping target. The hand is provided on a terminal movable unit of a multi-axis robot and includes a mechanism that changes a distance between gripping claws and a mechanism that changes a tip end direction of the gripping claws. The calculating unit calculates an attitude of the work based on the three-dimensional shape measured by the three-dimensional measuring unit. The determining unit determines a tip end direction of the gripping claws based on the attitude of the work calculated by the calculating unit and a direction of a rotation axis of the terminal movable unit. The instructing unit instructs to perform an operation of gripping the work while maintaining the direction of the rotation axis of the terminal movable unit and the tip end direction of the gripping claws determined by the determining unit.

0009According to an aspect of the embodiments, it is possible to provide a work picking system capable of performing a pick operation in which the work gripping attitude is maintained to a fixed attitude regardless of the attitude of a work to be a gripping target.

BRIEF DESCRIPTION OF DRAWINGS

0010A more complete appreciation of the invention and many of the attendant advantages thereof will be readily obtained as the same becomes better understood by reference to the following detailed description when considered in connection with the accompanying drawings, wherein:

0011<figref idref="f0001">FIG. 1</figref> is an explanatory diagram of a work picking method according to a first embodiment;

0012<figref idref="f0002">FIG. 2</figref> is a block diagram of a work picking system according to the first embodiment;

0013<figref idref="f0003">FIG. 3</figref> is an arrangement diagram of the work picking system according to the first embodiment;

0014<figref idref="f0004">FIG. 4</figref> is an explanatory diagram of each axis of a seven-axis robot;

0015<figref idref="f0005">FIG. 5A to FIG. 5C</figref> are diagrams illustrating a schematic configuration of a hand;

0016<figref idref="f0006">FIG. 6A and FIG. 6B</figref> are diagrams illustrating a configuration example of the hand;

0017<figref idref="f0007">FIG. 7A and FIG. 7B</figref> are diagrams illustrating an example of a pick operation by the hand;

0018<figref idref="f0008">FIG. 8A and FIG. 8B</figref> are diagrams illustrating a measurement position and a pick position;

0019<figref idref="f0009">FIG. 9</figref> is a flowchart illustrating a process procedure performed by the work picking system according to the first embodiment;

0020<figref idref="f0010">FIG. 10</figref> is a diagram illustrating arrangement of a three-dimensional measuring unit according to a second embodiment; and

0021<figref idref="f0011">FIG. 11</figref> is a flowchart illustrating a process procedure performed by a work picking system according to the second embodiment.

DESCRIPTION OF EMBODIMENTS

0022Hereinafter, explanation is given for an embodiment in a case of providing a three-dimensional measuring instrument to be fixed separately from a multi-axis robot as a first embodiment and an embodiment in a case of providing a three-dimensional measuring instrument in a multi-axis robot as a second embodiment.

0023First, a work picking method according to the first embodiment is explained with reference to <figref idref="f0001">FIG. 1. FIG. 1</figref> is an explanatory diagram of the work picking method according to the first embodiment. In the followings, a case in which a work 100 to be a gripping target is a bolt is explained, however, the type of the work 100 is not limited to this. For example, the work 100 may be a nut or an electronic component.

0024<figref idref="f0001">FIG. 1</figref> illustrates a case where a measuring direction by a three-dimensional measuring instrument is vertically downward (hereinafter, described as vertical direction). Moreover, in <figref idref="f0001">FIG. 1</figref>, for easy understanding of the explanation, an xy coordinate system that is a Cartesian coordinate system is provided on a horizontal plane and a line obtained by projecting a reference axis (in this embodiment, an axis connecting axis centers of a bolt) of the work 100 onto the horizontal plane is a y axis.

0025As shown in <figref idref="f0001">FIG. 1</figref>, in the work picking method according to the first embodiment, an operation (pick operation) of gripping and moving the work 100 by a hand provided on a terminal movable unit (refer to an arm shown in <figref idref="f0001">FIG. 1</figref>) of a multi-axis robot is performed.

0026The hand includes a pair of gripping claws capable of changing a tip end direction and maintains a relative attitude of the gripping claws and the work 100 to a fixed attitude by appropriately changing the tip end direction of the gripping claws according to the attitude of the work 100 to be picked.

0027A pair of the gripping claws rotates around an axis AXp (hereinafter, described as pick axis AXp) shown in <figref idref="f0001">FIG. 1</figref> to change the tip end direction of the gripping claws to any direction. The arm, to which the hand is attached, rotates around an axis AXt shown in <figref idref="f0001">FIG. 1</figref>, however, the axis AXt is controlled to maintain an attitude approximately parallel to the vertical direction.

0028That is, in the work picking method according to the first embodiment, the pick operation is performed in which the angle that the tip end direction of the gripping claws of the hand forms with the reference axis of the work 100 is constant (for example, 90°) while maintaining the rotation axis of the terminal movable unit of the multi-axis robot to be approximately parallel to the vertical direction.

0029Therefore, according to the work picking method in the first embodiment, the attitude of the work 100 with respect to the gripping claws can be maintained to a fixed attitude during each pick operation, so that the next work (for example, work of inserting a shaft of a bolt into a hole) related to the gripped work 100 can be easily performed.

0030Moreover, according to the work picking method in the first embodiment, the direction of the rotation axis of the arm, on which the hand is provided, can be maintained approximately parallel to the vertical direction, so that the arm does not easily come into contact with an obstacle (for example, a vessel in which the works 100 are piled up in bulk).

0031The procedure of the work picking method according to the first embodiment is explained below. As shown in <figref idref="f0001">FIG. 1</figref>, in the work picking method according to the first embodiment, the works 100 piled up in bulk are three-dimensionally measured, and the work 100 to be a pick target is determined and the position and the attitude of the work 100 are obtained (see Step Sa in <figref idref="f0001">FIG. 1</figref>). The angle between the reference axis of the work 100 and the horizontal plane is θ as shown in <figref idref="f0001">FIG. 1</figref>.

0032In this case, in the work picking method according to the first embodiment, the arm is rotated around the axis AXt so that the pick axis AXp becomes approximately parallel to the x axis shown in <figref idref="f0001">FIG. 1</figref> (see Step Sb1 in <figref idref="f0001">FIG. 1</figref>). Moreover, in the work picking method according to the embodiment, the gripping claws are rotated around the pick axis AXp according to the attitude of the work 100 (see Step Sb2 in <figref idref="f0001">FIG. 1</figref>).

0033As shown in <figref idref="f0001">FIG. 1</figref>, if the angle between the tip end direction of the gripping claws and the axis AXt as the rotation axis of the arm is made equal to θ described above, the tip end direction of the gripping claws and the reference axis of the work 100 can be made orthogonal to each other.

0034In <figref idref="f0001">FIG. 1</figref>, the pick operation in which the tip end direction of the gripping claws and the reference axis of the work 100 are orthogonal to each other is exemplified, however, the pick operation may be performed so that the angle between the tip end direction of the gripping claws and the reference axis of the work 100 becomes a predetermined angle α. In this case, it is sufficient that the gripping claws are rotated around the pick axis AXp so that the angle between the tip end direction of the gripping claws and the axis AXt becomes "θ+α" or "θ-α".

0035As for the execution sequence of the procedures at Step Sb1 and Step Sb2 shown in <figref idref="f0001">FIG. 1</figref>, any of the procedures may be performed first and the two procedures may be performed in parallel.

0036In this manner, in the work picking method according to the first embodiment, the work 100 is gripped by a gripping operation of narrowing the distance between a pair of the gripping claws after appropriately adjusting the tip end direction of the gripping claws according to the attitude of the work 100 (see Step Sc in <figref idref="f0001">FIG. 1</figref>).

0037Next, a work picking system 1 according to the first embodiment is explained. <figref idref="f0002">FIG. 2</figref> is a block diagram of the work picking system 1 according to the first embodiment. As shown in <figref idref="f0002">FIG. 2</figref>, the work picking system 1 includes a three-dimensional measuring unit 10, a hand 20, a robot 30, and a control device 40. The hand 20 is a hand with the pick axis shown in <figref idref="f0001">FIG. 1</figref>.

0038The control device 40 includes a control unit 41 and a storing unit 42, and the control unit 41 includes a three-dimensional information obtaining unit 41a, a work attitude calculating unit 41b, a gripping claw direction determining unit 41c, and an instructing unit 41d. The storing unit 42 includes three-dimensional information 42a and work information 42b.

0039In <figref idref="f0002">FIG. 2</figref>, the hand 20 and the robot 30 are illustrated as independent components, however, the hand 20 may be included in the robot 30 and the instructing unit 41d of the control device 40 may instruct the robot 30 also for an instruction to the hand 20. Moreover, in <figref idref="f0002">FIG. 2</figref>, one control device 40 is illustrated, however, the control device 40 may be a plurality of independent devices and the devices may be configured to communicate with each other.

0040The three-dimensional measuring unit 10 is a device (three-dimensional measuring instrument) that measures a three-dimensional shape of the work 100. As the three-dimensional measuring unit 10, for example, it is possible to use a measuring unit that obtains a three-dimensional shape of an object by a scan operation using a laser slit light.

0041As shown in <figref idref="f0001">FIG. 1</figref>, the hand 20 is a hand with the pick axis that performs the gripping operation with a pair of the gripping claws capable of appropriately changing the tip end direction. The specific configuration example of the hand is described later with reference to <figref idref="f0006">FIG. 6A and FIG. 6B</figref>. The robot 30 is, for example, a multi-axis robot having seven axes and the hand 20 is provided on the terminal movable unit. In other words, the robot 30 is a general-purpose robot capable of replacing an end effector such as a hand.

0042The arrangement example of the work picking system 1 according to the first embodiment and each axis of the robot 30 according to the first embodiment are explained with reference to <figref idref="f0003">FIG. 3</figref> and <figref idref="f0004">FIG. 4</figref>, respectively. <figref idref="f0003">FIG. 3</figref> is an arrangement diagram of the work picking system 1 according to the first embodiment. As shown in <figref idref="f0003">FIG. 3</figref>, the three-dimensional measuring unit 10 is fixed via a stand 11 (supporting unit) so that a measuring area is on the vertical direction (vertically downward) side.

0043Moreover, as shown in <figref idref="f0003">FIG. 3</figref>, the robot 30 is so-called dual-arm robot including a right arm 30a and a left arm 30b as a double arm. Each of the right arm 30a and the left arm 30b is a multi-axis robot (seven-axis robot in <figref idref="f0003">FIG. 3</figref>) and the above-described hand 20 (hand with the pick axis) is provided as an end effector of the left arm 30b.

0044A predetermined end effector is provided on the right arm 30a to grip a vessel 200 in which the works 100 are piled up in bulk. In this manner, the robot 30 performs an operation of taking out the work 100 from the vessel 200, which is gripped by the right arm 30a, by the hand 20 provided on the left arm 30b.

0045The robot 30 includes a mechanism of causing a trunk portion 30c, on which the right arm 30a and the left arm 30b are provided, to pivot along a horizontal plane with respect to a supporting portion 30d fixed to, for example, a floor.

0046<figref idref="f0004">FIG. 4</figref> is an explanatory diagram of each axis of the seven-axis robot. As for the direction of the rotation axis of each joint shown in <figref idref="f0004">FIG. 4</figref>, the rotation axis of a joint indicated by a circle is vertical to the paper surface and the rotation axis of a joint indicated by a rectangle is parallel to the paper surface. In <figref idref="f0004">FIG. 4</figref>, the rotation direction of each joint is indicated by a double-headed arrow. Each of the right arm 30a and the left arm 30b shown in <figref idref="f0003">FIG. 3</figref> can be the seven-axis robot shown in <figref idref="f0004">FIG. 4</figref>.

0047As shown in <figref idref="f0004">FIG. 4</figref>, the rotation axes of the joints are an axis AXs, an axis AXl, an axis AXe, an axis AXu, an axis AXr, an axis AXb, and the axis AXt in order from the arrangement reference plane. The axis AXt corresponds to the rotation axis of the terminal movable unit of the seven-axis robot and an end effector is provided on the terminal movable unit. The axis configuration of the right arm 30a and the left arm 30b is not limited to the configuration exemplified in <figref idref="f0004">FIG. 4</figref>.

0048The left arm 30b (see <figref idref="f0003">FIG. 3</figref>), on which the hand 20 (see <figref idref="f0003">FIG. 3</figref>) is provided, according to the first embodiment performs the pick operation by the hand 20 in a state where the axis AXt is maintained approximately parallel to the vertical direction.

0049Returning to the explanation of <figref idref="f0002">FIG. 2</figref>, the control device 40 is explained. The control unit 41 performs overall control of the control device 40. The three-dimensional information obtaining unit 41a receives measured data from the three-dimensional measuring unit 10 and causes the storing unit 42 to store therein the received measured data as the three-dimensional information 42a. The three-dimensional information 42a is information indicating the three-dimensional shape of one or a plurality of the works 100.

0050The work attitude calculating unit 41b performs a process of calculating the attitude of the work 100 to be a target for the pick operation based on the three-dimensional information 42a and the work information 42b. The work information 42b is information defining the three-dimensional shape and a gripped part of the work 100.

0051For example, when the work 100 is a bolt, a shaft near the head portion of the bolt is defined as the gripped part. Space tends to be generated near the head portion in a state where bolts are piled up in bulk, so that the shaft near the head portion of the bolt is defined as the gripped part in the above manner.

0052The work attitude calculating unit 41b detects the works 100 from the three-dimensional information 42a by performing a matching process using the work information 42b. Then, the work attitude calculating unit 41b determines the work 100 to be picked next from the detected works 100 and calculates the attitude of the determined work 100. The work attitude calculating unit 41b also calculates the position of the gripped part in the work 100.

0053Then, the gripping claw direction determining unit 41c determines the tip end direction of the gripping claws of the hand 20 based on the attitude of the work 100 calculated by the work attitude calculating unit 41b. Moreover, the gripping claw direction determining unit 41c notifies the work attitude calculating unit 41b of the determined tip end direction.

0054The schematic configuration of the hand 20 (hand with the pick axis) is explained with reference to <figref idref="f0005">FIG. 5A, FIG. 5B, and FIG. 5C. FIG. 5A to FIG. 5C</figref> are diagrams illustrating the schematic configuration of the hand 20. <figref idref="f0005">FIG. 5A</figref> illustrates the schematic configuration of the hand 20, <figref idref="f0005">FIG. 5B</figref> illustrates a state where the tip end direction of the gripping claws is changed, and <figref idref="f0005">FIG. 5C</figref> illustrates the relationship between a reference axis 101 in the work 100 and the tip end direction of the gripping claws.

0055As shown in <figref idref="f0005">FIG. 5A</figref>, the hand 20 includes a pair of moving units 22 that respectively include a slider 21a and a slider 21b capable of moving along a slide axis 21. A gripping claw 24 is attached to each moving unit 22 via a joint 23. The tip end of the gripping claw 24 is a point 24a.

0056A pair of the gripping claws 24 grips the work 100 by a pair of the moving units 22 performing an operation of moving toward each other along the slide axis 21 and a pair of the gripping claws 24 release the gripped work 100 by the moving units 22 performing an operation of moving away from each other.

0057Moreover, as shown in <figref idref="f0005">FIG. 5A</figref>, the gripping claw 24 rotates in a direction indicated by a double-headed arrow around the joint 23 as a supporting point. The line connecting two joints 23 is the above-described pick axis AXp. Moreover, <figref idref="f0005">FIG. 5A</figref> illustrates a state where the moving unit 22 and the gripping claw 24 are on one straight line, that is, a reference attitude of the gripping claw 24.

0058<figref idref="f0005">FIG. 5B</figref> exemplifies a state where a pair of the gripping claws 24 is rotated by a predetermined angle around the pick axis AXp from the reference attitude shown in <figref idref="f0005">FIG. 5A</figref>. The plane including the pick axis AXp and two points 24a (each tip end of the gripping claws 24) is defined as a plane 50 and the normal of the plane 50 is defined as a normal 51.

0059In this case, as shown in <figref idref="f0005">FIG. 5C</figref>, when the hand 20 grips the work 100, the tip end direction of the gripping claws 24 is adjusted so that the normal 51 and the reference axis 101 of the work 100 are approximately parallel to each other. With this adjustment, the work 100 can be gripped in a state where the direction of the gripping claws 24 is approximately orthogonal to the reference axis 101 of the work 100.

0060<figref idref="f0005">FIG. 5C</figref> illustrates a case where the direction of the gripping claws 24 is made approximately orthogonal to the reference axis 101 of the work 100, however, the angle between the direction of the gripping claws 24 and the reference axis 101 of the work 100 can be any angle.

0061Returning to the explanation of <figref idref="f0002">FIG. 2</figref>, the explanation of the control device 40 is continued. The instructing unit 41d indicates to the hand 20 the gripping claw direction determined by the gripping claw direction determining unit 41c. Moreover, the instructing unit 41d instructs the robot 30 to move the hand 20 in association with the pick operation.

0062The instructing unit 41d instructs the robot 30 to maintain the attitude in which the rotation axis (see the axis AXt in <figref idref="f0001">FIG. 1</figref>) of the terminal movable unit, to which the hand 20 is attached, is approximately parallel to the vertical direction. Moreover, the instructing unit 41d appropriately performs a measurement start instruction to the three-dimensional measuring unit 10. The timing of the measurement start instruction is described later with reference to <figref idref="f0008">FIG. 8A and FIG. 8B</figref>.

0063The storing unit 42 is a storage device such as a hard disk drive and a nonvolatile memory and stores therein the three-dimensional information 42a and the work information 42b. The content of the three-dimensional information 42a and the work information 42b is already explained, so that the explanation thereof is omitted here.

0064In <figref idref="f0002">FIG. 2</figref>, the control device 40 is explained as one device, however, the control device 40 may be configured as a plurality of independent devices. For example, the configuration may be such that a measurement control device that controls the three-dimensional measuring unit 10, a robot control device that controls the hand 20 and the robot 30, and an integrated control device that integrally controls the measurement control device and the robot control device communicate with each other.

0065Next, the configuration example of the hand 20 (hand with the pick axis) is explained with reference to <figref idref="f0006">FIG. 6A and FIG. 6B. FIG. 6A and FIG. 6B</figref> are diagrams illustrating the configuration example of the hand 20. <figref idref="f0006">FIG. 6A</figref> illustrates the hand 20 in a state of being attached to the left arm 30b (see <figref idref="f0003">FIG. 3</figref>) and <figref idref="f0006">FIG. 6B</figref> illustrates the configuration example of the hand 20.

0066As shown in <figref idref="f0006">FIG. 6A</figref>, the hand 20 is attached to a terminal movable unit 31 of the left arm 30b. The above-described pick axis AXp in the hand 20 is approximately orthogonal to the axis AXt as the rotation axis of the terminal movable unit 31.

0067As shown in <figref idref="f0006">FIG. 6B</figref>, the hand 20 includes a first servo motor 61a used for opening and closing of the gripping claws 24 and a second servo motor 62a used for changing the tip end direction of the gripping claw 24. Moreover, the hand 20 includes a pair of the moving units 22 and a pair of the gripping claws 24.

0068The driving force by the first servo motor 61a is transmitted to a right and left threaded shaft 21 (an example of a slide axis 21 in <figref idref="f0005">Fig. 5A</figref>) via a transmission mechanism 61b. One end side and the other end side of the right and left threaded shaft 21 are threaded (right and left threads) in opposite directions.

0069A pair of the moving units 22 has holes, through which the right and left threaded shaft 21 passes, respectively, and the holes are threaded in the same direction. Therefore, the moving units 22 move in directions opposite to each other along the right and left threaded shaft 21 with the rotation of the right and left threaded shaft 21.

0070The driving force by the second servo motor 62a is transmitted to a not-shown spline shaft via a transmission mechanism 62b. Then, a link mechanism 62d, which operates with the rotation of the spline shaft, rotates circular disks 23 (an example of a joint 23 in <figref idref="f0005">Fig. 5A</figref>) connected to the gripping claws 24 at the pick axis AXp. Consequently, the gripping claws 24 rotate around the pick axis AXp and the tip end direction of the gripping claws 24 is changed.

0071In this manner, the distance between a pair of the gripping claws 24 and the tip end direction of the gripping claws 24 are changed by the servo motors, respectively, so that the work 100 can be gripped in an appropriate attitude and with an appropriate gripping force. Moreover, the thickness (for example, shaft diameter of a bolt) at the gripped part of the work 100 can be obtained.

0072Next, the pick operation by the hand 20 (hand with the pick axis) is explained with reference to <figref idref="f0007">FIG. 7A and FIG. 7B. FIG. 7A and FIG. 7B</figref> are diagrams illustrating an example of the pick operation by the hand 20. <figref idref="f0007">FIG. 7A</figref> illustrates an operation example of the gripping claws 24 gripping the work 100 and <figref idref="f0007">FIG. 7B</figref> illustrates the positional relationship between the vessel 200 and the gripping claws 24.

0073In <figref idref="f0007">FIG. 7A and FIG. 7B</figref>, the pick axis AXp is vertical to the paper surface for simplifying the explanation.

0074As shown in <figref idref="f0007">FIG. 7A</figref>, in a state where the axis AXt, which is the rotation axis of the terminal movable unit 31, is made approximately parallel to the vertical direction, the gripping claws 24 grip the work 100 in an attitude orthogonal to the reference axis 101 of the work 100. Therefore, the reference axis 101 of the work 100 becomes approximately orthogonal to the axis AXt by changing the tip end direction of the gripping claws 24 gripping the work 100 to be approximately parallel to the axis AXt.

0075In this manner, even when the works 100 are piled up in bulk in various attitudes, the hand 20 can grip the work 100 in a fixed gripping attitude while maintaining the attitude of the terminal movable unit 31. Moreover, the hand 20 can change the attitude of the work 100 after being gripped to a fixed attitude (for example, horizontal state) in a state of maintaining the attitude of the terminal movable unit 31.

0076Moreover, as shown in <figref idref="f0007">FIG. 7B</figref>, the hand 20 can take out the work 100 located near the wall surface of the vessel 200 without the left arm 30b (see <figref idref="f0003">FIG. 3</figref>) and the hand 20 coming into contact with the vessel 200.

0077For example, when gripping the work 100 near the left-side wall surface in <figref idref="f0007">FIG. 7B</figref>, the tip end direction of the gripping claws 24 is changed so that the tip end side of the gripping claws 24 comes close to the left-side wall surface in a state where the hand 20 is positioned in a position 71. Moreover, when gripping the work 100 near the right-side wall surface in <figref idref="f0007">FIG. 7B</figref>, the tip end direction of the gripping claws 24 is changed so that the tip end side of the gripping claws 24 comes close to the right-side wall surface in a state where the hand 20 is positioned in a position 72.

0078Next, explanation is given for an example of an instruction by the instructing unit 41d of the control device 40 with reference to <figref idref="f0008">FIG. 8A and FIG. 8B. FIG. 8A and FIG. 8B</figref> are diagrams illustrating a measurement position and a pick position. <figref idref="f0008">FIG. 8A</figref> illustrates a case where a measurement position and a pick position are arranged on a vertical line and <figref idref="f0008">FIG. 8B</figref> illustrates a case where a measurement position and a pick position are arranged on a horizontal line. Moreover, <figref idref="f0008">FIG. 8A and FIG. 8B</figref> each illustrate a measuring direction 81 by the three-dimensional measuring unit 10.

0079As shown in <figref idref="f0008">FIG. 8A</figref>, the instructing unit 41d instructs the right arm 30a gripping the vessel 200 to position the vessel 200 in a measurement position 82 provided in a measurement range of the three-dimensional measuring unit 10.

0080Next, the instructing unit 41d performs a measurement start instruction on the three-dimensional measuring unit 10. When measurement by the three-dimensional measuring unit 10 is completed, the instructing unit 41d instructs the right arm 30a to position the vessel 200 in a pick position 83 by moving the vessel 200 in the vertical direction (vertically downward).

0081A distance hs (distance from the three-dimensional measuring unit 10 to the reference position of the vessel 200) corresponding to the measurement position 82 is shorter than a distance hp corresponding to the pick position 83. This is for ensuring workspace of the left arm 30b that performs the pick operation while performing measurement in a distance in which a measuring accuracy by the three-dimensional measuring unit 10 is ensured.

0082Moreover, the pick position 83 is provided in the vertical direction (vertically downward) of the measurement position 82 for preventing displacement of the works 100 in the vessel 200.

0083Moreover, as shown in <figref idref="f0008">FIG. 8B</figref>, the vessel 200 for which measurement by the three-dimensional measuring unit 10 is completed at the measurement position 82 may be positioned in a pick position 84 or a pick position 85 by horizontally moving the vessel 200. In this case, the instructing unit 41d instructs the robot 30 to cause the trunk portion 30c shown in <figref idref="f0003">FIG. 3</figref> to pivot.

0084In this manner, the workspace of the left arm 30b that performs the pick operation can be ensured also by horizontally moving the vessel 200.

0085Next, the process procedure performed by the work picking system 1 according to the first embodiment is explained with reference to <figref idref="f0009">FIG. 9. FIG. 9</figref> is a flowchart illustrating the process procedure performed by the work picking system 1 according to the first embodiment. In <figref idref="f0009">FIG. 9</figref>, a right hand indicates the hand provided on the right arm 30a in <figref idref="f0003">FIG. 3</figref> and a left hand indicates the hand 20 (hand with the pick axis) provided on the left arm 30b in <figref idref="f0003">FIG. 3</figref>.

0086As shown in <figref idref="f0009">FIG. 9</figref>, the instructing unit 41d instructs to position the vessel 200 in a measurement position by the right hand (Step S101). Moreover, the instructing unit 41d instructs the three-dimensional measuring unit 10 to perform three-dimensional measurement (Step 5102).

0087Next, the work attitude calculating unit 41b determines whether there is the work 100 that can be gripped (Step 5103). When there is the work 100 that can be gripped (Yes at Step S103), the gripping claw direction determining unit 41c determines the tip end direction of the gripping claws in the hand 20 based on the work attitude (Step S104).

0088Then, the instructing unit 41d instructs to position the vessel 200 in a pick position by the right hand (Step S105) and instructs to grip the work 100 by the left hand (hand 20) (Step S106). Next, the instructing unit 41d instructs to transfer the work 100 by the left hand (Step S107) and determines whether transfer of required works has completed (Step S108).

0089When transfer of the required works has completed (Yes at Step S108), the process ends. On the other hand, when transfer of the required works has not completed (No at Step S108), the process at Step S101 and the following steps is repeated. The required works, for example, indicate the total number of the works 100 to be transferred for each type.

0090When it is determined that there is no work 100 that can be gripped at Step S103 (No at Step S103), it is determined whether a remaining work (the number or total weight of the works 100) in the vessel 200 is less than a defined value (Step S109). When the remaining work is less than the defined value (Yes at Step S109), the error is reported (Step S110) and the process ends.

0091On the other hand, when the determination condition at Step S109 is not satisfied (No at Step S109), the instructing unit 41d instructs to swing the vessel 200 by the right hand (Step S111) and the process at Step S102 and the following steps is repeated. The positions of the works 100 in the vessel 200 change by swinging the vessel 200, so that the number of the works 100 that can be gripped can be increased.

0092Transfer of the work 100 by the left hand (Step S107) and movement of the vessel 200 to the measurement position by the right hand (Step S101) shown in <figref idref="f0009">FIG. 9</figref> may be performed in parallel.

0093As described above, the work picking system according to the first embodiment includes a three-dimensional measuring unit that measures a three-dimensional shape of a work as a gripping target and a hand that is provided on a terminal movable unit of a multi-axis robot and includes a mechanism that changes the distance between gripping claws and a mechanism that changes the tip end direction of the gripping claws. Moreover, the work picking system according to the first embodiment includes a calculating unit that calculates the attitude of a work based on the three-dimensional shape measured by the three-dimensional measuring unit and a determining unit that determines the tip end direction of the gripping claws based on the attitude of the work calculated by the calculating unit and a direction of a rotation axis of the terminal movable unit. Furthermore, the work picking system according to the first embodiment includes an instructing unit that instructs to perform an operation of gripping a work while maintaining the direction of the rotation axis of the terminal movable unit and the tip end direction of the gripping claws determined by the determining unit.

0094Therefore, according to the work picking system in the first embodiment, the work gripping attitude can be maintained to a fixed attitude without changing the attitude of the hand itself regardless of the attitude of a work to be a gripping target.

0095In the above first embodiment, the case of providing the three-dimensional measuring unit to be fixed separately from the multi-axis robot is explained, however, the three-dimensional measuring instrument may be provided on the multi-axis robot. In a second embodiment described below, a case where the three-dimensional measuring instrument is provided on the multi-axis robot is explained.

0096<figref idref="f0010">FIG. 10</figref> is a diagram illustrating arrangement of the three-dimensional measuring unit 10 according to the second embodiment. <figref idref="f0010">FIG. 10</figref> corresponds to <figref idref="f0006">FIG. 6A</figref> and is similar to <figref idref="f0006">FIG. 6A</figref> except for the point that the three-dimensional measuring unit 10 is provided on the terminal movable unit 31 of the left arm 30b, so that explanation common to both of them is omitted below.

0097As shown in <figref idref="f0010">FIG. 10</figref>, the three-dimensional measuring unit 10 is provided on the terminal movable unit 31 to which the hand 20 is attached. The three-dimensional measuring unit 10 may be provided on a part that rotates around the axis AXt together with the hand 20 or may be provided on a part that does not rotate around the axis AXt.

0098Moreover, as shown in <figref idref="f0010">FIG. 10</figref>, the three-dimensional measuring unit 10 is fixed to the terminal movable unit 31 so that the measuring direction 81 is directed to the tip end side of the hand 20. In this manner, the operation of the robot 30 related to the pick operation can be further simplified by providing the three-dimensional measuring unit 10 on the multi-axis robot including the hand 20.

0099Moreover, even when the measurement range of the three-dimensional measuring unit 10 is narrow, the work 100 can be easily positioned in the measurement range.

0100Next, the process procedure performed by the work picking system 1 according to the second embodiment is explained with reference to <figref idref="f0011">FIG. 11. FIG. 11</figref> is a flowchart illustrating the process procedure performed by the work picking system 1 according to the second embodiment. A right hand and a left hand in <figref idref="f0011">FIG. 11</figref> are similar to those explained with reference to <figref idref="f0009">FIG. 9</figref>, however, as shown in <figref idref="f0010">FIG. 10</figref>, the three-dimensional measuring unit 10 is provided on the left hand.

0101As shown in <figref idref="f0011">FIG. 11</figref>, the instructing unit 41d instructs to position the vessel 200 in a measurement position by the right hand (Step S201). Moreover, the instructing unit 41d instructs the three-dimensional measuring unit 10 provided on the left hand to perform three-dimensional measurement (Step S202).

0102Next, the work attitude calculating unit 41b determines whether there is the work 100 that can be gripped (Step S203). When there is the work 100 that can be gripped (Yes at Step S203), the gripping claw direction determining unit 41c determines the tip end direction of the gripping claws in the hand 20 based on the work attitude (Step S204).

0103Then, the instructing unit 41d instructs to grip the work 100 by the left hand (hand 20) (Step S205). Next, the instructing unit 41d instructs to transfer the work 100 by the left hand (Step S206) and determines whether transfer of required works has completed (Step S207).

0104When transfer of the required works has completed (Yes at Step S207), the process ends. On the other hand, when transfer of the required works has not completed (No at Step S207), the process at Step S201 and the following steps is repeated.

0105When it is determined that there is no work that can be gripped at Step S203 (No at Step S203), it is determined whether a remaining work (the number or total weight of the works 100) in the vessel 200 is less than a defined value (Step S208). When the remaining work is less than the defined value (Yes at Step S208), the error is reported (Step S209) and the process ends.

0106On the other hand, when the determination condition at Step S209 is not satisfied (No at Step S209), the instructing unit 41d instructs to swing the vessel 200 by the right hand (Step S210) and the process at Step S202 and the following steps is repeated.

0107In this manner, in the work picking system according to the second embodiment, the three-dimensional measuring unit is provided on the multi-axis robot to which the hand including the gripping claws capable of changing the tip end direction is attached, so that the pick operation by the multi-axis robot can be simplified. Moreover, the attitude of a work can be surely measured regardless of the size of the measurement range of the three-dimensional measuring unit.

0108In each of the above-described embodiments, explanation is given for the case where the vessel is gripped by the right hand of the dual-arm robot and a work in the vessel is taken out by the left hand, however, the vessel may be gripped by the left hand and the pick operation may be performed by the right hand. Moreover, the pick operation may be performed by a single-arm robot to which the hand with the pick axis is attached.

0109Moreover, in each of the above-described embodiments, explanation is given for the case of swinging the vessel when a remaining work in the vessel becomes less than a defined value, however, the pick operation may be performed continuously while omitting measurement by the three-dimensional measuring unit. Moreover, when there is a plurality of works that can be gripped in the vessel, the pick operation may be continuously performed while omitting measurement by the three-dimensional measuring unit.

0110Furthermore, in each of the above-described embodiments, the pick operation by the hand including a pair of the gripping claws is exemplified, however, the pick operation may be performed by a hand including two or more pairs of gripping claws, that is, by a hand with a plurality of pick axes. Moreover, the pick operation may be performed by a hand in which three or more gripping claws are provided with respect to one pick axis.

0111The control device described above can be composed of, for example, a computer. In this case, the control unit is a CPU (Central Processing unit) and the storing unit is a memory. Each function of the control unit can be realized by loading a program generated in advance to the control unit and executing the program.