IP Library › Granted Patent US 11,813,755
Granted Patent B2
US 11,813,755 · App. 17/253,973 · Granted Nov 14, 2023

Robot control device, robot control method, and robot control program

Inventors: Mami Yomoda (Kobe, JP); Yoshiharu Nishida (Kobe, JP); Naoki Kida (Fujisawa, JP); Atsushi Fukunaga (Fujisawa, JP); Kenichiro Kanao (Fujisawa, JP)
Assignee: Kobe Steel, Ltd.
B25J9/1676B25J9/1641G05B19/4155G05B2219/50391
View Patent ↗
Loading inventors, assignments & file history…
Monitor This Case
Get email alerts when status or documents change.
Order Certified Copies
Most orders are placed with the USPTO same day — all within 24 business hours.
Order via The Patent Place →
Pre-filled with this patent's details
Quick Facts
Patent No.
US 11,813,755
App. No.
17/253,973
Granted
Nov 14, 2023
Kind
B2
Abstract

A robot control device according to the present invention is configured to: detect a collision of a robot with an object at a predetermined collision detection sensitivity; perform control of operating the robot, and stopping the robot when a detection part detects the collision; and decrease, when a predetermined circumstance causing the robot to have a low temperature is satisfied, the collision detection sensitivity compared to when the predetermined circumstance is unsatisfied.

Claims (59)

1. A robot control device comprising: a processor, the processor being configured to:

detect a collision of a robot with an object at a predetermined collision detection sensitivity;

perform control of operating the robot, and stopping the robot when the collision is detected; and

decrease, a when a predetermined circumstance in which a current time is in a predetermined term during which a temperature of the robot is estimated to be lower than a predetermined temperature is satisfied, the predetermined collision detection sensitivity compared to when the predetermined circumstance is unsatisfied, wherein

the processor decreases the predetermined collision detection sensitivity before a total running time during which a servomotor of the robot is on reaches a predetermined time after a power source of the robot is turned on or after the servomotor is kept off in a predetermined stop time or longer, compared to the predetermined collision detection sensitivity after the total running time reaches the predetermined time.

2. The robot control device according to claim 1 , wherein

the predetermined circumstance includes a circumstance in which an actually measured temperature of the robot is lower than the predetermined temperature.

3. The robot control device according to claim 2 , wherein

the lower the actually measured temperature becomes, the more greatly the processor decreases the predetermined collision detection sensitivity.

4. The robot control device according to claim 3 , wherein

the processor detects the collision when a torque difference between an estimated torque and an actual torque of the robot or a disturbance torque directly estimated from the robot exceeds a predetermined threshold, and

the lower the actually measured temperature becomes, the more greatly the processor increases the predetermined threshold.

5. The robot control device according to claim 1 , wherein

the processor detects the collision when a torque difference between an estimated torque and an actual torque of the robot or a disturbance torque directly estimated from the robot exceeds a predetermined threshold, and

increases, when an actually measured temperature is lower than the predetermined temperature, the predetermined threshold compared to when the actually measured temperature is equal to or higher than the predetermined temperature.

6. The robot control device according to claim 1 , wherein

the processor detects the collision when a torque difference between an estimated torque and an actual torque of the robot or a disturbance torque directly estimated from the robot exceeds a predetermined threshold, and

changes the predetermined threshold to an increased value which is larger than an initial value before the total running time during which the servomotor of the robot is on reaches the predetermined time after the power source of the robot is turned on or after the servomotor is kept off in the predetermined stop time or longer, and returns the predetermined threshold to the initial value after the total running time reaches the predetermined time.

7. The robot control device according to claim 6 , wherein the processor extends the predetermined time when the torque difference or a difference between a value of the disturbance torque and the increased value is smaller than a predetermined value in a predetermined monitoring time before the total running time during which the servomotor is on reaches the predetermined time.

8. The robot control device according to claim 7 , wherein

the processor determines that the torque difference or the difference between the value of the disturbance torque and the increased value is smaller than the predetermined value when a maximal value of the torque difference or the disturbance torque is larger than the initial value and smaller than the increased value.

9. A robot control device comprising a processor, the processor being configured to:

detect a collision of a robot with an object at a predetermined collision detection sensitivity;

perform control of operating the robot, and stopping the robot when the collision is detected;

identify a friction model representing a friction occurring in the robot by using a predetermined matrix to obtain an estimated torque of the robot;

calculate a progress degree of identification of the friction model based on the predetermined matrix; and

decrease the predetermined collision detection sensitivity when the progress degree is small equal to or smaller than a preset value, wherein the processor identifies a friction model X k expressed by A k X k =B k as the predetermined matrix by using a matrix A k and a matrix B k in a time step k, and

calculates the progress degree in accordance with a criterion obtained by using diagonal elements in a matrix A k T A k .

10. The robot control device according to claim 9 , wherein

the criterion includes one of a trace value, a singular value, an element in a first row and a first column, and a number of conditions, in the matrix A k T A k , or a combination of at least two thereof.

11. The robot control device according to claim 9 , wherein

the processor detects the collision when a torque difference between an estimated torque and an actual torque exceeds a predetermined threshold, and

increases, when the progress degree is smaller than the preset value, the predetermined threshold compared to when the progress degree is equal to or larger than the preset value.

12. The robot control device according to claim 9 , wherein

the processor decreases the predetermined collision detection sensitivity when an actually measured temperature of the robot is lower than the predetermined temperature.

13. A robot control method comprising:

a detection step of detecting a collision of a robot with an object at a predetermined collision detection sensitivity;

a robot control step of performing control of operating the robot, and stopping the robot when the collision is detected in the detection step; and

a detection control step of decreasing, when a predetermined circumstance in which a current time is in a predetermined term during which a temperature of the robot is estimated to be lower than a predetermined temperature is satisfied, the predetermined collision detection sensitivity compared to when the predetermined circumstance is unsatisfied, wherein

the detection control step decreases the predetermined collision detection sensitivity before a total running time during which a servomotor of the robot is on reaches a predetermined time after a power source of the robot is turned on or after the servomotor is kept off in a predetermined stop time or longer, compared to the predetermined collision detection sensitivity after the total running time reaches the predetermined time.

14. A robot control method comprising:

a detection step of detecting a collision of a robot with an object at a predetermined collision detection sensitivity;

a robot control step of performing control of operating the robot, and stopping the robot when the collision is detected in the detection step;

an estimation step of identifying a friction model representing a friction occurring in the robot by using a predetermined matrix to obtain an estimated torque of the robot;

an identification progress degree calculation step of calculating a progress degree of identification of the friction model based on the predetermined matrix; and

a detection control step of decreasing the predetermined collision detection sensitivity when the progress degree is equal to or smaller than a preset value, wherein

the estimation step identifies a friction model X k expressed by A k X k =B k as the predetermined matrix by using a matrix A k and a matrix B k in a time step k, and calculates the progress degree in accordance with a criterion obtained by using diagonal elements in a matrix A k T A k .

15. A non-transitory computer readable medium storing a robot control program for causing a computer of a robot to execute:

detection of detecting a collision of the robot with an object at a predetermined collision detection sensitivity;

robot control of performing control of operating the robot, and stopping the robot when the collision is detected by the detection; and

detection control of decreasing, when a predetermined circumstance in which a current time is in a predetermined term during which a temperature of the robot is estimated to be lower than a predetermined temperature is satisfied, the predetermined collision detection sensitivity compared to when the predetermined circumstance is unsatisfied wherein

the detection control decreases the predetermined collision detection sensitivity before a total running time during which a servomotor of the robot is on reaches a predetermined time after a power source of the robot is turned on or after the servomotor is kept off in a predetermined stop time or longer, compared to the predetermined collision detection sensitivity after the total running time reaches the predetermined time.

16. A non-transitory computer readable medium storing a robot control program for causing a computer of a robot to execute:

detection of detecting a collision of the robot with an object at a predetermined collision detection sensitivity;

robot control of performing control of operating the robot, and stopping the robot when the collision is detected by the detection;

estimation of identifying a friction model representing a friction occurring in the robot by using a predetermined matrix to obtain an estimated torque of the robot;

identification progress degree calculation of calculating a progress degree of identification of the friction model based on the predetermined matrix; and

detection control of decreasing the predetermined collision detection sensitivity when the progress degree is equal to or smaller than a preset value, wherein

the estimation identifies a friction model X k expressed by A k X k =B k as the predetermined matrix by using a matrix A k and a matrix B k in a time step k, and calculates the progress degree in accordance with a criterion obtained by using diagonal elements in a matrix A k T A k .

Assignments (1)
ASSIGNMENT OF ASSIGNOR'S INTEREST Recorded Dec 18, 2020
From: YOMODA, MAMI; NISHIDA, YOSHIHARU; KIDA, NAOKI; FUKUNAGA, ATSUSHI; KANAO, KENICHIRO
To: KABUSHIKI KAISHA KOBE SEIKO SHO (KOBE STEEL, LTD.)
Reel/Frame 054695/0721 →
Priority Claims (1)
JP 2018-146103 · Aug 2, 2018 · national
Continuity (1)
Related Publication 20210268657A1 · Sep 2, 2021