Robot control device and control method
By introducing a speed control unit into the collaborative robot control device, using a force sensor to detect external forces, allowing the operator to change the robot speed through light force operation, solving the problem of frequent stopping of operation in the prior art and improving the operation efficiency.
Patent Information
- Application Number
- CN202280094255.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2022-04-08
- Publication Date
- 2024-11-12
AI Technical Summary
In a collaborative robot system, the operator needs to frequently stop the work to operate the teaching operation panel to change the speed of the robot, resulting in cumbersome and inefficient operations.
By introducing a speed control unit into the robot control device, the external force exerted by the operator is detected by using a force sensor, and the robot's movement speed is changed according to a predetermined threshold, allowing the operator to change the robot's speed through light force operation without stopping the operation.
It realizes the convenient change of the speed of the collaborative robot in actual operation, improves the operation efficiency, and reduces the dependence on the teaching operation panel.
Smart Images

Figure CN118946437A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to a robot control device and a control method. Background Art
[0002] A cooperative robot system is known in which a person and a robot share a workspace without a safety barrier. In such a cooperative robot system, safety is generally ensured by the robot detecting contact with a person and stopping the robot.
[0003] Patent document 1 relates to so-called direct teaching, and states that "In the robot system 11, when the operator 60 applies a force (external force) to the front end portion 58 of the robot 50, the robot control device 10 controls the actuators that move the axes of the robot 50 based on the force applied to the front end portion 58 of the robot 50 measured by the force measuring unit 21, set data, and position data of the robot 50, thereby changing the positions of the axes constituting the robot 50 and moving the robot 50" (paragraph 0019).
[0004] Patent document 2 relates to a simulation device for a collaborative robot, and states that "a simulation device 50 for simulating collaborative work performed by a collaborative robot and a human comprises: a head-mounted display device 80 worn by an operator who simulates performing the collaborative work; a detection unit 70 that detects the position of the operator in the actual space; a three-dimensional model display unit 502 that causes the head-mounted display device to display an image of a robot system model including a collaborative robot model configured in a three-dimensional virtual space; and a simulation execution unit 503 that causes the collaborative robot model to simulate movement in the three-dimensional virtual space based on the action program of the collaborative robot performing the collaborative work and the detected position of the operator" (abstract).
[0005] Patent document 3 relates to direct teaching of a robot, and states that "a gripping portion (103) having a structure separated from an end effector portion (102) installed on the robot arm is provided on the robot arm (100), and a person grips the gripping portion (103) and moves it, thereby causing the robot arm (100) to follow the gripping portion (103). In addition, the gripping portion (103) has a contact sensor (105), and a method of switching the following control is performed according to the detection result of the contact sensor (105)" (abstract).
[0006] Patent document 4 relates to collaborative robots and states that "a human collaborative robot system (1) includes: a first detection unit (S1) for detecting external forces acting on the robot; a second detection unit (S2) for detecting only operating forces acting on the robot when a person manually operates the robot; and a safety ensuring action instruction unit (21) for instructing a safety ensuring action to move the robot in a direction where the external force is reduced or to stop the robot when the external force detected by the first detection unit is greater than a predetermined threshold value" (abstract).
[0007] Prior art literature
[0008] Patent Literature
[0009] Patent Document 1: Japanese Patent Application Publication No. 2015-202534
[0010] Patent Document 2: Japanese Patent Application Publication No. 2019-188531
[0011] Patent Document 3: International Publication No. 2012 / 101956
[0012] Patent Document 4: Japanese Patent Application Publication No. 2018-111174 Summary of the invention
[0013] Problems to be solved by the invention
[0014] Without considering the teaching stage of the collaborative robot, consider the scenario of the actual operation of the collaborative robot executing the control program and cooperating with the operator to perform the predetermined work. During the actual operation of a system using such a collaborative robot, when the operator working with the collaborative robot wants to temporarily reduce the speed of the robot, the operator generally needs to stop the work so far and operate the teaching operating panel to set the movement speed of the robot. In addition, in order to return the reduced speed of the robot to the original speed, the operator needs to operate the teaching operating panel again. Such operations are cumbersome for the operator and reduce the working efficiency. A robot control device and a control method are desired, which do not require stopping the work to operate the teaching operating panel, and can change the speed of the collaborative robot in actual operation according to the operator's intention.
[0015] Means for solving problems
[0016] One aspect of the present disclosure is a robot control device for controlling a robot, comprising a speed control unit that changes an operating speed of the robot in response to detecting that a predetermined external force is applied to the robot when the robot operates according to a control program.
[0017] Another aspect of the present disclosure is a control method for controlling a robot by a robot control device, wherein when the robot moves according to a control program, the movement speed of the robot is changed according to detection that a predetermined external force is applied to the robot.
[0018] Effects of the Invention
[0019] According to the above configuration, the operation speed of the robot operating according to the control program can be changed by an operation that is intuitive and convenient for the operator, such as applying force to the robot.
[0020] These and other objects, features and advantages of the present invention will become more apparent from the detailed description of typical embodiments of the present invention as shown in the accompanying drawings. BRIEF DESCRIPTION OF THE DRAWINGS
[0021] Figure 1 It is a diagram showing the device configuration of a robot system according to one embodiment.
[0022] Figure 2 This is a diagram showing a hardware configuration example of a robot control device and a teaching pendant.
[0023] Figure 3 This is a functional block diagram of a robot control device.
[0024] Figure 4 It is a diagram for explaining the operation details of the speed control in the first embodiment.
[0025] Figure 5 It is a diagram for explaining the operation details of the speed control according to the second embodiment.
[0026] Figure 6 This is a flowchart showing a speed control process of a robot performed by a robot control device according to one embodiment. DETAILED DESCRIPTION
[0027] Next, the embodiments of the present disclosure are described with reference to the accompanying drawings. In the referenced drawings, the same structural parts or functional parts are marked with the same reference symbols. For easy understanding, the scales of these drawings are appropriately changed. In addition, the method shown in the drawings is an example for implementing the present invention, and the present invention is not limited to the method shown in the drawings.
[0028] Figure 1 1 is a diagram showing the equipment structure of a robot system 100 according to an embodiment. The robot system 100 includes a robot 10, a robot control device 50 for controlling the robot 10, and a teaching operation panel 30 connected to the robot control device 50. The robot 10 is configured as a cooperative robot that performs work in cooperation with a person. When the robot system 100 is actually operated, the robot control device 50 causes the robot 10 to perform a predetermined work according to a control program installed in the robot control device 50.
[0029] In a collaborative robot system, an operator who works in cooperation with a robot may want to temporarily change the speed of the robot that operates according to a control program due to various factors in the work. The robot control device 50 of this embodiment provides the following function: the speed of the robot 10 that operates according to the control program is changed by an intuitive and convenient operation such as applying force to the robot 10.
[0030] The base 11 of the robot 10 is fixed to the installation floor. The robot 10 can perform the desired work by means of the end effector installed at the wrist at the front end of the arm. The end effector is an external device that can be replaced according to the purpose, such as a hand, a welding gun, a tool, etc. Figure 1 , an example using a manipulator 60 as an example of an end effector is shown. In the present embodiment, the robot 10 is a vertical multi-joint robot, but other types of robots may be used.
[0031] The robot control device 50 controls the operation of the robot 10 according to a control program or a command from the teaching operation panel 30 .
[0032] A force sensor 71 is disposed below the base 11 of the robot 10. The force sensor 71 is, for example, a 6-axis force sensor. The robot control device 50 obtains the external force (contact force) acting on the robot 10 based on the detection value of the force sensor 71, and can detect that a person or an object has contacted the robot 10. In addition, it is also possible to configure the robot 10 to detect the external force (contact force) acting on the robot 10 using a torque sensor disposed on each joint axis (or at least one joint axis).
[0033] The teaching operation panel 30 is used to perform various settings related to teaching of the robot 10, program generation, jog operation of the robot 10, and other operations related to teaching. In addition, an information processing device such as a tablet terminal or a PC (personal computer) having a teaching function may be used instead of the teaching operation panel.
[0034] Figure 2 The following is an example of the hardware configuration of the robot control device 50 and the teaching operation panel 30. The robot control device 50 may have a configuration as a general computer, in which a memory 52 (ROM, RAM, non-volatile memory, etc.), various input / output interfaces 53, an operation unit 54 including various operation switches, etc. are connected to the processor 51 via a bus. The teaching operation panel 30 may have the following configuration as a general computer, in which a memory 32 (ROM, RAM, non-volatile memory, etc.), a display unit 33, an operation unit 34 composed of an input device such as a keyboard (or software key), various input / output interfaces 35, etc. are connected to the processor 31 via a bus.
[0035] Figure 3 2 is a functional block diagram of the robot control device 50 . The robot control device 50 includes a motion control unit 151 , an external force detection unit 152 , a stop control unit 153 , and a speed control unit 154 .
[0036] The motion control unit 151 generates a trajectory plan of a predetermined movable part (TCP (Tool Center Point) etc.) of the robot 10 according to the control program 150 loaded into the robot control device 50, and generates a command for each axis of the robot 10 through kinematic calculation. Furthermore, the robot control device 50 can move the predetermined control part of the robot 10 according to the planned trajectory by executing servo control for each axis according to the command of each axis. In addition, the motion control unit 151 controls the manipulator 60 according to the control program 150.
[0037] The external force detection unit 152 can detect the external force (contact force) acting on the robot 10 by subtracting the weight of the workpiece gripped by the robot 10 and the inertial force generated by the movement of the robot 10 from the detection value output by the force sensor 71. In addition, the external force detection unit 152 can also be expressed as an external force acquisition unit that acquires the external force based on the detection value of the external force detector such as the force sensor 71.
[0038] When the external force (contact force) detected by the external force detector 152 exceeds a reference value, the stop control unit 153 stops the robot 10 to ensure safety. The reference value is set as a threshold value TH1. With this configuration, the safety of the work performed by the human and the robot 10 in cooperation is ensured.
[0039] When the robot 10 operates according to the control program, the speed control unit 154 changes the operation speed of the robot 10 according to the detection of a predetermined external force applied to the robot 10. In the present embodiment, as an example, when the external force (contact force) detected by the external force detection unit 152 is less than the threshold value TH1, the speed control unit 154 determines that the operator intends to change the speed of the robot 10 and operates the arm of the robot 10, thereby changing the speed of the robot 10.
[0040] According to the above structure, the operator who wishes to change the speed of the robot 10 that is operating at the speed specified by the control program 150 only needs to operate the arm of the robot 10 with a relatively weak force, that is, a light force, which is less than the threshold value TH1 of the external force for determining whether to stop the robot 10. The operator can change the speed of the robot 10 by operating the arm with a light force, so that the operator can use a function that is useful to the operator through an operation that is convenient and simple for the operator. Therefore, the structure that changes the speed of the robot 10 when an external force less than the threshold value TH1 is detected can reliably capture the intention of the operator who wants to temporarily change the speed of the robot 10.
[0041] Hereinafter, two specific examples of speed control by the speed control unit 154 when an external force less than the threshold value TH1 is detected will be described. The two embodiments described below are equivalent to the action of changing the speed of the robot 10 according to the direction of the external force based on the movement direction of the robot 10 when an external force less than the threshold value TH1 is detected to be applied to the robot 10.
[0042] (First embodiment)
[0043] The first embodiment is an operation example of reducing the speed of the robot 10 when the operator applies a force equal to or less than a certain value (threshold value TH1) to the robot 10 in a direction considered to be opposite to the operation direction of the robot 10 operating according to the control program 150. That is, the speed control unit 154 controls the robot 10 to reduce its speed when the following conditions (A1) and (A2) are satisfied.
[0044] (A1) When the external force detected by the external force detection unit 152 is less than or equal to the threshold value TH1
[0045] (A2) When the direction of the external force applied by the operator is opposite to the direction of movement of the robot 10
[0046] Reference Figure 4 The operation of the first embodiment will be described. Figure 4 1 shows the state of the robot 10 as viewed from above. Figure 4 In FIG. 1 , the robot 10 moves along the arrow D. At the position shown in the figure, the operator operates to push the robot 10 back with an external force F1 below the threshold value TH1. Figure 4 The circle within the lower right dashed line in shows the relationship between the motion direction D1 of the robot 10 and the external force F1 at the position shown in the figure.
[0047] As a criterion for determining whether the condition (A2) is satisfied, for example, the following determination criterion (B1) or (B2) can be used.
[0048] (B1) The difference between the movement direction D1 of the robot 10 and the direction of the force (external force) F1 applied by the person to the robot 10 ( Figure 4 The angle θ) is within the range of 180 degrees ± a predetermined value (here the predetermined value is a value less than 90 degrees).
[0049] (B2) The force F1 applied by the person to the robot 10 includes a component in the opposite direction to the movement direction D1 of the robot.
[0050] These can be regarded as a state in which the operator applies a force to the robot 10 in a direction regarded as opposite to the movement direction of the robot 10 .
[0051] The speed control unit 154 reduces the speed of the robot 10 when it is detected that the operator has applied a force equal to or less than a threshold value TH1 to the robot 10 in a direction considered opposite to the movement direction of the robot 10. Examples of control for reducing the speed include the following actions (C1) or (C2).
[0052] (C1) When an external force equal to or less than the threshold value TH1 is detected in a direction considered to be opposite to the movement direction of the robot, the movement speed of the robot 10 is reduced to a constant speed lower than the speed specified by the control program.
[0053] (C2) When an external force below the threshold value TH1 is detected in a direction considered to be opposite to the direction of movement of the robot, the time for which the external force acts is measured, and control is performed in such a manner that the longer the time for which the external force acts, the greater the degree of reduction in speed. In this case, the longer the operator applies force to the robot 10, the greater the degree of reduction in speed can be.
[0054] As described above, according to the first embodiment, the operator can reduce the movement speed of the robot by performing an intuitive and convenient operation such as applying a force of a magnitude less than the reference value TH1 in a direction considered to be opposite to the movement direction to the robot that moves according to the control program. Therefore, the operator can perform cooperative work with the robot more efficiently according to various situations.
[0055] (Second embodiment)
[0056] The second embodiment is an operation example in which, when the operation speed of the robot 10 temporarily drops below the speed specified by the control program 150, the operation speed of the robot 10 is increased when the operator applies a force of a certain value (threshold value TH1) or less to the robot 10 in a direction considered to be the same as the operation direction of the robot 10. That is, the speed control unit 154 increases the speed of the robot 10 when the following conditions (A11) and (A12) are satisfied.
[0057] (A11) When the external force detected by the external force detection unit 152 is less than or equal to the threshold value TH1
[0058] (A12) When the direction of the external force applied by the operator is the same as the direction of movement of the robot 10
[0059] Reference Figure 5 The operation of the second embodiment is described below. Figure 5 In FIG. 1 , the robot 10 moves along the arrow E. At the position shown in the figure, the operator operates the robot 10 in the same direction as the movement direction of the robot 10 with an external force F2 that is less than a threshold value TH1. Figure 5The circle with the broken line in the lower right corner of FIG. 1 shows the relationship between the motion direction E1 of the robot 10 and the external force F2 at the position shown in the figure.
[0060] As a criterion for determining whether the above condition (A12) is satisfied, for example, the following criterion (B11) or (B12) can be used.
[0061] (B11) The difference between the movement direction E1 of the robot 10 and the direction of the force (external force) F2 applied by the person to the robot 10 ( Figure 5 The angle θ2 in the figure is within a predetermined value (here, the predetermined value is a value less than 90 degrees).
[0062] (B12) When the force F2 applied by the person to the robot 10 includes a component in the same direction as the robot's motion direction E1
[0063] These can be regarded as a state in which the operator applies a force to the robot 10 in the same direction as the movement direction of the robot 10 .
[0064] The speed control unit 154 increases the speed of the robot 10 when it is detected that the operator has applied a force equal to or less than the threshold value TH1 to the robot 10 in the same direction as the movement direction of the robot 10. Examples of control for increasing the speed include the following actions (C11) or (C12).
[0065] ( C11 ) When an external force equal to or less than the threshold value TH1 is detected in the direction considered to be the same as the movement direction of the robot 10 , the speed of the robot 10 is restored to the speed specified by the control program 150 .
[0066] (C12) When an external force below a threshold value (TH1) is detected in a direction that is considered to be the same as the direction of movement of the robot (10), the time for which the external force acts is measured, and control is performed in such a manner that the longer the time for which the external force acts, the greater the degree of increase in speed. In this case, the longer the operator applies force to the robot 10, the greater the degree of increase in speed can be.
[0067] As described above, according to the second embodiment, the operator can increase or restore the robot's motion speed by performing an intuitive and convenient operation of applying a force of a magnitude less than the reference value TH1 to the robot whose speed has temporarily decreased in the direction considered to be the same as the motion direction. Therefore, the operator can perform cooperative work with the robot more efficiently according to various situations.
[0068] Furthermore, the above-described operation of the second embodiment can also be applied as an operation for temporarily increasing the operation speed of the robot 10 compared to the speed specified by the control program.
[0069] Figure 6 The figure shows the control method (speed control process) of the robot control device 50 as a flowchart. The speed control process is executed under the control of the processor 51 of the robot control device 50. The speed control process may be executed periodically during the operation of the robot 10.
[0070] like Figure 6 As shown, when the robot 10 operates according to the control program, the external force detection unit 152 detects whether an external force (contact force) is applied to the robot 10 (step S1). The external force detection unit 152 can appropriately detect whether an external force (contact force) is applied to the robot 10 by considering the noise level of the output value of the force sensor 71, for example, by determining that an external force (contact force) is applied when the output value of the force sensor 71 is greater than a certain value (but less than TH1). In step S1, the process is repeated until the external force is detected (S1: No).
[0071] When it is detected that an external force (contact force) acts on the robot 10 (S1: Yes), the magnitude of the external force (F) is determined (step S2). When the magnitude of the external force (F) exceeds a predetermined reference value (threshold TH1) (S2: F>TH1), the robot 10 is stopped by the stop control unit 153 to ensure safety (step S3).
[0072] When the magnitude of the external force (F) is less than or equal to a predetermined reference value (threshold value TH1) (S2: F≤TH1), the speed control unit 154 changes the motion speed of the robot 10 (step S4). In step S4, as described in the first embodiment or the second embodiment, the speed control unit 154 can change the motion speed of the robot 10 according to the direction of the external force based on the motion direction of the robot 10.
[0073] As described above, according to the present embodiment, the operation speed of the robot operating according to the control program can be changed by an operation that is intuitive and convenient for the operator, such as applying force to the robot.
[0074] Although the present invention has been described above using typical embodiments, it will be understood by those skilled in the art that changes to the above-described embodiments and various other changes, omissions, and additions may be made without departing from the scope of the present invention.
[0075] For example, in the above-mentioned embodiment, the threshold value (first threshold value) used in the first embodiment to detect the external force applied in the direction opposite to the movement direction of the robot and the threshold value (second threshold value) used in the second embodiment to detect the external force applied in the same direction as the movement direction of the robot are set to the same value (threshold value TH1), but the first threshold value and the second threshold value may also be different values.
[0076] Figure 3 The functional blocks of the robot control device 50 shown may be realized by the processor 51 of the robot control device 50 executing various software stored in a storage device, or may be realized by a configuration mainly based on hardware such as an ASIC (Application Specific Integrated Circuit).
[0077] Execute the speed control process in the above embodiment ( Figure 6 ) and other processing programs can be recorded on various computer-readable recording media (for example, semiconductor memories such as ROM, EEPROM, and flash memory, magnetic recording media, and optical disks such as CD-ROM and DVD-ROM).
[0078] Description of Reference Numerals
[0079] 10. Robot
[0080] 30 Teaching Operation Panel
[0081] 31 processors
[0082] 32 Memory
[0083] 33 Display unit
[0084] 34 Operation Department
[0085] 35 Input and output interfaces
[0086] 50Robot control device
[0087] 51 processors
[0088] 52 Memory
[0089] 53 Input and output interface
[0090] 54 Operation Department
[0091] 60 Robot
[0092] 71 Force Sensor
[0093] 100 Robotic Systems
[0094] 150 Control Program
[0095] 151 Motion Control Unit
[0096] 152 External force detection unit
[0097] 153 Stop control unit
[0098] 154 speed control unit.
Claims
1. A robot control device, which controls a robot, characterized in that: The robot control device includes a speed control unit that changes the operation speed of the robot in response to detecting that a predetermined external force is applied to the robot when the robot is operating according to a control program.
2. The robot control device according to claim 1, characterized in that: The speed control unit changes the motion speed of the robot in response to an external force equal to or less than a predetermined reference value being detected as the predetermined external force.
3. The robot control device according to claim 2, characterized in that: The robot control device further includes a stop control unit that stops the robot when the external force applied to the robot exceeds the predetermined reference value.
4. The robot control device according to any one of claims 1 to 3, characterized in that: When the robot is operating according to the control program and when it is detected that the predetermined external force is applied to the robot, the speed control unit changes the operating speed of the robot according to the direction of the predetermined external force based on the operating direction of the robot.
5. The robot control device according to any one of claims 1 to 4, characterized in that: The speed control unit sets a degree of change in the motion speed according to a length of time the predetermined external force is applied to the robot.
6. The robot control device according to any one of claims 1 to 5, characterized in that: When the robot is operating according to the control program, the speed control unit reduces the operating speed of the robot when the direction of the predetermined external force applied to the robot is considered to be opposite to the operating direction of the robot.
7. The robot control device according to claim 6, characterized in that: The speed control unit reduces the movement speed of the robot when an external force equal to or less than a first threshold is detected as the predetermined external force and the direction of the external force is considered to be opposite to the movement direction of the robot.
8. The robot control device according to any one of claims 1 to 5, characterized in that: When the direction of the predetermined external force applied to the robot is considered to be the same as the movement direction of the robot when the robot is moving according to the control program, the speed control unit increases the movement speed of the robot.
9. The robot control device according to claim 8, characterized in that: The speed control unit increases the movement speed of the robot when an external force equal to or less than a second threshold is detected as the predetermined external force and when the direction of the external force is considered to be the same as the movement direction of the robot.
10. The robot control device according to claim 8 or 9, characterized in that: When the robot reduces its speed to a speed lower than that specified by the control program, the speed control unit restores the speed of the robot to the speed specified by the control program based on detecting that the predetermined external force considered to be in the same direction as the movement direction of the robot is applied to the robot.
11. A control method for controlling a robot by a robot control device, characterized in that: When the robot is operating according to a control program, the operating speed of the robot is changed according to detection that a predetermined external force is applied to the robot.
12. The control method according to claim 11, characterized in that: The operation speed of the robot is changed in response to an external force equal to or less than a predetermined reference value being detected as the predetermined external force.
13. The control method according to claim 12, characterized in that: The control method further comprises: The robot is stopped when the external force applied to the robot exceeds the predetermined reference value.
14. The control method according to any one of claims 11 to 13, characterized in that: When the robot is operating according to the control program, when an external force equal to or less than a first threshold is detected as the predetermined external force and the direction of the external force is considered to be opposite to the operating direction of the robot, the operating speed of the robot is reduced.
15. The control method according to any one of claims 11 to 13, characterized in that: When the robot is operating according to the control program, when an external force equal to or less than a second threshold is detected as the predetermined external force and the direction of the external force is considered to be the same as the operating direction of the robot, the operating speed of the robot is increased.
Citation Information
Patent Citations
Dual-core two-wheel driving free-lifting high-speed robot electric sickbed controller
CN106074043A
Robot control unit for stopping a movement of a robot according to a force detection value detected by a force sensor
EP1955831A2
Human-collaborative robot system
US20160089790A1
Robot control device for stopping robot by detecting contact force with person
US20160176052A1
Moving bed robot and method of controlling the same
US20210128384A1
