Robot arm control device and production system

Abstract

To shorten a time required in pick-and-place operation.SOLUTION: A work-piece selecting part 13 selects a target work-piece to be subjected to pick-and-place operation out of a plurality of work-pieces 11. A position selecting part 14 selects a target putting position into which the target work-piece is put, out of a plurality of putting positions P1-P9. A motion control part 15 obtains the selected target work-piece at a predetermined obtaining position, and controls motion of a robot arm 3 so that the obtained target work-piece is arranged at the selected target putting position. The work-piece selecting part 13 sets, as work-pieces to be selected, the work-pieces 11 in which current work-piece positions which are current positions of the plurality of work-pieces 11 are positions closer to an upstream side in a flowing direction of a conveyor 2 than a current tip position which is a current position of a tip of the robot arm 3, out of the plurality of work-pieces 11, and then selects, as the target work-piece, the work-piece 11 in which a distance from the current tip position to the current work-piece position is shortest, out of the work-pieces 11 to be selected.SELECTED DRAWING: Figure 1

Description

[Technical field]

[0001] The present invention relates to a robot arm control device that controls a robot arm that performs pick-and-place operations, and a production system. [Background technology]

[0002] Conventionally, as disclosed in Patent Document 1, there is a production system in which a plurality of workpieces are transported by a transport device such as a conveyor to be distributed to a production line in a factory, and a robot arm performs a predetermined operation on the distributed workpieces. One of the operations performed by such a robot arm is a pick-and-place operation in which a transported workpiece is picked up and inserted into a predetermined insertion position. In this case, the robot arm selects and picks up one of a plurality of workpieces transported in a predetermined flow direction by the transport device, and inserts the picked workpiece into a predetermined insertion position in an insertion tray.

[0003] In a production system in which such pick-and-place operations are performed, multiple robot arms are arranged in a line from the upstream side to the downstream side of the conveyor flow direction, and each of the multiple robot arms performs the same operation. Conventionally, each robot arm in such a production system is designed to select and pick up the workpiece that is located furthest downstream in the flow direction among the multiple workpieces, with the highest priority being given to reliably preventing the occurrence of workpieces being missed. [Prior art documents] [Patent documents]

[0004] [Patent Document 1] JP 2011-125989 A Summary of the Invention [Problem to be solved by the invention]

[0005] According to the conventional work selection criteria as described above, it is possible to reliably prevent the occurrence of missed workpieces. However, with the conventional work selection criteria, depending on the position of the workpiece selected as the work target and the position in the input tray into which the workpiece is input, the moving distance of the robot arm may become very long, lengthening the time required for the work, and as a result, there is a risk that the work time by the robot arm will not fall within the expected cycle time of the equipment.

[0006] The present invention has been made in consideration of the above circumstances, and an object of the present invention is to provide a robot arm control device and a production system that can shorten the time required for pick-and-place work. [Means for solving the problem]

[0007] Claim 1 or 3 The robot arm control device described in controls the robot arm that performs a pick-and-place operation of picking up one of a plurality of workpieces transported in a predetermined flow direction by a transport device and inserting the picked workpiece into one of a plurality of predetermined insertion positions, and includes a work selection unit, a position selection unit, and an operation control unit. The work selection unit selects a target workpiece that is a workpiece that is a target of the pick-and-place operation from the plurality of workpieces. The position selection unit selects a target insertion position that is an insertion position where the target workpiece is inserted from the plurality of insertion positions.

[0008] The operation control unit controls the operation of the robot arm to pick up the target work selected by the work selection unit at a specified acquisition position and place the target work at the target input position selected by the position selection unit. In the above configuration, the work selection unit selects the target work based on the following selection criteria. That is, the work selection unit selects, from among the multiple workpieces, a workpiece whose current work position, which is the current position of the multiple workpieces, is located upstream in the flow direction from the current tip position, which is the current position of the tip of the robot arm. Then, from among the workpieces to be selected, the work selection unit selects as the target workpiece a workpiece whose distance from the current tip position to the current work position is the shortest.

[0009] The time required for the pick-and-place operation depends on the posture of the robot arm, but is mainly determined by the travel distance of the robot arm from the current tip position to the position of the target work when the target work is picked up, and the travel distance of the robot arm from the position of the target work when the target work is picked up to the target insertion position. Hereinafter, of these travel distances, the former will be referred to as the first travel distance, and the latter will be referred to as the second travel distance. In the selection criteria for the target work in the above configuration, the work that has the shortest first travel distance is selected as the target work from among the workpieces to be selected, and this makes it possible to reduce the time required for the pick-and-place operation.

[0010] In this case, the work selection unit selects workpieces whose current workpiece position is located upstream of the current tip position in the flow direction, and excludes workpieces whose current workpiece position is located downstream of the current tip position in the flow direction. The reason for this is as follows. That is, since the workpieces are transported in the flow direction by the transport device, their positions move in the flow direction every moment. Therefore, if a workpiece whose current workpiece position is located downstream of the current tip position in the flow direction is selected as the target workpiece, the target workpiece will continue to move in a direction that is steadily moving away from the robot arm while the robot arm moves from the current tip position toward the target workpiece, which may result in an unnecessary long first movement distance or, in the worst case, the robot arm may fail to acquire the target workpiece.

[0011] In contrast, if a workpiece whose current workpiece position is located upstream of the current tip position in the flow direction is selected as the target workpiece, the target workpiece will in most cases move in a direction approaching the robot arm while the robot arm moves from the current tip position toward the target workpiece, making it extremely unlikely that the robot arm will fail to acquire the target workpiece and keeping the first movement distance short. Therefore, as in the above configuration, if a workpiece whose current workpiece position is located upstream of the current tip position in the flow direction is selected as the selection target, it is possible to reduce the time required for the pick-and-place operation while keeping the possibility of the robot arm failing to acquire the target workpiece low.

[0012] Claim 1In the control device for a robot arm described in the above, the position selection unit selects, from among the multiple input positions, an input position that is the shortest distance from a future work position, which is the position of the target work at the time the robot arm picks up the work, as the target input position. In other words, in this case, the position selection unit selects, from among the multiple input positions, an input position that makes the second movement distance the shortest as the target input position. Therefore, according to the above configuration, it is possible to shorten both the first movement distance and the second movement distance, which mainly determine the time required for the pick-and-place operation, and as a result, it is possible to further shorten the time required for the pick-and-place operation.

[0013] Claim 2 The production system according to claim 1 includes a conveying device that conveys a plurality of workpieces in a predetermined flow direction, a plurality of robot arms that perform a pick-and-place operation of picking up any one of the plurality of workpieces conveyed by the conveying device and inserting the picked workpiece into any one of a plurality of predetermined insertion positions, 1 to and a robot arm control device according to the present invention. In this case, the multiple robot arms are arranged in a line from the upstream side to the downstream side in the flow direction. The robot arm control device described above is adapted to control a predetermined robot arm among the multiple robot arms other than the robot arm arranged most downstream in the flow direction.

[0014] Claim 1 to According to the selection criteria for the target workpiece in the described robot arm control device, priority is given to shortening the time required for pick-and-place work, so there is a possibility that a workpiece may be missed. However, in the production system configured as described above, the robot arm where such a miss may occur is not the one located at the most downstream side in the flow direction, so there is at least one robot arm downstream of it. Therefore, even if the claim 1 toEven if a robot arm controlled by the robot arm control device described above misses a workpiece, the robot arm provided downstream of the robot arm can pick up the missed workpiece. Therefore, according to the above configuration, the production system as a whole can reduce the time required for pick-and-place operations while preventing the workpiece from being missed. [Brief description of the drawings]

[0015] [Figure 1] FIG. 1 is a diagram showing a schematic configuration of a production system according to a first embodiment; [Diagram 2] FIG. 1 is a diagram for explaining an example of a specific operation related to a pick-and-place operation according to the first embodiment. [Diagram 3] FIG. 2 is a diagram for explaining an example of a specific operation related to a pick-and-place operation according to the first embodiment. [Figure 4] FIG. 3 is a diagram for explaining an example of a specific operation related to a pick-and-place operation according to the first embodiment. [Diagram 5] FIG. 4 is a diagram for explaining an example of a specific operation related to a pick-and-place operation according to the first embodiment. [Figure 6] FIG. 5 is a diagram for explaining an example of a specific operation related to a pick-and-place operation according to the first embodiment. [Figure 7] FIG. 6 is a diagram for explaining an example of a specific operation related to a pick-and-place operation according to the first embodiment. [Figure 8] FIG. 1 is a diagram showing an example of a specific process related to a pick-and-place operation according to the first embodiment; [Figure 9] FIG. 11 is a diagram showing an example of a specific process related to a pick-and-place operation according to the second embodiment; DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0016] Hereinafter, a number of embodiments will be described with reference to the drawings. Note that the same reference numerals are used to designate substantially the same components in the respective embodiments, and the description thereof will be omitted. (First embodiment) The first embodiment will be described below with reference to FIGS.

[0017] As shown in FIG. 1, the production system 1 of this embodiment includes a conveyor 2, which is a belt conveyor device, robot arms 3, 4, 5, controllers 6, 7, 8, a visual device 9, an encoder 10, and the like. The conveyor 2 conveys a plurality of workpieces 11 in a predetermined flow direction, and functions as a conveying device. In this specification, the direction along the flow direction A1 of the conveyor 2 represented by a thick white arrow in FIG. 1, that is, the left-right direction in FIG. 1, is defined as the Y axis, and the direction perpendicular to the Y axis direction and the vertical direction, that is, the up-down direction in FIG. 1, is defined as the X axis. In this specification, the right direction in FIG. 1 is defined as the positive direction for the Y axis, and the downward direction in FIG. 1 is defined as the positive direction for the X axis.

[0018] In the production system 1, a plurality of workpieces 11 are distributed along a production line in a factory by being transported by a conveyor 2. The production system 1 includes a process as shown in Fig. 1, that is, when the workpieces 11 are transported by the conveyor 2, the robot arms 3, 4, and 5 pick up the workpieces 11 and load them in an aligned state onto a rectangular container-shaped input tray 12, that is, a process of transferring the workpieces from the conveyor 2 to the input tray 12.

[0019] The conveyor 2 basically operates continuously without stopping. The workpieces 11 are, for example, food such as sweets, which are wrapped in a previous process prior to this process and transported to this process in an individually wrapped state. The workpieces 11 are transported continuously at a predetermined speed by the conveyor 2. Note that in FIG. 1 and other figures, only some of the workpieces are labeled with reference numerals, and the reference numerals of the other workpieces are omitted. The robot arms 3, 4, and 5 are configured as horizontal articulated robots having, for example, four-axis arms.

[0020] The robot arms 3, 4, and 5 perform a pick-and-place operation of picking up any one of a plurality of workpieces 11 conveyed by the conveyor 2 and feeding the picked workpiece 11 into any one of a plurality of predetermined feeding positions. Specifically, the robot arms 3, 4, and 5 rotate the arms to position the tip above the conveyor 2, then lower a hand (not shown) attached to the tip of the arm, and grip or suck the workpiece 11 with the hand and lift it up. The robot arms 3, 4, and 5 rotate the arms to position the tip above the feeding tray 12, then lower the hand, release the workpiece 11 from the hand, and place it in a predetermined feeding position in the feeding tray 12. In this case, the plurality of feeding positions are nine feeding positions P1 to P9 in the feeding tray 12.

[0021] The robot arms 3, 4, and 5 are arranged side by side from the upstream side to the downstream side of the flow direction A1 of the conveyor 2, i.e., along the Y axis. The robot arm 3, which is arranged on the most upstream side in the flow direction A1, is controlled by a controller 6. The robot arm 4, which is arranged on the second most upstream side in the flow direction A1, is controlled by a controller 7. The robot arm 5, which is arranged on the most downstream side in the flow direction A1, is controlled by a controller 8. In this way, the controllers 6, 7, and 8 control the robot arms 3, 4, and 5, respectively, and function as robot arm control devices.

[0022] Two input trays 12 into which the workpieces 11 are input by the robot arm 3 are provided on both sides of the conveyor 2 so as to face each other across the conveyor 2, near the robot arm 3. Two input trays 12 into which the workpieces 11 are input by the robot arm 4 are provided on both sides of the conveyor 2 so as to face each other across the conveyor 2, near the robot arm 4. Two input trays 12 into which the workpieces 11 are input by the robot arm 5 are provided on both sides of the conveyor 2 so as to face each other across the conveyor 2, near the robot arm 5.

[0023] In the production system 1, the following configuration realizes a conveyor tracking function in which the robot arms 3, 4, and 5 follow the workpieces 11 and enable pick-and-place operations without stopping the conveyor 2. That is, a visual device 9 consisting of a camera or the like captures an image of each workpiece 11 within a predetermined imaging range upstream of the robot arms 3, 4, and 5 in the flow direction A1.

[0024] Control devices or controllers 6, 7, and 8 (not shown) acquire the position, posture, and the like of each workpiece 11 on the conveyor 2 by performing a predetermined image recognition process on the image captured by the visual device 9. In addition, an encoder 10 attached to the conveyor 2 outputs a pulse signal according to the moving distance, moving speed, and the like of the conveyor 2. The control devices or controllers 6, 7, and 8 sequentially calculate how each workpiece 11, whose position, posture, and the like have been acquired, flows within the imaging range based on the pulse signal, and cause the robot arms 3, 4, and 5 to follow the workpiece 11.

[0025] Of the three robot arms 3, 4, and 5, the controller 8 that controls the robot arm 5 that is provided furthest downstream in the flow direction A1 has the same configuration and function as a conventional controller, although a detailed description will be omitted. Therefore, the robot arm 5 gives top priority to reliably preventing the occurrence of missed picking of the workpieces 11, and selects and picks up the workpiece 11 that is furthest downstream in the flow direction A1 among the multiple workpieces 11.

[0026] Of the three robot arms 3, 4, 5, the controllers 6, 7 that control the robot arms 3, 4 other than the robot arm 5 that is provided furthest downstream in the flow direction A1 all have the following unique configurations and functions. In the following explanations, the specific configurations and functions of the controllers 6, 7 will be explained using the controller 6 as an example, but the specific configurations and functions of the controller 7 are similar. The controller 6 controls the robot arm 3 by executing a computer program in control means made up of a computer composed of a CPU, ROM, RAM, etc. (not shown).

[0027] Specifically, the controller 6 includes a drive unit configured with an inverter circuit and the like, and drives each motor by, for example, feedback control based on the rotational position of the motor detected by an encoder provided corresponding to the motor that drives each axis of the robot arm 3. The controller 6 executes a preset operation program to control the robot arm 3 so that each axis of the robot arm 3 automatically performs a predetermined operation.

[0028] The controller 6 includes functional blocks such as a workpiece selection unit 13, a position selection unit 14, and an operation control unit 15. Each of these functional blocks is realized by a CPU included in the controller 6 executing a computer program stored in a ROM or the like to execute processing corresponding to the computer program, that is, by software. Note that at least a portion of each functional block may be realized by hardware.

[0029] The work selection unit 13 selects a target work, which is a work 11 to be subjected to the pick-and-place operation, from among the multiple work pieces 11. Specifically, the work selection unit 13 selects as selection targets the work pieces 11 whose current work position, which is the current position of the work piece 11, is located upstream in the flow direction A1 from the tip of the robot arm 3, i.e., the current tip position, which is the current position of the hand, and selects as the target work piece, from among the selection target work pieces 11, the work piece 11 whose distance from the current tip position to the current work position is the shortest.

[0030] The position selection unit 14 selects a target insertion position, which is an insertion position where the target workpiece is inserted, from among the multiple insertion positions P1 to P9. Specifically, the position selection unit 14 selects, from among the multiple insertion positions P1 to P9, an insertion position that is the shortest distance from a future work position, which is an estimated position of the target workpiece at the time when the robot arm 3 picks up the workpiece 11, as the target insertion position. The operation control unit 15 picks up the target workpiece selected by the work selection unit 13 at a predetermined acquired position, and controls the operation of the robot arm 3 so as to place the picked target workpiece at the target insertion position selected by the position selection unit 14.

[0031] Next, an example of a specific operation related to a pick-and-place operation by the controller 6 that controls the robot arm 3 configured as described above will be described with reference to Figs. 2 to 7. Note that in Figs. 2 to 7, the illustration of the robot arm 3 is omitted, and only the position of its tip is indicated by a dotted circle. Here, it is assumed that the robot arm 3 has placed the workpiece 11 at the insertion position P9 in the previous operation. In this case, since the tip of the robot arm 3 is located at the insertion position P9, the insertion position P9 becomes the initial current tip position.

[0032] In this case, the tracking range is the range T1 surrounded by a dashed square in Fig. 2, and the robot arm 3 tracks seven workpieces 11 that are present within the range T1. In the following description, the seven workpieces 11 to be tracked are distinguished by adding lowercase alphabets a to g to the end of their names. When there is no need to distinguish between the seven workpieces 11, the alphabets at the end are omitted and the seven workpieces 11 are collectively referred to as workpieces 11. Note that the positions of the workpieces 11 shown in Fig. 2 all represent the current workpiece positions.

[0033] As shown in FIG. 2, the workpiece selection unit 13 forms a first search range R1, which is a search range in a 90-degree sector shape centered on the current tip position and extending in the -X-axis direction and +Y-axis direction. The workpiece selection unit 13 gradually expands the first search range R1 in a 90-degree sector shape and selects the workpiece 11 detected first in the first search range R1 as the target workpiece. In this embodiment, if the center position of the workpiece 11 is present within the first search range R1, the workpiece selection unit 13 determines that the workpiece 11 is present within the first search range R1. That is, in this case, the workpiece selection unit 13 determines the presence of each workpiece 11 by point, so that the possibility of multiple workpieces 11 being detected first is extremely low. In this case, the workpiece selection unit 13 detects the workpiece 11c first in the first search range R1, and selects the workpiece 11c as the target workpiece.

[0034] Next, the controller 6 obtains a future work position, which is an estimated position of the work 11c at the time when the robot arm 3 picks up the target work 11c. Such calculation of the future work position can be realized by the conveyor tracking function described above. In FIG. 3, the future work positions of each work 11 are indicated by solid lines, and the current work position of the work 11c is indicated by dashed lines. As shown in FIG. 3, the future work position of the work 11c is a position moved in the -Y-axis direction from the current work position by the time it takes the robot arm 3 to move to pick up the work 11c.

[0035] 3, the position selection unit 14 forms a second search range R2, which is a search range in a sector shape of 180 degrees centered on the future work position of the work 11c and extending in the +X-axis direction, that is, toward the input tray 12 side to which the work 11c is input. In this case, the input positions P1 to P9 in the input tray 12 provided on the +X-axis side of the conveyor 2 are searched for, so the second search range R2 in a sector shape of 180 degrees extending toward the +X-axis direction is formed, but when the input positions P1 to P9 in the input tray 12 provided on the -X-axis side of the conveyor 2 (not shown) are searched for, the position selection unit 14 may form the second search range R2 in a sector shape of 180 degrees extending toward the -X-axis direction.

[0036] The position selection unit 14 gradually expands the second search range R2 of such a 180-degree sector shape and selects the first insertion position detected in the second search range R2 as the target insertion position. In this embodiment, the position selection unit 14 is configured to determine that an insertion position exists within the second search range R2 if the center position of the insertion position exists within the second search range R2. In other words, in this case, the position selection unit 14 determines the existence of each insertion position as a point, so that the possibility of multiple insertion positions being detected first is extremely low. In this case, the position selection unit 14 detects insertion position P3 first in the second search range R2, and therefore selects the insertion position P3 as the target insertion position.

[0037] Next, the operation control unit 15 controls the operation of the robot arm 3 so as to pick up the work 11c selected as the target work by the work selection unit 13 and place the work 11c at the insertion position P3 selected as the target insertion position by the position selection unit 14. The movement trajectory of the robot arm 3 at this time is a trajectory from the insertion position P9, which is the current tip position, to the insertion position P3, which is the target insertion position, via the future work position of the work 11c, as shown by the solid arrow in Figure 4. Note that all positions of the work 11 shown in Figure 4 represent the future work position. This completes the pick-and-place operation for the work 11c, and then the pick-and-place operation for the next work 11 is started.

[0038] At this time, as shown in Fig. 5, the tip of the robot arm 3 is located at the input position P3, so the input position P3 becomes the current tip position. Note that all positions of the workpiece 11 shown in Fig. 5 represent the current workpiece position. As shown in Fig. 5, the workpiece selection unit 13 forms a first search range R1 in a 90-degree sector shape centered on the current tip position, as in the previous work, and selects the workpiece 11 detected first in the first search range R1 as the target workpiece. In this case, since the workpiece 11d was detected first in the first search range R1, the workpiece selection unit 13 selects the workpiece 11d as the target workpiece.

[0039] Next, the controller 6 obtains a future work position, which is an estimated position of the work 11d at the time when the robot arm 3 picks up the target work 11d. In Fig. 6, the future work position of each work 11 is indicated by a solid line, and the current work position of the work 11d is indicated by a dashed line. As shown in Fig. 6, the future work position of the work 11d is a position moved in the -Y axis direction from the current work position by the time it takes the robot arm 3 to move to pick up the work 11d.

[0040] As shown in FIG. 6, the position selection unit 14 forms a second search range R2 in the shape of a 180-degree sector centered on the future work position of the work 11d, as in the previous work, and selects the insertion position detected first in the second search range R2 as the target insertion position. In this case, the position selection unit 14 first detects insertion position P3 in the second search range R2, but the work 11c has already been placed at that insertion position P3. Therefore, the position selection unit 14 continues to detect insertion positions without selecting insertion position P3 as the target insertion position. After that, since the position selection unit 14 detects insertion position P2 in the second search range R2, it selects that insertion position P2 as the target insertion position.

[0041] Next, the operation control unit 15 controls the operation of the robot arm 3 so as to pick up the work 11d selected as the target work by the work selection unit 13 and place the work 11d at the insertion position P2 selected as the target insertion position by the position selection unit 14. The movement trajectory of the robot arm 3 at this time is a trajectory from the insertion position P3, which is the current tip position, to the insertion position P2, which is the target insertion position, via the future work position of the work 11d, as shown by the solid arrow in Fig. 7. Note that all positions of the work 11 shown in Fig. 7 represent the future work position. This completes the pick-and-place operation for the work 11d, and then the pick-and-place operation for the next work 11 is started.

[0042] In this embodiment, such an operation is repeatedly performed, so that the workpieces 11 are placed at all of the loading positions P1 to P9 in the loading tray 12. In this case, as shown in Fig. 7, the workpieces 11a, 11b, and 11e move downstream of the tracking range without being picked up by the robot arm 3, and are therefore workpieces that are missed by the robot arm 3. However, the workpieces 11a, 11b, and 11e that are missed by the robot arm 3 can be picked up by the robot arms 4 and 5 provided downstream.

[0043] In this case, the workpieces 11 are successively loaded into one of the two loading trays 12, but the workpieces 11 may be loaded alternately into the two loading trays 12 so that the workpieces 11 are evenly distributed in both of the two loading trays 12. Even in this case, the pick-and-place operation can be performed in the same manner by the specific operations described above.

[0044] Next, an example of specific processing contents regarding the pick-and-place operation by the controller 6 that controls the robot arm 3 configured as above will be described with reference to FIG. 8. Note that, here, the processing up to the determination of the motion trajectory of the robot arm 3 will be described, and the processing after the motion trajectory is determined will not be described. First, in step S1, the current tip position of the robot arm 3 is acquired. In step S2, a first search range R1 is formed, which is a 90-degree sector-shaped search range centered on the current tip position and extending in the -X-axis direction and +Y-axis direction. In step S3, it is determined whether or not a workpiece 11 is detected in the first search range R1.

[0045] If the workpiece 11 is detected in the first search range R1, the result is "YES" in step S3, and the process proceeds to step S4. In step S4, the detected workpiece 11 is selected as the target workpiece. On the other hand, if the workpiece 11 is not detected in the first search range R1, the result is "NO" in step S3, and the process proceeds to step S5. In step S5, the first search range R1 is expanded so that the radius of the sector is increased by a predetermined value. After execution of step S5, the process proceeds to step S6, and it is determined whether the first search range R1 has reached its upper limit. The upper limit of the first search range R1 can be determined, for example, based on the upper limit of the movable range of the robot arm 3, or based on the upper limit of the time required for the pick-and-place operation by the robot arm 3.

[0046] Here, if the first search range R1 is less than the upper limit, the result is "NO" in step S6, and the process returns to step S3 to continue searching for the workpiece 11. On the other hand, if the first search range R1 has reached its upper limit, the result is "YES" in step S6, and the process proceeds to step S7. In step S7, a predetermined error process is executed since the workpiece 11 to be selected as the target workpiece could not be detected. After step S7 is executed, the process ends. After step S4 is executed, the process proceeds to step S8, and a second search range R2 is formed, which is a 180-degree sector-shaped search range centered on the future work position of the target workpiece and extending toward the input tray 12.

[0047] In step S9, it is determined whether or not a loading position is detected in the second search range R2. If a loading position is detected in the second search range R2, the result is "YES" in step S9, and the process proceeds to step S10. In step S10, the detected loading position is selected as the target loading position. On the other hand, if a loading position is not detected in the second search range R2 or if a work 11 has already been placed at the detected loading position, the result is "NO" in step S9, and the process proceeds to step S11. In step S11, the second search range R2 is expanded so that the radius of the sector is increased by a predetermined value. After execution of step S11, the process proceeds to step S12, and it is determined whether or not the second search range R2 has reached its upper limit. The upper limit of the second search range R2 is set to a range that is wider by a predetermined margin than the range that can just cover all loading positions P1 to P9 in the loading tray 12.

[0048] Here, if the second search range R2 is less than the upper limit, the result is "NO" in step S12, and the process returns to step S9 to continue searching for the insertion position. On the other hand, if the second search range R2 has reached its upper limit, the result is "YES" in step S12, and the process proceeds to step S13. In step S13, a predetermined error process is executed since the insertion position to be selected as the target insertion position could not be detected. After step S13 is executed, this process ends. After step S10 is executed, the process proceeds to step S14. In step S14, a motion trajectory is determined with the current tip position as the start point, the future work position as the intermediate point, and the target insertion position as the end point. After step S14 is executed, this process ends.

[0049] According to the present embodiment described above, the following effects can be obtained. The controllers 6 and 7 of this embodiment include a work selection unit 13 that selects a target work, which is a work 11 that is a target of a pick-and-place operation, from among the multiple workpieces 11, and a position selection unit 14 that selects a target insertion position, which is an insertion position where the target work is inserted, from among the multiple insertion positions. The work selection unit 13 is configured to select the target work based on the following selection criteria. That is, the work selection unit 13 selects as selection targets the workpieces 11 whose current work position, which is the current position of the workpiece 11, is located upstream in the flow direction A1 of the conveyor 2 from the current tip position, which is the current position of the tip of the robot arms 3 and 4, and then selects as the target workpiece, from among the selection target workpieces 11, the workpiece 11 whose distance from the current tip position to the current work position is the shortest.

[0050] The time required for the pick-and-place operation depends on the posture of the robot arms 3 and 4, but is mainly determined by the travel distance of the robot arms 3 and 4 from the current tip position to the future work position, which is the position of the target work at the time of picking up the target work, and the travel distance of the robot arms 3 and 4 from the future work position of the target work to the target insertion position. Hereinafter, of these travel distances, the former will be referred to as the first travel distance, and the latter will be referred to as the second travel distance. In the selection criteria for the target work in the above configuration, the work 11 that has the shortest first travel distance is selected as the target work from among the workpieces 11 to be selected, and this makes it possible to shorten the time required for the pick-and-place operation.

[0051] In this case, the work selection unit 13 selects the work 11 whose current work position is located upstream of the current tip position in the flow direction A1, and excludes the work 11 whose current work position is located downstream of the current tip position in the flow direction from the selection target. The reason for this is as follows. That is, since the work 11 is transported in the flow direction A1 by the conveyor 2, its position moves in the flow direction every moment.

[0052] Therefore, when a workpiece 11 whose current workpiece position is downstream in the flow direction A1 from the current tip position is selected as the target workpiece, the target workpiece will continue to move in a direction steadily away from the robot arms 3, 4 while the robot arms 3, 4 move from their current tip positions toward the target workpiece, which may result in the first movement distance of the robot arms 3, 4 becoming unnecessarily long, or in the worst case scenario, the robot arms 3, 4 failing to acquire the target workpiece.

[0053] In contrast, when a workpiece whose current workpiece position is located upstream of the current tip position in the flow direction is selected as the target workpiece, the target workpiece will in most cases move in a direction approaching the robot arms 3, 4 while the robot arm 3 moves from the current tip position toward the target workpiece, making it extremely unlikely that the robot arms 3, 4 will fail to acquire the target workpiece and keeping the first movement distance short. Therefore, as in the above configuration, if the workpiece 11 whose current workpiece position is located upstream of the current tip position in the flow direction A1 is selected as the selection target, it is possible to reduce the time required for the pick-and-place operation while keeping the possibility of the robot arms 3, 4 failing to acquire the target workpiece low.

[0054] The position selection unit 14 is adapted to select, as the target insertion position, an insertion position that is the shortest distance from the future work position, which is the position of the target work at the time when the robot arms 3 and 4 pick up the work 11, from among the multiple insertion positions P1 to P9 in the insertion tray 12. That is, in this case, the position selection unit 14 is adapted to select, as the target insertion position, an insertion position that is the shortest in the second movement distance of the robot arms 3 and 4 from among the multiple insertion positions P1 to P9. Therefore, according to the above configuration, it is possible to shorten both the first movement distance and the second movement distance, which mainly determine the time required for the pick-and-place operation, and as a result, it is possible to further shorten the time required for the pick-and-place operation.

[0055] The production system 1 of this embodiment includes a conveyor 2 that transports a plurality of workpieces 11 in a predetermined flow direction A1, a plurality of robot arms 3, 4, and 5 that perform a pick-and-place operation of picking up any one of the plurality of workpieces 11 transported by the conveyor 2 and inserting the picked workpiece 11 into any one of a plurality of predetermined insertion positions, and controllers 6, 7, and 8. In this case, the plurality of robot arms 3, 4, and 5 are provided so as to be aligned along the flow direction A1 from the upstream side to the downstream side of the flow direction A1.

[0056] The controllers 6, 7 that control the robot arms 3, 4 other than the robot arm 5 that is provided most downstream in the flow direction A1 among the multiple robot arms 3, 4, 5 have the unique configuration and function described above. According to the selection criteria for the target workpiece in the controllers 6, 7, priority is given to shortening the time required for the pick-and-place operation, so there is a possibility that the workpiece 11 will be missed. However, according to the production system 1 configured as described above, the robot arms 3, 4 that may be missed are not provided most downstream in the flow direction A1, and the robot arm 5 is located downstream of them.

[0057] Therefore, even if the robot arms 3 and 4 controlled by the controllers 6 and 7 miss a workpiece, the robot arm 5 provided downstream of the robot arms 3 and 4 can cover the missed workpiece. Moreover, in this case, the robot arm 5 prioritizes preventing the workpiece 11 from being missed, and selects and picks up the workpiece 11 that is located furthest downstream in the flow direction A1 among the multiple workpieces 11. Therefore, according to the above configuration, the production system 1 as a whole can reduce the time required for the pick-and-place operation while preventing the workpiece 11 from being missed.

[0058] When the first search range R1 reaches its upper limit, the workpiece selection unit 13 does not select the target workpiece, that is, it abandons the acquisition of the workpiece 11 at that point. Here, if the upper limit of the first search range R1 is determined based on the upper limit of the time required for the pick-and-place operation by the robot arms 3 and 4, when only workpieces 11 whose first movement distance is extremely long exist within the tracking range T1, it becomes possible to abandon the acquisition of such workpieces 11 and leave the operation to the downstream robot arm 5. In this way, it is possible to contribute to further shortening the time required for the pick-and-place operation by the robot arms 3 and 4.

[0059] Second embodiment The second embodiment will be described below with reference to FIG. In this embodiment, the robot arms 3, 4, and 5 are configured to insert the picked-up workpieces 11 into insertion positions P1 to P9 in the insertion tray 12 in this order. Therefore, the position selection unit 14 in this embodiment is configured to select, as a target insertion position, from among the multiple insertion positions P1 to P9 in order from the position with the smallest last number.

[0060] Therefore, an example of specific processing contents regarding the pick-and-place operation by the controller 6 that controls the robot arm 3 of this embodiment is, for example, as shown in Fig. 9. The processing contents of this embodiment shown in Fig. 9 differ from the processing contents of the first embodiment shown in Fig. 8 in that steps S8 to S13 are omitted and step S21 is added. In this case, step S21 is executed after execution of step S8. In step S21, a target insertion position is selected in order from the multiple insertion positions P1 to P9. After execution of step S21, the process proceeds to step S14, where a motion trajectory is determined.

[0061] According to the present embodiment described above, the target work is selected using the same selection criteria as in the first embodiment, and therefore the same effect as in the first embodiment can be obtained, that is, the time required for pick-and-place operations can be shortened while keeping the possibility of the robot arms 3 and 4 failing to acquire the target work low and preventing the production system 1 as a whole from missing out on the work 11.

[0062] (Other embodiments) The present invention is not limited to the embodiments described above and illustrated in the drawings, and can be modified, combined, or expanded in any manner without departing from the spirit and scope of the present invention. The numerical values ​​and the like shown in the above embodiments are merely examples and are not intended to be limiting.

[0063] Although the production system 1 has three robot arms 3, 4, and 5, the number of robot arms may be any number, such as two, four or more. When the number of robot arms is changed, a controller that controls a predetermined robot arm other than the robot arm provided furthest downstream in the flow direction A1 of the conveyor 2 among the multiple robot arms may have the same configuration and function as the controller 6 described in each of the above embodiments.

[0064] The present invention is not limited to the controllers 6, 7 that control the robot arms 3, 4 applied to the production system 1, but can be applied to all robot arm control devices that control robot arms that perform pick-and-place operations. [Explanation of symbols]

[0065] 1...production system, 2...conveyor, 3, 4, 5...robot arm, 6, 7, 8...controller, 11...work, 12...feeding tray, 13...work selection unit, 14...position selection unit, 15...motion control unit, P1 to P9...feeding positions.

Claims

1. A control device for a robot arm that controls a robot arm that performs a pick-and-place operation of picking up one of a plurality of workpieces transported in a predetermined flow direction by a transport device and placing the picked workpiece in one of a plurality of predetermined placement positions, A work selection unit that selects a target work that is a work to be subjected to the pick-and-place operation from among the plurality of workpieces; a position selection unit that selects a target insertion position, which is an insertion position at which the target workpiece is inserted, from among the plurality of insertion positions; an operation control unit that controls the operation of the robot arm so as to pick up the target workpiece selected by the workpiece selection unit at a predetermined acquisition position and place the target workpiece at the target insertion position selected by the position selection unit; Equipped with The work selection unit is Among the plurality of workpieces, a workpiece is selected whose current workpiece position, which is the current position of the plurality of workpieces, is located upstream in the flow direction from a current tip position, which is the current position of the tip of the robot arm; Selecting, as the target workpiece, a workpiece having a shortest distance from the current tip position to the current workpiece position from among the workpieces to be selected; The position selection unit is a control device for a robot arm that selects, from the multiple input positions, the input position that is the shortest distance from the future work position, which is the position of the target work at the time the robot arm picks up the work, as the target input position.

2. A conveying device that conveys a plurality of workpieces in a predetermined flow direction; a plurality of robot arms that perform a pick-and-place operation of picking up any one of a plurality of workpieces transported by the transport device and placing the picked up workpiece in any one of a plurality of predetermined placement positions; The robot arm control device according to claim 1 ; A production system comprising: the plurality of robot arms are arranged in line from an upstream side to a downstream side in the flow direction, The robot arm control device is configured to control a predetermined robot arm among the plurality of robot arms other than the robot arm that is provided furthest downstream in the flow direction.

3. A conveying device that conveys a plurality of workpieces in a predetermined flow direction; a plurality of robot arms that perform a pick-and-place operation of picking up any one of a plurality of workpieces transported by the transport device and placing the picked up workpiece in any one of a plurality of predetermined placement positions; A robot arm control device that controls the robot arm; A production system comprising: The robot arm control device includes: A work selection unit that selects a target work that is a work to be subjected to the pick-and-place operation from among the plurality of workpieces; a position selection unit that selects a target insertion position, which is an insertion position at which the target workpiece is inserted, from among the plurality of insertion positions; an operation control unit that controls the operation of the robot arm so as to pick up the target workpiece selected by the workpiece selection unit at a predetermined acquisition position and place the target workpiece at the target insertion position selected by the position selection unit; Equipped with The work selection unit is Among the plurality of workpieces, a workpiece is selected whose current workpiece position, which is the current position of the plurality of workpieces, is located upstream in the flow direction from a current tip position, which is the current position of the tip of the robot arm; Selecting, as the target workpiece, a workpiece having a shortest distance from the current tip position to the current workpiece position from among the workpieces to be selected; the plurality of robot arms are arranged in line from an upstream side to a downstream side in the flow direction, The robot arm control device is configured to control a predetermined robot arm among the plurality of robot arms other than the robot arm that is provided furthest downstream in the flow direction.

Images