Robot
AssigneeFanuc Corporation
InventorsKazutaka Nakayama, Kenichiro Oguri
Life of this patent
Estimating the term…
Abstract
A robot including a plurality of joints each configured to rotate about an axis line; a torque sensor S1 configured to detect torque about the axis line of a target joint as one of the plurality of joints; angle information detection units configured to detect information related to a rotation angle of each of the joints about the axis line; a torque change amount estimation unit configured to estimate a change amount of the torque detected by the torque sensor due to a load other than the torque about the axis line of the target joint based on the detected information; and a correction unit configured to correct the torque detected by the torque sensor by using the estimated change amount.
Claims7
A robot, comprising:
- a plurality of joints, each joint being configured to rotate about an axis line, a robot constitution component extending between at least two joints;
- a torque sensor configured to detect a torque about the axis line of a target joint, the torque including a torque acting around the axis line of the target joint by inertia force of the robot constitution component, which occurs due to a movement of the robot, and a weight of the robot constitution component;
- an encoder configured to detect information related to a rotation angle about the axis line of all or part of the plurality of joints, the part of the plurality of joints including the target joint and at least one joint other than the target joint;
- and
- a processor comprising hardware, the processor being configured to:
- estimate a change amount of the torque detected by the torque sensor due to a load other than the torque about the axis line of the target joint based on the detected information of all or part of the plurality of joints, the load including a load acting on the target joint by the inertia force and the weight of the robot constitution component;
- and
- correct the torque detected by the torque sensor by using the estimated change amount to calculate the torque about the axis line of the target joint to drive the target joint based on the calculated torque and a motor torque command value.
Dependencies are inferred from the claim text.