# US 5,374,882 A · Method of controlling servomotor

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

- Number: US 5,374,882 A
- Document ID: US5374882A
- Status: Granted
- Kind: A
- Application number: 08/087,749
- Filed: 1993-07-12
- Granted: 1994-12-20
- Earliest claimed: 1991-11-21
- Assignees: Fanuc Corporation
- Inventors: Shunsuke Matsubara; Tadashi Okita; Yasusuke Iwashita
- Web page: https://patentgrep.com/patent/US5374882A

## CPC

- G05B 19/19: 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
- 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)

## Abstract

A method of controlling a servomotor, characterized by faster convergence of both positional deviations and velocity deviations, higher responsibility as well as an improved resistivity against a disturbance, and being free from any mechanical resonance. An adjustment gain G is increased when a torque command Tc1 received from a conventional velocity control is small, whereas the adjustment gain G is decreased when the torque command Tc1 is large. A torque command Tc2 obtained by multiplying the Tc1 to the output from the velocity control section by the adjustment gain G is supplied to the servomotor. The gain is to be heightened in the case where the positional deviation and velocity deviation are both small and the torque command Tc1 is also small, to thereby ensure a higher responsibility and a rapid convergence. Moreover, the gain is to be suppressed when the torque command Tc1 is large, thus preventing the occurrence of a mechanical resonance.

## Claims

### Claim 1

A method of controlling a servomotor, comprising a step of:
adjusting a velocity loop gain of said servomotor based on a magnitude of a torque command issued from a velocity loop control of said servomotor.

### Claim 2

A method of controlling a servomotor, comprising steps of:
detecting a magnitude of a torque command issued from a velocity loop control of said servomotor;
decreasing a velocity loop gain of said servomotor when the detected magnitude of the torque command is large; and
increasing a velocity loop gain of said servomotor when the detected magnitude of the torque command is small.

### Claim 3

A method of controlling a servomotor, comprising steps of:
dividing magnitudes of torque commands issued from a velocity loop control of said servomotor into a plurality of regions of different magnitude;
assigning a value of a gain for adjustment to each of said plurality of regions of different magnitude;
determining a region of said plurality of regions for which a magnitude of a detected torque command falls within; and
applying said assigned value of gain for adjustment corresponding to said region to said detected torque command.

### Claim 4

A method of controlling a servomotor comprising steps of:
determining a torque command value Tc1 based on a velocity loop control of said servomotor having a preset velocity loop gain;
multiplying the determined torque command value Tc1 by an adjustment gain G and thereby obtaining a product as a torque command value Tc2, said adjustment gain G being determined based on said torque command value Tc1; and
providing the obtained product as the torque command value Tc2 to said servomotor.

### Claim 5 (depends on 4)

A method of controlling a servomotor according to claim 4, wherein
said adjustment gain G is determined from the expression
G=1+{Imax/(.vertline.Tc1.vertline.+.delta.)}
where said torque command value Tc1 is a variable, Imax representing a producible torque command maximum is a constant, and .delta. represents a gain adjustment value set through a control system.

### Claim 6 (depends on 5)

A method of controlling a servomotor according to claim 5, wherein
said gain adjustment value .delta. is determined by said producible torque command maximum Imax.

### Claim 7 (depends on 1)

A method of controlling a servomotor according to claims 1, wherein
said servomotor control includes a position loop in addition to said velocity loop.

### Claim 8 (depends on 1)

A method of controlling a servomotor according to claims 1, wherein
said servomotor control includes a position loop in addition to said velocity loop, and wherein
a feedforward control is introduced into the positional loop.

### Claim 9 (depends on 1)

A method of controlling a servomotor according to claims 1, wherein
said servomotor control is effected by a digital servo.

### Claim 10 (depends on 1)

A method of controlling a servomotor according to claims 1, wherein
said servomotor control is effected by an analog servo.
