Control device and control method for robot and the robot

1. A control device for a robot including: a robot main body; an arm coupled to the robot main body and including a plurality of links; driving units configured to drive the plurality of links; and an angle sensor configured to detect a driving amount of the driving units,

the control device comprising:

an inertia sensor set in a damping position corresponding to a target location at which vibration of the arm is to be suppressed, and configured to detect at least one of an acceleration and an angular velocity in the damping position;

a first calculating unit configured to calculate a first arm speed in the damping position from at least one of the acceleration and the angular velocity in the damping position detected by the inertia sensor;

a second calculating unit configured to calculate a driving speed from the driving amount of the driving units detected by the angle sensor and calculate a second arm speed in the damping position based on the driving amount and the driving speed;

a third calculating unit configured to calculate a third arm speed based on the first arm speed and the second arm speed;

a fourth calculating unit configured to calculate, based on the third arm speed, a correction speed for each of the driving units that drive the links present between the robot main body and the damping position; and

a control unit configured to control, based on the driving amount, the driving speed, and the correction speed, the driving units that drive the links present between the robot main body and the damping position.

2. The control device for the robot according to claim 1 , wherein the third calculating unit further comprises a filter for removing a low frequency component equal to or less than a predetermined frequency included in a waveform of the third arm speed.

3. A control method for a robot including: an arm including a plurality of coupled links; and driving units configured to drive the plurality of links,

the control method including:

detecting a first arm speed in a damping position corresponding to a target location at which vibration of the arm is to be suppressed;

calculating a third arm speed based on a difference between the detected first arm speed and a second arm speed calculated based on a driving amount of the driving units, the second arm speed being a speed at which the damping position is driven; and

subjecting the driving units to correction control based on the calculated third arm speed.

4. A control method for a robot including: a robot main body; an arm coupled to the robot main body and including a plurality of links; driving units configured to drive the plurality of links; and an angle sensor configured to detect a driving amount of the driving units,

the control method comprising:

detecting, with an inertia sensor set in a damping position corresponding to a target location at which vibration of the arm is to be suppressed, at least one of an acceleration and an angular velocity in the damping position;

detecting, with the angle sensor, a driving amount of the driving units that drive the links present between the damping position and the robot main body;

calculating a first arm speed in the damping position from at least one of the acceleration and the angular velocity in the damping position detected by the inertia sensor;

calculating a driving speed from the driving amount of the driving units detected by the angle sensor and calculating a second arm speed in the damping position based on the driving amount and the driving speed;

calculating a third arm speed in the damping position based on the first arm speed and the second arm speed;

calculating, based on the third arm speed, a correction speed for each of the driving units that drive the links present between the robot main body and the damping position; and

controlling, based on the driving amount, the driving speed, and the correction speed, the driving units that drive the links present between the robot main body and the damping position.

5. The control method for the robot according to claim 4 , wherein the calculating of the third arm speed further includes removing a low frequency component equal to or less than a predetermined frequency included in a waveform of the calculated third arm speed.

6. The control method for the robot according to claim 4 , wherein the calculating of the correction speed for each of the driving units that drive the links present between the robot main body and the damping position based on the third arm speed is applied to the driving unit preselected among the driving units.

7. The control method for the robot according to claim 4 , wherein the calculating of the correction speed for each of the driving units that drive the links present between the robot main body and the damping position based on the third arm speed includes pre-weighting each of the driving units.

8. A robot comprising:

a robot main body;

an arm coupled to the robot main body and including a plurality of links;

driving units configured to drive the plurality of links;

an angle sensor configured to detect a driving amount of the driving units;

an inertia sensor set in a damping position corresponding to a target location at which vibration of the arm is to be suppressed, and configured to detect at least one of an acceleration and an angular velocity in the damping position;

a first calculating unit configured to calculate a first arm speed in the damping position from at least one of the acceleration and the angular velocity in the damping position detected by the inertia sensor;

a second calculating unit configured to calculate a driving speed from the driving amount of the driving units detected by the angle sensor and calculate a second arm speed in the damping position based on the driving amount and the driving speed;

a third calculating unit configured to calculate a third arm speed based on the first arm speed and the second arm speed;

a fourth calculating unit configured to calculate, based on the third arm speed, a correction speed for each of the driving units that drive the links present between the robot main body and the damping position; and

a control unit configured to control, based on the driving amount, the driving speed, and the correction speed, the driving units that drive the links present between the robot main body and the damping position.

9. The robot according to claim 8 , wherein the third calculating unit further comprises a filter for removing a low frequency component equal to or less than a predetermined frequency included in a waveform of the third arm speed.