Structure of robot control system
First Claim
Patent Images
1. A robot control apparatus comprising:
- a plurality of servomotors which move preselected components of a robot, respectively;
a plurality of position detectors which detect rotational positions of said servomotors and output the rotational positions in the form of serial data, respectively;
a motor control driver which controls said servomotors based on the rotational positions detected by said position detectors and required positions, wherein said motor control driver detects an error in transmission between each of said position detectors and said motor control driver by checking a format of the serial data outputted from each of said position detectors, an error check code contained in the serial data, and a time required for the transmission between each of said position detectors and said motor control driver; and
a serial communication path disposed between said motor control driver and said position detectors to transmit request signals provided by said motor control driver to said position detectors to request said position detectors to output the rotational positions, said position detectors being connected to said serial communication path in parallel to each other, respectively; and
a storage circuit which stores therein the rotational positions detected by said position detectors in a cycle and a position estimating circuit which estimates the rotational positions of said servomotors based on the rotational positions derived in previous cycles when transmission between said position detectors and said motor control driver is in error in this cycle, and wherein said motor control driver controls said servomotors based on the estimated rotational positions.
1 Assignment
0 Petitions
Accused Products
Abstract
A robot control system is provided which controls a plurality of servomotors for moving a hand and articulated arms of a robot. The robot control system includes a plurality of position detectors, a motor control driver, and a serial communication path. The position detectors detect rotational positions of the servomotors and output the rotational positions in the form of serial data, respectively. The serial communication path is disposed between the motor control driver and the position detectors to transmit request signals provided by the motor control driver to the position detectors to request the position detectors to output the rotational positions.
-
Citations
3 Claims
-
1. A robot control apparatus comprising:
-
a plurality of servomotors which move preselected components of a robot, respectively; a plurality of position detectors which detect rotational positions of said servomotors and output the rotational positions in the form of serial data, respectively; a motor control driver which controls said servomotors based on the rotational positions detected by said position detectors and required positions, wherein said motor control driver detects an error in transmission between each of said position detectors and said motor control driver by checking a format of the serial data outputted from each of said position detectors, an error check code contained in the serial data, and a time required for the transmission between each of said position detectors and said motor control driver; and a serial communication path disposed between said motor control driver and said position detectors to transmit request signals provided by said motor control driver to said position detectors to request said position detectors to output the rotational positions, said position detectors being connected to said serial communication path in parallel to each other, respectively; and a storage circuit which stores therein the rotational positions detected by said position detectors in a cycle and a position estimating circuit which estimates the rotational positions of said servomotors based on the rotational positions derived in previous cycles when transmission between said position detectors and said motor control driver is in error in this cycle, and wherein said motor control driver controls said servomotors based on the estimated rotational positions. - View Dependent Claims (2)
-
-
3. A robot control apparatus comprising:
-
a plurality of servomotors which move preselected components of a robot, respectively, each servomotor including a motor casing having formed thereon a spigot and an annular sealing member installed in the spigot, the robot having a motor mount which has formed therein a socket into which the spigot of the motor casing is fitted through the annular sealing member with a portion of the motor mount around the socket connecting directly with a portion of the motor casing around the spigot for grounding the motor casing through the robot; a plurality of position detectors which detect rotational positions of said servomotors and output the rotational positions in the form of serial data, respectively; a motor control driver which controls said servomotors based on the rotational positions detected by said position detectors and required positions; and a serial communication path, connecting said motor control driver and said position detectors, to transmit request signals provided by said motor control driver to said position detectors to request said position detectors to output the rotational positions, said position detectors being connected to said serial communication path in parallel to each other, respectively.
-
Specification