Horizontal articulated robot, and method of controlling the same
A robot includes a first horizontal arm coupled to a base, a second horizontal arm coupled to the base via the first horizontal arm, first and second motors adapted to rotate the respective arms, and first and second encoders adapted to calculate rotational angles and rotational velocities of the respective motors. A first motor control section subtracts first and second angular velocities based on the first and second encoders from a sensor angular velocity detected by an angular sensor, and controls the first motor so that a velocity measurement value obtained by adding a vibration velocity based on a vibration angular velocity as the subtraction result and a first rotational velocity becomes equal to a velocity command value.
1. A robot comprising:
a first arm;
a first motor that rotates the first arm;
a first sensor that detects an angle of the first arm and that outputs a first output;
a second arm connected to the first arm;
a second motor that rotates the second arm;
a second sensor that detects an angle of the second arm and that output a second output; and
an angular velocity sensor that is s disposed to the second arm and that outputs a third output; wherein
the first motor is controlled by the first, second and third outputs, and
the second motor is controlled by the second output without using the first output, wherein the second motor is controlled without using the third output.
2. The robot according to claim 1 , wherein
the first motor is controlled based on a difference between the third output and an angular velocity calculated from the second output.
3. The robot according to claim 2 , wherein
the second arm comprises a cover, and
the angular velocity sensor is disposed inside the cover.
4. The robot according to claim 2 , wherein
the angular velocity sensor is a vibratory gyroscope.
5. The robot according to claim 4 , wherein
the angular velocity sensor has a quartz crystal vibrator.
6. The robot according to claim 1 , wherein
the second arm comprises a cover, and
the angular velocity sensor is disposed inside the cover.
7. The robot according to claim 6 , wherein
the angular velocity sensor is a vibratory gyroscope.
8. The robot according to claim 7 , wherein
the angular velocity sensor has a quartz crystal vibrator.
9. The robot according to claim 1 , wherein
the angular velocity sensor is a vibratory gyroscope.
10. The robot according to claim 9 , wherein
the angular velocity sensor has a quartz crystal vibrator.
11. The robot according to claim 1 , wherein
the robot is a horizontal articulated robot.