Servo control device having function of automatically adjusting control system with autonomous stabilization

Patent metadata

Field	Value
Publication number	US-10108152-B2
Application number	US-201715466975-A
Country	US
Kind code	B2
Filing date	Mar 23, 2017
Priority date	Apr 13, 2016
Publication date	Oct 23, 2018
Grant date	Oct 23, 2018

Abstract

A servo control device according to the present invention includes a speed command generation unit, a torque command generation unit, a speed detection unit, a speed control loop, a speed control gain setting unit for setting a speed control gain for the speed control loop, a sinusoidal disturbance input unit for performing a sinusoidal sweep on the speed control loop, a frequency characteristic calculation unit, and a gain adjustment unit. When the speed control loop has fallen into an oscillation state and has become unstable owing to the increased speed control gain, the speed control gain is reduced and the sinusoidal sweep is temporarily stopped. After the speed control loop is stabilized using the speed control gain which is lower than in the unstable state, the sinusoidal sweep is restarted.

First claim

What is claimed is:

1. A servo control device for a transmission mechanism driven by a servomotor, comprising:
a speed control loop electrical circuitry in communication with the transmission mechanism, the speed control loop electrical circuitry configured to:
generate a speed command value for the servomotor;
set a speed control gain;
generate a torque command value for the servomotor; and
detect the speed of the servomotor,

wherein the speed control loop electrical circuitry receives inputs from a sinusoidal disturbance input unit and a gain adjustment unit, and
wherein the sinusoidal disturbance input unit generates a sinusoidal wave and performs a sinusoidal sweep on the speed control loop electrical circuitry; and
a frequency characteristic calculation unit that receives an input from the sinusoidal disturbance input unit and estimates gain of speed control loop electrical circuitry when a sinusoidal wave is inputted to the speed control loop electrical circuitry,
the frequency characteristic calculation unit expresses an output of the speed control loop as a Fourier series using a disturbance input frequency from the sinusoidal disturbance input unit as a fundamental frequency,
wherein the frequency characteristic calculation unit calculates the amplitude and phase of a fundamental component of the Fourier series in order to calculate frequency characteristics online,
wherein the gain adjustment unit determines the adjustment amount of a speed control gain based on the difference between a desired target evaluation function value and an evaluation function value by an actual sweep and outputs a signal to the speed control loop electrical circuitry to adjust the speed control gain online, and
wherein when the speed control loop electrical circuitry has fallen into an oscillation state and has become unstable owing to an increased speed control gain determined during a sinusoidal sweep by the sinusoidal disturbance input unit, the speed control gain is reduced by the gain adjustment unit and the sinusoidal sweep is temporarily stopped.

2. The servo control device according to claim 1 , wherein when the speed control loop electrical circuitry has become unstable, the speed control gain is changed by the gain adjustment unit and the sinusoidal sweep is performed in a repeated manner until the speed control loop electrical circuitry is stabilized, and after the stabilization of the speed control loop electrical circuitry, the gain adjustment unit measures frequency characteristics of the speed control loop electrical circuitry.

Assignees

• Fanuc Corp

Inventors

• Iijima Kazunori

Classifications

• G05B5/01 Primary

  electric · CPC title

• G05B2219/41025

  Detect oscillation, unstability of servo and change gain to stabilize again · CPC title

• G05B2219/35473

  Input limit values of speed, position, acceleration or force · CPC title

• G05B19/4062 Primary

  Monitoring servoloop, e.g. overload of servomotor, loss of feedback or reference · CPC title

• G05B19/404

  characterised by control arrangements for compensation, e.g. for backlash, overshoot, tool offset, tool wear, temperature, machine construction errors, load, inertia (G05B19/19, G05B19/41 take precedence) · CPC title