Velocity control system
AssigneeFanuc Corporation
InventorsKeiji Sakamoto, Yukio Toyosawa
Life of this patent
Estimating the term…
Abstract
A velocity control system in which, when an observer is used to estimate velocity based on position information from a rotary encoder, load torque, which is a cause of a steady-state estimation error, is estimated at the same time and velocity is controlled by using the estimated value. Velocity control of the motor is executed by feeding back the position information from the rotary encoder to an integration element in the I-P controller.
Claims3
A velocity control system in which digital position information from a rotary encoder mounted on a motor is fed back during each period of sampling and a torque command information is produced for application to the motor, said system comprising:
- an integral-proportional (I-P) controller including an integration element and a proportion element;
- means for providing feedback position information during one sampling period from the rotary encoder
- observer means, coupled to said means for providing feedback position information and said proportion element of said I-P controller, for estimating velocity based on the position information and motor current and outputting an estimated velocity value to said proportion element of said I-P controller;
- first calculating means, coupled to said integration element and said proportion element of said I-P controller, for calculating the torque command information for the motor based on an output from said integration element and said proportion element;
- and
- second calculating means, connected to said means for providing feedback position information and the integration element of said I-P controller, for receiving the feedback position information and a velocity command signal and outputting an average velocity during one sampling period to said integration element of said I-P controller.
Dependencies are inferred from the claim text.