# US 4,588,937 A · Position control apparatus

> Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt

- Number: US 4,588,937 A
- Document ID: US4588937A
- Status: Granted
- Kind: A
- Application number: 06/683,017
- Filed: 1984-12-13
- Granted: 1986-05-13
- Earliest claimed: 1983-04-13
- Assignees: Fanuc Corporation
- Inventors: Yoshiki Fujioka; Naoto Ota; Mitsuhiko Hirota
- Web page: https://patentgrep.com/patent/US4588937A

## CPC

- G05B 19/232: {with speed feedback only}
- G05D 3/20: using a digital comparing device
- G05B 2219/41021: Variable gain
- G05B 2219/41024: High gain for low command speed, torque or position error equals or near zero
- G05B: CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS (systems for controlling or regulating non-electric variables G05D; systems for regulating electric or magnetic variables G05F; control devices or systems insofar as characterised by mechanical features only G05G)
- G05D: SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES

## Abstract

A position control apparatus has a variable gain-type velocity amplifier (115) provided within a servo control circuit, and a low velocity sensing circuit (114) for sensing a predetermined low velocity of a motor (100) immediately before the motor is stopped. When the rotational velocity of the motor (100) drops to the predetermined low velocity immediately before stoppage during orientation control, the velocity amplifier is changed over in response to a signal from the gain of the low velocity sensing circuit (114), thereby raising servo loop gain.

## Claims

### Claim 1

A position control apparatus for a motor, comprising:
a servo control circuit for rotating the motor during normal servo control by following an offset between a commanded velocity and an actual velocity of the motor; and
an orientation control circuit for stopping the motor at a predetermined position upon receiving an orientation signal as the commanded velocity, said servo control circuit including:
a velocity amplifier having changeover means capable of making servo loop gain higher than that which prevails during the normal servo control; and
a low velocity sensing circuit, coupled to said velocity amplifier and the motor, for sensing a predetermined low velocity as the motor is being stopped, the servo loop gain being raised by the changeover means of said velocity amplifier in response to a signal from said low velocity sensing circuit when the rotational velocity of the motor drops to the predetermined low velocity during orientation control.

### Claim 2

A position control apparatus for a motor, comprising:
a servo control circuit for rotating the motor during normal servo control by following an offset between a commanded velocity and an actual velocity of the motor; and
an orientation control circuit for stopping the motor at a predetermined position upon receiving an orientation signal as the commanded velocity, said servo control circuit including:
a velocity amplifier having changeover means capable of making servo loop gain higher than that which prevails during the normal servo control;
a switch control circuit for switching between a servo control operation and an orientation control operation;
motor velocity sensing means;
a low velocity sensing circuit, coupled to said velocity amplifier and said motor velocity sensing means, for sensing a predetermined low velocity of the motor as the motor is stopping; and
a gate circuit provided between said velocity amplifier and said low velocity sensing circuit, said gate circuit being opened only when the motor reaches a predetermined position during orientation control, the servo loop gain being raised by the changeover means of said velocity amplifier in response to a signal from said low velocity sensing circuit when the rotational velocity of the motor drops to the predetermined low velocity during the orientation control operation.

### Claim 3 (depends on 2)

A position control apparatus according to claim 2, wherein said switch control circuit, said motor velocity sensing means, said low velocity sensing means and said gate circuit are constructed in the form of a single block.

### Claim 4

A position control apparatus for enhancing servo stability of a motor in a servo control system having a normal servo control mode and an orientation control mode, comprising:
first means, coupled to the motor, for providing an actual velocity signal and for providing an in position signal when the motor has reached a target position during the orientation control mode;
second means, operatively connected to said first means, for providing a first switching signal when said servo control system is in the normal servo control mode, for providing a second switching signal when the servo control system is in the orientation control mode, and for providing a third switching signal when said second means receives the in position signal while the servo control system is in the orientation control mode;
third means, operatively connected to said second means, for providing a command signal comprising one of a velocity command signal, an orientation command signal and an analog error signal in dependence upon the first, second and third switching signals, respectively;
fourth means, operatively connected to said third means and said first means, for generating a torque command signal based on the command signal and the actual velocity signal;
low velocity sensing means, operatively connected to said first means, for providing a gain changeover command signal when the actual velocity of the motor drops below a predetermined velocity and said first means is generating the in position signal; and
a velocity amplifier, operatively connected to said fourth means, said low velocity sensing means and the motor, for providing an amplified torque command to the motor, said velocity amplifier having a first gain when the gain changeover command signal is not being generated by said low velocity sensing means, and having a second gain which is greater than the first gain, when the gain changeover command signal is generated.

### Claim 5 (depends on 4)

A position control circuit as set forth in claim 4, wherein said low velocity sensing means comprises:
a low velocity sensing circuit for generating a low velocity signal when the actual velocity of the motor drops below the predetermined velocity; and
a gate circuit, operatively connected to said low velocity sensing circuit and to said velocity amplifier, for generating the gain changeover command signal upon receiving both the in position signal and the low velocity signal.

### Claim 6 (depends on 5)

A position control circuit as set forth in claim 5, wherein the second gain is at least three times the first gain.
