JP5440885B2 - Robot system - Google Patents

Description

  The disclosed embodiments include, for example, an operation of lifting and transferring an object conveyed on a conveyance path by a conveying device, an operation of applying an adhesive or a paint to the object, and removing an unnecessary portion of the object The present invention relates to a robot system including a robot to which a tool for performing a predetermined work such as a work, a work of pressing a branding on an object, and the like can be attached.

  2. Description of the Related Art Conventionally, a technique for performing a predetermined operation as described above on an object conveyed on a conveyance path by a conveyance device is known (for example, see Patent Document 1). In this prior art, an object (work) is sequentially conveyed by a conveying device (belt conveyor), and the flowing object is photographed by a video camera when it reaches a fixed position. The video signal generated by the video camera is sent to the image processing device, and the image processing device confirms the shape of the object, the mounting posture, the presence or absence of unevenness, the position of the burr, and the like. Based on the information, for example, gripping claws attached to a claw interval variable mechanism provided on two fingers of a tool (robot hand) fixed to a robot arm of a robot (multi-joint robot), for example, The position to be applied to the object is determined, and the claw interval varying mechanism adjusts the interval between the gripping claws according to this position.

  Then, the robot arm moves to the position of the target object based on information from the image processing apparatus, and grips the target object with the tool. Thereafter, the robot arm performs shaping by placing an unshaped part of the object on the grinder and moving it up and down, rotating, holding, or the like. When the shaping of the object is completed, the robot arm places the object on the transport device, finishes the series of operations, and adjusts the interval between the gripping claws toward the next object.

JP-A-11-262886

  In general, an operation command input in advance via a teaching pendant or the like is output to the robot, and the robot operates based on the operation command.

  By the way, when the target object is an indefinite shape whose shape is indeterminate among individuals, such as natural objects such as vegetables and fruits, and artificial objects (industrial products) in which a plurality of types are mixed, there is a variation in the shape between the objects. In addition, since the shape of each object cannot be confirmed, even if the robot operates based on the operation command, there is a possibility that a predetermined operation cannot be accurately performed by the tool on the object conveyed on the conveyance path. In the above prior art, the object conveyed on the conveyance path is photographed with a video camera, and the shape of the object is confirmed based on the video signal. Therefore, the shape of the object is not natural or artificial. Even if it is a non-standard shaped object, the operation command is corrected based on the video signal and the corrected operation command is output to the robot, so that the robot operates based on the corrected operation command. Thus, it is possible to accurately perform a predetermined work on the object conveyed on the conveyance path with a tool.

  However, although it is possible to confirm the two-dimensional shape of the target object based on the captured image captured by an imaging device such as a video camera, it is difficult to accurately confirm the three-dimensional shape of the target object. For this reason, when the object is an indeterminate shape, the method of correcting the operation command based on the captured image captured by the imaging device is transported on the transport path even if the robot operates based on the corrected operation command. It cannot be said that the prescribed work can be performed accurately and accurately on the target object, and as a result of not being performed accurately, the target object after the work becomes defective and cannot be put on the market. There was a problem of lowering. On the other hand, in order to reliably perform a predetermined operation on an object conveyed on the conveyance path with accuracy, a method of performing the operation over a longer time than usual can be considered, but in this case, the tact time is extended. Therefore, as in the case described above, there is a problem that productivity is lowered.

  The present invention has been made in view of such problems, and an object thereof is to provide a robot system capable of improving productivity.

In order to solve the above problems, according to one aspect of the present invention, a transport device that transports an object and a three-dimensional shape that detects a three-dimensional shape of the target object that is transported on a transport path by the transport device. sensor and, a plurality of robots can be attached a tool for performing the task of transferring the object while lifted by a predetermined lifting method, the first command output means to output an operation command to the robot, the 3 First mode determining means for determining a lifting method as a processing mode of lifting processing by the tool for the object transported on the transport path based on three-dimensional information corresponding to a detection result of a dimension sensor; Of the plurality of robots, the first robot to which the first tool corresponding to the lifting method determined by the first mode determining means is attached is selected. Robot selection means, and, based on the detection result of the three-dimensional sensor, wherein a first operation correcting means for correcting the operation command, the first controller means having, a first operation correction unit, The first command output means corrects the operation command so that the first tool attached to the first robot is transported while lifting the object transported on the transport path . The robot system is characterized in that an operation command corrected by the first operation correcting means is output to the first robot.
In order to solve the above problems, according to another aspect of the present invention, a transport device that transports an object, and a three-dimensional shape that detects a three-dimensional shape of the target object that is transported on a transport path by the transport device. A plurality of robots to which a sensor, a tool for performing a transfer operation while lifting the object by a predetermined lifting method, a second command output means for outputting an operation command to the robot, the three-dimensional Based on the three-dimensional information corresponding to the detection result of the sensor, the waiting posture until the lifting process of the robot is started as a processing mode of the lifting process by the tool for the object transported on the transport path A second mode determination means for determining the second robot waiting in the standby posture determined by the second mode determination means among the plurality of robots. Second controller selecting means, and second controller means having second action correcting means for correcting the action command based on the detection result of the three-dimensional sensor, and the second controller means. The motion correction means corrects the motion command so as to lift and transfer the object transported on the transport path by the tool attached to the second robot, and outputs the second command output. The robot system is applied, wherein the means outputs an operation command corrected by the second operation correction unit to the second robot.

  According to the robot system of the present invention, productivity can be improved.

It is a top view which represents typically the whole structure of the cutting cutting system of one Embodiment. It is a side view which represents typically the whole structure of a rough cutting processing system. It is a flowchart showing an example of the control content which a controller performs. It is explanatory drawing explaining an example of operation | movement of a rough cutting processing system. It is explanatory drawing explaining an example of operation | movement of a rough cutting processing system. It is explanatory drawing explaining an example of operation | movement of a rough cutting processing system. It is explanatory drawing explaining an example of operation | movement of a rough cutting processing system. It is explanatory drawing explaining an example of operation | movement of a rough cutting processing system. It is explanatory drawing explaining an example of operation | movement of a rough cutting processing system. It is explanatory drawing explaining an example of operation | movement of a rough cutting processing system. It is a side view which represents typically the whole structure of the cutting cutting system of the modification which determines the standby posture of a robot, and selects a robot. It is a flowchart showing an example of the control content which a controller performs. It is a side view which represents typically the whole structure of the cutting cutting system of the modification which determines the installation area | region of a robot, and selects a robot. It is a flowchart showing an example of the control content which a controller performs. It is a side view which represents typically the whole structure of the cutting cutting system of the modification which installs only one robot. It is a side view which represents typically the whole structure of a rough cutting processing system. It is a flowchart showing an example of the control content which a controller performs.

  Hereinafter, an embodiment will be described with reference to the drawings.

As shown in FIGS. 1 and 2, the raccoon cutting processing system 10 (robot system) of the present embodiment extracts the bulb part 12c by cutting the root hair part 12a and the stem part 12b from the raccoon 12 (object). It is a system that performs the cutting process. The raccoon 12 is a bulbous vegetable, that is, a natural product, and has a variation in shape (for example, the position, size, range, etc. of the root hair portion 12a, the stem portion 12b, and the bulb portion 12c). This is an example of an indefinite shape having an indefinite shape. This cutting and cutting system 10 includes a conveyor 14 (conveying device), a three-dimensional sensor 18, and a plurality of (two in this example) robots 16A and 16B (hereinafter referred to as “robots when appropriate, without any distinction”). 16 ”) and a controller 28 (controller means). The conveyor 14, the three-dimensional sensor 18, the robots 16A and 16B, and the controller 28 are connected so as to be able to communicate with each other.

  The conveyor 14 is a device that conveys the paper 12 placed on the conveyance surface in one direction (from the right side to the left side in FIG. 1 and from the depth side to the front side in FIG. 2). A unit 144 (drive unit) and an encoder 146 are provided. The motor 142 generates a rotational force. The conveyor driving unit 144 is connected to the motor 142 and is driven to rotate by the rotational force of the motor 142. The encoder 146 is connected to the conveyor driving unit 144 and detects the rotational position of the conveyor driving unit 144. The detection result of the encoder 146, that is, the rotational position information of the conveyor driving unit 144 is output to the controller 28.

  The three-dimensional sensor 18 includes a laser light source and a camera, and is fixed to the floor so that the laser light source and the camera are directed downward on the upstream side of the transport path by the conveyor 14 and positioned above the transport path. Further, it is fixed to a substantially inverted L-shaped support member 32. More specifically, the laser light source is a slit-shaped (linear) laser beam (hereinafter referred to as “laser slit light” as appropriate) at a predetermined position on the conveyor 14 conveyor surface in a direction orthogonal to the conveyor 14 conveyance direction. Is oriented so as to continuously irradiate (project). The camera is oriented so as to receive reflected light (reflected light having a predetermined angle with respect to incident light) of an optical path different from the laser light slit irradiation path by the laser light source, and the laser slit light irradiation position by the laser light source and The vicinity is continuously imaged.

  The three-dimensional sensor 18 is continuously transported continuously at a predetermined speed on the transport path, that is, the laser slit light is irradiated from the laser light source to the surface 12 passing through the lower part where the detection area is set. Then, the reflected light of the laser slit light is imaged by the camera, and the undercarriage 12 is scanned while passing below. Then, based on the captured image of the camera, the distance to the screen 12 is calculated using the principle of triangulation, and the three-dimensional shape of the screen 12 is detected. The detection result of the three-dimensional sensor 18, that is, the captured image of the camera of the three-dimensional sensor 18 and the distance information on the captured image are output to the controller 28.

  Each of the robots 16A and 16B has one side in the width direction of the transport path so that the robots 16A and 16B are separated to some extent (for example, about 1 m) along the transport path on the downstream side of the transport path from the three-dimensional sensor 18. 1 (the upper side in FIG. 1, the left side in FIG. 2) region and the other side (the lower side in FIG. 1, the right side in FIG. 2) region. Of the robots 16A and 16B, the robot 16A on the most upstream side of the transport path is described later with respect to the rack 12 that is transported on the transport path by a tool described later (specifically, a suction pad 166a described later). The area where the lifting process is performed is a predetermined distance S along the conveyance path from the fixed position of the three-dimensional sensor 18, specifically, the detection area of the outline 12 by the three-dimensional sensor 18, along the conveyance path. 12 is a distance transported during a processing time required for processing for obtaining a distance image described later from the detection result of the three-dimensional sensor 18 (for example, 1 m) or more.

  Each of these robots 16A and 16B is a vertical articulated robot in this example, and is a work for lifting and transferring the base 162, the turning base 163, the arm 164, and the rack 12 by a predetermined lifting method (for a predetermined work). Equivalent). The base 162 is fixed to the top side of the base 30 fixed to a floor (not shown). The turning base 163 is attached to the base 162 so as to freely turn. The arm 164 is composed of a plurality of members, and each member is rotatably attached. Further, a camera 20, a cutting device 22, a disposal box 24, and a throwing box 26 are installed around each robot 16A, 16B. The cameras 20 and 20 and the controller 28 are connected so as to be able to communicate with each other.

  The robot 16 </ b> A on the upstream side of the transfer path is capable of lifting the hood 12 by vacuum suction as the predetermined lifting method by being vacuumed by the vacuum device (not shown) as the tool at the tip of the arm 164. A pad 166a (adsorption device) is attached. This robot 16A cooperates with the turning base 163 and the arm 164, so that the suction pad 166a is placed on the raccoon 12 (specifically, the bulb 12c portion of the raccoon 12 as described later) that is transported on the transport path. Are moved to a predetermined imaging position within the field of view of a lens 201 of the camera 20 to be described later, while lifting the vacuum 12 by vacuum suction by the suction pad 166a. Then, the roof 12 lifted by the suction pad 166a is moved to the position of the blade 2221 of the circular cutter 222 of the surrounding cutting device 22 described later, and the cutting device 22 performs the cutting process. After that, when the root hair portion 12a and the stem portion 12b are removed by the above-described cutting process, the bulb portion 12c of the crown 12 is moved above the surrounding charging box 26 and charged into the charging box 26. To do.

  On the other hand, the robot 16B on the downstream side of the transfer path has a hand 166b (robot hand) that can lift the raccoon 12 by gripping as the predetermined lifting method, as the tool, is attached to the tip of the arm 164. The robot 16B moves the swing base 163 and the arm 164 in a coordinated manner to bring the hand 166b into contact with the transported hood 12 (specifically, the bulb 12c portion of the wrapping 12 as described later). The handle 12 is moved up to a predetermined imaging position in the field of view of a lens 201 of the camera 20 described later while being lifted by the gripping by 166b. Then, the rack 12 lifted by the hand 166b is moved to the position of a blade 2221 of a circular cutter 222 of the cutting apparatus 22 described later, and the cutting apparatus 22 performs the cutting process. After that, when the root hair portion 12a and the stem portion 12b are removed by the cutting process, which is lifted by the hand 166b, the bulb portion 12c of the crown 12 is moved above the surrounding throwing box 26 and thrown into the throwing box 26. .

  The tact time when lifting the candy 12 by vacuum suction by the suction pad 166a is shorter than the tact time when lifting the luck 12 by gripping with the hand 166b. That is, the vacuum suction by the suction pad 166a can be lifted faster than the grip by the hand 166b.

  Each camera 20, 20 includes a lens 201 and an illumination 202 composed of a plurality of LEDs arranged in a ring shape around the lens 201 on the front side, and the back side faces the side of the conveyor 14. The lens 201 is installed in the vicinity of each robot 16A, 16B so that the field of view of the lens 201 is located within the movable range of the tool of the surrounding robot 16. By installing the cameras 20 and 20 so that the front side does not face upward, the lens 201 can be protected from water drops falling from above. Further, a backlight (not shown) is installed on the front side of the lens 201 of each camera 20, 20. Each of the cameras 20 and 20 captures an image of the visual field through the lens 201 when the surrounding robot 16 is moved to the imaging position within the visual field of the lens 201 as described above. As a result, when the image is moved to the image pickup position, the image of the image 12 is captured, and the shape and posture of the image 12 are detected. The detection results of the cameras 20, 20, that is, the captured images of the cameras 20, 20 are output to the controller 28.

  Each of the cutting devices 22, 22 has a circular cutter 222 that rotates in the circumferential direction with a blade 2221 that performs the above-described cutting processing on the package 12, and the position of the blade 2221 of the circular cutter 222 is The robots 16 are installed in the vicinity of the robots 16A and 16B so as to be located within the movable range of the tool of the robot 16.

  Each disposal box 24, 24 is a box opened on the top side for discarding the root hair portion 12 a and stem portion 12 b of the plant 12 that has been cut by the cutting device 22, and is installed below each cutting device 22, 22. ing.

  Each throwing box 26, 26 is a box whose top side is opened for throwing the bulb portion 12c of the crown 12 after the root hair portion 12a and the stem portion 12b are cut by the cutting device 22, and is placed in the vicinity of each robot 16A, 16B. Each is installed.

  The controller 28 is composed of a computer including an input device, a display device, a storage device, an arithmetic device, and the like for controlling the operations of the three-dimensional camera 18, the robots 16A and 16B, and the cameras 20 and 20. ing. In the storage device of the controller 28, the robot 16 and the tool for performing the work of lifting and transporting the raccoon 12 which has been input on the conveyance path, for example, via the teaching pendant, etc. while being lifted by the tool. A plurality of operation commands including operation commands (for example, teaching data such as the position of each control point, the angle of each joint, and the type of interpolation operation) in which the type is not specified are stored.

  Hereinafter, an example of the control contents executed by the controller 28 in the present embodiment will be described with reference to FIG.

  In FIG. 3, the processing shown in this flow is started by performing a predetermined start operation (for example, powering on the controller 28) via the input device, for example. First, in step S5, the controller 28 performs predetermined operations stored in the storage device for the robots 16A and 16B so that the robots 16A and 16B assume a predetermined standby posture (for example, the posture shown in FIG. 2). Outputs a command. Thereby, each robot 16A, 16B cooperates with the turning base 163 and the arm 164 based on the operation command from the controller 28, and waits in a predetermined standby posture.

  In step S10, the controller 28 inputs a detection result of the three-dimensional sensor 18, that is, a captured image of the camera of the three-dimensional sensor 18 and distance information on the captured image.

  Thereafter, in step S20, the controller 28 represents the distance from the three-dimensional sensor 18 on the image based on the captured image of the camera of the three-dimensional sensor 18 input in step S10 and the distance information on the captured image. A distance image (three-dimensional information) is generated. Then, based on the generated distance image, the three-dimensional shape of the mask 12 (hereinafter referred to as “specific rack 12” as appropriate) is detected after passing under the three-dimensional sensor 18.

  Then, the process proceeds to step S30, and the controller 28 detects a part that can be vacuum-sucked by the suction pad 166a of the specific raccoon 12 based on the three-dimensional shape of the specific raccoon 12 detected in step S20 (step S30). Details will be described later).

  Thereafter, in step S40, the controller 28 determines a lifting method as a processing mode of the lifting process by the tool of the robot 16 with respect to the specific package 12 according to the detection result in the step S30. For example, in the above-described step S30, when a portion that can be vacuum-sucked by the specific raccoon 12 is detected, that is, when there is a portion that can be vacuum-sucked by the specific raccoon 12, a lifting method for the specific raccoon 12 Are determined to be vacuum suction with a short tact time among vacuum suction by the suction pad 166a and gripping by the hand 166b. On the other hand, in the above-described step S30, when a portion of the specific raccoon 12 that is likely to be vacuum-sucked is not detected, that is, when there is no portion of the specific raccoon 12 that is likely to be vacuum-sucked, the specific raccoon 12 is raised The method is determined to be gripping with a long tact time among vacuum suction by the suction pad 166a and gripping by the hand 166b. That is, when there is a site that can be vacuum-adsorbed in a specific rack 12, the lifting method is determined to be a vacuum adsorption with a short tact time, and only when there is no site that can be vacuum-adsorbed in a specific rack 12. The lifting method is determined to grip with a long tact time. The procedure of step S40 functions as an aspect determination unit described in the claims.

  Then, the process proceeds to step S50, and the controller 28 is a tool (corresponding to the first tool) corresponding to the lifting method determined in step S40 as the robot 16 that performs the work on the specific rack 12 among the robots 16A and 16B. Hereinafter, the robot 16 (corresponding to the first robot, hereinafter referred to as “specific robot 16”) to which the “specific tool” is attached is selected. For example, when the lifting method is determined to be vacuum suction in step S40, the robot 16A including the suction pad 166a that is a tool for performing vacuum suction is selected. On the other hand, if the lifting method is determined to be gripping in step S40, the robot 16B including the hand 166b that is a tool for gripping is selected. The procedure of step S50 functions as the first robot selection unit described in the claims.

  After that, in step S60, the controller 28 sets a specific contact target site for the current 12 according to the selection result in step S50. The contact target part is a part to be a target of contact by a specific tool of the specific robot 16. For example, when the robot 16A is selected in step S50, a part satisfying a predetermined condition (details will be described later) among the parts that can be vacuum-sucked in the specific jacket 12 detected in step S30. Then, the suction target site is set as the contact target site of the specific 12. The suction target site is a target site for vacuum suction by the suction pad 166a. On the other hand, if the robot 16B is selected in step S50, an appropriate part of the bulb portion 12c of the specific raccoon 12 is set as a grip target part as the contact target part of the specific raccoon 12. The grip target part is a part that is a target of gripping by the hand 166b.

  Then, the process proceeds to step S70, where the controller 28 is transported on the transport path based on the detection result of the encoder 146 input from the encoder 146 of the conveyor 14 at an appropriate timing, that is, the rotational position information of the conveyor driving unit 144. The movement amount of Lucky 12 is calculated. Then, based on the calculated movement amount of the robot 12, the timing at which the specific robot 12 is transported within the movable range of the specific tool of the specific robot 16, in other words, the transport path of the specific robot 16 on the transport path. The operation start timing for lifting the transported specific package 12 with a specific tool is calculated. The procedure of step S70 functions as a timing calculation unit described in the claims.

  Thereafter, in step S75, the controller 28 reads out the operation command related to step S75 stored in the storage device, and corrects the read-out operation command. Specifically, when the operation start timing calculated in step S70 is reached, the turning base 163 and the arm 164 are cooperatively operated to specify a specific contact target site of the specific rack 12 that is transported on the transport path. The read operation command is corrected for the specific tool of the specific robot 16 so that the tool is brought into contact and the specific tool 12 is lifted by the specific tool and moved to the imaging position of the surrounding camera 20. . For example, when the robot 16A is selected in the above step S50, the suction pad 166a is brought into contact with the suction target site of the specific raccoon 12, and the specific raccoon 12 is lifted by vacuum suction by the suction pad 166a and the imaging position is picked up. The movement command is corrected for the suction pad 166a of the robot 16A. On the other hand, if the robot 16B has been selected in step S50, the hand 166b is brought into contact with the grip target portion of the specific raccoon 12, and the specific raccoon 12 is lifted and moved to the imaging position by gripping with the hand 166b. In this way, the operation command is corrected for the hand 166b of the robot 16B.

  Thereafter, in step S80, the controller 28 outputs the operation command corrected in step S75 to the specific robot 16. As a result, when the specific robot 16 comes to the operation start timing based on the operation command from the controller 28, the specific robot 12 is transported on the transport path by cooperatively operating the turning base 163 and the arm 164. A specific tool is brought into contact with the contact target site, and the specific tool 12 is lifted by the specific tool and moved to an imaging position related to the surrounding camera 20 (details will be described later). For example, when the robot 16A has been selected in the above step S50, the robot 16A brings the suction pad 166a into contact with the suction target site of the specific rack 12, and the specific rack 12 is sucked by the vacuum suction by the suction pad 166a. Move to the imaging position while lifting. On the other hand, if the robot 16B has been selected in the above step S50, the robot 16B brings the hand 166b into contact with the gripping target site of the specific raccoon 12, and picks up an image while lifting the specific raccoon 12 by gripping with the hand 166b. Move to position.

  Then, the process proceeds to step S <b> 90, and the controller 28 inputs a detection result of the camera 20 installed around the specific robot 16, that is, a captured image of the camera 20.

  After that, in step S100, the controller 28 detects the shape and posture of the specific raccoon 12 captured by the camera 20 based on the captured image of the camera 20 input in step S90, and the specific raccoon 12 The processing target part is set (details will be described later). The processing target portion is a portion that is a target of the entire cutting portion including the cutting start position by the blade 2221 of the circular cutter 222 of the cutting device 22 and the cutting angle therefrom.

  Then, the process proceeds to step S105, and the controller 28 reads out the operation command related to the step S105 stored in the storage device, and corrects the read operation command. Specifically, the read operation command is corrected for the specific tool of the specific robot 16 so that the processing target portion of the specific rack 12 lifted by the specific tool is guided to the position of the blade 2221. . For example, when the robot 16A is selected in the above step S50, the operation command is sent to the suction pad of the robot 16A so as to guide the processing target site of the specific arm 12 lifted by the suction pad 166a to the position of the blade 2221. Correct for 166a. On the other hand, if the robot 16B has been selected in the above step S50, the operation command is sent to the hand 166b of the robot 16B so as to guide the processing target part of the specific arm 12 that is lifted by the hand 166b to the position of the blade 2221. To correct.

  Then, the process proceeds to step S110, and the controller 28 outputs the operation command corrected in step S105 to the specific robot 16. As a result, the specific robot 16 cooperates with the turning base 163 and the arm 164 on the basis of the operation command from the controller 28, and the processing target site of the specific rack 12 lifted by the specific tool is moved to the position of the blade 2221. To perform a predetermined operation (details will be described later). For example, when the robot 16A is selected in the above step S50, the robot 16A guides the processing target site of the specific jacket 12 lifted by the suction pad 166a to the position of the blade 2221 and performs a predetermined operation. . On the other hand, when the robot 16B is selected in the above step S50, the robot 16B guides the processing target portion of the specific arm 12 that is lifted by the hand 166b to the position of the blade 2221 and performs a predetermined operation.

  Thereafter, in step S120, the controller 28 determines whether or not a predetermined end operation (for example, powering off the controller 28) has been performed via the input device, for example. Until the predetermined end operation is performed, the determination in step S120 is not satisfied, and the process returns to step S5 and the same procedure is repeated. If a predetermined end operation is performed, the determination in step S120 is satisfied, and the processing shown in this flow is ended.

  In the above, the procedure of step S75 and step S105 functions as an operation correction unit described in the claims. Further, the procedures of step S5, step S80, and step S110 function as an operation output unit.

  Hereinafter, an example of the operation of the scissors cutting processing system 10 will be described with reference to FIGS.

  First, a predetermined operation command stored in the storage device is output from the controller 28 to each robot 16A, 16B, and each robot 16A, 16B cooperates with the turning base 163 and the arm 164 to obtain a predetermined standby posture. And waits (see step S5). As shown in FIG. 4, when the transport 12 continuously transported continuously at a predetermined speed on the upstream side of the transport path passes below the three-dimensional sensor 18, it is detected by the three-dimensional sensor 18. . Then, the detection result, that is, the captured image of the camera of the three-dimensional sensor 18 and the distance information on the captured image are output to the controller 28. Thereby, the captured image of the camera of the three-dimensional sensor 18 and the distance information on the captured image are input to the controller 28 (see step S10), and the input captured image of the camera of the three-dimensional sensor 18 and the captured image thereof are input. The distance image is generated based on the upper distance information. FIGS. 5A and 5B are schematic diagrams obtained by modeling an example of the generated distance image. Note that the distance images shown in FIGS. 5A and 5B are obtained by modeling the same information from different viewpoints. As shown in FIGS. 5 (a) and 5 (b), the generated distance image shows the shape of the specific 12 that has passed under the three-dimensional sensor 18 in three dimensions. Based on this, the three-dimensional shape of the specific 12 is detected (see step S20). Then, based on the detected three-dimensional shape of the specific raccoon 12, a part of the specific raccoon 12 that is likely to be vacuum-sucked is detected (see step S30). In the present embodiment, an obstacle (for example, root hair portion) of vacuum suction by the suction pad 166a in the bulb portion 12c of the specific raccoon 12 shown in the generated distance image as a portion that can be vacuum-sucked by the specific raccoon 12 is shown. A part having a flat area equal to or larger than a predetermined area (for example, 1 cm 3) is detected.

  Thereafter, the lifting method by the tool of the robot 16 with respect to the specific package 12 is determined according to the detection result (see step S40). In the following, description will be given by taking as an example a case in which a portion of the specific hood 12 that is likely to be vacuum-sucked is detected. That is, in the above, when a part that is likely to be vacuum-sucked by the specific raccoon 12 is detected, the lifting method for the specific raccoon 12 is determined to be the vacuum suction. Then, the robot 16A including the suction pad 166a, which is a tool corresponding to vacuum suction, is selected from the robots 16A and 16B (see step S50). After that, among the parts that are likely to be vacuum-adsorbed of a specific 12, the part existing at the highest position (the part indicated by reference numeral 31 in the examples shown in FIGS. 5A and 5B) is detected, The detected site is set as the suction target site of the specific 12 (see step S60). Then, based on the detection result of the encoder 146 input to the controller 28 from the encoder 146 of the conveyor 14 at an appropriate timing, that is, based on the rotational position information of the conveyor drive unit 144, the amount of movement of the transport 12 that is transported on the transport path Is calculated. Then, based on the calculated movement amount of the head 12, the timing at which the specific head 12 is transported within the movable range of the suction pad 166a of the robot 16A, in other words, transported on the transport path of the robot 16A. The operation start timing for lifting the specific rack 12 coming up with the suction pad 166a is calculated (see step S70).

  Then, the operation command stored in the storage device is read and corrected for the suction pad 166a of the robot 16A (see step S75). Thereafter, a corrected operation command is output from the controller 28 to the robot 16A, and as shown in FIG. 6, the robot 16A coordinates the turning base 163 and the arm 164 when the calculated operation start timing is reached. The suction pad 166a is brought into contact with the set suction target part (part indicated by reference numeral 31 in the example shown in FIG. 6) of the specific raccoon 12 that is operated and transported on the transport path. Then, as shown in FIG. 7, the suction pad 166 is lifted by vacuum suction by the suction pad 166, and the swivel base 163 and the arm 164 are cooperatively operated so as to have a predetermined imaging posture. The rack 12 lifted at 166 is moved to the imaging position within the field of view of the lens 201 of the surrounding camera 20 (see step S80).

  Then, the camera 20 images the robot 16 </ b> A in the imaging posture in the field of view of the lens 201, and the specific lucky 12 moved to the imaging position. The captured image is output to the controller 28. Thereby, the captured image of the camera 20 is input to the controller 28 (see step S90). FIG. 8A is a schematic diagram that models an example of a captured image of the camera 20 input to the controller 28. As shown in FIG. 8A, in the captured image of the camera 20, the shapes and postures of the robot 16A and the specific wrapping 12 are represented in two dimensions. Based on this captured image, the image is captured by the camera 20. Then, the shape and orientation of the specific bracket 12 are detected, and the processing target part of the specific bracket 12 is set (see step S100). In the present embodiment, first, an image excluding the image 16A ′ of the robot 16A shown in the captured image of the camera 20 as shown in FIG. Thereafter, as shown in FIG. 8 (b), the maximum inscribed circle (circle indicated by reference numeral 33 in the example shown in FIG. 8 (b)) of the image 12 'of the specific sketch 12 shown in the generated image is obtained. The center position of the calculated maximum inscribed circle is calculated, and the position is set as the center of gravity of the image 12 ′ of the specific 12 (the position indicated by reference numeral 34 in the example shown in FIG. 8B). Next, as shown in FIG. 9 (a), a predetermined range on one side of the center of gravity of the image 12 'of the specific poster 12 obtained as described above (range indicated by reference numeral 35 in the example shown in FIG. 9 (a)). Is compared with the area of a predetermined range on the other side (in the example shown in FIG. 9A, the range indicated by reference numeral 36), and the area having the larger area (in the example shown in FIG. 9A, indicated by reference numeral 35). The range shown) is determined to be the root hair 12a side, and the side having the smaller area (the range indicated by reference numeral 36 in the example shown in FIG. 9A) is determined to be the stem 12b side. Then, as shown in FIG. 9B, the width (thickness) on the stem portion 12b side is measured from the center of gravity of the image 12 'of the specific raccoon 12 obtained as described above, and the width becomes a predetermined value or less. (The part indicated by reference numeral 37 in the example shown in FIG. 9 (b)) and the width (thickness) of the root hair 12a side from the center of gravity of the image 12 'of the specific raccoon 12 obtained above is measured to obtain a predetermined width. A part that is equal to or less than the value (part indicated by reference numeral 38 in the example shown in FIG. 9B) is set as a specific target part for processing 12.

  Then, the operation command stored in the storage device is read and corrected for the suction pad 166a of the robot 16A (see step S105). Thereafter, a corrected operation command is output from the controller 28 to the robot 16A, and as shown in FIG. 10, the robot 16A operates the turning base 163 and the arm 164 in a coordinated manner and lifts the suction pad 166a. The set machining target portion of the bracket 12 (portions indicated by reference numerals 37 and 38 in the example shown in FIG. 10) is guided to the position of the blade 2221 of the circular cutter 222. Then, the specific blank 12 lifted by the suction pad 166a is cut along the processing target portion by the blade 2221. As a result, the root hair portion 12a and the stem portion 12b are separated from the bulb portion 12c and dropped, thereby entering the disposal box 24 below the blade 2221. Then, the bulb portion 12c of the specific raccoon 12 lifted by the suction pad 166a is moved above the surrounding charging box 26, where the vacuum suction by the suction pad 166 is released, whereby the bulb portion of the specific raccoon 12 is released. 12c is loaded into the loading box 26 (see step S110).

  As described above, the raccoon cutting processing system 10 according to the present embodiment includes the conveyor 14 that transports the raccoon 12, the robots 16A and 16B including the suction pads 166a or the hands 166b, and operation commands to the robots 16A and 16B. And a controller 28 for outputting. Each of the robots 16A and 16B operates based on an operation command from the controller 28, and performs a work of transporting the raccoon 12 transported on the transport path while being lifted by the suction pad 166a or the hand 166b.

  Here, when carrying out the work of lifting and transporting the raccoon 12, which is the above-mentioned indefinite shape, the shapes of the raccoons 12 vary, and the shapes of the raccoons 12 cannot be recognized, so that each robot 16A, 16B. Even if it operates based on the operation command from the controller 28, there is a possibility that it will miss the package 12. In order to eliminate such inconvenience, in general, the camera 12 picks up the image of the transport 12 that is transported on the transport path, and the controller 28 corrects the operation command based on the captured image and corrects the robot 16 to be operated. By outputting the subsequent operation command, even when the transfer operation is performed with respect to the raccoon 12, the robot 16 operates based on the corrected operation command, thereby reducing the loss of the raccoon 12. . However, although the two-dimensional shape of the raccoon 12 can be confirmed based on the captured image captured by the camera, it is difficult to accurately confirm the three-dimensional shape of the raccoon 12. For this reason, when performing the work of lifting and transporting the raccoon 12, the method of correcting the operation command based on the captured image captured by the camera, even if the robot operates based on the corrected operation command, It cannot be said that it is possible to reliably prevent the loss, and there is a problem in that productivity is reduced as a result of the loss of the blank 12. On the other hand, in order to reliably carry out the work of lifting and transporting the raccoon 12, a method of lifting the larva 12 over a longer time than usual can be considered. However, in this case, the tact time is extended. Similarly, there is a problem that productivity is lowered.

  Therefore, in the present embodiment, the three-dimensional sensor 18 is provided on the upstream side of the conveyance path, and the three-dimensional sensor 18 detects the three-dimensional shape of the paper 12 that is conveyed on the conveyance path. Thereafter, the controller 28 corrects the operation command based on the detection result of the three-dimensional sensor 18 and outputs the corrected operation command to the robot 16 to be operated. As a result, the robot 16 that has input the corrected operation command from the controller 28 operates based on the corrected operation command, so that the robot 12 that is transported on the transport path is moved by the suction pad 166a or the hand 166b. It is possible to lift it reliably and quickly.

  As described above, according to the present embodiment, even when the transporting operation is performed with respect to the raccoon 12, it is possible to reliably prevent the raccoon 12 from being missed without extending the time tact. . As a result, productivity can be improved.

  In the present embodiment, in particular, the three-dimensional sensor 18 has a laser light source distributed so as to irradiate laser slit light to a predetermined position on the transport surface of the conveyor 14, an irradiation position of the laser slit light by the laser light source, and And a camera for imaging the vicinity thereof. By making the three-dimensional sensor 18 have such a structure, the three-dimensional shape of the raccoon 12 conveyed on the conveyance path can be reliably detected with high accuracy.

  In the present embodiment, in particular, the controller 28 determines a lifting method for the crane 12 that is transported on the transport path based on the detection result of the three-dimensional sensor 18. As a result, it is possible to determine a lifting method capable of reliably and quickly lifting the package 12. Then, the controller 28 corrects the operation command so that the suction pad 166a or the hand 166b moves the transport 12 that is transported on the transport path in accordance with the determined lifting method. Thereby, it is possible to transfer the larva 12 while being lifted on the conveyance path by a lifting method capable of lifting the larva 12 reliably and quickly. As a result, even if the transporting operation is performed with respect to the raccoon 12, it is possible to reliably prevent the lacquer 12 from being missed without extending the time tact, and to improve productivity.

  In the present embodiment, the following effects can be obtained. That is, the processing for acquiring the distance image from the detection result of the three-dimensional sensor 18 requires a large amount of calculation and requires a relatively long processing time. Therefore, in the present embodiment, the area where the robot 16A installed on the most upstream side of the transport path among the robots 16A and 16B is lifted by the suction pad 166a is the area from the detection area of the rack 12 by the three-dimensional sensor 18. It is installed on the downstream side of the conveyance path so as to be separated by a predetermined distance S or more along the conveyance path. Accordingly, the predetermined distance S is set to be longer than the distance transported in the processing time required for the processing of the raccoon 12 to acquire the distance image from the detection result of the three-dimensional sensor 18, thereby attracting the robot 16 </ b> A. Before reaching the area where the lifting process is performed by the pad 166a, the above process can be ended and a distance image can be acquired. As a result, the suction pad 166a can be lifted after confirming the three-dimensional shape of the suction pad 166a based on the acquired distance image, so that it is possible to reliably prevent the suction pad 166a from being missed. it can. Further, while the processing for acquiring the distance image from the detection result of the three-dimensional sensor 18 is being performed, the suction pad 166a can be transported to effectively use the processing time for the processing without wasting it. it can.

  In this embodiment, in particular, the conveyor 14 includes a motor 142, a conveyor driving unit 144 that is rotationally driven by the motor 142, and an encoder 146 that is connected to the conveyor driving unit 144 and detects the rotational position of the conveyor driving unit 144. It has. Then, the controller 28 calculates the operation start timing of the robot 16 based on the detection result of the encoder 146. As a result, the raccoon 12 conveyed on the conveyance path can be reliably lifted by the tool of the robot 16 while reliably interlocking with the conveyance operation of the raccoon 12 by the conveyor 14.

  In the present embodiment, two robots 16A and 16B having tools with different lifting methods are installed. Then, the controller 28 determines the lifting method of the raccoon 12 based on the distance image corresponding to the detection result of the three-dimensional sensor 18, and includes a tool corresponding to the determined lifting method among the robots 16A and 16B. The selected robot 16 is selected. Thereafter, the operation command is corrected so that the robot 12 transported on the transport path is transported while being lifted by a tool corresponding to the determined lifting method of the selected robot 16. Thereby, it becomes possible to selectively use the robot 16 having a tool corresponding to a lifting method capable of lifting the crane 12 reliably and quickly among the robots 16A and 16B. As a result, it is possible to reliably prevent the removal of the package 12 and to improve productivity.

  In this embodiment, in particular, the suction pad 166a is attached to the arm 164 of the robot 16A, and the hand 166b is attached to the arm 164 of the robot 16B. By attaching the suction pad 166a to the arm 164 of the robot 16A, the crane 12 can be lifted by suction. Thereby, the raccoon 12 can be lifted without being damaged by piercing or the like, and the tact time can be shortened as compared with the case where the raccoon 12 is lifted by gripping with the hand 166b. Further, by attaching the hand 166b to the arm 164 of the robot 16B, the crane 12 can be lifted by gripping. As a result, although the tact time is extended as compared with the case where the oyster 12 is lifted by the suction of the suction pad 166a, the luck 12 may have a shape or material that is not suitable for suction, or the suction pad 166a of the raccoon 12 may be sucked. Even when it is difficult to lift the candy 12 by suction with the suction pad 166a, such as when there is an obstacle in the vicinity of the part, the candy 12 can be reliably lifted.

  The embodiment is not limited to the above contents, and various modifications can be made without departing from the spirit and technical idea of the embodiment. Hereinafter, such modifications will be sequentially described.

(1) When the robot is selected by determining the standby posture of the robot In the above embodiment, the robot 16 is determined by determining the lifting method of the raccoon 12 based on the distance image corresponding to the detection result of the three-dimensional sensor 18. However, the present invention is not limited to this. Even if the robot 16 is selected by determining the waiting posture until the robot 16 starts the lifting process based on the distance image corresponding to the detection result of the three-dimensional sensor 18. Good.

  As shown in FIG. 11, in this modification, the tool attached to the tip of the arm 164 of the robot 16B and the control content of the controller 28 (see FIG. 1) are different from the above embodiment. That is, in the present modification, the robot 16B has the same suction pad 166a as the robot 16A attached to the tip of the arm 164.

  Hereinafter, an example of the control contents executed by the controller 28 in this modification will be described with reference to FIG. FIG. 12 is a diagram corresponding to FIG. 3 described above, and the same steps as those in FIG. 3 are denoted by the same reference numerals, and description thereof will be omitted or simplified as appropriate.

  In FIG. 12, first, in step S5 ′, the controller 28 stores a storage device for each robot 16A, 16B so that the robots 16A, 16B have different predetermined standby postures (for example, the posture shown in FIG. 11). The predetermined operation command stored in is output. Thereby, each robot 16A, 16B cooperates with the turning base 163 and the arm 164 based on the operation command from the controller 28, and waits for each robot 16A, 16B in the predetermined standby posture different from the above.

  Subsequent steps S10 and S20 are the same as those in FIG. 3 described above. When the three-dimensional shape of the specific package 12 is detected in step S20, the process proceeds to step S35.

  In step S <b> 35, the controller 28 detects a portion that is likely to be vacuum-sucked by the suction pad 166 a of the specific raccoon 12 based on the three-dimensional shape of the specific raccoon 12 detected in step S <b> 20 described above. Then, a part that satisfies a predetermined condition among the parts that can be vacuum-sucked in the vacuum 12 after the detection is set as a suction target part by the suction pad 166a of the specific vacuum 12.

  Thereafter, in step S40 ′, the controller 28 starts the lifting process of the robot 16 as the processing mode of the lifting process for the specific raccoon 12 according to the set position of the suction target site of the specific raccoon 12. The standby posture is determined. Specifically, among the different waiting postures taken by the robots 16A and 16B in step S5 ′, the suction target site can be reliably approached, and the time taken to approach the suction target site is short, that is, the tact time The short waiting posture is determined. In addition, the procedure of this step S40 'functions as the aspect determining means described in the claims.

  Then, the process proceeds to step S50 ′, and the controller 28 is the robot 16 (second robot) that waits in the standby posture determined in step S40 ′ as the robot 16 that performs the work on the specific robot 12 among the robots 16A and 16B. (Equivalent to robot). Note that the procedure of step S50 'functions as the second robot selection means described in the claims.

  The subsequent procedure is almost the same as that in FIG.

  In the above, the procedure of the above-described step S75 and the above-described step S105 functions as an operation correction unit described in the claims. Further, the procedure of step S5 ′, the above-described step S80, and the above-described step S110 functions as an operation output unit.

  In the present modification described above, two robots 16 are installed, that is, the robots 16A and 16B that wait in different standby postures. Then, the controller 28 determines the standby posture until the robot 16 starts the lifting process based on the distance image corresponding to the detection result of the three-dimensional sensor 18, and the above-determined standby state is selected among the robots 16A and 16B. The robot 16 waiting in the posture is selected. Thereafter, the operation command is corrected so that the suction pad 166a of the selected robot 16 is transported while lifting the transport 12 that is transported on the transport path. As a result, it is possible to selectively use the robot 16 that stands by in a standby posture in which the robot 12 can be lifted reliably and quickly among the robots 16A and 16B. As a result, it is possible to reliably prevent the removal of the package 12 and to improve productivity.

(2) In the case where the robot installation area is determined and the robot is selected In the above-described embodiment, the lifting method of the crane 12 is determined based on the distance image corresponding to the detection result of the three-dimensional sensor 18, and the robot 16 However, the present invention is not limited to this, and the robot 16 may be selected by determining the installation region of the robot 16 based on the distance image corresponding to the detection result of the three-dimensional sensor 18.

  As shown in FIG. 13, in this modification, the tool attached to the tip of the arm 164 of the robot 16B and the control content of the controller 28 (see FIG. 1) are different from those in the above-described embodiment. That is, in the present modification, the robot 16B has the same suction pad 166a as the robot 16A attached to the tip of the arm 164.

  Hereinafter, an example of the control content executed by the controller 28 in this modification will be described with reference to FIG. Note that FIG. 14 corresponds to FIG. 3 and FIG. 12 described above, and the same steps as those in FIG. 3 and FIG. 12 are denoted by the same reference numerals, and description thereof will be omitted or simplified as appropriate.

  14, step S5, step S10, and step S20 are the same as those in FIG. 3 described above, and step S35 is the same as that in FIG. 12 described above. In step S35, the suction target of the specific 12 When the site is set, the process proceeds to step S42.

  In step S42, the controller 28 determines the width of the conveyance path by the conveyor 14 of the suction target part of the specific raccoon 12 that is transported on the transport path based on the set position of the suction target part of the specific raccoon 12. Detect the direction position. Specifically, the suction target portion is located on one side (left side in FIG. 13) or the other side (right side in FIG. 13) of the central portion CP (see FIG. 13) in the width direction of the conveyance path by the conveyor 14. Detect if there is.

  Thereafter, in step S44, the controller 28 determines a specific value based on the detection result in step S42, that is, whether the suction target site is on one side or the other side of the central portion CP in the width direction of the transport path. As the processing mode of the above-described lifting process for the robot 12, the installation area of the robot 16 is determined. For example, if it is detected in step S42 that the suction target site is on one side of the central portion CP in the width direction of the transport path, the installation area of the robot 16 is determined as the one side area in the width direction of the transport path. To do. On the other hand, if it is detected in step S42 that the suction target site is on the other side of the central portion CP in the width direction of the transport path, the installation area of the robot 16 is determined as the other side area in the width direction of the transport path. To do.

  Then, the process proceeds to step S50 ″, and the controller 28 sets the robot 16 installed in the installation area of the robot 16 determined in step S44 as the robot 16 that performs work on the specific robot 12 among the robots 16A and 16B. For example, if the installation area of the robot 16 is determined as the one side area in the width direction of the transfer path in step S44, the center CP in the width direction of the transfer path is selected. The robot 16A installed in the one side region in the width direction of the transport path that can reliably approach the suction target site on one side and takes a short time to approach the target site, that is, has a short tact time is selected. On the other hand, in step S44, the installation area of the robot 16 is determined as the other area in the width direction of the transfer path. In this case, it is possible to reliably approach the suction target site on the other side of the central portion CP in the width direction of the transport path, and the time required for approaching the suction target site is short, that is, the width direction of the transport path with short tact time The robot 16B installed in the other side region is selected. The procedure of step S50 ″ functions as third robot selection means described in the claims.

  The subsequent procedure is almost the same as that in FIG.

  In the above, the procedure of step S42 and step S44 functions as the aspect determining means described in the claims. Among them, the procedure of step S42 functions as the position detecting means, and the procedure of step S44 is the area determining means. Function as. Moreover, the procedure of the above-mentioned step S75 and the above-mentioned step S105 functions as an operation | movement correction means as described in a claim. Further, the procedure of step S5 ′, the above-described step S80, and the above-described step S110 functions as an operation output unit.

  In the present modification described above, two robots 16 are installed, that is, the robots 16A and 16B provided over the one side region and the other region in the width direction of the transport path. Then, the controller 28 detects the position in the width direction of the transport path of the transport 12 that is transported on the transport path based on the distance image corresponding to the detection result of the three-dimensional sensor 18, and based on the detection result, the robot 16 And the robot 16 installed in the determined installation area is selected from the robots 16A and 16B. Thereafter, the operation command is corrected so that the suction pad 166a of the selected robot 16 is transported while lifting the transport 12 that is transported on the transport path. As a result, it is possible to selectively use the robot 16 installed in the installation area where the robot 12 can be lifted reliably and quickly among the robots 16A and 16B. As a result, it is possible to reliably prevent the removal of the package 12 and to improve productivity.

(3) When only one robot is installed In the above description, the configuration is such that two robots 16 are installed. However, the present invention is not limited to this, and a configuration in which only one robot 16 is installed may be used.

  As shown in FIG.15 and FIG.16, the cutting system 10A (robot system) of this modification includes the conveyor 14, the three-dimensional sensor 18, the robot 16A, the controller 28, and the controller 28. have.

  In the robot 16A of this modification, the above-described suction pad 166a and hand 166b are attached to the distal end side of the arm 164 as a plurality of (two in this example) tools having different lifting methods. Around the robot 16A, the above-described camera 20, cutting device 22, disposal box 24, and insertion box 26 are installed.

  Further, in the storage device of the controller 28 of this modification, for example, an operation is performed in which the tool 12 is transported while being lifted by a tool with respect to the transport 12 that has been previously transported on the transport path, for example, via a teaching pendant. A plurality of operation commands are stored, including operation commands for which no tool type is specified.

  Hereinafter, an example of control contents executed by the controller 28 in the present modification will be described with reference to FIG. Note that FIG. 17 corresponds to FIG. 3 described above, and the same steps as those in FIG. 3 are denoted by the same reference numerals, and description thereof will be omitted or simplified as appropriate.

  In FIG. 17, first, in step S5A, the controller 28 sends a predetermined operation command stored in the storage device to the robot 16A so that the robot 16A assumes a predetermined standby posture (for example, the posture shown in FIG. 16). Output. As a result, the robot 16A cooperates with the turning base 163 and the arm 164, and waits in a predetermined standby posture.

  Subsequent steps S10 to S40 are the same as those in FIG. 3 described above. When the above-described method for lifting the specific package 12 is determined in step S40, the process proceeds to step S50A. In this modification as well, the procedure of step S40 functions as the aspect determining means described in the claims.

  In Step S50A, the controller 28 lifts the robot determined in Step S40 described above as a tool for lifting the specific tool 12 among the two tools provided in the robot 16A, that is, the suction pad 166a and the hand 166b. A tool corresponding to the method (corresponding to the second tool; hereinafter referred to as “specific tool” as appropriate) is selected. For example, if the lifting method is determined to be vacuum suction in step S40 described above, the suction pad 166a, which is a tool for performing vacuum suction, is selected. On the other hand, if the lifting method has been determined to be gripping in step S40 described above, the hand 166b, which is a tool for gripping, is selected. Note that the procedure of step S50A functions as the tool selection means described in the claims.

  After that, in step S60A, the controller 28 sets a specific contact target site for the 12th step according to the selection result in step S50A. For example, when the suction pad 166a is selected in the above step S50A, the part that satisfies the predetermined condition among the parts that are likely to be vacuum-sucked in the specific 12 that is detected in the above-described step S30 is It is set as a suction target site for a specific luck 12. On the other hand, when the hand 166b is selected in the step S50A, an appropriate part of the bulb portion 12c of the specific raccoon 12 is set as the grip target part of the specific raccoon 12.

  Then, the process proceeds to step S70A, and the controller 28, similarly to the above-described step S70, is the timing at which the specific rack 12 is conveyed within the movable range of the tool selected in step S50A, in other words, the robot 16A. The operation start timing is calculated. The procedure of step S70A functions as a timing calculation unit described in the claims.

  Thereafter, in step S75A, the controller 28 reads out the operation command related to the step S75A stored in the storage device, and corrects the read operation command. Specifically, when the operation start timing calculated in step S70A is reached, the turning base 163 and the arm 164 are cooperatively operated, and the specific contact target site of the specific rack 12 that is transported on the transport path is specified. The read operation command is corrected for a specific tool so that the tool is brought into contact with the specific camera 12 and moved to the above-described imaging position of the surrounding camera 20 while being lifted by the specific tool. For example, when the suction pad 166a is selected in the above step S50A, the suction pad 166a is brought into contact with the suction target site of the specific suction pad 12, and imaging is performed while the specific suction pad 12 is lifted by vacuum suction by the suction pad 166a. The operation command is corrected for the suction pad 166a so as to move to the position. On the other hand, when the hand 166b is selected in the above step S50A, the hand 166b is brought into contact with the grasping target portion of the specific candy 12 and is moved to the imaging position while being lifted by the hand 166b. Thus, the operation command is corrected for the hand 166b.

  Thereafter, in step S80A, the controller 28 outputs the operation command corrected in step S75A to the robot 16A. As a result, the robot 16A collaborates with the turning base 163 and the arm 164 when the operation start timing is reached based on the operation command from the controller 28, and contacts the specific rack 12 that is transported on the transport path. A specific tool is brought into contact with the target site, and the specific tool 12 is moved to an imaging position related to the surrounding camera 20 while being lifted by the specific tool. For example, when the suction pad 166a is selected in the above step S50A, the robot 16A brings the suction pad 166a into contact with the specific suction target site of the specific skin 12, and the specific suction 12 by vacuum suction by the suction pad 166a. Is moved to the imaging position while lifting. On the other hand, when the hand 166b has been selected in the above step S50A, the robot 16A brings the hand 166b into contact with the gripping target site of the specific luck 12 and picks up the image by lifting the specific luck 12 by gripping with the hand 166b. Move to position.

  Subsequent steps S90 and S100 are substantially the same as those in FIG. 3 described above. When a specific machining target site of the specific 12 is set in step S100, the process proceeds to step S105A.

  In step S105A, the controller 28 reads out the operation command related to the step S105A stored in the storage device, and corrects the read operation command. Specifically, the read operation command is corrected for the specific tool so that the processing target site of the specific arm 12 lifted by the specific tool is guided to the position of the blade 2221 described above. For example, when the suction pad 166a is selected in the above step S50A, the operation command is sent to the suction pad 166a so as to guide the processing target portion of the specific arm 12 lifted by the suction pad 166a to the position of the blade 2221. To correct. On the other hand, when the hand 166b is selected in step S50A, the operation command is corrected for the hand 166b so as to guide the processing target portion of the specific arm 12 lifted by the hand 166b to the position of the blade 2221. .

  Then, the process proceeds to step S110A, and the controller 28 outputs the operation command corrected in step S105 to the robot 16A. As a result, the robot 16A cooperates with the turning base 163 and the arm 164 based on the operation command from the controller 28, and guides the processing target portion of the specific rack 12 lifted by the specific tool to the position of the blade 2221. , Perform a predetermined operation. For example, when the suction pad 166a is selected in the above step S50A, the robot 16A guides the processing target site of the specific jacket 12 lifted by the suction pad 166a to the position of the blade 2221 and performs a predetermined operation. Do. On the other hand, when the hand 166b is selected in the above step S50, the robot 16A guides the processing target site of the specific arm 12 that is lifted by the hand 166b to the position of the blade 2221 and performs a predetermined operation.

  The subsequent step S120 is the same as that in FIG.

  In the above, the procedure of step S75A and step S105A functions as the operation correcting means described in the claims. In addition, the procedure of step S5A, step S80A, and step S110A functions as an operation output unit.

  In this modification described above, the robot 16A includes the suction pad 166a and the hand 166b. Then, the controller 28 determines the lifting method of the raccoon 12 based on the distance image corresponding to the detection result of the three-dimensional sensor 18, and the tool corresponding to the determined lifting method of the suction pad 166a and the hand 166b. Make a selection. Thereafter, the operation command is corrected so that the selected tool is moved while being lifted up the transport 12 on the transport path. Thereby, it becomes possible to selectively use a tool corresponding to a lifting method that can lift the crane 12 reliably and quickly among the suction pads 166a and the hands 166b provided in the robot 16A. As a result, it is possible to reliably prevent the removal of the package 12 and to improve productivity.

(4) Others In the above-described embodiment, the suction pad 166a is attached to the arm 164 of the robot 16A, and the hand 166b is attached to the arm 164 of the robot 16B. However, the present invention is not limited thereto, and the arm 164 of the robot 16A is used as a tool. Instead of the suction pad 166a, a barbed member capable of lifting the raccoon 12 by piercing as the predetermined lifting method described above may be attached. Alternatively, the barbed member may be attached to the arm 164 of the robot 16B as a tool instead of the hand 166b. By attaching a barbed member to the arm 164 of the robot 16A or the robot 16B, the raccoon 12 can be lifted by piercing. As a result, the tact time can be shortened as compared with the case where the crane 12 is lifted by gripping with the hand 166b.

  In the above-described embodiment, the suction pad 166a is attached to the arm 164 of the robot 16A and the hand 166b is attached to the arm 164 of the robot 16B. However, the present invention is not limited to this, and vacuum suction is performed on the arms 164 of the robots 16A and 16B. You may attach the suction pad 166a from which quantity (vacuum suction power) differs.

  In the modified examples (1) and (2) described above, the suction pad 166a is attached to the arm 164 of each robot 16A, 16B. However, the present invention is not limited to this, and the suction pad 166a is attached to the arm 164 of each robot 16A, 16B. Instead of 166a, the hand 166b or the barbed member may be attached.

  In the modification (3) described above, the suction pad 166a and the hand 166b are attached to the arm 164 of the robot 16A. However, the present invention is not limited to this, and the arm 164 of the robot 16A is replaced with the suction pad 166a or the hand 166b. The barbed member may be attached. Alternatively, the barbed member may be attached to the arm 164 of the robot 16A in addition to the suction pad 166a and the hand 166b. Alternatively, two suction pads 166a having different vacuum suction amounts (vacuum suction power) may be attached to the arm 164 of the robot 16A.

  In the above description, the controller 28 performs various calculations and processes all at once. However, the present invention is not limited thereto, and these various calculations and processes may be performed by a device other than the controller 28. For example, a first image processing device, a second image processing device, a robot controller, and a control device (for example, a PC or a PLC) that controls them are provided, and the first image processing device includes a captured image of a camera of the three-dimensional sensor 18 and Based on the distance information on the captured image, the above-described distance image is generated and a part that is likely to be vacuum-sucked is detected, and the second image processing device, based on the captured image of the camera 20, The posture is detected, and the robot controller performs processing related to the motion control of the robot 16 such as determination of the processing mode of the above-described lifting processing, selection of the robot 16 or selection of the tool, correction of the motion command, and output of the motion command. You may go. In this case, the first image processing device, the second image processing device provided for each camera 20, the robot controller provided for each robot 16, and the control device for controlling them correspond to the controller means.

  In the above, the raccoon 12 which is an indeterminate shape is lifted and transported, but is not limited to this. Natural products such as vegetables and fruits other than the raccoon 12 and a plurality of types of artificial products (industrial products), etc. It may be transferred while lifting the irregular shape. In this case, natural objects such as vegetables and fruits other than Lucky 12 and irregular objects such as artificial objects in a state where a plurality of types are mixed correspond to the objects described in the claims. Moreover, you may process with respect to a fixed form thing, without being restricted to an indefinite form thing. In this case, the shaped object corresponds to the object described in the claims.

  Further, when performing an operation of transferring an object made of a magnetic material such as iron while lifting it, the object made of a magnetic material such as iron is lifted to the arm 164 of the robot 16 by electromagnetic adsorption as the above-described predetermined lifting method. Possible electromagnets may be attached. In this case, the electromagnet corresponds to the adsorption device and tool described in the claims.

  Further, in the above-described embodiment and the modifications of (1) and (2), two robots 16 are installed. However, the present invention is not limited to this, and three or more robots 16 may be installed. Further, in the modified example (3) described above, one robot 16 is installed. However, the present invention is not limited to this, and two or more robots 16 may be installed.

  In the above description, the robot system has been described as an example of a case where the robot system is applied to the chopping cutting processing system 10 that performs a transfer operation while lifting the rocket 12 that is transported on the transport path as a predetermined work. However, the present invention is not limited to this, and the robot system is a predetermined operation, such as an operation of applying an adhesive or paint to an object, an operation of removing an unnecessary part of the object, an operation of pressing a branding on an object, etc. It may be applied when performing. Even when applied to these operations, the operation command is corrected based on the detection result of the three-dimensional sensor, and the operation command after correction is output to the robot to be operated, so that the operation can be performed reliably and accurately. As in the above-described embodiment, productivity can be improved.

  Further, the flow shown in FIG. 3 and the like is not limited to the procedure illustrated in the embodiment, and the procedure may be added or deleted or the order may be changed without departing from the spirit and technical idea. Good.

  In addition to those already described above, the methods according to the above-described embodiments and modifications may be used in appropriate combination.

  In addition, although not illustrated one by one, the above-mentioned embodiment and each modification are implemented by adding various changes without departing from the spirit thereof.

10 Lucky cutting system (robot system)
10A Lucky cutting system (robot system)
12 Lucky (object)
14 Conveyor (conveying device)
16 Robot 16A, B Robot 18 Three-dimensional camera 28 Controller (controller means)
142 motor 144 conveyor drive unit (drive unit)
146 Encoder 166a Suction pad (Suction device, tool)
166b Hand (robot hand, tool)

Claims (6)

A transport device for transporting an object;
A three-dimensional sensor for detecting a three-dimensional shape of the object conveyed on a conveyance path by the conveyance device;
A plurality of robots to which a tool for performing an operation of transferring the object while being lifted by a predetermined lifting method can be attached;
First command output means for outputting an operation command to the robot, and based on three-dimensional information corresponding to a detection result of the three-dimensional sensor, a lifting process by the tool for the object conveyed on the conveyance path the first mode determining unit intends line determination of lifting Chiage method as processing mode, among the plurality of robots, the first tool corresponding to the method lifting determined by the first mode determining means is mounted First controller means having first robot selection means for selecting one robot , and first motion correction means for correcting the motion command based on the detection result of the three-dimensional sensor;
Have
The first motion correction means includes
The first command attached to the first robot performs the correction of the operation command so as to lift and transfer the object conveyed on the conveyance path,
The first command output means includes
A robot system, wherein an operation command corrected by the first operation correction unit is output to the first robot. A transport device for transporting an object;
A three-dimensional sensor for detecting a three-dimensional shape of the object conveyed on a conveyance path by the conveyance device;
A plurality of robots to which a tool for performing an operation of transferring the object while being lifted by a predetermined lifting method can be attached;
Second command output means for outputting an operation command to the robot; based on the three-dimensional information corresponding to the detection result of the three-dimensional sensor, a lifting process by the tool on the object conveyed on the conveyance path as processing mode, the lifting second mode determining unit intends line determination of standby state until the start of processing of the robot, among the plurality of robots, in a standby position determined by the second mode determining means Second controller means having second robot selection means for selecting a second robot to wait , and second motion correction means for correcting the motion command based on the detection result of the three-dimensional sensor;
Have
The second operation correcting means includes
The operation command is corrected so that the object that is transported on the transport path is lifted and transported by the tool attached to the second robot,
The second command output means includes
An operation command after correction by the second operation correction means is output to the second robot. The three-dimensional sensor
A laser light source oriented to project linear laser light at a predetermined position on the transport surface of the transport device; and
A camera for imaging the position of the laser beam projected by the laser light source and the vicinity thereof;
The robot system according to claim 1, further comprising: Among the plurality of robots, the robot installed on the most upstream side of the transfer path is:
An area where the lifting process is performed by the tool is installed downstream from the detection area of the object by the three-dimensional sensor so as to be separated by a predetermined distance or more along the conveyance path. The robot system according to claim 1 , wherein: The transfer device
A motor,
A drive unit that is rotationally driven by the motor;
An encoder coupled to the drive unit for detecting a rotational position of the drive unit;
With
The first or second controller means comprises:
The robot system according to claim 4, further comprising timing calculation means for calculating an operation start timing of the robot based on a detection result of the encoder. The plurality of robots are:
As the tool for performing the predetermined lifting method, a suction device that can lift the object by suction, a robot hand that can lift the object by gripping, and a barbed member that can lift the object by piercing, 3. The robot system according to claim 1, wherein one or more of the robots can be attached.

Images