Hybrid sample rate servo motor controller
AssigneeHewlett-Packard Company
InventorsLowell J. Stewart, Alfred H. Mebane IV
Life of this patent
Estimating the term…
Abstract
A hybrid sample rate servo motor employing rate feedback compensation is disclosed. The system employs a shaft encoder having a predetermined resolution to provide position data which are pulses indicating the shaft has moved another resolution unit. Under high motor velocity conditions the rate compensation feedback loop is operated at a conventional constant sample rate. Under low velocity conditions, the sample rate at which the rate compensation feedback loop is operated is modified so that rate samples are taken and calculated only when new position data are available from the motor encoder. Rate quantization error is substantially reduced, thereby leading to more robust controller operation.
Claims18
In a digital rate compensation servo controller for controlling a plant apparatus and employing a displacement indicator having a predetermined resolution and providing displacement signals indicative of displacement of said plant and which are integral multiples of said resolution, and further employing a rate compensation feedback loop for providing rate compensation signals to be combined with reference control signals, the magnitude of said compensation signals varying as a function of estimates of the plant velocity, said velocity estimates being dependent on said displacement signals, and wherein updated velocity estimates are provided under high velocity conditions at a first relatively high fixed sample rate, the improvement comprising means for modifying the rate at which non-zero velocity estimates are provided under low velocity conditions so that updated non-zero velocity estimates are provided only after said displacement signal has incremented by said predetermined resolution, thereby substantially reducing rate quantization error due to said displacement indicator resolution.
A digital sample rate servo motor controller, comprising:
- a servo motor having a motor shaft and means for driving the shaft through rotary displacement as a function of motor drive signals;
- a motor driver responsive to motor control signals for providing said motor drive signals;
- means for providing servo reference control signals;
- means for providing digital displacement signals indicative of the motor shaft displacement, said means having a predetermined resolution and wherein said digital displacement signals indicates displacement of said shaft as a function of integral multiples of said resolution;
- position compensation feedback means responsive to said displacement signals for providing digitized position compensation feedback signals in dependence on estimates of total motor shaft displacement;
- rate compensation feedback means for providing digitized rate compensation feedback signals in dependence on estimates of the motor shaft displacement rate;
- means responsive to said reference control signals, said position compensation feedback signals and said rate compensation feedback signals for providing said motor control signals;
- and
- means for controlling said rate compensation feedback means so that said means operates under high rate conditions to provide updated displacement rate estimates at a first, relatively high fixed sample rate, and under low rate conditions to provide non-zero updated rate estimates at a variable sample rate and only after incremented displacement signals are provided.
A sample rate servo motor controller, comprising:
- a servo motor having a motor shaft and means for driving the shaft through rotary displacement as a function of motor drive signals;
- a motor driver responsive to motor control signals for providing said motor drive signals;
- means for providing servo reference control signals;
- means for providing displacement signals indicative of the motor shaft displacement, said means having a predetermined resolution and wherein said displacement signals indicates displacement of said shaft as a function of integral multiples of said resolution, said means comprising a shaft encoder for providing a displacement signal each time said shaft rotates through a predetermined angular displacement, said angular displacement being related to said predetermined resolution;
- position compensation feedback means responsive to said displacement signals for providing digitized position compensation feedback signals in dependence on estimates of total motor shaft displacement;
- rate compensation feedback means for providing digitized rate compensation feedback signals in dependence on estimates of the motor shaft displacement rate;
- means responsive to said reference control signals, said position compensation feedback signals and said rate compensation feedback signals for providing said motor control signals;
- means for controlling said rate compensation feedback means so that said means operates under high rate conditions to provide updated displacement rate estimates at a first, relatively high fixed sample rate, and under low rate conditions to provide non-zero updated rate estimates at a variable sample rate and only after incremented displacement signals are provided;
- and
- wherein said rate compensation feedback means comprises means for providing a first rate feedback means, said means comprising means for providing updated displacement rate estimates in dependence on the ratio of said resolution and the measured time interval between changes in said displacement signal, said first rate feedback means being activated by said controlling means under low rate conditions, said first rate feedback means further comprises means for attenuating said rate compensation feedback signal, said attenuation being an inverse function of said rate estimates, whereby said attenuation increases as said rate estimates decrease.
A digital servo motor controller responsive to digital reference control signals, comprising:
- a servo motor having a motor shaft and means for driving the shaft through rotary displacement as a function of motor drive signals;
- a motor driver responsive to motor control signals for providing said motor drive signals;
- means for providing displacement signals indicative of the motor shaft displacement, said means having a predetermined resolution and providing a displacement signal which indicates displacement of said shaft as a function of integral multiples of said resolution;
- first feedback means responsive to said displacement signal for providing first digitized feedback signals in dependence on the displacement of the motor shaft;
- second feedback means responsive to said displacement signal for providing second digitized feedback signals in dependence on the motor shaft displacement rate;
- means for combining said reference control signals and said first and second feedback signals to provide said motor control signals;
- and
- means for controlling said second feedback means so that said means operates when said motor shaft displacement rate exceeds a predetermined rate to provide updated second feedback signals at a first, relatively high fixed sample rate, and when said motor shaft displacement rate is less than a predetermined value to provide updated second feedback signals only when updated displacement signals are provided.
A dual axis velocity feedback servo controller apparatus for controlling the movement of a first device along a first axis and the movement of a second device along a second axis, comprising:
- respective first and second means for providing respective first and second displacement signals indicative of the respective displacement of said first and second devices along said respective axes, each said means having a predetermined resolution value and providing displacement signals which are updated each time said respective device is displaced through said resolution value;
- respective first and second velocity feedback compensation means for providing first and second digitized velocity feedback compensation signals in dependence on the respective velocities of said devices along said respective axes;
- said velocity feedback means each comprising means responsive to said respective first and second displacement signals for estimating the velocity of said respective device, said means operating under high velocity conditions to provide updated velocity estimates at a first, relatively high sample rate, and under low velocity conditions to provide updated non-zero rate estimates at a variable sample rate and only after a change in said respective displacement signal.
Dependencies are inferred from the claim text.