EP4360823A1 - Control method for robot system and robot system - Google Patents
Control method for robot system and robot system Download PDFInfo
- Publication number
- EP4360823A1 EP4360823A1 EP23205368.6A EP23205368A EP4360823A1 EP 4360823 A1 EP4360823 A1 EP 4360823A1 EP 23205368 A EP23205368 A EP 23205368A EP 4360823 A1 EP4360823 A1 EP 4360823A1
- Authority
- EP
- European Patent Office
- Prior art keywords
- robot
- speed
- speed reduction
- abnormality
- time point
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 51
- 230000009467 reduction Effects 0.000 claims abstract description 95
- 230000005856 abnormality Effects 0.000 claims abstract description 69
- 238000012544 monitoring process Methods 0.000 claims abstract description 55
- 230000008859 change Effects 0.000 claims abstract description 14
- 238000001514 detection method Methods 0.000 claims abstract description 11
- 230000002159 abnormal effect Effects 0.000 description 4
- 230000008878 coupling Effects 0.000 description 2
- 238000010168 coupling process Methods 0.000 description 2
- 238000005859 coupling reaction Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 238000005452 bending Methods 0.000 description 1
- 230000000052 comparative effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1674—Programme controls characterised by safety, monitoring, diagnostic
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1651—Programme controls characterised by the control loop acceleration, rate control
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/34—Director, elements to supervisory
- G05B2219/34491—Count certain number of faults before delivering alarm or stop
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/43—Speed, acceleration, deceleration control ADC
- G05B2219/43004—Decelerate to follow desired velocity
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/50—Machine tool, machine tool null till machine tool work handling
- G05B2219/50198—Emergency stop
Definitions
- the present disclosure relates to a control method for a robot system and a robot system.
- JP-A-2011-152612 describes a robot control device that monitors a speed reduction state of a robot after the robot receives a stop command.
- the robot control device of JP-A-2011-152612 performs the monitoring, using a comparative speed calculated based on a maximum speed of the robot, and therefore may not be able to sufficiently detect a speed reduction abnormality when the robot reduces the speed from a speed that is not the maximum speed.
- a control method for a robot system includes a robot, a robot control unit that controls an operation of the robot, and a safety monitoring unit that monitors the operation of the robot.
- the control method includes: a speed reduction control step of causing the robot control unit to perform speed reduction control of the robot, based on a speed reduction command; and an abnormality detection step of causing the safety monitoring unit to acquire an operation speed of the robot at a predetermined interval during the speed reduction control step, and to detect an abnormality in the speed reduction control from a speed change calculated based on the acquired operation speed.
- a robot system includes: a robot; a robot control unit that controls an operation of the robot; and a safety monitoring unit that monitors the operation of the robot.
- the robot control unit performs speed reduction control of the robot, based on a speed reduction command.
- the safety monitoring unit acquires an operation speed of the robot at a predetermined interval during the speed reduction control, and detects an abnormality in the speed reduction control from a speed change calculated based on the acquired operation speed.
- FIG. 1 shows the configuration of a robot system according to a preferred embodiment.
- FIGS. 2 to 4 are graphs showing a state where speed reduction control is abnormal.
- FIG. 5 is a graph showing a state where speed reduction control is normal.
- FIGS. 6 and 7 are flowcharts showing a control method for a robot system.
- a robot system 1 shown in FIG. 1 has a robot 2, a robot control unit 3 that controls the drive of the robot 2, and a safety monitoring unit 4 that monitors the drive of the robot 2.
- the robot 2 is a six-axis vertical articulated robot having six drive shafts.
- the robot 2 has a base 21, a robot arm 22 coupled to the base 21 in a rotationally movable manner, and a tool 23 installed at the distal end of the robot arm 22.
- the robot arm 22 is a robotic arm having six arms 221, 222, 223, 224, 225, 226 coupled in a rotationally movable manner and has six joints J1, J2, J3, J4, J5, J6. Of these six joints J1 to J6, the joints J2, J3, J5 are bending joints and the joints J1, J4, J6 are torsion joints. Each of the joints J1, J2, J3, J4, J5, J6 is equipped with a motor M and an encoder E.
- the robot control unit 3 executes feedback control such that the angle of rotation of the joints J1 to J6 indicated by an output from the encoder E coincides with a target position for each of the joints J1 to J6, while the robot system 1 is in operation.
- a tool center point hereinafter referred to as "TCP" as a control point is set.
- the tool 23 is a hand that holds a workpiece W.
- the configuration of the tool 23 is not particularly limited. A suitable configuration can be selected according to the target task.
- the robot 2 has been described above.
- the configuration of the robot 2 is not particularly limited.
- a SCARA robot horizontal articulated robot
- a dual-arm robot having two of the foregoing robot arms 22, or the like may be employed.
- a selfpropelled robot having the base 21 that is not fixed may be employed.
- the robot control unit 3 controls the drive of the robot 2, for example, based on an operation command from a host computer, not illustrated.
- the robot control unit 3 is formed of a computer, for example, and has a processor that processes information, a memory communicatively coupled to the processor, and an external interface that implements coupling with an external device.
- Various programs executable by the processor are saved in the memory.
- the processor can read and execute the various programs or the like stored in the memory.
- the safety monitoring unit 4 monitors the drive of the robot 2 by the robot control unit 3, and causes the robot 2 to make an emergency stop when an abnormality is detected at the time of the speed reduction of the robot 2.
- the method for the emergency stop is not particularly limited.
- the power of the robot 2 may be shut off.
- a physical brake device may be installed in the robot 2 in advance and the brake device may be activated to stop the robot 2.
- the safety monitoring unit 4 is formed of a computer, for example, and has a processor that processes information, a memory communicatively coupled to the processor, and an external interface that implements coupling with an external device.
- Various programs executable by the processor are saved in the memory.
- the processor can read and execute the various programs or the like stored in the memory.
- the safety monitoring unit 4 detects an abnormality at the time of the speed reduction control of the robot 2 by the robot control unit 3, using the three methods described below.
- the safety monitoring unit 4 first repeatedly detects an operation speed V of the robot 2 every predetermined period while the robot control unit 3 is performing the speed reduction control of the robot 2.
- the operation speed V in this embodiment means the operation speed of the TCP.
- the operation speed V is not particularly limited and can be suitably set.
- the operation speed of the workpiece W may be employed.
- the operation speed V can also be detected, based on a control parameter such as the length of each of the arms 221 to 226, the amount of offset of each of the joints J1 to J6, or the amount of correction to a software origin (correction pulse value), and the output from each encoder E, that is, the angle of rotation of each of the joints J1 to J6.
- the method for detecting the operation speed V is not particularly limited.
- the operation speed V may be detected, using a laser Doppler measurement device, or an inertial sensor may be attached to the robot arm 22 and the operation speed V may be detected, based on an output from the inertial sensor.
- the predetermined period may be measured using actual time or may be decided using a clock frequency of the robot control unit 3.
- the predetermined period is not particularly limited. However, in this embodiment, the predetermined period is set to be approximately 5 milliseconds.
- the safety monitoring unit 4 detects an abnormality when a state where the operation speed V acquired at a certain time point, in this embodiment, the most recent time point, is equal to or higher than the operation speed V acquired at the immediately previous time point, has occurred a predetermined number of times N consecutively.
- FIG. 2 shows a state where the operation speed V increases in the middle due to a certain abnormality despite the speed reduction control of the robot 2 being performed.
- N 3.
- the safety monitoring unit 4 detects the operation speed V every predetermined period, that is, at time points T1, T2, T3, and the like.
- the operation speed V acquired at a time point T8 is equal to or higher than the operation speed V acquired at the immediately previous time point T7.
- the operation speed V acquired at a time point T9 next to the time point T8 is equal to or higher than the operation speed V acquired at the immediately previous time point T8.
- the operation speed V acquired at a time point T10 next to the time point T9 is equal to or higher than the operation speed V acquired at the immediately previous time point T9.
- the safety monitoring unit 4 detects an abnormality in the robot 2 and causes the robot 2 to make an emergency stop.
- N is not limited to 3 and may be 2 or smaller or may be 4 or greater. However, preferably, N is approximately 3 or greater and 10 or smaller.
- N is approximately 3 or greater and 10 or smaller.
- the operation speed V acquired at the most recent time point and the operation speed V acquired at the immediately previous time point are compared with each other. Therefore, a speed reduction abnormality can be detected accurately.
- the safety monitoring unit 4 first repeatedly detects the operation speed V of the robot 2 every predetermined period while the robot control unit 3 is performing the speed reduction control of the robot 2.
- the method for detecting the operation speed V is similar to that in the foregoing first method.
- the safety monitoring unit 4 detects an abnormality when the operation speed V acquired at a certain time point, in this embodiment, the most recent time point, is equal to or higher than the operation speed V acquired at a time point that is M periods before.
- M M ⁇ 2.
- FIG. 3 shows a state where the operation speed V increases in the middle due to a certain abnormality despite the speed reduction control of the robot 2 being performed.
- M 6.
- the safety monitoring unit 4 detects the operation speed V every predetermined period, that is, at time points T1, T2, T3, and the like.
- the operation speed V acquired at a time point T10 is equal to or higher than the operation speed V acquired at a time point T4 that is M periods before.
- the safety monitoring unit 4 detects an abnormality in the robot 2 and causes the robot 2 to make an emergency stop.
- M is not particularly limited if 2 or greater. However, preferably, M is approximately 5 or greater and 10 or smaller. Thus, an abnormality in the speed reduction control of the robot 2 can be detected more accurately and in a short time.
- the operation speed V momentarily changes in the robot 2 due to the influence of a noise or the like and that, due to this change, the operation speed V acquired at the most recent time point is equal to or higher than the operation speed V acquired at the time point that is M periods before, even though in practice the operation speed V is reduced as normal speed reduction control is performed.
- the interval between the present time point and the time point that is M periods before is short and the operation speed V does not drop sufficiently during that time.
- the operation speed V at the present time point is equal to or greater than the operation speed V at the time point that is M periods before because of the foregoing momentary change in the operation speed V due to the noise. Therefore, an abnormality may be detected by mistake despite normal speed reduction control being performed. Meanwhile, if M is too large, it may take time until an abnormality is detected, and it may take a long time until the robot 2 makes an emergency stop after the abnormality occurs.
- the operation speed V acquired at the most recent time point and the operation speed V acquired at the time point that is M periods before are compared with each other. Therefore, a speed reduction abnormality can be detected accurately.
- the safety monitoring unit 4 detects an abnormality when the operation speed V at an expected stop time point Ts of the robot 2 is equal to or higher than a predetermined speed V0.
- the expected stop time point Ts can be found, for example, based on a speed reduction command. Instead of being found based on the speed reduction command, the expected stop time point Ts can also be a time point when a predetermined time has passed since the start of the speed reduction control based on the speed reduction command. Also, the predetermined speed V0 is set to be low enough to regard that the robot 2 is substantially stopped.
- FIG. 4 shows a state where the degree of speed reduction at the time of the speed reduction control of the robot 2 is lower than the degree of speed reduction designated by a command.
- the safety monitoring unit 4 detects the operation speed V every predetermined period, that is, at time points T1, T2, T3, and the like.
- the expected stop time point Ts is located between a time point T10 and a time point T11 and the operation speed V acquired at the time point T11 is higher than the predetermined speed V0.
- the safety monitoring unit 4 detects an abnormality in the robot 2 and causes the robot 2 to make an emergency stop.
- the safety monitoring unit 4 also determines that the speed reduction control of the robot 2 by the robot control unit 3 is normal, by the following method.
- the safety monitoring unit 4 first repeatedly detects the operation speed V of the robot 2 every predetermined period while the robot control unit 3 is performing the speed reduction control of the robot 2.
- the method for detecting the operation speed V is similar to that in the foregoing first method. As shown in FIG. 5 , when the operation speed V becomes lower than the predetermined speed V0 before the expected stop time point Ts, the safety monitoring unit 4 determines that the speed reduction control has normally finished, and gives a notification to that effect.
- the control method for the robot system 1 includes: a speed reduction control step S1 of causing the robot control unit 3 to perform the speed reduction control of the robot 2, based on a speed reduction command; and an abnormality detection step S2 of causing the safety monitoring unit 4 to acquire the operation speed V of the robot 2 at a predetermined interval during the speed reduction control step S1, and to detect an abnormality in the speed reduction control from a speed change calculated based on the acquired operation speed V. Since an abnormality in the speed reduction control is detected from a speed change in the operation speed V during the speed reduction control in this way, the abnormality in the speed reduction control can be accurately detected.
- the control method will be described in detail below.
- the robot control unit 3 performs the speed reduction control to reduce the speed of the robot 2 which is being driven, and to stop the robot 2, for example, based on a speed reduction command from a host computer, not illustrated.
- the safety monitoring unit 4 first initializes a time point T to 0 in step S21.
- the time point T is an integer.
- the safety monitoring unit 4 determines whether a predetermined interval Tcyc equivalent to one period has passed or not. In this embodiment, when the remainder in the division of the time point T by the predetermined interval Tcyc is 0, the safety monitoring unit 4 determines that the predetermined interval Tcyc has passed. When the predetermined interval Tcyc has not passed, the safety monitoring unit 4 increments the time point T, that is, increases the time point T by 1, and executes step S22 again. When the predetermined interval Tcyc has passed, the safety monitoring unit 4 detects the operation speed V of the robot 2 in step S23.
- step S24 the safety monitoring unit 4 detects an abnormality in the speed reduction control of the robot 2, using the first method. That is, the safety monitoring unit 4 determines whether an operation speed Vn acquired at an immediately previous time point Tn ⁇ an operation speed Vn-1 acquired at a time point Tn-1, the operation speed Vn-1 acquired at the time point Tn-1 ⁇ an operation speed Vn-2 acquired at a time point Tn-2, and the operation speed Vn-2 acquired at the time point Tn-2 ⁇ an operation speed Vn-3 acquired at a time point Tn-3, or not.
- Vn ⁇ Vn-1, Vn-1 ⁇ Vn-2, and Vn-2 ⁇ Vn-3 the safety monitoring unit 4 detects an abnormality in the speed reduction control of the robot 2.
- the safety monitoring unit 4 in step S25 detects an abnormality in the speed reduction control of the robot 2, using the second method. That is, the safety monitoring unit 4 determines whether the operation speed Vn acquired at the immediately previous time point Tn ⁇ an operation speed Vn-6 acquired at a time point Tn-6 that is six periods before, or not. When Vn ⁇ Vn-6, the safety monitoring unit 4 detects an abnormality in the speed reduction control of the robot 2.
- the safety monitoring unit 4 in step S26 detects an abnormality in the speed reduction control of the robot 2, using the third method. That is, the safety monitoring unit 4 determines whether an operation speed Vs+1 acquired when the time point T is a time point Ts+1 immediately after the expected stop time point Ts ⁇ the predetermined speed V0 or not. When Vs+1 ⁇ V0, the safety monitoring unit 4 detects an abnormality in the speed reduction control of the robot 2.
- the safety monitoring unit 4 in step S27 determines whether the operation speed Vn acquired at the immediately previous time point ⁇ the predetermined speed V0 or not.
- Vn ⁇ V0 the safety monitoring unit 4 determines that the robot has normally stopped.
- Vn>V0 the safety monitoring unit 4 increments the time point T and executes step S22 again.
- the safety monitoring unit 4 shuts off the power of each motor M in step S28.
- steps S24, S25, S26, S27 is not particularly limited.
- the degrees of priority are S25 ⁇ S24>S26>27. The steps can be executed in order from the highest degree of priority.
- Such a control method for the robot system 1 is a control method for the robot system 1 having the robot 2, the robot control unit 3 controlling the operation of the robot 2, and the safety monitoring unit 4 monitoring the operation of the robot 2, as described above.
- the control method includes: the speed reduction control step S1 of causing the robot control unit 3 to perform the speed reduction control of the robot 2, based on a speed reduction command; and the abnormality detection step S2 of causing the safety monitoring unit 4 to acquire the operation speed V of the robot 2 at a predetermined interval during the speed reduction control step S1, and to detect an abnormality in the speed reduction control from a speed change calculated based on the acquired operation speed V.
- the method of detecting an abnormality in the speed reduction control from a speed change in the operation speed V during the speed reduction control in this way, an abnormality in the speed reduction control can be accurately detected.
- an abnormality is detected when the state where the operation speed V acquired at a certain time point is equal to or higher than the operation speed V acquired at the immediately previous time point has occurred the predetermined number of times N consecutively. According to such a method, a speed reduction abnormality can be accurately detected.
- an abnormality is detected when the operation speed V acquired at a certain time point is equal to or higher than the operation speed V acquired at a time point that is two periods or more before. According to such a method, a speed reduction abnormality can be accurately detected.
- the robot system 1 includes: the robot 2; the robot control unit 3 controlling an operation of the robot 2; and the safety monitoring unit 4 monitoring the operation of the robot 2.
- the robot control unit 3 performs the speed reduction control of the robot 2, based on a speed reduction command.
- the safety monitoring unit 4 acquires the operation speed V of the robot 2 at a predetermined interval during the speed reduction control, and detects an abnormality in the speed reduction control from a speed change calculated based on the acquired operation speed V. According to the configuration where an abnormality in the speed reduction control is detected from a speed change in the operation speed V during the speed reduction control in this way, an abnormality in the speed reduction control can be accurately detected.
- control method for the robot system and the robot system according to the present disclosure have been described above, based on the illustrated embodiment.
- the present disclosure is not limited to this embodiment.
- the configuration of each part can be replaced with any configuration having a similar function.
- any other component may be added to the present disclosure.
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
A control method for a robot system is provided. The robot system includes a robot, a robot control unit that controls an operation of the robot, and a safety monitoring unit that monitors the operation of the robot. The control method includes: a speed reduction control step of causing the robot control unit to perform speed reduction control of the robot, based on a speed reduction command; and an abnormality detection step of causing the safety monitoring unit to acquire an operation speed of the robot at a predetermined interval during the speed reduction control step, and to detect an abnormality in the speed reduction control from a speed change calculated based on the acquired operation speed.
Description
- The present application is based on, and claims priority from
JP Application Serial Number 2022-173080, filed October 28, 2022 - The present disclosure relates to a control method for a robot system and a robot system.
- In the field of human-friendly robots that perform a task in collaboration with a human, a configuration where a safety monitoring unit monitors an operation of a robot and where an emergency stop of the robot is made when an abnormality or trouble in the robot is detected, is known. For example,
JP-A-2011-152612 - However, the robot control device of
JP-A-2011-152612 - According to an aspect of the present disclosure, a control method for a robot system is provided. The robot system includes a robot, a robot control unit that controls an operation of the robot, and a safety monitoring unit that monitors the operation of the robot. The control method includes: a speed reduction control step of causing the robot control unit to perform speed reduction control of the robot, based on a speed reduction command; and an abnormality detection step of causing the safety monitoring unit to acquire an operation speed of the robot at a predetermined interval during the speed reduction control step, and to detect an abnormality in the speed reduction control from a speed change calculated based on the acquired operation speed.
- According to another aspect of the present disclosure, a robot system includes: a robot; a robot control unit that controls an operation of the robot; and a safety monitoring unit that monitors the operation of the robot. The robot control unit performs speed reduction control of the robot, based on a speed reduction command. The safety monitoring unit acquires an operation speed of the robot at a predetermined interval during the speed reduction control, and detects an abnormality in the speed reduction control from a speed change calculated based on the acquired operation speed.
-
-
FIG. 1 shows the configuration of a robot system according to a preferred embodiment. -
FIG. 2 is a graph showing a state where speed reduction control is abnormal. -
FIG. 3 is a graph showing a state where speed reduction control is abnormal. -
FIG. 4 is a graph showing a state where speed reduction control is abnormal. -
FIG. 5 is a graph showing a state where speed reduction control is normal. -
FIG. 6 is a flowchart showing a control method for the robot system. -
FIG. 7 is a flowchart showing the control method for the robot system. - The control method for the robot system and the robot system according to the present disclosure will now be described in detail, based on an embodiment shown in the accompanying drawings.
-
FIG. 1 shows the configuration of a robot system according to a preferred embodiment.FIGS. 2 to 4 are graphs showing a state where speed reduction control is abnormal.FIG. 5 is a graph showing a state where speed reduction control is normal.FIGS. 6 and7 are flowcharts showing a control method for a robot system. - A
robot system 1 shown inFIG. 1 has arobot 2, arobot control unit 3 that controls the drive of therobot 2, and a safety monitoring unit 4 that monitors the drive of therobot 2. - The
robot 2 is a six-axis vertical articulated robot having six drive shafts. Therobot 2 has abase 21, arobot arm 22 coupled to thebase 21 in a rotationally movable manner, and atool 23 installed at the distal end of therobot arm 22. - The
robot arm 22 is a robotic arm having sixarms robot control unit 3 executes feedback control such that the angle of rotation of the joints J1 to J6 indicated by an output from the encoder E coincides with a target position for each of the joints J1 to J6, while therobot system 1 is in operation. At the distal end of such arobot arm 22, a tool center point (hereinafter referred to as "TCP") as a control point is set. - The
tool 23 is a hand that holds a workpiece W. However, the configuration of thetool 23 is not particularly limited. A suitable configuration can be selected according to the target task. - The
robot 2 has been described above. However, the configuration of therobot 2 is not particularly limited. For example, a SCARA robot (horizontal articulated robot), a dual-arm robot having two of theforegoing robot arms 22, or the like, may be employed. Also, a selfpropelled robot having thebase 21 that is not fixed may be employed. - The
robot control unit 3 controls the drive of therobot 2, for example, based on an operation command from a host computer, not illustrated. Therobot control unit 3 is formed of a computer, for example, and has a processor that processes information, a memory communicatively coupled to the processor, and an external interface that implements coupling with an external device. Various programs executable by the processor are saved in the memory. The processor can read and execute the various programs or the like stored in the memory. - The safety monitoring unit 4 monitors the drive of the
robot 2 by therobot control unit 3, and causes therobot 2 to make an emergency stop when an abnormality is detected at the time of the speed reduction of therobot 2. The method for the emergency stop is not particularly limited. For example, the power of therobot 2 may be shut off. Also, a physical brake device may be installed in therobot 2 in advance and the brake device may be activated to stop therobot 2. The safety monitoring unit 4 is formed of a computer, for example, and has a processor that processes information, a memory communicatively coupled to the processor, and an external interface that implements coupling with an external device. Various programs executable by the processor are saved in the memory. The processor can read and execute the various programs or the like stored in the memory. - The safety monitoring unit 4 detects an abnormality at the time of the speed reduction control of the
robot 2 by therobot control unit 3, using the three methods described below. - In a first method, the safety monitoring unit 4 first repeatedly detects an operation speed V of the
robot 2 every predetermined period while therobot control unit 3 is performing the speed reduction control of therobot 2. The operation speed V in this embodiment means the operation speed of the TCP. However, the operation speed V is not particularly limited and can be suitably set. For example, the operation speed of the workpiece W may be employed. The operation speed V can also be detected, based on a control parameter such as the length of each of thearms 221 to 226, the amount of offset of each of the joints J1 to J6, or the amount of correction to a software origin (correction pulse value), and the output from each encoder E, that is, the angle of rotation of each of the joints J1 to J6. However, the method for detecting the operation speed V is not particularly limited. For example, the operation speed V may be detected, using a laser Doppler measurement device, or an inertial sensor may be attached to therobot arm 22 and the operation speed V may be detected, based on an output from the inertial sensor. Also, the predetermined period may be measured using actual time or may be decided using a clock frequency of therobot control unit 3. The predetermined period is not particularly limited. However, in this embodiment, the predetermined period is set to be approximately 5 milliseconds. - Next, the safety monitoring unit 4 detects an abnormality when a state where the operation speed V acquired at a certain time point, in this embodiment, the most recent time point, is equal to or higher than the operation speed V acquired at the immediately previous time point, has occurred a predetermined number of times N consecutively.
- An example where an abnormality is detected will now be described, based on
FIG. 2. FIG. 2 shows a state where the operation speed V increases in the middle due to a certain abnormality despite the speed reduction control of therobot 2 being performed. In the illustrated example, N=3. As shown in the illustration, the safety monitoring unit 4 detects the operation speed V every predetermined period, that is, at time points T1, T2, T3, and the like. In the illustrated example, the operation speed V acquired at a time point T8 is equal to or higher than the operation speed V acquired at the immediately previous time point T7. The operation speed V acquired at a time point T9 next to the time point T8 is equal to or higher than the operation speed V acquired at the immediately previous time point T8. The operation speed V acquired at a time point T10 next to the time point T9 is equal to or higher than the operation speed V acquired at the immediately previous time point T9. When the operation speed V acquired at the most recent time point is equal to or higher than the operation speed V acquired at the immediately previous time point three consecutive times in this way, the safety monitoring unit 4 detects an abnormality in therobot 2 and causes therobot 2 to make an emergency stop. - N is not limited to 3 and may be 2 or smaller or may be 4 or greater. However, preferably, N is approximately 3 or greater and 10 or smaller. Thus, an abnormality at the time of the speed reduction control of the
robot 2 can be detected more accurately and in a short time. At this point, it is conceivable that the operation speed V momentarily changes in therobot 2 due to the influence of a noise or the like and that, due to this change, the operation speed V acquired at the most recent time point is equal to or higher than the operation speed V acquired at the previous time point, even though in practice the operation speed V is reduced as normal speed reduction control is performed. In such a case, if N is too small, an abnormality may be detected by mistake despite normal speed reduction control being performed. Meanwhile, if N is too large, it may take time until an abnormality is detected after the abnormality occurs, and it may take a long time until therobot 2 makes an emergency stop after the abnormality occurs. - In such a method, the operation speed V acquired at the most recent time point and the operation speed V acquired at the immediately previous time point are compared with each other. Therefore, a speed reduction abnormality can be detected accurately.
- In a second method, the safety monitoring unit 4 first repeatedly detects the operation speed V of the
robot 2 every predetermined period while therobot control unit 3 is performing the speed reduction control of therobot 2. The method for detecting the operation speed V is similar to that in the foregoing first method. Next, the safety monitoring unit 4 detects an abnormality when the operation speed V acquired at a certain time point, in this embodiment, the most recent time point, is equal to or higher than the operation speed V acquired at a time point that is M periods before. Here, M≥2. - An example where an abnormality is detected will now be described, based on
FIG. 3. FIG. 3 shows a state where the operation speed V increases in the middle due to a certain abnormality despite the speed reduction control of therobot 2 being performed. In the illustrated example, M=6. As shown in the illustration, the safety monitoring unit 4 detects the operation speed V every predetermined period, that is, at time points T1, T2, T3, and the like. In the illustrated example, the operation speed V acquired at a time point T10 is equal to or higher than the operation speed V acquired at a time point T4 that is M periods before. When the operation speed V acquired at the present time point is equal to or higher than the operation speed V acquired at the time point that is 6 periods before in this way, the safety monitoring unit 4 detects an abnormality in therobot 2 and causes therobot 2 to make an emergency stop. - M is not particularly limited if 2 or greater. However, preferably, M is approximately 5 or greater and 10 or smaller. Thus, an abnormality in the speed reduction control of the
robot 2 can be detected more accurately and in a short time. At this point, as described in the case of the first method, it is conceivable that the operation speed V momentarily changes in therobot 2 due to the influence of a noise or the like and that, due to this change, the operation speed V acquired at the most recent time point is equal to or higher than the operation speed V acquired at the time point that is M periods before, even though in practice the operation speed V is reduced as normal speed reduction control is performed. In such a case, if M is too small, the interval between the present time point and the time point that is M periods before is short and the operation speed V does not drop sufficiently during that time. The operation speed V at the present time point is equal to or greater than the operation speed V at the time point that is M periods before because of the foregoing momentary change in the operation speed V due to the noise. Therefore, an abnormality may be detected by mistake despite normal speed reduction control being performed. Meanwhile, if M is too large, it may take time until an abnormality is detected, and it may take a long time until therobot 2 makes an emergency stop after the abnormality occurs. - In such a method, the operation speed V acquired at the most recent time point and the operation speed V acquired at the time point that is M periods before are compared with each other. Therefore, a speed reduction abnormality can be detected accurately.
- In a third method, the safety monitoring unit 4 detects an abnormality when the operation speed V at an expected stop time point Ts of the
robot 2 is equal to or higher than a predetermined speed V0. The expected stop time point Ts can be found, for example, based on a speed reduction command. Instead of being found based on the speed reduction command, the expected stop time point Ts can also be a time point when a predetermined time has passed since the start of the speed reduction control based on the speed reduction command. Also, the predetermined speed V0 is set to be low enough to regard that therobot 2 is substantially stopped. - An example where an abnormality is detected will now be described in detail, based on
FIG. 4. FIG. 4 shows a state where the degree of speed reduction at the time of the speed reduction control of therobot 2 is lower than the degree of speed reduction designated by a command. As shown in the illustration, the safety monitoring unit 4 detects the operation speed V every predetermined period, that is, at time points T1, T2, T3, and the like. In the illustrated example, the expected stop time point Ts is located between a time point T10 and a time point T11 and the operation speed V acquired at the time point T11 is higher than the predetermined speed V0. When the operation speed V at the expected stop time point Ts, more specifically, the operation speed V detected immediately after the expected stop time point Ts, is equal to or higher than the predetermined speed V0 in this way, the safety monitoring unit 4 detects an abnormality in therobot 2 and causes therobot 2 to make an emergency stop. - In such a method, an abnormality is detected, based on the operation speed V at the expected stop time point Ts. Therefore, a speed reduction abnormality can be detected accurately.
- The safety monitoring unit 4 also determines that the speed reduction control of the
robot 2 by therobot control unit 3 is normal, by the following method. In this method, the safety monitoring unit 4 first repeatedly detects the operation speed V of therobot 2 every predetermined period while therobot control unit 3 is performing the speed reduction control of therobot 2. The method for detecting the operation speed V is similar to that in the foregoing first method. As shown inFIG. 5 , when the operation speed V becomes lower than the predetermined speed V0 before the expected stop time point Ts, the safety monitoring unit 4 determines that the speed reduction control has normally finished, and gives a notification to that effect. - The configuration of the
robot system 1 has been briefly described above. Next, a control method for therobot system 1 will be described. As shown inFIG. 6 , the control method for therobot system 1 includes: a speed reduction control step S1 of causing therobot control unit 3 to perform the speed reduction control of therobot 2, based on a speed reduction command; and an abnormality detection step S2 of causing the safety monitoring unit 4 to acquire the operation speed V of therobot 2 at a predetermined interval during the speed reduction control step S1, and to detect an abnormality in the speed reduction control from a speed change calculated based on the acquired operation speed V. Since an abnormality in the speed reduction control is detected from a speed change in the operation speed V during the speed reduction control in this way, the abnormality in the speed reduction control can be accurately detected. The control method will be described in detail below. - In the speed reduction control step S1, the
robot control unit 3 performs the speed reduction control to reduce the speed of therobot 2 which is being driven, and to stop therobot 2, for example, based on a speed reduction command from a host computer, not illustrated. - As shown in
FIG. 7 , in the abnormality detection step S2, the safety monitoring unit 4 first initializes a time point T to 0 in step S21. The time point T is an integer. Next, in step S22, the safety monitoring unit 4 determines whether a predetermined interval Tcyc equivalent to one period has passed or not. In this embodiment, when the remainder in the division of the time point T by the predetermined interval Tcyc is 0, the safety monitoring unit 4 determines that the predetermined interval Tcyc has passed. When the predetermined interval Tcyc has not passed, the safety monitoring unit 4 increments the time point T, that is, increases the time point T by 1, and executes step S22 again. When the predetermined interval Tcyc has passed, the safety monitoring unit 4 detects the operation speed V of therobot 2 in step S23. - Next, in step S24, the safety monitoring unit 4 detects an abnormality in the speed reduction control of the
robot 2, using the first method. That is, the safety monitoring unit 4 determines whether an operation speed Vn acquired at an immediately previous time point Tn ≥ an operation speed Vn-1 acquired at a time point Tn-1, the operation speed Vn-1 acquired at the time point Tn-1 ≥ an operation speed Vn-2 acquired at a time point Tn-2, and the operation speed Vn-2 acquired at the time point Tn-2 ≥ an operation speed Vn-3 acquired at a time point Tn-3, or not. When Vn≥Vn-1, Vn-1≥Vn-2, and Vn-2≥Vn-3, the safety monitoring unit 4 detects an abnormality in the speed reduction control of therobot 2. - Meanwhile, when not Vn≥Vn-1, Vn-1≥Vn-2, and Vn-2≥Vn-3, the safety monitoring unit 4 in step S25 detects an abnormality in the speed reduction control of the
robot 2, using the second method. That is, the safety monitoring unit 4 determines whether the operation speed Vn acquired at the immediately previous time point Tn ≥ an operation speed Vn-6 acquired at a time point Tn-6 that is six periods before, or not. When Vn≥Vn-6, the safety monitoring unit 4 detects an abnormality in the speed reduction control of therobot 2. - Meanwhile, when not Vn≥Vn-6, the safety monitoring unit 4 in step S26 detects an abnormality in the speed reduction control of the
robot 2, using the third method. That is, the safety monitoring unit 4 determines whether an operation speed Vs+1 acquired when the time point T is a time point Ts+1 immediately after the expected stop time point Ts ≥ the predetermined speed V0 or not. When Vs+1≥V0, the safety monitoring unit 4 detects an abnormality in the speed reduction control of therobot 2. - Meanwhile, when not Vs+1≥V0, the safety monitoring unit 4 in step S27 determines whether the operation speed Vn acquired at the immediately previous time point ≤ the predetermined speed V0 or not. When Vn≤V0, the safety monitoring unit 4 determines that the robot has normally stopped. Meanwhile, when Vn>V0, the safety monitoring unit 4 increments the time point T and executes step S22 again.
- When an abnormality in the speed reduction control of the
robot 2 is detected in the foregoing steps S24, S25, S26 and when it is determined in the foregoing step S27 that the robot has normally stopped, the safety monitoring unit 4 shuts off the power of each motor M in step S28. - In such a method, an abnormality in the speed reduction control of the
robot 2 is detected using the three methods. Therefore, an abnormality in the speed reduction control of therobot 2 can be detected more accurately. The order of steps S24, S25, S26, S27 is not particularly limited. For example, from a viewpoint of wishing to detect an abnormality in the speed reduction control of therobot 2 as early as possible, the degrees of priority are S25≥S24>S26>27. The steps can be executed in order from the highest degree of priority. - The
robot system 1 and the control method therefor have been described above. Such a control method for therobot system 1 is a control method for therobot system 1 having therobot 2, therobot control unit 3 controlling the operation of therobot 2, and the safety monitoring unit 4 monitoring the operation of therobot 2, as described above. The control method includes: the speed reduction control step S1 of causing therobot control unit 3 to perform the speed reduction control of therobot 2, based on a speed reduction command; and the abnormality detection step S2 of causing the safety monitoring unit 4 to acquire the operation speed V of therobot 2 at a predetermined interval during the speed reduction control step S1, and to detect an abnormality in the speed reduction control from a speed change calculated based on the acquired operation speed V. According to the method of detecting an abnormality in the speed reduction control from a speed change in the operation speed V during the speed reduction control in this way, an abnormality in the speed reduction control can be accurately detected. - Also, in the abnormality detection step S2, as described above, an abnormality is detected when the state where the operation speed V acquired at a certain time point is equal to or higher than the operation speed V acquired at the immediately previous time point has occurred the predetermined number of times N consecutively. According to such a method, a speed reduction abnormality can be accurately detected.
- Also, in the abnormality detection step S2, as described above, an abnormality is detected when the operation speed V acquired at a certain time point is equal to or higher than the operation speed V acquired at a time point that is two periods or more before. According to such a method, a speed reduction abnormality can be accurately detected.
- Also, as described above, the
robot system 1 includes: therobot 2; therobot control unit 3 controlling an operation of therobot 2; and the safety monitoring unit 4 monitoring the operation of therobot 2. Therobot control unit 3 performs the speed reduction control of therobot 2, based on a speed reduction command. The safety monitoring unit 4 acquires the operation speed V of therobot 2 at a predetermined interval during the speed reduction control, and detects an abnormality in the speed reduction control from a speed change calculated based on the acquired operation speed V. According to the configuration where an abnormality in the speed reduction control is detected from a speed change in the operation speed V during the speed reduction control in this way, an abnormality in the speed reduction control can be accurately detected. - The control method for the robot system and the robot system according to the present disclosure have been described above, based on the illustrated embodiment. However, the present disclosure is not limited to this embodiment. The configuration of each part can be replaced with any configuration having a similar function. Also, any other component may be added to the present disclosure.
Claims (4)
- A control method for a robot system, the robot system including a robot, a robot control unit that controls an operation of the robot, and a safety monitoring unit that monitors the operation of the robot, the control method comprising:a speed reduction control step of causing the robot control unit to perform speed reduction control of the robot, based on a speed reduction command; andan abnormality detection step of causing the safety monitoring unit to acquire an operation speed of the robot at a predetermined interval during the speed reduction control step, and to detect an abnormality in the speed reduction control from a speed change calculated based on the acquired operation speed.
- The control method for the robot system according to claim 1, wherein
in the abnormality detection step, the abnormality is detected when a state where the operation speed acquired at a certain time point is equal to or higher than the operation speed acquired at an immediately previous time point occurs a predetermined number of times consecutively. - The control method for the robot system according to claim 1, wherein
in the abnormality detection step, the abnormality is detected when the operation speed acquired at a certain time point is equal to or higher than the operation speed acquired at a time point that is two periods or more before. - A robot system comprising:a robot;a robot control unit that controls an operation of the robot; anda safety monitoring unit that monitors the operation of the robot, whereinthe robot control unit performs speed reduction control of the robot, based on a speed reduction command, andthe safety monitoring unit acquires an operation speed of the robot at a predetermined interval during the speed reduction control, and detects an abnormality in the speed reduction control from a speed change calculated based on the acquired operation speed.
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2022173080A JP2024064471A (en) | 2022-10-28 | 2022-10-28 | Method for controlling robot system and robot system |
Publications (1)
Publication Number | Publication Date |
---|---|
EP4360823A1 true EP4360823A1 (en) | 2024-05-01 |
Family
ID=88511084
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
EP23205368.6A Pending EP4360823A1 (en) | 2022-10-28 | 2023-10-23 | Control method for robot system and robot system |
Country Status (4)
Country | Link |
---|---|
US (1) | US20240139955A1 (en) |
EP (1) | EP4360823A1 (en) |
JP (1) | JP2024064471A (en) |
CN (1) | CN117944042A (en) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6140789A (en) * | 1995-06-30 | 2000-10-31 | Mitsubishi Denki Kabushiki Kaisha | Method of detecting, diagnosing and automatically correcting abnormalities in servo control system |
US6778867B1 (en) * | 1997-12-06 | 2004-08-17 | Elan Schaltelemente Gmbh & Co. Kg | Monitoring and control of a handling device |
JP2011152612A (en) | 2010-01-27 | 2011-08-11 | Kawasaki Heavy Ind Ltd | Robot control device |
US20180356815A1 (en) * | 2017-06-12 | 2018-12-13 | Kuka Deutschland Gmbh | Monitoring A Robot |
JP2022173080A (en) | 2021-05-06 | 2022-11-17 | 東洋インキScホールディングス株式会社 | Photosensitive composition, and cured film, optical filter, image display device, solid-state imaging element, and infrared sensor using the photosensitive composition |
-
2022
- 2022-10-28 JP JP2022173080A patent/JP2024064471A/en active Pending
-
2023
- 2023-10-23 EP EP23205368.6A patent/EP4360823A1/en active Pending
- 2023-10-24 CN CN202311387865.3A patent/CN117944042A/en active Pending
- 2023-10-26 US US18/495,074 patent/US20240139955A1/en active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6140789A (en) * | 1995-06-30 | 2000-10-31 | Mitsubishi Denki Kabushiki Kaisha | Method of detecting, diagnosing and automatically correcting abnormalities in servo control system |
US6778867B1 (en) * | 1997-12-06 | 2004-08-17 | Elan Schaltelemente Gmbh & Co. Kg | Monitoring and control of a handling device |
JP2011152612A (en) | 2010-01-27 | 2011-08-11 | Kawasaki Heavy Ind Ltd | Robot control device |
US20180356815A1 (en) * | 2017-06-12 | 2018-12-13 | Kuka Deutschland Gmbh | Monitoring A Robot |
JP2022173080A (en) | 2021-05-06 | 2022-11-17 | 東洋インキScホールディングス株式会社 | Photosensitive composition, and cured film, optical filter, image display device, solid-state imaging element, and infrared sensor using the photosensitive composition |
Also Published As
Publication number | Publication date |
---|---|
US20240139955A1 (en) | 2024-05-02 |
JP2024064471A (en) | 2024-05-14 |
CN117944042A (en) | 2024-04-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10486309B2 (en) | Robot controlling method, robot apparatus, program, recording medium, and method for manufacturing assembly component | |
US10661443B2 (en) | Robot apparatus, robot controlling method, program and recording medium | |
US9348331B2 (en) | Robot apparatus and speed reducer state diagnosing method | |
US6429617B1 (en) | Drive-controlling method and apparatus and robot having the apparatus | |
US10350749B2 (en) | Robot control device having learning control function | |
US20180085921A1 (en) | Robot control device, robot, and robot system | |
US10618164B2 (en) | Robot system having learning control function and learning control method | |
US11413759B2 (en) | Robot apparatus, control method for controlling the same, non-transitory computer-readable recording medium, manufacturing system, and method for manufacturing an article | |
JP6512790B2 (en) | Robot control method, robot apparatus, program, recording medium, and article manufacturing method | |
JP2012051042A (en) | Robot system and robot control device | |
JP2008229800A (en) | Arm-mounted mobile robot and its control method | |
CN111032294B (en) | Information transmission method for controller and abnormality detection method for encoder | |
CN111745277B (en) | Robot control device and robot system | |
JP2016078149A (en) | Robot device control method, robot device, program and recording medium | |
US11141855B2 (en) | Robot system, method of controlling robot arm, recording medium, and method of manufacturing an article | |
EP4360823A1 (en) | Control method for robot system and robot system | |
JP6839369B2 (en) | Robot system | |
JP3327205B2 (en) | Robot control method and device | |
JP2002328707A (en) | Numerical controller | |
JP2006321046A (en) | Controlling method for multi-articulated robot | |
CN111660292A (en) | Control system for industrial robot | |
US20220305651A1 (en) | Robot System, Control Device, And Control Method | |
EP4063085A1 (en) | Robot control method and robot control device | |
JP3366248B2 (en) | Robot control method and device | |
JP2003048181A (en) | Articulated robot |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PUAI | Public reference made under article 153(3) epc to a published international application that has entered the european phase |
Free format text: ORIGINAL CODE: 0009012 |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: THE APPLICATION HAS BEEN PUBLISHED |
|
AK | Designated contracting states |
Kind code of ref document: A1 Designated state(s): AL AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HR HU IE IS IT LI LT LU LV MC ME MK MT NL NO PL PT RO RS SE SI SK SM TR |