Control device for limiting speed of robot
A control device includes a stop command unit for stopping an operation of a robot when a person comes in contact with the robot, and a speed limit unit for limiting the operation speed of the robot. A distance determination value relating to an accident caused by sandwiching a person is predetermined. The speed limit unit includes a model generation unit for generating three-dimensional models of two objects among the component of the robot, a hand, and object arranged around the robot, and a distance calculation unit for calculating the shortest distance between the models of the two objects. When the shortest distance is less than the distance determination value, the speed limit unit controls the operation speed of the robot so that the operation speed is equal to or lower than a predetermined limit speed.
1. A control device for controlling an operation speed of a robot, the control device comprising:
a processor configured to
stop an operation of the robot in response to a person coming in contact with the robot, and
limit the operation speed of the robot, wherein
a distance determination value relating to an accident caused by sandwiching a person between two objects among a component of the robot, an operation tool attached to the robot, and an object arranged around the robot is predetermined,
a contact determination value is a determination value for a distance when the two objects among the component of the robot, the operation tool, and the object arranged around the robot come into contact with each other,
the contact determination value relating to contact between the two objects is a value that is different from the distance determination value relating to the accident caused by sandwiching the person,
the processor is configured to
generate three-dimensional models of the two objects among the component of the robot, the operation tool, and the object arranged around the robot,
calculate a shortest distance between the models of the two objects in the three-dimensional models,
determine whether or not the shortest distance is less than the distance determination value,
in response to the shortest distance being less than the distance determination value, control the operation speed of the robot so that the operation speed is equal to or lower than a first limit speed determined in advance,
determine whether or not the shortest distance is less than the contact determination value, and
in response to the shortest distance being less than the contact determination value, control the operation speed of the robot so that the operation speed is equal to or lower than a second limit speed determined in advance.
2. The control device according to claim 1 , wherein
the two objects for which the shortest distance is determined by the processor include the component of the robot and the object arranged around the robot,
the processor is configured to generate
the model of the component of the robot so as to cover the component of the robot, and
the model of the object arranged around the robot so as to cover the object arranged around the robot,
the distance determination value is a determination value for the distance between the model of the component of the robot and the model of the object arranged around the robot, and
the processor is configured to calculate the shortest distance between the model of the component of the robot and the model of the object arranged around the robot.
3. The control device according to claim 1 , wherein
the two objects for which the shortest distance is determined by the processor include the component of the robot and the operation tool,
the processor is configured to generate
the model of the component of the robot so as to cover the component of the robot, and
the model of the operation tool so as to cover the operation tool,
the distance determination value is a determination value for the distance between the model of the component of the robot and the model of the operation tool, and
the processor is configured to calculate the shortest distance between the model of the component of the robot and the model of the operation tool.
4. The control device according to claim 1 , wherein
the two objects for which the shortest distance is determined by the processor include the operation tool and the object arranged around the robot,
the processor is configured to generate
the model of the operation tool so as to cover the operation tool, and
the model of the object arranged around the robot so as to cover the object arranged around the robot,
the distance determination value is a determination value for the distance between the model of the operation tool and the model of the object arranged around the robot, and
the processor is configured to calculate the shortest distance between the model of the operation tool and the model of the object arranged around the robot.
5. The control device according to claim 1 , wherein
the two objects for which the shortest distance is determined by the processor include a first component of the robot and a second component of the robot,
the processor is configured to generate
a model of the first component so as to cover the first component, and
a model of the second component so as to cover the second component,
the distance determination value is a determination value for the distance between the model of the first component and the model of the second component, and
the processor is configured to calculate the shortest distance between the model of the first component and the model of the second component.
6. The control device according to claim 1 , wherein the contact determination value is set to be smaller than the distance determination value.