Servomotor velocity control method
AssigneeFanuc Corporation
InventorsMitsuo Kurakake, Keiji Sakamoto, Yukio Toyosawa
Life of this patent
Estimating the term…
Abstract
A servomotor velocity control system according to the present invention control velocity by using an observer for obtaining a sensed value of velocity while estimating motor load torque. When resolution of a rotary encoder is a problem in a region of low motor velocities, this is compensated for to improve the velocity sensing precision in the low-velocity region. In a region of high motor velocities, velocity processing is executed based on the output of the rotary encoder considering the processing time of a CPU. Use or non-use of the observer for obtaining the estimated value of velocity is selected in dependence upon the velocity of the motor.
Claims2
A servomotor velocity control method in which position information from a rotary encoder mounted on a servomotor driving a mechanical load is fed back and a torque command signal is produced for application to the servomotor, said method comprising the steps of:
- comparing a reference velocity set for said servomotor and the motor velocity;
- calculating an estimated value of load torque when the motor velocity is less than said reference velocity;
- calculating an estimated value of velocity of the servomotor based on position information from said rotary encoder, motor current of the servomotor and said estimated value of load torque;
- and
- calculating the torque command signal based on said estimated value of velocity and a velocity command signal.
Dependencies are inferred from the claim text.