Back to results
US 9,636,823 B2Granted
Robot control device for updating rotation angle by plurality of rotation angle detectors
AssigneeFanuc Corporation
InventorsKunihiko Harada, Takahiro Tanaka
Life of this patent
Estimating the term…
Abstract
A robot control device, when starting from a stop state, updates a first rotation angle or a second rotation angle based on at least one of the first rotation angle stored in a first rotation angle storage unit and the second rotation angle stored in a second rotation angle storage unit and at least one of the first rotation angle detected by a first rotation angle detector and the second rotation angle detected by the second rotation angle detector.
Claims4
A robot control device for controlling a robot including a joint part driven by an output from a reducer for increasing rotational force of a driving motor, the robot control device comprising:
- a first rotation angle detector configured to detect a rotation angle of an input shaft of the reducer;
- a second rotation angle detector configured to detect a rotation angle of an output shaft of the reducer;
- an auxiliary power source configured to supply electricity to the first rotation angle detector in a state in which the robot control device is stopped;
- and
- a control unit configured to store and update a rotation angle, wherein
- the control unit includes a first rotation angle storage unit configured to store a first rotation angle detected by the first rotation angle detector, a second rotation angle storage unit configured to store a second rotation angle detected by the second rotation angle detector, and a rotation angle updating unit configured to update a rotation angle stored in the first rotation angle storage unit or the second rotation angle storage unit,
- supply of electricity to the second rotation angle detector is stopped in the state in which the robot control device is stopped,
- the second rotation angle storage unit is configured to store the second rotation angle at a time when the robot control device is stopped in the state in which the robot control device is stopped, and
- when the robot control device is started from the state in which the robot control device is stopped, the rotation angle updating unit calculates an error in number of rotations regarding the second rotation angle based on a difference between the first rotation angle stored in the first rotation angle storage unit when the robot control device is stopped and the first rotation angle detected by the first rotation angle detector when the robot control device is started and a difference between the second rotation angle stored in the second rotation angle storage unit when the robot control device is stopped and the second rotation angle detected by the second rotation angle detector when the robot control device is started, and updates the second rotation angle based on the error in the number of rotations.
6 more elements
A robot control device for controlling a robot including a joint part driven by an output from a reducer for increasing rotational force of a driving motor, the robot control device comprising:
- a first rotation angle detector configured to detect a rotation angle of an input shaft of the reducer;
- a second rotation angle detector configured to detect a rotation angle of an output shaft of the reducer;
- an auxiliary power source configured to supply electricity to the first rotation angle detector in a state in which the robot control device is stopped;
- and
- a control unit configured to store and update a rotation angle, wherein
- the control unit includes a first rotation angle storage unit configured to store a first rotation angle detected by the first rotation angle detector, a second rotation angle storage unit configured to store a second rotation angle detected by the second rotation angle detector, and a rotation angle updating unit configured to update a rotation angle stored in the first rotation angle storage unit or the second rotation angle storage unit,
- supply of electricity to the second rotation angle detector is stopped in the state in which the robot control device is stopped,
- the second rotation angle storage unit is configured to store the second rotation angle at a time when the robot control device is stopped in the state in which the robot control device is stopped, and
- when the robot control device is started from the state in which the robot control device is stopped, the rotation angle updating unit calculates number of rotations regarding the first rotation angle at which the first rotation angle is closest to the second rotation angle based on a difference between the second rotation angle stored in the second rotation angle storage unit when the robot control device is stopped or the second rotation angle detected by the second rotation angle detector after the robot control device is started and the first rotation angle detected by the first rotation angle detector after the robot control device is started, and updates the first rotation angle based on calculated number of rotations.
6 more elements
Dependencies are inferred from the claim text.