# US 6,020,706 A · Method of and apparatus for controlling a servomotor

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

- Number: US 6,020,706 A
- Document ID: US6020706A
- Status: Granted
- Kind: A
- Application number: 09/043,635
- Filed: 1998-03-24
- Granted: 2000-02-01
- Earliest claimed: 1996-07-24
- Assignees: Fanuc Corporation
- Inventors: Yasusuke Iwashita; Hiroyuki Kawamura
- Web page: https://patentgrep.com/patent/US6020706A

## 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 2219/42074: Position feedback and speed feedback, speed measured with tacho
- Y02P 90/02: Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
- 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)
- Y02P: CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS

## Abstract

A servomotor control method capable of preventing an overshoot in positioning a movable part of a machine in the case where the position of the movable part is controlled in a full-closed loop. When an output P1 of a first acceleration/deceleration processing section of a bell-type acceleration/deceleration process becomes "0", a coefficient k3 of incomplete integration is set to a relatively small value .alpha., and a torque limit value TL is set to a relatively small value TLL. The incomplete integration is performed with the coefficient k3 set to the small value, and a torque command TC is limited to the small value, so that an output of the servomotor is reduced and torsion of a mechanical system between the servomotor and the mechanical movable part is canceled. When both the outputs P1 and P2 of the acceleration/deceleration processing sections become "0", the coefficient k3 is set to a relatively large value .beta., and a torque limit value is made larger, to perform the incomplete integration. Then, the output torque of the servomotor is increased gradually to position the movable part at the designated position.

## Claims

### Claim 1

A method of controlling a servomotor for driving a movable part of a machine through a mechanical system, based on a first motion command distributed from a numerical control device, the method comprising the steps of:
detecting a position of the movable part;
controlling a position of the movable part using the first motion command and the position of the movable part detected in the detecting step by a feedback control system including a position loop; and
positioning the movable part so that torsion of the mechanical system between the servomotor and the movable part is released by reducing a torque command for the servomotor for a period immediately before termination of a second motion command input to the position loop, the period commencing upon occurrence of a predetermined indication preceding termination of the second motion command.

### Claim 2 (depends on 1)

A method of controlling a servomotor according to claim 1, wherein:
the feedback control system comprises an acceleration/deceleration processing section,
the controlling step includes the steps of:
performing an acceleration/deceleration process of the first motion command by the acceleration/deceleration processing section; and
outputting the motion command obtained by the acceleration/deceleration process in the acceleration/deceleration process step to the position loop as the second motion command, and
the positioning step includes a step of reducing the torque command for the servomotor when an input to the acceleration/deceleration processing section becomes zero.

### Claim 3

A method of controlling a servomotor for driving a movable part of a machine through a mechanical system, based on a first motion command distributed from a numerical control device, the method comprising the steps of:
detecting a position of the movable part;
controlling a position of the movable part using the first motion command and the position of the movable part detected in the detecting step by a feedback control system including a position loop; and
positioning the movable part so that torsion of the mechanical system between the servomotor and the movable part is released by reducing a torque command for the servomotor for a period immediately before termination of a second motion command input to the position loop, the period commencing upon occurrence of a predetermined indication preceding termination of the second motion command;
wherein:
the feedback control system comprises a first acceleration/deceleration processing section and a second acceleration/deceleration processing section; and
the controlling step includes the steps of:
performing an acceleration/deceleration process of the first motion command by the first acceleration/-deceleration processing section and further performing an acceleration/deceleration process by the second acceleration/deceleration processing section, and
outputting the motion command obtained by the acceleration/-deceleration processes in the acceleration/deceleration process step to the position loop as the second command; and
the positioning step includes the step of reducing the torque command for the servomotor when an output of the first acceleration/deceleration processing section becomes zero.

### Claim 4

A method of controlling a servomotor for driving a movable part of a machine through a mechanical system, based on a first motion command distributed from a numerical control device, the method comprising the steps of:
detecting a position of the movable part;
controlling a position of the movable part using the first motion command and the position of the movable part detected in the detecting step by a feedback control system including a position loop;
positioning the movable part so that torsion of the mechanical system between the servomotor and the movable part is released by reducing a torque command for the servomotor for a period immediately before termination of a second motion command input to the position loop, the period commencing upon occurrence of a predetermined indication preceding termination of the second motion command; and
delivering a predetermined signal at a predetermined time before the second motion command terminates;
wherein the positioning step includes a step of reducing the torque command for the servomotor when the predetermined signal is delivered.

### Claim 5

A method of controlling a servomotor for driving a movable part of a machine through a mechanical system, based on a first motion command distributed from a numerical control device, the method comprising the steps of:
detecting a position of the movable part;
controlling a position of the movable part using the first motion command and the position of the movable part detected in the detecting step by a feedback control system including a position loop;
positioning the movable part so that torsion of the mechanical system between the servomotor and the movable part is released by reducing a torque command for the servomotor for a period immediately before termination of a second motion command input to the position loop, the period commencing upon occurrence of a predetermined indication preceding termination of the second motion command; and
delivering a signal indicating a time immediately before termination of the first motion command when the remainder of the first motion command amount is not greater than a predetermined value;
wherein the positioning step includes a step of reducing the torque command for the servomotor when the signal is delivered.

### Claim 6

A method of controlling a servomotor for driving a movable part of a machine through a mechanical system, based on a first motion command distributed from a numerical control device, the method comprising the steps of:
detecting a position of the movable part;
controlling a position of the movable part using the first motion command and the position of the movable part detected in the detecting step by a feedback control system including a position loop; and
positioning the movable part so that torsion of the mechanical system between the servomotor and the movable part is released by reducing a torque command for the servomotor for a period immediately before termination of a second motion command input to the position loop, the period commencing upon occurrence of a predetermined indication preceding termination of the second motion command;
wherein the feedback control system includes a velocity loop and the positioning step includes the step of reducing the torque command by decreasing a value of an integrator in the velocity loop.

### Claim 7 (depends on 6)

A method of controlling a servomotor according to claim 6, wherein the positioning step includes the step of obtaining an integral value for the present processing period of a position and velocity feedback control using a product of an integral value in the last processing period and a predetermined constant which is equal to or larger than 0 but smaller than 1.

### Claim 8 (depends on 7)

A method of controlling a servomotor according to claim 7, further comprising the step of gradually increasing the torque command by changing the predetermined constant to a value larger than a present value of the predetermined constant but smaller than 1 after the second motion command is wholly inputted to the position loop.

### Claim 9

A method of controlling a servomotor for driving a movable part of a machine through a mechanical system, based on a first motion command distributed from a numerical control device, the method comprising the steps of:
detecting a position of the movable part;
controlling a position of the movable part using the first motion command and the position of the movable part detected in the detecting step by a feedback control system including a position loop; and
positioning the movable part so that torsion of the mechanical system between the servomotor and the movable part is released by reducing a torque command for the servomotor for a period immediately before termination of a second motion command input to the position loop, the period commencing upon occurrence of a predetermined indication preceding termination of the second motion command;
wherein the feedback control system includes a torque limit circuit for limiting the torque command, and the positioning step includes the step of reducing the torque command by decreasing a limit value of the torque limit circuit.

### Claim 10 (depends on 1)

A method of controlling a servomotor according to claim 1, wherein the predetermined indication is one of
the first motion command, provided as an input signal to an acceleration/deceleration processing operation, becoming zero while an output signal thereof is nonzero,
commencement of a predetermined time interval before termination of the second motion command, and
a remaining amount of the second motion command becoming less than or equal to a predetermined value.

### Claim 11 (depends on 10)

A method of controlling a servomotor according to claim 10, wherein the acceleration/deceleration processing operation is a second acceleration/deceleration processing operation subsequent to a first acceleration/deceleration processing operation, and the input signal to the second acceleration/deceleration processing operation is an output signal from the first acceleration/deceleration operation.

### Claim 12

A servo control system for controlling a servomotor to drive a movable part of a machine through a mechanical system, based on a first motion command distributed from a numerical control device, said system comprising:
means for detecting a position of the movable part;
means, including a feedback control system including a position loop, for controlling a position of the movable part using the feedback control system and in accordance with the first motion command and the position of the movable part detected by said detecting means; and
means for positioning the movable part so that torsion of the mechanical system between the servomotor and the movable part is released by reducing a torque command for the servomotor for a period immediately before termination of a second motion command input to the position loop, the period commencing upon occurrence of a predetermined indication preceding termination of the second motion command.

### Claim 13 (depends on 12)

A servo control system according to claim 12, wherein:
the feedback control system further includes an acceleration/deceleration processing section for performing an acceleration/deceleration process of the first motion command to obtain the second motion command;
said controlling means further includes means for outputting the second motion command obtained by the acceleration/deceleration processing section to the position loop; and
said positioning means includes means for reducing the torque command for the servomotor when an input to the acceleration/deceleration processing section becomes zero.

### Claim 14 (depends on 12)

A servo control system according to claim 12, wherein:
the feedback control system further includes
a first acceleration/deceleration processing section for performing a first acceleration/deceleration process on the first motion command to generate a first output signal, and
a second acceleration/deceleration processing section for performing a second acceleration/deceleration process on the first output signal to generate a second output signal as the second motion command;
said controlling means further comprises means for outputting the second output signal to the position loop; and
said positioning means includes means for reducing the torque command for the servomotor when the first output signal becomes zero.

### Claim 15

A computer-readable medium encoded with a program for controlling a servomotor to drive a movable part of a machine through a mechanical system, based on a first motion command distributed from a numerical control device, said program comprising the functions of:
detecting a position of the movable part;
controlling a position of the movable part using a feedback control system including a position loop and in accordance with the first motion command and the position of the movable part detected by the detecting function; and
positioning the movable part so that torsion of the mechanical system between the servomotor and the movable part is released by reducing a torque command for the servomotor for a period immediately before termination of a second motion command input to the position loop, the period commencing upon occurrence of a predetermined indication preceding termination of the second motion command.

### Claim 16 (depends on 15)

A computer-readable medium according to claim 15, wherein:
the feedback control system further includes an acceleration/deceleration processing section for performing an acceleration/deceleration process of the first motion command to obtain the second motion command;
the controlling function includes a function for outputting the second motion command obtained by the acceleration/deceleration process of the acceleration/-deceleration processing section to the position loop; and
the positioning function includes a function for reducing the torque command for the servomotor when an input to the acceleration/deceleration processing section becomes zero.

### Claim 17 (depends on 15)

A computer-readable medium according to claim 15, wherein:
the feedback control system further includes
a first acceleration/deceleration processing section for performing a first acceleration/deceleration process on the first motion command to generate a first output signal, and
a second acceleration/deceleration processing section for performing a second acceleration/deceleration process on the first output signal to generate a second output signal as the second motion command;
the controlling function further comprises a function for outputting the second output signal to the position loop; and
the positioning function includes a function for reducing the torque command for the servomotor when the first output signal becomes zero.

### Claim 18

A servomotor drive control system for controlling a servomotor to drive a movable part through a mechanical system coupled between the servomotor and the movable part, said servomotor drive control system comprising:
a numerical controller for distributing a first motion command for the servomotor; and
a digital servo control circuit for receiving the first motion command, obtain therefrom a second motion command, and reducing a torque command for the servomotor for a period immediately before termination of the second motion command, the period commencing upon occurrence of a predetermined indication preceding termination of the second motion command;
whereby the movable part is positioned so that torsion of the mechanical system is released as the movable part is driven by the servomotor.
