Robot
A robot includes a base, a first arm that rotates around a first rotation axis, a second arm that rotates around a second rotation axis extending in a direction different than the first rotation axis, a third arm that rotates around a third rotation axis extending in a direction parallel to the second rotation axis, a first inertia sensor at the first arm, a second (a) inertia sensor at the third arm, a first angle sensor at a first drive source, a third angle sensor at a third drive source, and the drive sources rotate the respective arms. Angular velocities from the first inertia sensor and the first angle sensor are fed back to a first drive source control unit. Angular velocities from the second (a) inertia sensor and the third angle sensor are fed back to a second drive source control unit.
1. A controller controlling a robot including a base, a first arm that is coupled to the base and is rotated around a first rotation axis, a second arm that is rotated around a second rotation axis in a direction different from the first rotation axis, a first inertia sensor that is installed at the first arm, a first drive source that rotates the first arm through a first angular velocity command, and a first angle sensor that detects a rotation angle of the first drive source, comprising:
a processor that is configured to feed back a first correction component, which is derived from a first angular velocity of the first arm around the first rotation axis obtained from the first inertia sensor and a second angular velocity of the first arm around the first rotation axis obtained from the first angle sensor, and controls the first drive source,
wherein the first angular velocity is ωA 1 , which is an angular velocity of the first arm around the first rotation axis,
the second angular velocity is ωA 1 m , which is obtained by dividing an angular velocity ωm 1 of the first drive source that is calculated on the basis of a frequency of a pulse signal input from the first angle sensor by a reduction ratio between a motor of the first drive source and the first arm, and
the first correction component is obtained by taking a difference ωA 1 s between ωA 1 and ωA 1 m , and multiplying the difference ωA 1 s by a gain Ka that is a predetermined factor.
2. The controller according to claim 1 , wherein the processor is configured to control the second arm that is coupled to the first arm based on an output from a second inertia sensor installed at the second arm.
3. The controller according to claim 1 , wherein the second arm is coupled to the first arm, and
the processor is configured to control the second arm based on an output from a third inertia sensor installed at a third arm coupled to the second arm.
4. The controller according to claim 1 , wherein the second arm is coupled to the first arm, and
the processor is configured to control a third arm that is coupled to the second arm based on an output from a third inertia sensor installed at the third arm.
5. The controller according to claim 2 , wherein the second arm is coupled to the first arm, and
the processor is configured to control a third arm that is coupled to the second arm based on an output from a third inertia sensor installed at the third arm.
6. The controller according to claim 1 , wherein the first rotation axis is arranged normal to an installation surface of the base.
7. The controller according to claim 2 , wherein the first rotation axis is arranged normal to an installation surface of the base.
8. The controller according to claim 3 , wherein the first rotation axis is arranged normal to an installation surface of the base.
9. The controller according to claim 4 , wherein the first rotation axis is arranged normal to an installation surface of the base.
10. The controller according to claim 5 , wherein the first rotation axis is arranged normal to an installation surface of the base.
11. The controller according to claim 1 , wherein the first inertia sensor is an angular velocity sensor.
12. The controller according to claim 2 , wherein the first inertia sensor is an angular velocity sensor.
13. The controller according to claim 3 , wherein the first inertia sensor is an angular velocity sensor.
14. The controller according to claim 4 , wherein the first inertia sensor is an angular velocity sensor.
15. The controller according to claim 5 , wherein the first inertia sensor is an angular velocity sensor.
16. The controller according to claim 6 , wherein the first inertia sensor is an angular velocity sensor.
17. The controller according to claim 7 , wherein the first inertia sensor is an angular velocity sensor.
18. The controller according to claim 8 , wherein the first inertia sensor is an angular velocity sensor.
19. The controller according to claim 9 , wherein the first inertia sensor is an angular velocity sensor.
20. The controller according to claim 10 , wherein the first inertia sensor is an angular velocity sensor.