Balancer abnormality detection system and balancer abnormality detection method
A balancer abnormality detection system includes: a robot; a motor configured to operate the robot; a balancer provided in the robot and configured to generate assist torque which assists power of the motor with force generated by elastic bodies; and a controller configured to detect abnormality of the balancer by measuring a current value of the motor operated to keep a posture of the robot during standby of the robot and comparing the current value with a current command value of the motor necessary for keeping the posture of the robot.
1. A balancer abnormality detection system comprising:
a robot;
a motor configured to operate the robot;
a balancer provided in the robot, provided with elastic bodies, and configured to generate assist torque which assists power of the motor with force generated by the elastic bodies; and
a controller configured to detect abnormality of the balancer by measuring a current value of the motor operated to keep a posture of the robot during standby of the robot and comparing the current value with a current command value of the motor necessary for keeping the posture of the robot.
2. The balancer abnormality detection system according to claim 1 , wherein the controller has a threshold for balancer abnormality detection set at such a value that decline of the assist torque due to the abnormality of the balancer can be detected, calculates a difference between the current value and the current command value during the standby of the robot, and determines that the balancer is abnormal when the difference exceeds the threshold.
3. The balancer abnormality detection system according to claim 2 , wherein the threshold for balancer abnormality detection is set smaller than a threshold for collision detection.
4. The balancer abnormality detection system according to claim 1 , wherein the robot is in a state of stopping at a predetermined standby position after ending an operation until starting a next operation during the standby of the robot.
5. An abnormality detection method for a balancer provided in a robot operated by a motor and configured to generate assist torque which assists power of the motor by force generated by elastic bodies,
the balancer abnormality detection method comprising: detecting abnormality of the balancer by measuring a current value of the motor operated to keep a posture of the robot during standby of the robot and comparing the current value with a current command value of the motor necessary for keeping the posture of the robot.
6. The balancer abnormality detection method according to claim 5 , the method further comprising: calculating a difference between the current value and the current command value during the standby of the robot, and determining that the balancer is abnormal when the difference exceeds a threshold for balancer abnormality detection set at such a value that decline of the assist torque due to the abnormality of the balancer can be detected.
7. The balancer abnormality detection method according to claim 6 , wherein the threshold for balancer abnormality detection is set smaller than a threshold for collision detection.
8. The balancer abnormality detection method according to claim 5 , wherein the robot is in a state of stopping at a predetermined standby position after ending an operation until starting a next operation during the standby of the robot.