Stability margins and error recovery in servo control systems
View Patent ↗Adjusting a servo control system includes identifying a gain crossover frequency for the servo control system, generating a sensitivity function for the servo control system, measuring a sensitivity peak in the sensitivity function, comparing a frequency of the sensitivity peak to the gain crossover frequency, and adjusting the servo control system in response to the comparison of the frequency of the sensitivity peak to the gain crossover frequency.
1. A method of adjusting a servo control system, comprising:
identifying a gain crossover frequency for the servo control system;
measuring a sensitivity function for the servo control system;
identifying a sensitivity peak in the sensitivity function;
comparing a frequency of the sensitivity peak to the gain crossover frequency; and
adjusting the servo control system in response to the comparison of the frequency of the sensitivity peak to the gain crossover frequency.
2. The method of claim 1 , wherein the servo control system includes a controller generating a control signal, a notch filter filtering the control signal, and an actuator moving in response to the control signal, and wherein adjusting the servo control system comprises:
increasing a gain of the controller if the frequency of the sensitivity peak is less than the gain crossover frequency; and
decreasing the gain of the controller if the frequency of the sensitivity peak is greater than the gain crossover frequency.
3. The method of claim 1 , further comprising:
measuring an open loop transfer function of the servo control system; and
determining the gain crossover frequency from the open loop transfer function.
4. The method of claim 1 , further comprising:
re-identifying the sensitivity peak in the sensitivity function after adjusting the servo control system;
comparing the re-identified sensitivity peak to a threshold; and
if the re-identified sensitivity peak is above the threshold, comparing a frequency of the re-identified sensitivity peak to the gain crossover frequency, and adjusting the servo control system in response to the comparison of the frequency of the re-identified sensitivity peak to the gain crossover frequency.
5. The method of claim 1 , wherein the servo control system includes a controller generating a control signal, a notch filter filtering the control signal, and an actuator moving in response to the control signal, the method further comprising:
comparing the frequency of the sensitivity peak to a frequency of a system mode of the servo control system; and
adjusting a property of the notch filter in response to the frequency of the sensitivity peak exceeding the frequency of the system mode.
6. The method of claim 5 , further comprising:
comparing a difference between a center frequency of the notch filter and the frequency of the sensitivity peak with a first threshold; and
if a difference between the center frequency of the notch filter and the frequency of the sensitivity peak is greater than the first threshold, taking no action with respect to the notch filter.
7. The method of claim 5 , further comprising:
comparing a difference between a center frequency of the notch filter and the frequency of the sensitivity peak with a second threshold; and
if the difference between the center frequency of the notch filter and the frequency of the sensitivity peak is less than the second threshold, increasing an attenuation of the control signal by the notch filter.
8. The method of claim 7 , further comprising:
if the difference between the center frequency of the notch filter and the frequency of the sensitivity peak is greater than the second threshold, adjusting the notch filter to move the center frequency of the notch filter toward the frequency of the sensitivity peak.
9. The method of claim 5 , wherein the property of the notch filter comprises a first property of the notch filter, the method further comprising:
remeasuring the sensitivity peak in the sensitivity function after adjusting the property of the notch filter;
comparing the re-identified sensitivity peak to a threshold; and
if the re-identified sensitivity peak is above the threshold, re-adjusting the first property of the notch filter or adjusting a second property of the notch filter.
10. The method of claim 9 , wherein the first property of the notch filter comprises a center frequency of the notch filter and the second property of the notch filter comprises an attenuation of the notch filter.
11. A servo control system, comprising:
an actuator that moves in response to a control signal;
a notch filter that filters the control signal; and
a controller that generates the control signal with a gain adjusted in response to a comparison of a frequency of a sensitivity peak to a gain crossover frequency.
12. The servo control system of claim 11 , wherein the controller identifies the gain crossover frequency, generates a sensitivity function for the servo control system, measures the sensitivity peak in the sensitivity function, and compares a frequency of the sensitivity peak to the gain crossover frequency.
13. The servo control system of claim 12 , wherein the controller increases the gain of the controller if the frequency of the sensitivity peak is less than the gain crossover frequency, and that decreases the gain of the controller if the frequency of the sensitivity peak is greater than the gain crossover frequency.
14. The servo control system of claim 12 , wherein the controller re-identifies the sensitivity peak in the sensitivity function after adjusting the gain of the control signal, and compares the re-identified sensitivity peak to a threshold; and
wherein if the re-identified sensitivity peak is above the threshold, the controller compares a frequency of the re-identified sensitivity peak to the gain crossover frequency, and adjusts the gain of the controller in response to the comparison of the frequency of the re-identified sensitivity peak to the gain crossover frequency.
15. The servo control system of claim 12 , wherein the controller compares the frequency of the sensitivity peak to a frequency of a system mode of the servo control system, and adjusts a property of the notch filter in response to the frequency of the sensitivity peak exceeding the frequency of the system mode.
16. The servo control system of claim 15 , wherein the controller compares a difference between a center frequency of the notch filter and the frequency of the sensitivity peak with a first threshold; and
if a difference between the center frequency of the notch filter and the frequency of the sensitivity peak is greater than the first threshold, the controller takes no action with respect to the notch filter.
17. The servo control system of claim 16 , wherein the controller compares a difference between a center frequency of the notch filter and the frequency of the sensitivity peak with a second threshold; and
if the difference between the center frequency of the notch filter and the frequency of the sensitivity peak is less than the second threshold, the controller increases the attenuation of the notch filter.
18. The servo control system of claim 17 , wherein:
if the difference between the center frequency of the notch filter and the frequency of the sensitivity peak is greater than the second threshold, the controller adjusts the notch filter to move the center frequency of the notch filter toward the frequency of the sensitivity peak.
19. The servo control system of claim 15 , wherein the property of the notch filter comprises a first property of the notch filter, and wherein the controller re-identifies the sensitivity peak in the sensitivity function after adjusting the property of the notch filter, compares the re-identified sensitivity peak to a threshold, and, if the re-identified sensitivity peak is above the threshold, re-adjusts the first property of the notch filter or adjusts a second property of the notch filter.
20. The servo control system of claim 11 , wherein the controller measures an open loop transfer function of the servo control system, and determines the gain crossover frequency from the open loop transfer function.
21. A method of calibrating a servo control system, comprising:
generating a sensitivity function for the servo control system; and
calibrating the servo control system in response to a comparison of a frequency of a sensitivity peak of the sensitivity function to a gain crossover frequency of the servo control system.
22. The method of claim 21 , further comprising:
identifying the gain crossover frequency for the servo control system;
measuring the sensitivity peak in the sensitivity function; and
comparing the frequency of the sensitivity peak to the gain crossover frequency.
23. The method of claim 22 , wherein the servo control system includes a controller generating a control signal, a notch filter filtering the control signal, and an actuator moving in response to the control signal, and wherein adjusting the servo control system comprises:
increasing a gain of the controller if the frequency of the sensitivity peak is less than the gain crossover frequency; and
decreasing the gain of the controller if the frequency of the sensitivity peak is greater than the gain crossover frequency.