| CPC B25J 9/1612 (2013.01) [B25J 13/082 (2013.01)] | 4 Claims |
|
1. A robot hand comprising:
a motor;
claws configured to grip a workpiece in accordance with rotation of the motor;
an encoder configured to detect a rotational position of the motor; and
a processor configured to control a torque of the motor such that the claws grip the workpiece in accordance with the rotational position,
wherein the processor is configured to:
execute a limiting process of limiting the torque to a torque limit value or less;
estimate that the claws have come into contact with the workpiece when a speed of the rotational position becomes equal to or less than a threshold value during execution of the limiting process;
execute an increasing process of gradually increasing the torque to be higher than the torque limit value after the claws come into contact with the workpiece;
calculate a movement amount from a position at which the claws are in contact with the workpiece to a current position based on the rotational position during execution of the increasing process; and
execute a maintaining process during the increasing process of:
(i) checking whether the torque is equal to or greater than a torque upper limit value that is greater than the torque limit value and maintaining the torque when the torque is equal to or greater than the torque upper limit value, and
(ii) when the torque is checked and the torque is not equal to or greater than the torque upper limit value, checking whether the movement amount is equal to or greater than a movement amount upper limit value and maintaining the torque when the movement amount is equal to or greater than the movement amount upper limit value.
|