# US 2017/0277206 A1 · Servo control apparatus, servo control method and computer-readable recording medium

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

- Number: US 2017/0277206 A1
- Document ID: US20170277206A1
- Status: Published application
- Kind: A1
- Application number: 15/456,959
- Filed: 2017-03-13
- Published: 2017-09-28
- Earliest claimed: 2016-03-24
- Assignees: Fanuc Corporation
- Applicants: Fanuc Corporation
- Inventors: Kazunori IIJIMA
- Web page: https://patentgrep.com/patent/US20170277206A1

## CPC

- G05D 17/02: characterised by the use of electric means
- G05B 15/02: electric
- G05B 19/416: characterised by control of velocity, acceleration or deceleration (G05B19/19 takes precedence)
- G05B 2219/41197: Adaptive postfiltering
- G05D: SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- 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 servo control apparatus includes a velocity command creation unit; a velocity detection unit; a velocity control gain; a torque command creation unit; a filter configured to attenuate a particular frequency band component in a torque command value; a sine-wave sweep input unit configured to perform a sine-wave sweep in a predetermined frequency range; a frequency characteristics calculation unit configured to calculate a frequency characteristic of a sine-wave; and a filter adjustment unit configured to attenuate a particular frequency band component in a torque command value. A signal is input to the velocity control gain. The signal is obtained by adding a sine-wave to a difference between a velocity command value and a velocity detected. The filter adjustment unit measures an influence of the velocity control gain on a resonance frequency and resonance peak amplitude, while changing a value of the velocity control gain, thereby adjusting the filter.

## Claims

### Claim 1

A servo control apparatus, comprising:
a velocity command creation unit configured to create a velocity command value of a servomotor;
a velocity detection unit configured to detect a velocity of the servomotor;
a velocity control gain that is a control gain of a velocity control loop;
a torque command creation unit configured to create a torque command value for the servomotor;
at least one filter configured to attenuate a particular frequency band component included in the torque command value;
a sine-wave sweep input unit configured to perform a sine-wave sweep in a predetermined frequency range;
a frequency characteristics calculation unit configured to calculate frequency characteristics of a sine-wave that is swept; and
a filter adjustment unit configured to adjust the filter so as to attenuate a particular frequency band component included in the torque command value; wherein
the velocity control gain, the torque command creation unit, the filter, and the velocity detection unit configure the velocity control loop;
a signal is input to the velocity control gain, the signal being obtained by adding a sine-wave being output from the sine-wave sweep input unit to a difference between the velocity command value and the velocity detected; and
the filter adjustment unit is configured to detect a resonance frequency included in frequency characteristics that is calculated by way of the frequency characteristics calculation unit, while changing a value of the velocity control gain, and configured to adjust the filter by measuring an influence of the velocity control gain on a resonance frequency and resonance peak amplitude.

### Claim 2 (depends on 1)

The servo control apparatus according to claim 1, wherein the filter adjustment unit determines evaluation of a resonance characteristic and applicability of the filter, based on a quantitative relationship between a value of the velocity control gain and resonance peak amplitude of frequency characteristics obtained from the frequency characteristics calculation unit.

### Claim 3 (depends on 1)

The servo control apparatus according to claim 1, wherein the filter adjustment unit determines evaluation of a resonance characteristic and applicability of the filter, based on a quantitative relationship between a value of the velocity control gain and a resonance frequency of frequency characteristics obtained from the frequency characteristics calculation unit.

### Claim 4

A servo control method for a servo control apparatus, the method comprising:
creating a velocity command value of a servomotor;
detecting a velocity of the servomotor;
inputting a signal to a velocity control gain, the signal being obtained by adding a sine-wave being swept in a predetermined frequency range to a difference between the velocity command value and the velocity detected;
creating a torque command value for the servomotor, based on an output from the velocity control gain;
attenuating a particular frequency band component included in the torque command value by way of at least one filter; and
driving the servomotor, based on the torque command value with the particular frequency band component attenuated,
wherein the servo control method for the servo control apparatus further comprises:
calculating frequency characteristics of the sine-wave that is swept in the predetermined frequency range;
detecting a resonance frequency included in the frequency characteristics calculated, while changing a value of the velocity control gain; and
adjusting the filter so as to attenuate a particular frequency band component included in the torque command value, by measuring an influence of value of the velocity control gain on a resonance frequency and resonance peak amplitude.

### Claim 5

A computer-readable medium storing a servo control program causing a computer as a servo control apparatus of a servomotor to execute the processing of:
creating a velocity command value of the servomotor;
detecting a velocity of the servomotor;
inputting a signal to a velocity control gain, the signal being obtained by adding a sine-wave being swept in a predetermined frequency range to a difference between the velocity command value and the velocity detected;
creating a torque command value for the servomotor, based on an output from the velocity control gain;
attenuating a particular frequency band component included in the torque command value by way of at least one filter; and
driving the servomotor, based on the torque command value with the particular frequency band component attenuated,
wherein the program further causes the computer to:
calculate frequency characteristics of the sine-wave that is swept in the predetermined frequency range;
detect a resonance frequency included in the frequency characteristics calculated, while changing a value of the velocity control gain; and
adjust the filter so as to attenuate a particular frequency band component included in the torque command value, by measuring an influence of value of the velocity control gain on a resonance frequency and resonance peak amplitude.
