主权项 |
1. A robot control device which controls a robot including a force detector for detecting at least one of force and torque applied to the robot and a state detector for detecting a position and a posture of the robot, comprising:
a mass parameter setting unit which sets a mass parameter including mass of the robot and mass of a workpiece; and a stop command unit which sends a command for making the robot to be in a stop state; wherein the stop command unit includes an internal force estimation unit which estimates internal force generated by an operation of the robot on a basis of the position and the posture of the robot detected by the state detector and the mass parameter, and an external force estimation unit which estimates external force generated by force applied to the robot from an outside of the robot by subtracting the internal force from output of the force detector, a first upper limit values regarding the external force for stopping the robot when a person and an object has made contact with the robot and a second upper limit value smaller than the first upper limit values have been set in advance, and the stop command unit is formed to stop the robot when the external force estimated by the external force estimation unit during an operation period of the robot exceeds the first upper limit values set in advance, and makes the robot to be in the stop state when an average value of the external force in a time length decided in advance during the operation period or a stop period of the robot exceeds the second upper limit value. |