Robot control method
By storing the shape information of the robot and surrounding objects, calculating distance changes and adjusting the speed, the problem of risk of operators being caught when the robot and surrounding objects is close, and the operation efficiency is maintained and the risk reduction is achieved.
Patent Information
- Application Number
- CN201911004545.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Priority Date
- 2018-10-24
- Filing Date
- 2019-10-22
- Publication Date
- 2024-11-08
- Estimated Expiration
- 2039-10-22
AI Technical Summary
In the prior art, when the distance between the robot and the surrounding objects is close, it is difficult to effectively reduce the risk of workers being caught in without affecting the robot's movement efficiency.
By storing the shape information of the robot and surrounding objects, the distance change between the two is calculated, and the action speed is reduced only when the distance changes in the direction of smaller, avoid unnecessary speed reduction, and adjust the speed according to the hardness or sharpness of the object. Reduce the degree.
While preventing the risk of workers getting caught in, maintain the robot's operation efficiency and avoid the reduction in efficiency due to unnecessary speed reduction.
Smart Images

Figure CN111085983B_ABST
Abstract
Description
Technical Field
[0001] The invention relates to a control method of a robot. Background Art
[0002] In the past, the following system is known: when a worker enters the working area where the robot is working, the system detects the worker and calculates the distance between the worker and the robot. The closer the distance between the worker and the robot, the lower the movement speed of the robot (for example, refer to Patent Document 1).
[0003] On the other hand, in a system equipped with a robot, in order to eliminate the risk of a part of the worker being caught between the robot and surrounding objects when the robot approaches surrounding objects other than the worker, such as when the robot is holding a workpiece, the robot's movement speed is required to be reduced regardless of the presence or absence of a worker.
[0004] Prior art literature
[0005] Patent Literature
[0006] Patent Document 1: Japanese Patent Application Publication No. 2012-223831 Summary of the invention
[0007] Problem that the invention aims to solve
[0008] However, even when the distance between the robot and the surrounding objects is close, a part of the worker may not necessarily be caught in the trap.
[0009] The present invention has been made in view of the above-mentioned situation, and an object of the present invention is to provide a robot control method that can prevent unnecessary reduction in the robot's motion efficiency and reduce the risk of a part of an operator being caught between the robot and surrounding objects.
[0010] Solutions for solving problems
[0011] One embodiment of the present invention is a method for controlling a robot, comprising the following steps: storing at least a portion of shape information of a robot including a tool mounted on a front end and surrounding objects arranged around the robot; calculating a change in the distance between the robot and the surrounding objects based on the shape information at each position of the movement when causing the robot to move according to a teaching program; and controlling the speed set in the teaching program to decrease only when the calculated distance changes in a decreasing direction.
[0012] According to the present scheme, the shape information of the robot including the tool installed at the front end and the surrounding objects arranged around the robot is stored, and when the robot is operated according to the teaching program, the change in the distance between the robot and the surrounding objects is calculated at each position of the operation based on the stored shape information. When the calculated distance does not change or changes in the direction of increasing, the speed set in the teaching program is not reduced, and when the distance changes in the direction of decreasing, the speed set in the teaching program is controlled to be reduced. In this way, the risk can be reduced by reducing the operation speed when there is a possibility that a part of the operator is sandwiched between the robot including the tool and the surrounding objects, and the operation efficiency of the robot can be prevented from being unnecessarily reduced by maintaining the operation speed when there is no possibility of sandwiching.
[0013] Another embodiment of the present invention is a robot control method, which includes the following steps: storing at least a portion of shape information of a robot including a tool installed at a front end and surrounding objects arranged around the robot; when causing the robot to perform micro-motion, calculating the change in the distance between the robot and the surrounding objects at each position of the motion based on the shape information; and controlling the speed of the micro-motion to decrease only when the calculated distance changes in a decreasing direction.
[0014] In the above scheme, the robot can also be stopped when the external force applied to the robot exceeds a reference value; and the reference value of the external force can be controlled to decrease only when the calculated distance changes in a decreasing direction.
[0015] In addition, another embodiment of the present invention is a robot control method, which includes the following steps: storing at least a portion of the shape information of the robot including a tool installed at the front end; when the robot is caused to move according to a teaching program, at each position of the movement, calculating the change in distance of each part of the robot itself based on the shape information; and controlling the speed set in the teaching program to decrease only when the calculated distance changes in a decreasing direction.
[0016] Furthermore, in the above scheme, the speed may be controlled to decrease when the distance between the robot and the surrounding objects is smaller than a prescribed threshold.
[0017] With this configuration, when the calculated distance between the robot and the surrounding objects changes in a decreasing direction and is less than a predetermined threshold, the speed set in the teaching program is reduced. That is, when the distance between the robot and the surrounding objects is large, no pinching occurs even if the distance changes in a decreasing direction, thereby preventing the speed from being limited in this case and causing a decrease in the operation efficiency.
[0018] Furthermore, in the above scheme, the speed can be controlled to decrease only when the distance between the tool and the surrounding objects changes in a decreasing direction.
[0019] With this configuration, when the calculated distance between the tool and the surrounding object changes in a decreasing direction, the speed set in the teaching program is reduced.
[0020] In addition, in the above scheme, information on the hardness or sharpness of each part of the robot and at least one of the surrounding objects can also be stored; and the degree of speed reduction can be adjusted according to the hardness or sharpness of the part that changes in the direction of decreasing distance.
[0021] With this configuration, even when the calculated distance between the tool and the surrounding object changes in a decreasing direction, the degree of speed reduction set in the teaching program is adjusted according to the hardness or sharpness of at least one of the robot and the surrounding object. That is, when the hardness or sharpness of at least one of the robot and the surrounding object moving in a direction approaching each other is sufficiently low, even if entrapment occurs, the damage to the operator is small, so it is not necessary to significantly reduce the speed, and it is possible to prevent a decrease in the operation efficiency.
[0022] Furthermore, in the above aspect, it may be configured so that the higher the hardness of the portion is, the greater the degree of reduction in the speed is.
[0023] With this configuration, even when the calculated distance between the robot and the surrounding objects changes in a decreasing direction, if the hardness of at least one of the robot and the surrounding objects is low, the degree of speed reduction can be reduced to prevent a reduction in work efficiency.
[0024] Furthermore, in the above aspect, it may be configured that the higher the sharpness of the portion is, the higher the degree of reduction in the speed is.
[0025] With this configuration, even when the calculated distance between the robot and the surrounding objects changes in a decreasing direction, if the sharpness of at least one of the robot and the surrounding objects is low, the degree of speed reduction can be reduced to prevent a reduction in work efficiency.
[0026] Effects of the Invention
[0027] According to the present invention, there is an effect of being able to reduce the risk of a part of a worker being caught between a robot and a surrounding object while preventing an unnecessary decrease in operation efficiency. BRIEF DESCRIPTION OF THE DRAWINGS
[0028] Figure 1This is an overall structural diagram of a robot system that implements a control method of a collaborative robot according to an embodiment of the present invention.
[0029] Figure 2 Yes means Figure 1 Flowchart of a control method for a collaborative robot.
[0030] Figure 3 It means in Figure 1 An enlarged front view of a robot system in which the distance between the collaborative robot and surrounding objects decreases.
[0031] Figure 4 It means in Figure 1 An enlarged front view of a robot system in which the distance between the collaborative robot and surrounding objects increases.
[0032] Figure 5 It means in Figure 1 An enlarged front view of a robot system in which the distance between the collaborative robot and surrounding objects does not change.
[0033] Figure 6 It means in Figure 1 An enlarged front view of a robot system in which the distance between the collaborative robot and surrounding objects decreases and is greater than a specified threshold.
[0034] Figure 7 It means in Figure 1 A magnified front view of a collaborative robot passing near surrounding objects in a robotic system.
[0035] Description of reference numerals:
[0036] 1: Collaborative robots (robots)
[0037] 10: Surrounding objects
[0038] L: distance
[0039] Th: Threshold
[0040] S: Tools DETAILED DESCRIPTION
[0041] A control method for a collaborative robot according to an embodiment of the present invention will be described below with reference to the accompanying drawings.
[0042] The control method of the collaborative robot 1 of this embodiment is Figure 1 The robot system 100 is shown as being implemented therein.
[0043] like Figure 1As shown, the robot system 100 includes: a cooperative robot (robot) 1; a peripheral object 10 provided around the cooperative robot 1; and a control device 20 that controls the cooperative robot.
[0044] The collaborative robot 1 is, for example, a six-axis multi-joint collaborative robot. A tool S for processing a workpiece W is fixed to the front end of the collaborative robot 1. The tool S is, for example, a hand 2 for holding the workpiece W or a tool for performing any operation on the workpiece W. The surrounding object 10 is, for example, a workbench on which the workpiece W processed by the collaborative robot 1 is placed or a machine tool for processing the workpiece W.
[0045] The control device 20 includes a storage unit 21 and a processing unit 22. The storage unit 21 stores a teaching program and shape information taught in advance, and the processing unit 22 executes the teaching program read from the storage unit 21. The storage unit 21 is a memory, and the processing unit 22 is a processor.
[0046] The teaching program stores the coordinates of a plurality of teaching points, the motion sequence of the teaching points, the moving speed between the teaching points, and the motion method between the teaching points, etc., which are manually or offline teaching for the collaborative robot 1 to move. When the processing unit 22 executes the teaching program, the processing unit 22 moves the collaborative robot 1 from one teaching point to another teaching point according to the motion sequence as a principle, at the stored motion speed and motion method. As the motion method, linear interpolation or circular interpolation can be exemplified.
[0047] The shape information stored in the storage unit 21 is a shape model of the collaborative robot 1 including the tool S at the front end and the surrounding object 10. Moreover, as the shape information, two-dimensional shape information or three-dimensional shape information can be used. The processing unit 22 calculates the distance L between the collaborative robot 1 and the surrounding object 10 based on the shape information stored in the storage unit 21 at each position on the motion trajectory of each teaching point set in the teaching program or each interpolation point between the teaching points.
[0048] That is, Figure 2 As shown, the processing unit 22 first reads the shape information stored in the storage unit 21 at the initial position of the collaborative robot 1, and calculates the distance L between the collaborative robot 1 and the surrounding object 10 (step S1). The initial position may be the position of the collaborative robot 1 immediately before it starts to move. The distance L is calculated between a plurality of predetermined measurement points on the outer surface of the collaborative robot 1 including the tool S and a plurality of predetermined measurement points on the outer surface of the surrounding object 10. The calculated distance L is stored in the storage unit 21 (step S2).
[0049] Next, the processing unit 22 causes the collaborative robot 1 to operate according to the teaching program (step S3), and determines whether it is a position to calculate the distance L (step S4). If it is not a position to calculate the distance L, the steps starting from step S3 are repeated. If it is a position to calculate the distance L, the shape information stored in the storage unit 21 is read, and the distance L between the collaborative robot 1 and the surrounding object 10 is calculated (step S5). For example, although the shape of the surrounding object 10 does not change, the shape of the collaborative robot 1 changes according to the position of each axis of the collaborative robot 1.
[0050] The processing unit 22 calculates the shape of the collaborative robot 1 at each position based on the stored shape information, and calculates the distance L between the collaborative robot 1 and a plurality of measurement points of the surrounding object 10. The calculated distance L between the measurement points is stored in the storage unit 21 (step S6), and the change ΔL relative to the previous distance L stored in the storage unit 21 is calculated (step S7), and it is determined whether the sign of the change ΔL is negative (step S8).
[0051] like Figure 3 As shown in FIG. 1 , when there is a pair of measurement points whose distance L changes in a decreasing direction, it is determined whether the distance L between the measurement points is less than a predetermined threshold value Th (step S9). If the distance L between the measurement point pairs is less than the predetermined threshold value Th, the processing unit 22 multiplies the motion speed set in the teaching program by a constant α less than 1 to operate the cooperative robot 1. That is, the cooperative robot 1 operates at a motion speed lower than the motion speed set in the teaching program (step S10).
[0052] The multiplication constant α of the processing unit 22 can be selected according to the distance L between the measurement points. That is, when the distance L between the cooperative robot 1 and the surrounding object 10 is getting closer, the closer the distance L is, the smaller the multiplication constant α is, so that the movement speed can be greatly reduced.
[0053] Then, it is determined whether the operation is completed (step S11), and if not completed, the steps starting from step S3 are repeated.
[0054] In this way, according to the control method of the collaborative robot 1 of the present embodiment, the distance between each measurement point of the collaborative robot 1 and each measurement point of the surrounding object 10 is calculated at each position of the movement of the collaborative robot 1, and when the distance L is close to or less than a specified threshold value Th and the distance L changes in a decreasing direction, the movement speed of the collaborative robot 1 is limited.
[0055] On the other hand, Figure 4 as well as Figure 5As shown, even if the distance L is less than the predetermined threshold value Th, if the distance L does not change or changes in a direction of increasing, the speed restriction is not performed.
[0056] In addition, if Figure 6 As shown, even if the distance L changes in a decreasing direction, if the distance L is greater than a predetermined threshold value Th, the speed restriction is not performed.
[0057] In addition, for example, Figure 7 As shown, when the collaborative robot 1 passes near a surrounding object 10, the speed limit increases according to the distance L in the stage where the collaborative robot 1 approaches the surrounding object 10. When the collaborative robot 1 passes the surrounding object 10 and becomes distant from it, the speed limit is released and the movement speed is restored to the speed set in the teaching program.
[0058] Therefore, the control method of the collaborative robot 1 according to this embodiment has the following advantages: it can limit the movement speed to prevent entrapment when the possibility of entrapment is high, and prevent unnecessary restriction of the movement speed to prevent a decrease in movement efficiency when the possibility of entrapment is low.
[0059] That is, the movement speed is limited only when the collaborative robot 1 approaches the surrounding object 10, and the movement speed is not limited when the collaborative robot 1 moves away from the surrounding object 10. In addition, even when the collaborative robot 1 approaches the surrounding object 10, if the distance L is still far away, the speed is not limited. Moreover, even when the distance L approaches to below the predetermined threshold value Th, the greater the degree of approach, the greater the movement speed is limited.
[0060] In particular, in the present embodiment, since the shape information of the collaborative robot 1 and the surrounding objects 10 is stored, the speed limit is automatically implemented according to the stored shape information, so the operator does not need to set the movement speed corresponding to the distance L between the collaborative robot 1 and the surrounding objects 10 during the teaching operation of the collaborative robot 1. That is, there is the following advantage: the operator can perform the teaching operation without considering the distance L between the collaborative robot 1 and the surrounding objects 10, which can simplify the teaching operation and shorten the time spent on teaching.
[0061] Furthermore, in the present embodiment, since not only the tool S but also the shape information of the collaborative robot 1 itself is taken into consideration, it is possible to reliably prevent not only the clamping between the tool S and the surrounding object 10 but also the clamping between the collaborative robot 1 itself and the surrounding object 10. Furthermore, in the case where the tool S or the collaborative robot 1 performs an action such as passing through a narrow gap of the surrounding object 10, even if the distance L between the tool S or the collaborative robot 1 and the surrounding object 10 is extremely close, the action speed is not limited as long as the distance L does not continue to close, and a decrease in the action efficiency can be prevented.
[0062] In addition, in the present embodiment, the speed limit is implemented based on the distance L between the tool S and the collaborative robot 1 itself and the surrounding objects 10, and the change in the distance L, but the speed limit may also be implemented based on the distance between the tool S and the surrounding objects 10, and the change in the distance L. By limiting the judgment object of the distance L to only the tool S and the surrounding objects 10, the amount of calculation can be reduced.
[0063] Furthermore, although the speed limit is implemented based on the distance L between the cooperative robot 1 including the tool S and the surrounding object 10 and the change in the distance L, the speed limit may be implemented based only on the change in the distance L.
[0064] Furthermore, in the present embodiment, the shape information stored in the storage unit 21 may include the hardness or sharpness of each part of at least one of the collaborative robot 1 and the surrounding object 10. Furthermore, the lower the hardness or sharpness of the part where the distance L between the collaborative robot 1 and the surrounding object 10 gradually decreases, the more the processing unit 22 can relax the speed limit.
[0065] That is, when parts with high hardness or sharpness are caught between each other, the damage to the operator is great, but even when parts with low hardness or sharpness are caught between each other, the damage is low. Therefore, when at least one of the surface of the collaborative robot 1 and the surface of the surrounding object 10 is soft or not sharp, the speed can be prevented from being excessively reduced and the operation efficiency can be improved. On the contrary, when the surface of the collaborative robot 1 and the surface of the surrounding object 10 is hard or sharp, the speed can be sufficiently reduced to reduce the damage to the operator.
[0066] In addition, in the present embodiment, a robot system that causes the collaborative robot 1 to move according to a teaching program is exemplified as the robot system 100, but the present invention is not limited thereto, and for example, a robot system that causes the collaborative robot 1 to perform micro-motion may be adopted. In this case, the speed of the micro-motion is controlled to decrease only when the distance L calculated by the processing unit 22 changes in a decreasing direction.
[0067] In addition, in the present embodiment, the collaborative robot 1 may also be provided with a stopping mechanism for stopping when the external force applied to the collaborative robot 1 exceeds a reference value. In this case, the collaborative robot 1 is stopped by the stopping mechanism of the collaborative robot 1 when the external force applied to the collaborative robot 1 exceeds the reference value. Furthermore, it is preferred that the reference value of the external force applied to the collaborative robot 1 is controlled to decrease only when the distance L calculated by the processing unit 22 changes in a decreasing direction.
[0068] In addition, in the present embodiment, the processing unit 22 calculates the change in the distance L between the collaborative robot 1 and the surrounding object 10, but instead, a configuration may be adopted in which the change in the distance between each part of the collaborative robot 1 including the tool S is calculated. In this way, it is possible to suppress the occurrence of collisions between the components constituting the collaborative robot 1, such as between the arms of the collaborative robot 1, or between the tool S and the base of the collaborative robot 1.
[0069] Furthermore, although a six-axis articulated robot is exemplified as the cooperative robot 1 , the present invention is not limited thereto and the robot system 100 can be applied to a robot system 100 including any type of cooperative robot 1 .
Claims
1. A robot control method, characterized in that: The following steps are involved: storing at least a portion of shape information of a robot including a tool mounted on a front end and surrounding objects arranged around the robot; When the robot is caused to move according to the teaching program, at each position of the movement, the change in the distance between the robot and the surrounding object is calculated based on the shape information; When the external force applied to the robot exceeds a reference value, the robot is stopped; Only when the calculated distance changes in a decreasing direction, the speed set in the teaching program is controlled to decrease, and the reference value of the external force is controlled to decrease.
2. The robot control method according to claim 1, characterized in that: When the distance between the robot and the surrounding object is smaller than a predetermined threshold, the speed is controlled to decrease.
3. The robot control method according to claim 1 or 2, characterized in that: The speed is controlled to decrease only when the distance between the tool and the surrounding object changes in a decreasing direction.
4. The robot control method according to claim 1 or 2, characterized in that: storing information on the hardness or sharpness of each part of at least one of the robot and the surrounding object; The degree of reduction in the speed is adjusted according to the hardness or sharpness of the portion where the distance changes in the direction in which it decreases.
5. The robot control method according to claim 4, characterized in that: The higher the hardness of the portion, the greater the reduction in speed.
6. The robot control method according to claim 4, characterized in that: The sharper the portion, the greater the reduction in speed.
7. A robot control method, characterized in that: The following steps are involved: storing at least a portion of shape information of a robot including a tool mounted on a front end and surrounding objects arranged around the robot; When the robot is caused to perform micro-motion, at each position of the motion, a change in the distance between the robot and the surrounding object is calculated based on the shape information; When the external force applied to the robot exceeds a reference value, the robot is stopped; Only when the calculated distance changes in a decreasing direction, the speed of the inching operation is controlled to be reduced, and the reference value of the external force is controlled to be reduced.
8. The robot control method according to claim 7, characterized in that: When the distance between the robot and the surrounding object is smaller than a predetermined threshold, the speed is controlled to decrease.
9. The robot control method according to claim 7 or 8, characterized in that: The speed is controlled to decrease only when the distance between the tool and the surrounding object changes in a decreasing direction.
10. The robot control method according to claim 7 or 8, characterized in that: storing information on the hardness or sharpness of each part of at least one of the robot and the surrounding object; The degree of reduction in the speed is adjusted according to the hardness or sharpness of the portion where the distance changes in the direction in which it decreases.
11. The robot control method according to claim 10, characterized in that: The higher the hardness of the portion, the greater the reduction in speed.
12. The robot control method according to claim 10, characterized in that: The sharper the portion, the greater the reduction in speed.
13. A robot control method, characterized in that: The following steps are involved: storing at least a portion of shape information of a robot including a tool mounted on a front end; When the robot is caused to move according to the teaching program, at each position of the movement, the change in distance of each part of the robot itself is calculated based on the shape information; When the external force applied to the robot exceeds a reference value, the robot is stopped; Only when the calculated distance changes in a decreasing direction, the speed set in the teaching program is controlled to decrease, and the reference value of the external force is controlled to decrease.
