Control apparatus for controlling rotation of joints of robot

Patent metadata

Field	Value
Publication number	US-9306434-B2
Application number	US-201314387736-A
Country	US
Kind code	B2
Filing date	Mar 26, 2013
Priority date	Mar 30, 2012
Publication date	Apr 5, 2016
Grant date	Apr 5, 2016

Abstract

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.

First claim

The invention claimed is:

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.

2. The control apparatus according to claim 1 , wherein:
the control means comprises:
a controller that controls rotation of the motor;
a transfer means that transfers the arm rotational position data latched in the second latch circuit from the second encoder to the first encoder when the latch signal is outputted; and
a data combining means arranged in the first encoder combines, when the latch signal is outputted, the motor rotational position data latched in the first latch circuit with the arm rotational position data transferred by the transfer means, for provision to the controller.

3. The control apparatus according to claim 2 , wherein:
the data combining means comprises:
a register that combines the motor rotational position data and the arm position rotation data into parallel data at a rate of predetermined numbers of bits; and
a data bus that transfers the parallel data outputted by the register to the controller.

4. The control apparatus according to claim 2 , wherein the first and second encoders are connected to each other by a relay bus that transmits the latch signal and the arm rotational position data from the second encoder to the first encoder.

5. The control apparatus according to claim 3 , wherein the number of bits of the arm rotational position data is smaller than the number of bits of the motor rotational position data.

6. The control apparatus according to claim 3 , wherein the first and second encoders are connected to each other by a relay bus that transmits the latch signal and the arm rotational position data from the second encoder to the first encoder.

7. The control apparatus according to claim 3 , wherein the first and second encoders are connected to each other by a relay bus that transmits the latch signal and the arm rotational position data from the second encoder to the first encoder.

Assignees

• Denso Wave Inc
• Nikon Corp

Inventors

• Ueda Takeshi
• Takahashi Yoshiji
• Morita Toru
• Ohno Kou

Classifications

• B25J9/10

  characterised by positioning means for manipulator elements · CPC title

• H02K7/116

  with gears · CPC title

• H02K11/0015 Primary

  Electricity · mapped topic

• G05B19/19 Primary

  characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path · CPC title

• H02K11/21 Primary

  Devices for sensing speed or position, or actuated thereby (specially adapted for machines having non-mechanical commutating devices H02K29/06, H02K29/14) · CPC title