Robot, carriage device, and control method using inertia sensor
A robot includes: an arm; a driving source that pivots the arm; an angle sensor that detects a pivot angle and outputs pivot angle information; an inertia sensor that is attached to the arm and outputs inertial force information; a control command generating unit that outputs a control command defining rotational operation of the arm; a control conversion determining unit that determines whether the inertial force information is used when the driving source is controlled; and an arm operation control unit that performs a first control based on the control command, the pivot angle information, and the inertial force information, if the control conversion determining unit determines that the inertial force information should be used, and performs a second control based on the control command and the pivot angle information, if the control conversion determining unit determines that the inertial force information should not be used.
1. A robot comprising:
an arm with one end pivotally supported;
a driving source that pivots the arm;
an angle sensor that detects a pivot angle of the driving source and outputs pivot angle information of the driving source;
an inertia sensor that is attached to the arm and outputs inertial force information of an inertial force acting on the arm;
a control command generating unit that outputs a control command defining rotational operation of the arm;
a control conversion determining unit that determines whether the inertial force information is used or not when the driving source is controlled to control operation of the arm; and
an arm operation control unit that performs a first control based on the control command, the pivot angle information, and the inertial force information, to control the driving source and thus control the operation of the arm, if the control conversion determining unit determines to use the inertial force information, and performs a second control which is different from the first control, based on the control command and the pivot angle information, to control the driving source and thus control the operation of the arm, if the control conversion determining unit determines not to use the inertial force information.
2. The robot according to claim 1 , wherein a threshold value is previously set in the inertial force information, and the control conversion determining unit compares the inertial force information with the threshold value to determine whether the inertial force information is used or not.
3. The robot according to claim 1 , wherein a threshold value is previously set in the pivot angle information, and the control conversion determining unit compares the pivot angle information with the threshold value to determine whether the inertial force information is used or not.
4. The robot according to claim 1 , wherein a threshold value is previously set in an integral value of one or more times of the inertial force information, and the control conversion determining unit compares the integral value of one or more times of the inertial force information with the threshold value to determine whether the inertial force information is used or not.
5. The robot according to claim 1 , wherein a threshold value is previously set in a differential value of one or more times of the pivot angle information, and the control conversion determining unit compares the differential value of one or more times of the pivot angle information with the threshold value to determine whether the inertial force information is used or not.
6. The robot according to claim 1 , wherein a threshold value is previously set in a time axis based on a specific point of the control command, and the control conversion determining unit compares a lapse time from the specific point with the threshold value to determine whether the inertial force information is used or not.
7. The robot according to claim 1 , wherein a threshold value is previously set in a noise affecting the inertial force information, and the control conversion determining unit compares the noise affecting the inertial force information with the threshold value to determine whether the inertial force information is used or not.