发明名称 Robot control device for stopping robot by detecting contact force with person
摘要 A robot control device comprises a mass parameter setting unit which sets a mass parameter, and a stop command unit which sends a stop command of a robot. A first upper limit value regarding external force and a second upper limit value smaller than the first upper limit value have been set. The stop command unit stops the robot when estimated external force exceeds the first upper limit value. Furthermore, the stop command unit makes the robot to be in a stop state when an average value of the external force exceeds the second upper limit value.
申请公布号 US9505129(B2) 申请公布日期 2016.11.29
申请号 US201514943608 申请日期 2015.11.17
申请人 FANUC CORPORATION 发明人 Yamamoto Tomoyuki
分类号 G05B19/04;B25J9/16 主分类号 G05B19/04
代理机构 Hauptman Ham, LLP 代理人 Hauptman Ham, LLP
主权项 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.
地址 Yamanashi JP