Electricity: motive power systems – Positional servo systems
Patent
1993-07-12
1994-12-20
Shoop, Jr., William M.
Electricity: motive power systems
Positional servo systems
318432, G05B 1101
Patent
active
053748824
DESCRIPTION:
BRIEF SUMMARY
BACKGROUND OF THE INVENTION
1. Field of the Invention
The present invention relates to a method of controlling a servomotor for use as a drive source in machine tools and robots.
2. Description of the Related Art
Feed rods of a machine tool, arms of a robot or the like are driven by a servomotor which performs a velocity loop control or a position loop control. In the conventional control of the servomotor, a velocity loop gain is always set at an unvaried value allowing a certain degree of margin with respect to a gain level which may cause a mechanical resonance.
FIG. 1 is a block diagram of a servomotor position control system, by way of example, in which reference numeral 1 denotes a position control section with a position loop gain Kp; reference numeral 2 denotes a velocity control section with a integral gain k1 and a proportional gain k2; reference numeral 3 denotes a motor and mechanical system, and reference numeral 4 denotes a term integrating a velocity to derive a position.
The torque command Tc (or current command) can be derived from the procedure comprising the steps of: subtracting a position .theta. detected, for instance, by a position detector from a position command .theta.d to find a positional deviation; multiplying the positional deviation by the position loop gain Kp to find a velocity command vd; subtracting an actual velocity v detected, for instance, by a velocity detector from the velocity command vd to find a velocity deviation; adding a value, obtained by integrating the velocity deviation and then multiplying the result by the integral gain k1, to a value, obtained by multiplying the velocity deviation by the proportional gain k2, thereby obtaining a torque command Tc (current command). The servomotor is commonly driven in response to a torque command Tc (and further through a current loop control). Also, it is a common practice to control the servomotor only by means of the speed loop control without the position loop control.
In the servomotor control as described above, reductions in the positional deviation and then the velocity deviation leads to a reduction in the torque command Tc, which in turn results in a reduction in an output torque of the servomotor, thereby further preventing the positional deviation and velocity deviation from converging rapidly. Therefore, increasing the integral gain k1 and the proportional gain k2 in values not only will accelerate the convergence but improve the responsibility and the resistivity against a disturbance, thereby improving the performance of the control system. However, higher storage and proportional gains may possibly bring about a mechanical resonance as the torque command is enlarged, and lead to an adverse effect such as an overshoot or undershoot, thereby eventually causing a fluctuation in the case of greater variation in the velocity command.
In the conventional manner employing the fixed gains, the gains are restricted by the oscillation limit causing a mechanical resonance, which in turn restricts the control performance of the servomotor.
SUMMARY OF THE INVENTION
It is therefore the object of the present invention to provide a method of controlling a servomotor, characterized by faster convergence of both positional deviations and velocity deviations, a higher responsiveness as well as an improved resistivity against a disturbance, and being free from any mechanical resonance.
In order to accomplish the above object, the method of controlling a servomotor according to the present invention comprises the step of adjusting a velocity loop gain depending on the magnitude of a torque command issued from a velocity loop control. More specifically, the method comprises the steps of detecting the magnitude of a torque command issued from a velocity loop control, decreasing a velocity loop gain by adjusting when the detected torque command is large in magnitude, and increasing a velocity loop gain by adjusting when the detected torque command is small in magnitude.
Preferably, the method of controlling a servomotor in
REFERENCES:
patent: 4639652 (1987-01-01), Takahashi et al.
patent: 5063335 (1991-11-01), Baechtel et al.
patent: 5191272 (1993-03-01), Torrii et al.
patent: 5223778 (1993-06-01), Svarovsky et al.
Iwashita Yasusuke
Matsubara Shunsuke
Okita Tadashi
Fanuc Ltd.
Masih Karen
Shoop Jr. William M.
LandOfFree
Method of controlling servomotor does not yet have a rating. At this time, there are no reviews or comments for this patent.
If you have personal experience with Method of controlling servomotor, we encourage you to share that experience with our LandOfFree.com community. Your opinion is very important and Method of controlling servomotor will most certainly appreciate the feedback.
Profile ID: LFUS-PAI-O-2387957