Controller

• US 20060158143A1
• Filed: 01/10/2006
• Published: 07/20/2006
• Est. Priority Date: 01/20/2005
• Status: Active Grant

• Current Assignee: Fanuc Ltd (Fanuc Corporation)
• Original Assignee: Fanuc Ltd (Fanuc Corporation)
• Inventors: Okita, Tadashi, Iwashita, Yasusuke, Kawamura, Hiroyuki, Ikai, Satoshi
• Granted Patent: US 7,348,745 B2
• Time in Patent Office: Days
• US Class Current: 318/276
• CPC Class Codes: G05B 19/358 with a combination of feedback covered by G05B19/353 - G05B19/356
• CPC Class Codes: G05B 2219/37297 Two measurements, on driving motor and on slide or on both sides of motor

Abstract

First and second acceleration detection means are attached to first and second sections on a driven body, and values of accelerations α1 and α2 in travel direction of the driven body are detected. On the basis of the difference or sum of the acceleration values α1 and α2, at least one of a position command, speed command, or current command for performing drive control of the driven body is corrected.

Claims

1. A controller, comprising position/speed detection means for detecting the position and/or speed of a driven body, and controlling the position and/or speed of the driven body on the basis of a detection value from the position/speed detection means, wherein the controller further comprises:

at least two acceleration detection means which are disposed in different sections on the driven body and detect the accelerations in the sections; and

command correction means for correcting at least one of a position command, speed command, or current command on the basis of the accelerations in one direction, which are detected by the acceleration detection means.

2. A controller, comprising position/speed detection means for detecting the position and/or speed of a driven body, and controlling the position and/or speed of the driven body on the basis of a detection value from the position/speed detection means, wherein the controller further comprises:

at least two acceleration detection means which are disposed indifferent sections on the driven body and detect the accelerations in the sections; and

command correction means for correcting at least one of a position command, speed command, or current command on the basis of the difference between the accelerations in one direction, which are detected by the acceleration detection means.

3. The controller according to claim 2, wherein

the acceleration detection means detect the accelerations in a plurality of directions;

and

the controller comprises calculation means for obtaining values of the accelerations in travel directions of the driven body from values of the accelerations in each of the plurality of directions, which are detected by the acceleration detection means, and obtaining the difference between the values of the accelerations in the travel directions.

4. A controller driving a driven body by means of a plurality of servo motors in one direction, comprising position/speed detection means for detecting the position and/or speed of the driven body, and controlling the position and/or speed of the driven body on the basis of a detection value from the position/speed detection means, wherein the controller further comprises:

at least two acceleration detection means which are disposed in different sections on the driven body and detect the accelerations in the sections; and

command correction means for correcting at least one of a position command, speed command, or current command of each of the servo motors by using the accelerations detected by the acceleration detection means.

5. The controller according to claim 4, wherein

the driven body is driven by a first and second servo motors, the acceleration detection means are disposed in the vicinities of the sections on the driven body driven by the first and second servo motors;

and

the command correction means obtains an acceleration difference by subtracting the acceleration detected by the acceleration detection means disposed on the second servo motor from the acceleration detected by the acceleration detection means disposed on the first servo motor, subjects the obtained acceleration difference to negative feedback to the first servo motor to correct at least one of the position command, speed command, or current command, and subjects the acceleration difference to positive feedback to the second servo motor to correct at least one of the position command, speed command, or current command.

6. The controller according to claim 4, wherein

the acceleration detection means are disposed in the vicinities of the sections on the driven body driven by each of the servo motors;

and

the command correction means obtains a sum of the values of the accelerations detected by the acceleration detection means, subjects thus obtained sum of the acceleration values to the negative feedback to at least one of the position command, speed command, or current command of each of the servo motors, and corrects the position command, speed command, or current command.