Control apparatus for controlling rotation of joints of robot

摘要

A joint of a robot includes a driving motor, a speed reducer that reduces rotation of an output shaft of the motor, and an arm connected to the speed reducer. The joint includes an input encoder that detects a rotational position of the motor and an output encoder that detects a rotational position of the arm. A controller controls the motor based on data indicating the rotational positions of the motor and the arm detected by the input encoder and the output encoder, respectively. The input encoder is arranged with a register that latches and retains an input EC value. The output encoder includes a register that latches and retains an output EC value, and an edge pulse output section that outputs an edge pulse to both registers every time the output EC value changes. In response to the edge pulse, both registers concurrently output EC values to the controller.

主权项

1. A control apparatus that controls rotation of a joint of a robot having a structure in which rotation of an electric motor is reduced by a speed reducer and transferred to an arm, comprising:
a first encoder that detects a rotational position of the motor to output motor rotational position data indicating the rotational position; a second encoder that detects a rotational position of the arm to output arm rotational position data indicating the rotational position; a first latch circuit arranged in the first encoder and latches the motor rotational position data; a second latch circuit arranged in the second encoder and latches the arm rotational position data; a latch signal output means arranged in the second encoder outputs a latch signal to the first and second latch circuits every time there is a change in the arm rotational position data; and a control means that controls, when the latch signal is outputted, rotation of the motor on the basis of the motor rotational position data and the arm rotational position data latched in the first and second latch circuits.