Device, method and program for estimating weight and position of gravity center of load by using robot
A device, a method and a program, by which a weight and/or a position of a gravity center of a load attached to a movable part of a robot can be estimated by a simple configuration. The device has a torque sensor configured to detect a torque applied to an axis for driving the movable part of the robot, and a calculation section configured to calculate the weight of the article, by using: a first torque applied to the axis, when the article attached to the movable part is positioned at a first position and represents a first posture; a second torque applied to the axis, when the article attached to the movable part is positioned at a second position different from the first position and represents the first posture; the first position; and the second position.
1. A device for estimating a weight of an article, comprising:
a torque sensor configured to detect a torque applied to an axis for driving a movable part of a robot; and
a calculation section configured to calculate the weight of the article, based on:
a first torque applied to the axis detected by the torque sensor, when the article attached to the movable part is positioned at a first position relative to the axis and at a first posture relative to gravity,
a second torque applied to the axis detected by the torque sensor, when the article attached to the movable part is positioned at a second position relative to the axis and at the first posture relative to gravity, the second position being different from the first position,
the first position, and
the second position.
2. The device as set forth in claim 1 , wherein the calculation section calculates the weight W of the article by using a following equation:
W =(( T 2− M 2)−( T 1− M 1))/ D
wherein T 1 is the first torque; T 2 is the second torque; M 1 is obtained as a torque applied to the axis when the article is not attached to the movable part and when the movable part is positioned at the first position and represents the first posture; M 2 is obtained as a torque applied to the axis when the article is not attached to the movable part and when the movable part is positioned at the second position and represents the first posture; and D is calculated as a magnitude of a horizontal component of a vector extending from the first position to the second position, the horizontal component being perpendicular to the axis.
3. A method for estimating a weight of an article, comprising:
attaching the article to a movable part of a robot having a torque sensor;
detecting a first torque applied to an axis for driving the movable part by the torque sensor, when the article is positioned at a first position relative to the axis and at a first posture relative to gravity;
detecting a second torque applied to the axis by the torque sensor, when the article is positioned at a second position relative to the axis at the first posture relative to gravity, the second position being different from the first position; and
calculating the weight of the article based on the first torque, the second torque, the first position and the second position.
4. The method as set forth in claim 3 , wherein the weight W of the article is calculated by using a following equation:
W =(( T 2− M 2)−( T 1− M 1))/ D
wherein T 1 is the first torque; T 2 is the second torque; M 1 is obtained as a torque applied to the axis when the article is not attached to the movable part and when the movable part is positioned at the first position and represents the first posture; M 2 is obtained as a torque applied to the axis when the article is not attached to the movable part and when the movable part is positioned at the second position and represents the first posture; and D is calculated as a magnitude of a horizontal component of a vector extending from the first position to the second position, the horizontal component being perpendicular to the axis.
5. A non-transitory computer readable medium which stores a program for causing the robot or an arithmetic processing unit used in conjunction with the robot to execute the method as set forth in claim 3 .