Robot control method and robot system
The integration of a force detection unit on the robot arm allows for precise determination of successful gripping, addressing the challenge of inaccurate grip detection in robot systems and ensuring safe and efficient operation.
Patent Information
- Application Number
- JP2021012860
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2021-01-29
- Publication Date
- 2024-11-06
- Estimated Expiration
- 2041-01-29
AI Technical Summary
Existing robot systems face issues with accurately determining whether a grip on a workpiece is successful, leading to potential contact with the conveyor belt and affecting subsequent operations.
Incorporating a force detection unit on the robot arm to detect forces applied during the gripping operation, allowing for precise determination of successful grasping through threshold comparisons and real-time force analysis.
Enables accurate identification of gripping failures, preventing damage to the robot arm or conveyor and ensuring proper operation by specifying the type of failure, thereby allowing appropriate corrective actions.
Smart Images

Figure 0007578007000001 
Figure 0007578007000002 
Figure 0007578007000003
Abstract
Description
[Technical field]
[0001] The present invention relates to a robot control method and a robot system. [Background technology]
[0002] In recent years, due to rising labor costs and labor shortages in factories, automation of tasks that have been performed manually using various robots and their peripheral devices is accelerating. For example, the robot system described in Patent Document 1 includes a conveyor, a robot arm that grips a workpiece transported by the conveyor, and a control unit that controls the operation of the conveyor and the robot arm. [Prior art documents] [Patent documents]
[0003] [Patent Document 1] JP 2016-60002 A Summary of the Invention [Problem to be solved by the invention]
[0004] In such a robot system, if the robot fails to grip a workpiece, for example, the robot arm may come into contact with the belt, affecting the position of other workpieces and causing problems in subsequent operations. For this reason, a method is required to accurately determine whether or not the grip was successful. [Means for solving the problem]
[0005] A method for controlling a robot of the present invention includes a robot arm and a force detection unit that detects a force applied to the robot arm, and the method controls a robot that grips an object conveyed by a belt using an end effector provided on the robot arm, the method comprising the steps of: a grasping step of performing an operation of grasping the object by the end effector; The method further comprises a determination step of determining whether or not the object has been properly grasped based on a detection result of the force detection unit in the grasping step.
[0006] A robot system of the present invention includes a robot having a robot arm and a force detection unit that detects a force applied to the robot arm, and a control unit that controls driving of the robot arm so that an end effector provided on the robot arm grips an object conveyed by a belt, The control unit executes an operation of gripping the object by the end effector, The present invention is characterized in that a determination is made as to whether or not the object has been properly grasped based on the detection result of the force detection unit. [Brief description of the drawings]
[0007] [Figure 1] FIG. 1 is a schematic diagram of a robot system. [Diagram 2] FIG. 2 is a side view for explaining a successful example of a grasping operation performed by the robot. [Diagram 3] FIG. 3 is a side view for explaining a successful example of a grasping operation performed by the robot. [Figure 4] FIG. 4 is a side view for explaining a successful example of a grasping operation performed by the robot. [Diagram 5] FIG. 5 is a side view for explaining a successful example of a gripping operation performed by the robot. [Figure 6] FIG. 6 is a side view for explaining an example of a failed gripping operation performed by a robot. [Figure 7] FIG. 7 is a side view for explaining an example of a failed gripping operation performed by a robot. [Figure 8] FIG. 8 is a graph illustrating the magnitude of force detected by the robot arm over time during a gripping operation. [Figure 9] FIG. 9 is a graph illustrating the magnitude of force detected by the robot arm over time during a gripping operation. [Figure 10] FIG. 10 is a flowchart illustrating an example of a method for controlling a robot of the present invention. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0008] DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS Hereinafter, a robot control method and a robot system according to the present invention will be described in detail based on preferred embodiments shown in the accompanying drawings.
[0009] First Embodiment Fig. 1 is a schematic diagram of a robot system. Figs. 2 to 5 are side views for explaining a successful example of a gripping operation performed by a robot. Figs. 6 and 7 are side views for explaining an unsuccessful example of a gripping operation performed by a robot. Figs. 8 and 9 are graphs for explaining the magnitude of a force detected by a robot arm over time in a gripping operation. Fig. 10 is a flow chart for explaining an example of a method for controlling a robot of the present invention.
[0010] For ease of explanation, Fig. 1 illustrates three mutually orthogonal axes: an X-axis, a Y-axis, and a Z-axis. In the following, the direction parallel to the X-axis will be referred to as the "X-axis direction," the direction parallel to the Y-axis as the "Y-axis direction," and the direction parallel to the Z-axis as the "Z-axis direction."
[0011] In the following description, the Z-axis direction in FIG. 1, ie, the up-down direction, is referred to as the "vertical direction", and the X-axis and Y-axis directions are referred to as the "horizontal direction".
[0012] The robot 200 has a base 230 fixed to the floor, a robot arm 220 supported by the base 230, and an end effector 210 supported by the robot arm 220. The robot arm 220 is a 6-axis arm having six joints J1 to J6 in this embodiment, in which the joints J2, J3, and J5 are bending joints, and the joints J1, J4, and J6 are torsion joints.
[0013] In addition, motors M1, M2, M3, M4, M5, M6 and encoders E1, E2, E3, E4, E5, E6 are installed at the joints J1, J2, J3, J4, J5, J6, respectively. During operation of the robot system 100, the control device 400 executes feedback control to match the rotation angles of the joints J1 to J6 indicated by the outputs of the encoders E1 to E6 with the target rotation angles that are control targets. This allows each of the joints J1 to J6 to be kept at the target rotation angle, and the robot arm 220 to be placed in a desired position and posture. Therefore, the robot 200 can be driven stably with a desired operation.
[0014] An end effector 210 is attached to the tip of the robot arm 220, i.e., joint J6, via a mechanical interface. Although not shown, the end effector 210 has a suction hole, a flow path communicating with the suction hole, and a suction source that generates negative pressure in the flow path, and the operation of this suction source is controlled by the control device 400. This allows suction to be performed at a desired timing to adsorb and grip the workpiece W, and suction to be released at a desired timing to release the grip of the workpiece W.
[0015] The end effector 210 is not limited to the above configuration, and may be configured to grip the workpiece W with a plurality of jaws, for example. In this embodiment, the end effector 210 may or may not be a component of the robot 200.
[0016] In addition, a force detection unit 240 that acquires information about the force acting on the workpiece W from the end effector 210 is attached to the joint J6 of the robot arm 220. The force detection unit 240 measures three-axis forces and torques about the three axes acting on the workpiece W in a sensor coordinate system that is a unique three-dimensional orthogonal coordinate system.
[0017] The force detection unit 240 is composed of a quartz force sensor. The quartz force sensor is, for example, a six-axis force sensor capable of detecting six-axis components of an external force. The six-axis components are made up of translational force components in the directions of the α-axis, β-axis, and γ-axis, which are three mutually orthogonal axes, and rotational force components around each of these three axes.
[0018] Although not shown, the quartz force sensor has a casing and multiple quartz piezoelectric elements arranged inside the casing. The quartz force sensor outputs detection signals according to the external force received by each sensor element, and by processing these detection signals, it is possible to detect six-axis components of the external force applied to the force detection unit 240, and to detect the level of the external force from the detected six-axis components.
[0019] In this way, the force detection unit 240 has a quartz force sensor. This makes it possible to obtain the force detection unit 240 with excellent characteristics such as high sensitivity, a wide dynamic range, and high rigidity. Therefore, the force applied to the robot arm 220 can be accurately detected.
[0020] The sensor element may be configured using a piezoelectric material other than quartz, such as topaz, barium titanate, lead titanate, lead zirconate titanate (PZT), lithium niobate, and lithium tantalate.
[0021] The attachment location of the force detection unit 240 is not particularly limited, and the force detection unit 240 may be attached to any of the other joints J1 to J5.
[0022] The transport device 600 is a belt conveyor that has an X-axis direction as its width direction and transports the workpiece W in the Y-axis direction, and includes a belt 620 and transport rollers 630a and 630b that transport the belt 620. In this embodiment, the transport direction 610 of the transport device 600 is a direction from the -Y axis side to the +Y axis side. However, the transport device 600 is not limited to a belt conveyor, and may be any device that can transport the workpiece W along the transport direction 610.
[0023] The transport device 600 transports the workpiece W placed on the transport surface in a transport direction 610 by moving the transport surface with transport rollers 630a and 630b. The transport roller 630a is provided with a transport amount sensor 640 that outputs a signal according to the amount of rotation of the transport roller 630a to the control device 400. During operation of the robot system 100, the control device 400 executes feedback control to match the transport speed of the workpiece W indicated by the output of the transport amount sensor 640 with a target transport speed that is a control target. This makes it possible to maintain the transport speed of the workpiece W at the target transport speed, and to transport the workpiece W stably at a desired speed.
[0024] The position sensor 300 detects the position of the workpiece W from above the conveying device 600. The position sensor 300 is a camera that outputs an image of the workpiece W to the control device 400. However, the position sensor 300 is not limited to a camera, and may be, for example, a laser range scanner. As shown by the dashed line in FIG. 1, the position sensor 300 has an angle of view that includes the workpiece W conveyed on the belt 620. The position in the image output from the position sensor 300 is associated with the position on the conveying path by the control device 400. Therefore, when the workpiece W is present within the angle of view of the position sensor 300, the coordinates of the workpiece W can be identified based on the position of the workpiece W in the image of the position sensor 300.
[0025] The control device 400 controls the operation of the robot 200, the position sensor 300, and the transport device 600. Such a control device 400 is, for example, configured from a computer, and has a processor (CPU) for processing information, a memory communicatively connected to the processor, and an external interface for connecting to an external device. Various programs executable by the processor are stored in the memory, and the processor can read and execute the various programs stored in the memory. Some or all of the components of the control device 400 may be disposed inside the housing of the robot 200. The control device 400 may also be configured from multiple processors.
[0026] Based on the detection result of the position sensor 300, the control device 400 drives the robot arm 220 so that the end effector 210 follows the workpiece W transported by the transport device 600, for example, at a constant speed. This allows the gripping or releasing operation to be performed while regulating the positional relationship between the end effector 210 and the workpiece W in the Y-axis direction.
[0027] The teaching device 500 is a device into which a user inputs an operation program by direct or indirect teaching. The teaching device 500 is, for example, composed of a computer, and has a processor (CPU) for processing information, a memory communicatively connected to the processor, and an external interface for connecting to an external device. The operation program input by the operator is stored in the memory and transmitted to the control device 400 via the external interface.
[0028] Next, a description will be given of successful and unsuccessful examples of a gripping operation performed by the robot 200. Figures 8 and 9 show the transition over time of the force detected by the force detection unit 240 in the successful and unsuccessful examples.
[0029] In the following explanation, only the movement up and down in the Z-axis direction will be explained, assuming that feedback control is executed to match the conveying speed of the workpiece W indicated by the output of the conveying amount sensor 640 with the target conveying speed, which is the control target.
[0030] First, a successful example of a grasping operation will be described. As shown in FIG. 2, with the end effector 210 positioned on the +Z axis side of the workpiece W, as shown in FIG. 3, the end effector 210 is moved to the -Z axis side, i.e., lowered, so as to bring the end effector 210 closer to the workpiece W.
[0031] When the end effector 210 is lowered and pressed against the workpiece W, the force detected by the force detection unit 240, i.e., the reaction force received from the workpiece W, increases as shown in Figures 8 and 9. At this time, the maximum value of the force detected by the force detection unit 240 is defined as force F1.
[0032] In this embodiment, the suction of the end effector 210 is started from the state shown in Fig. 2. Then, as shown in Fig. 4, the end effector 210 is pressed against the workpiece W. This brings the tip of the end effector 210 into close contact with the upper surface of the workpiece W, and the end effector 210 is in a state of gripping the workpiece W.
[0033] 5, the end effector 210 is moved toward the +Z axis side, that is, the robot arm 220 is driven to raise the end effector 210. This increases the force pulling the end effector 210 in the -Z axis direction, as shown in FIGS.
[0034] When the workpiece W is lifted, that is, in the state shown in FIG. 5, the force detected by the force detection unit 240, that is, the maximum value of the force pulled in the -Z axis direction, is defined as force F2 (see FIG. 8).
[0035] In this way, when gripping the workpiece W, the end effector 210 is lowered, a pressing operation in which the end effector 210 is pressed against the workpiece W, and a lifting operation in which the end effector 210 is lifted are sequentially performed.
[0036] Next, an example of a failed gripping operation will be described. Examples of failures include the state shown in FIG. 6 and the state shown in FIG.
[0037] The state shown in Fig. 6 is a state in which the end effector 210 is pressed against the belt 620 during the pressing operation. The maximum value of the force detected by the force detection unit 240 during the pressing operation is smaller than the force F1 detected by the force detection unit 240 in a successful example. In the state shown in Fig. 6, the maximum value of the force detected by the force detection unit 240 is set to force F3 (see Fig. 8). In this case, the force detected by the force detection unit 240 transitions as shown in Fig. 8.
[0038] Furthermore, when an upward movement is performed in this state, the belt 620 is attempted to be lifted, and the force F4 detected by the force detection unit 240 is greater than the force F2 detected when an attempt is made to lift the workpiece W (see FIG. 8).
[0039] The state shown in Fig. 7 is a state in which the end effector 210 is pressed against the edge of the workpiece W during the pressing operation. In this case, the force detected by the force detection unit 240 changes as shown in Fig. 9. The maximum value of the force magnitude detected by the force detection unit 240 during the pressing operation is force F5, which is approximately equal to force F1 (see Fig. 9).
[0040] Furthermore, if an upward movement is performed in this state, the workpiece W cannot be lifted, and therefore the maximum value of the force detected by the force detection unit 240 is smaller than the force F2 detected when attempting to lift the workpiece W (see FIG. 9). Moreover, in the state shown in FIG. 7, the maximum value of the force detected by the force detection unit 240 is set to force F6 (see FIG. 9).
[0041] Such forces F1 to F4 are set, for example, by the operator performing the above-mentioned movements when performing instruction and storing the detection results of the force detection unit 240 for each movement. Then, a first threshold value T1 and a second threshold value T2, which will be described later, are set based on these forces F1 to F4.
[0042] In addition to the forces F1 to F4, the failure examples of the forces F5 and F6 may also be experimentally performed in advance and stored.
[0043] Next, the control method of the robot of the present invention will be described using the flowchart shown in FIG. 10.
[0044] First, in step S101, the end effector 210 is moved to the starting position. That is, while following the workpiece W during the movement of the end effector 210, a state of being separated by a predetermined distance in the Z-axis direction is maintained.
[0045] Next, in step S102, the intake of the end effector 210 is started. Next, in step S103, the end effector 210 is lowered from the starting position. That is, the pressing operation described above is performed. This step S103 is a gripping step for executing an operation of gripping the workpiece W by the end effector 210.
[0046] Next, in step S104, it is determined whether the force in the -Z axis direction is equal to or greater than the first threshold value T1. That is, it is determined whether the force F1 applied to the robot arm 220 is equal to or greater than the first threshold value T1. The first threshold value T1 is, for example, a value set based on the force F1 at the time of teaching, for example, a value slightly smaller than the force F1 by a predetermined value. The first threshold value T1 is stored in advance in the memory of the control device 400.
[0047] Such a step S104 is a determination step for determining whether the gripping of the workpiece W has been performed normally.
[0048] For example, in the case of a normal gripping operation as shown in FIG. 5, since T1 < F1 (see FIG. 8), it is determined to be normal and the process proceeds to step S105. Regarding the failure example 2 shown in FIG. 7 as well, here the process proceeds to step S105. This step S105 is a gripping step for executing an operation of gripping the workpiece W by the end effector 210.
[0049] On the other hand, if an object thinner than the workpiece W, i.e., an object with a lower height in the Z-axis direction, is grasped, since the detected force is smaller than the first threshold value T1, it is determined to be abnormal and the process proceeds to step S113.
[0050] Next, in step S105, the end effector 210 is raised while continuing the intake. That is, a lifting operation for lifting the workpiece W is performed. As a result, as shown in FIG. 5, the workpiece W can be lifted.
[0051] Next, in step S106, it is determined whether the force applied in the +Z-axis direction is equal to or greater than the second threshold value T2. That is, it is determined whether the force F2 in the -Z-axis direction applied to the robot arm 220 is equal to or greater than the second threshold value T2. The second threshold value T2 is, for example, a value set based on the force F2 at the time of teaching, for example, a value smaller than the force F2 by a predetermined value. The second threshold value T2 is stored in advance in the memory of the control device 400.
[0052] Such a step S106 is a determination step for determining whether the workpiece W has been grasped normally.
[0053] For example, in the case of a normal grasping operation as shown in FIG. 5, since T2 < F2 (see FIG. 8), it is determined to be normal, and in step S107, the end effector 210 is moved to the end position, that is, the grasping is released to complete the movement of the workpiece W. Then, in step S108, the intake is stopped.
[0054] On the other hand, if it is determined in step S106 that the force applied in the +Z-axis direction is not equal to or greater than the second threshold value T2, it is determined in step S109 that the grasping has failed. Next, in step S110, it is determined whether the belt 620 has been grasped.
[0055] The determination in step S110 is made based on whether the force F5 applied in the -Z-axis direction exceeds a third threshold T3. The third threshold T3 is set to a value that is a predetermined value greater than the force F5 obtained in the teaching operation. The third threshold T3 is stored in advance in the memory of the control device 400.
[0056] If it is determined in step S110 that the belt 620 is being gripped, the lifting operation is stopped in step S112, and the suction is stopped in step S112. That is, the lifting operation of the end effector 210 is immediately stopped and then the grip is released. This makes it possible to prevent damage to the robot arm 220 or the transport device 600 caused by an attempt to lift the belt 620. Such step S112 is a release step in which an operation to release the grip of the workpiece W is performed.
[0057] Then, the intake is stopped, and in step S116, a notification that the gripping has failed is issued. There are no particular limitations on the type of notification, and examples of the notification include a notification in which a warning screen is displayed on a monitor (not shown) provided in the control device 400 or the teaching device 500, a notification by illumination of a lamp or the like, a notification by sound issued from a speaker, and the like.
[0058] On the other hand, in step S110, if it is determined that the belt 620 is not being gripped, that is, for example, as shown in Fig. 7, the suction is stopped in step S112, and a notification that gripping has failed is issued in step S116. Such step S116 is a notification step that notifies the user that gripping of the workpiece W is not being performed normally.
[0059] Here, if it is determined in step S104 that there is an abnormality, it is determined in step S113 that the gripping has failed, and in step S114, the intake is stopped. Then, the end effector 210 is raised. Such step S114 is a release step in which an operation of releasing the grip of the workpiece W is performed.
[0060] In this way, the control method of the robot of the present invention is a control method for controlling a robot having a robot arm 220 and a force detection unit that detects a force applied to the robot arm 220, and gripping a workpiece W, which is an object transported by a belt 620, by an end effector 210 provided on the robot arm 220, and includes a gripping step in which an operation of gripping the object workpiece W by the end effector 210 is performed, and a judgment step in which a judgment is made as to whether or not the gripping of the workpiece W has been performed normally based on the detection result of the force detection unit 240 in the gripping step. This allows for a more accurate judgment than, for example, a case in which the gripping has been performed normally based on a change in suction force. In particular, since the degree of reduction in suction force is almost the same when the workpiece W is sucked and when the belt 620 is sucked, it is difficult to identify the type of failure when judging whether or not the gripping has been performed normally based on a change in suction force. In contrast, in the present invention, the type of gripping failure can be identified as described above. Therefore, the subsequent operation of the robot arm 220 and the timing of the release of the gripping of the end effector 210 can be appropriately performed.
[0061] The robot system 100 of the present invention includes a robot 200 having a robot arm 220 and a force detection unit 240 that detects a force applied to the robot arm 220, and a control device 400 that is a control unit that controls the driving of the robot arm 220 so that the end effector 210 provided on the robot arm 220 grips a workpiece W, which is an object transported by a belt 620. The control device 400 also executes an operation to grip the workpiece W by the end effector 210, and judges whether the gripping of the workpiece W has been performed normally based on the detection result of the force detection unit 240. For this reason, a more accurate judgment can be made compared to, for example, a case in which the gripping has been performed normally based on a change in suction force.
[0062] The end effector 210 grips the target workpiece W by suction, and the gripping step sequentially executes a pressing operation in which the end effector 210 is lowered and pressed against the workpiece W while performing suction, and a lifting operation in which the end effector 210 is lifted while performing suction after the pressing operation. This allows the end effector 210 to grip the workpiece W accurately.
[0063] Furthermore, in the judgment step, if the maximum value of the force detected by the force detection unit 240 during the pressing operation is equal to or less than the first threshold value T1, it is judged that the gripping of the workpiece W is not performed normally. This makes it possible to know, for example, whether the workpiece W has been gripped or a different workpiece has been gripped. Therefore, thereafter, the robot arm 220 can be made to perform the appropriate operation as described above.
[0064] In addition, in the determination step, if the magnitude of the force detected by the force detection unit 240 during the upward movement is equal to or less than the second threshold value T2, it is determined that the workpiece W is not being gripped normally. This makes it possible to know whether the end effector 210 has gripped the workpiece W or the belt 620.
[0065] In addition, if it is determined in the determination step that the gripping of the target workpiece W is not performed normally, a release step is performed to release the grip of the workpiece W, and in the release step, the timing of releasing the grip of the workpiece W is made different depending on whether it is determined that the gripping of the workpiece W is not performed normally in the pressing operation or in the lifting operation. This allows the robot arm 220 to perform an appropriate operation according to the type of failure.
[0066] Moreover, if it is determined in the determination step that the gripping of the workpiece W is not performed normally, a notification step is provided for notifying the operator that the gripping of the workpiece W is not performed normally. This allows the operator to understand that the gripping has failed. Therefore, the operator can, for example, check the working environment of the robot 200 and reset it to a normal working environment.
[0067] Although the robot control method and the robot system of the present invention have been described above based on the illustrated embodiment, the present invention is not limited to this, and each process and structure can be replaced with any process or structure having a similar function. Also, any other process or structure may be added.
[0068] In addition, the present invention is not limited to the configuration in which the maximum value of the detected force is compared with a threshold value to determine whether the gripping of the workpiece is performed normally, as in the above embodiment, but may be configured to compare the force applied to the robot arm with the detection result over time obtained in the gripping step in real time. That is, in the judgment step, a judgment may be made based on information on the force over time detected by the force detection unit. In this case, for example, when the degree of deviation of the comparison result becomes equal to or greater than a predetermined amount, it can be determined that the gripping of the workpiece is not performed normally. [Explanation of symbols]
[0069] 100... robot system, 200... robot, 210... end effector, 220... robot arm, 230... base, 240... force detection unit, 300... position sensor, 400... control device, 500... teaching device, 600... conveying device, 610... conveying direction, 620... belt, 630a... conveying roller, 630b... conveying roller, 640... conveying amount sensor, E1... encoder, E2... encoder, E3... Encoder, E4...encoder, E5...encoder, E6...encoder, F1...force, F2...force, F3...force, F4...force, F5...force, F6...force, J1...joint, J2...joint, J3...joint, J4...joint, J5...joint, J6...joint, M1...motor, M2...motor, M3...motor, M4...motor, M5...motor, M6...motor, T1...first threshold, T2...second threshold, T3...third threshold, W...work
Claims
1. A robot arm and a force detection unit that detects a force applied to the robot arm. The object being conveyed by the belt is moved by an end effector provided on the robot arm. A control method for controlling a robot that grasps a a grasping step of performing an operation of grasping the object by the end effector; 、 Based on the detection result of the force detection unit in the gripping step, the gripping of the object is correct. A determination step of determining whether the above-mentioned operation has always been performed, the end effector grasps the object by suction, The gripping step is a step of lowering the end effector to perform the suction while gripping the object. A pressing operation for pressing the object against the object, and a suction operation for sucking the object while pressing the object against the object. and a lifting action to raise the effector. In the determining step, the magnitude of the force detected by the force detection unit during the upward movement is a first force. If the difference is less than or equal to the second threshold, it is determined that the object is not being grasped normally; The second threshold value is a threshold value indicating a state in which the object is normally gripped when the operator performs a teaching. It is particularly preferred that a value smaller than the force detected by the force detection unit when the object is lifted by the force detection unit is set. A method for controlling a robot.
2. A robot arm and a force detection unit that detects a force applied to the robot arm. The object being conveyed by the belt is moved by an end effector provided on the robot arm. A control method for controlling a robot that grasps a a grasping step of performing an operation of grasping the object by the end effector; 、 Based on the detection result of the force detection unit in the gripping step, the gripping of the object is correct. A determination step of determining whether the above-mentioned operation has always been performed, the end effector grasps the object by suction, The gripping step is a step of lowering the end effector to perform the suction while gripping the object. A pressing operation for pressing the object against the object, and a suction operation for sucking the object while pressing the object against the object. and a lifting action to raise the effector. When it is determined in the determination step that the object is not being grasped normally, A release step is performed to release the grip of the object, In the releasing step, the object is normally gripped in the pressing operation. When it is determined that the object is not being grasped normally during the lifting operation, The timing of releasing the grip of the object is made different depending on whether it is determined that the grip is not released or not. A method for controlling a robot.
3. In the determination step, a maximum value of the force detected by the force detection unit during the pressing operation is is equal to or smaller than a first threshold value, it is determined that the object is not being grasped normally.
3. A method for controlling a robot according to claim 1 or 2.
4. When it is determined in the determining step that the object is not being grasped normally, The present invention relates to a method for detecting an object by gripping the object, the method comprising:
4. A method for controlling a robot according to any one of claims 3 to 3.
5. In the determining step, the determination is performed based on information on the force over time detected by the force detection unit.
5. The method for controlling a robot according to claim 1, further comprising the step of:
6. The force detection unit according to claim 1 , wherein the force detection unit has a quartz force sensor. How to control a robot.
7. The robot arm includes a force detector that detects a force applied to the robot arm. The robot and the end effector attached to the robot arm transport the material on a belt. A control unit that controls the drive of the robot arm so as to grip a fed object, The control unit executes an operation of gripping the object by the end effector, Determining whether the object has been properly grasped based on the detection result of the force detection unit. Do the following: The end effector grasps the object by suction, The control unit lowers the end effector to perform the suction while contacting the target. A pressing operation, and after the pressing operation, the end effector is sucked while and a rising operation of raising the actuator. The control unit detects whether a magnitude of the force detected by the force detection unit during the upward movement is equal to or greater than a second threshold value. If the gripping speed is lower than the threshold, it is determined that the gripping speed of the object is not normal. The second threshold value is a threshold value indicating a state in which the object is normally gripped when the operator performs a teaching. It is particularly preferred that a value smaller than the force detected by the force detection unit when the object is lifted by the force detection unit is set. A robot system that is characteristic of this system.
8. A robot arm and a force detection unit for detecting a force applied to the robot arm. The robot and the end effector attached to the robot arm transport the material on a belt. A control unit that controls the drive of the robot arm so as to grip a fed object, The control unit executes an operation of gripping the object by the end effector, Determining whether the object has been properly grasped based on the detection result of the force detection unit. Do the following: The end effector grasps the object by suction, The control unit lowers the end effector to perform the suction while contacting the target. A pressing operation, and after the pressing operation, the end effector is sucked while and a rising operation of raising the actuator. When the control unit determines that the object is not being normally grasped, and releasing the grip of the The releasing operation is performed if the object is normally gripped in the pressing operation. When it is determined that the object is not being properly grasped during the lifting operation, The timing of releasing the grip of the object is made different depending on whether the grip is released or not. A robot system that
Citation Information
Patent Citations
Deformed part deciding method by suction pad, carrying method and carrier device
JP2000127071A
Manipulator loaded with vacuum chuck and part assembly method
JP2002254380A
Sensing method and sensing device
JP2003236786A
Vacuum suction device and suction force estimation method
JP2007331056A
Robot system and workpiece picking method
JP2016060002A
