Curvo Studio

Teil 5 · Kapitel 36

PID-Lageregelung eines Servomotors: Encoder-Rückführung, P-, I- und D-Anteil und Einstellung

Ein Servomotor ist ein Motor, der mit einem Positionssensor und einem Regler kombiniert ist. Der Regler vergleicht die Soll- mit der gemessenen Position und steuert den Motor so an, dass die Differenz verschwindet. Der gebräuchlichste Regler ist der PID-Regler: Der Proportionalanteil reagiert auf die aktuelle Regelabweichung, der Integralanteil beseitigt bleibende Abweichungen, und der Differentialanteil dämpft die Bewegung, um das Überschwingen zu begrenzen.

Was ein geschlossener Regelkreis bedeutet

In einem offenen System (Steuerung), etwa bei einem Schrittmotor, sendet die Steuerung einen Befehl und geht davon aus, dass er ausgeführt wurde. In einem geschlossenen Regelkreis misst der Regler das Ergebnis und korrigiert es.

Ein Servoregelkreis besteht aus vier Teilen:

  • Der Befehl (Sollwert): wo die Welle stehen soll oder wie schnell sie sich drehen soll.
  • Der Sensor: ein Encoder, Resolver oder Potentiometer, der die tatsächliche Wellenposition misst.
  • Der Regler: Er berechnet die Regelabweichung e = Sollwert − gemessene Position und erzeugt eine Stellgröße.
  • Antrieb und Motor: Sie setzen die Stellgröße des Reglers in Strom und den Strom in Drehmoment um.

Sobald eine Last die Welle auslenkt, wird die Regelabweichung ungleich null, der Regler steuert dagegen, und die Position stellt sich wieder ein. Der Preis dafür: Ein schlecht eingestellter Regelkreis kann schwingen oder instabil werden, was bei offenen Systemen nicht passieren kann.

Encoder-Rückführung und Auflösung

Ein Inkrementalencoder erzeugt beim Drehen der Welle Impulse, und zwar auf einem Kanalpaar in Quadratur, sodass die Drehrichtung bekannt ist. Ein Absolutencoder liefert den tatsächlichen Winkel, auch direkt nach dem Einschalten. Die Auflösung wird in Inkrementen pro Umdrehung angegeben, oft als Bitzahl: Ein Encoder mit nn Bit hat 2n2^{n} Inkremente pro Umdrehung.

Ein 17-Bit-Encoder hat 131.072 Inkremente pro Umdrehung, ein Inkrement entspricht also 360∘/131.072≈0,0027∘360^\circ / 131{.}072 \approx 0{,}0027^\circ. Der Regelkreis kann nicht genauer positionieren, als sein Sensor auflöst, und eine grobe Auflösung macht zudem den D-Anteil verrauscht, weil die Geschwindigkeit aus Positionsdifferenzen berechnet wird.

P-, I- und D-Anteil

Die Stellgröße des PID-Reglers lautet

u=Kp×e+Ki×∫e dt+Kd× de/dtu = K_p \times e + K_i \times \int e\,\mathrm{d}t + K_d \times\,\mathrm{d}e/\mathrm{d}t

Jeder Anteil hat eine eigene Aufgabe.

  • Proportionalanteil (KpK_p): Die Stellgröße ist proportional zur aktuellen Regelabweichung. Ein größeres KpK_p macht die Antwort schneller und das System steifer gegenüber Störungen, ein zu hoher Wert führt jedoch zu Überschwingen und Schwingungen. Mit reinem PP-Anteil bleibt bei konstantem Lastmoment meist eine bleibende Regelabweichung.
  • Integralanteil (KiK_i): summiert die Regelabweichung über die Zeit auf, sodass selbst ein kleiner Restfehler die Stellgröße irgendwann so weit erhöht, dass er beseitigt wird. Er beseitigt die bleibende Regelabweichung, fügt aber Phasennacheilung hinzu, was das Überschwingen verstärkt, und er kann bei Sättigung des Stellglieds unkontrolliert aufintegrieren (Windup), weshalb der Integrator normalerweise begrenzt wird.
  • Differentialanteil (KdK_d): reagiert auf die Änderungsgeschwindigkeit der Regelabweichung. Er wirkt wie ein Dämpfer und verringert Überschwingen und Nachschwingen, verstärkt aber Sensorrauschen und Quantisierung, weshalb er meist gefiltert wird.

Wirkung einer Erhöhung jeder einzelnen Verstärkung, grob gesagt: KpK_p verkürzt die Anstiegszeit und vergrößert das Überschwingen; KiK_i beseitigt die bleibende Regelabweichung und vergrößert das Überschwingen; KdK_d verringert Überschwingen und Ausregelzeit, kann aber Rauschen hinzufügen.

Intuition für die Einstellung und ein Zahlenbeispiel

Ein gängiges manuelles Vorgehen ist:

1. Setzen Sie KiK_i und KdK_d auf null. Erhöhen Sie KpK_p, bis die Achse schnell reagiert, aber zu überschwingen oder zu schwingen beginnt, und reduzieren Sie dann auf etwa die Hälfte dieses Werts. 2. Fügen Sie KdK_d hinzu, bis das Überschwingen akzeptabel und die Sprungantwort gut gedämpft ist. 3. Fügen Sie ein kleines KiK_i hinzu, um die restliche bleibende Regelabweichung zu beseitigen, und hören Sie auf, sobald dies gelingt, ohne dass die Antwort nachschwingt. 4. Testen Sie mit der realen Last, einem realen Sprung und einer realen Störung, und prüfen Sie, dass das System bei Laständerungen mit ausreichender Reserve stabil bleibt.

Stellen Sie sich KpK_p als Feder vor, KdK_d als Dämpfer und KiK_i als langsame Hand, die so lange weiterdreht, bis die Regelabweichung verschwunden ist. Bei einem reinen PP-Regelkreis ist der Schleppfehler bei konstanter Geschwindigkeit gleich der Geschwindigkeit geteilt durch die Verstärkung. Ein Regelkreis mit der Lageverstärkung Kv=50K_v = 50 1/s, der 600 U/min folgt (10 Umdrehungen pro Sekunde bzw. 3.600°/s), hinkt dem Sollwert um 3.600/50=72∘3{.}600 / 50 = 72^\circ hinterher. Das ist viel, weshalb Hochleistungsantriebe hohe Verstärkungen und eine Geschwindigkeitsvorsteuerung verwenden.

Industrielle Antriebe verschachteln meist drei Regelkreise: einen äußeren Lageregelkreis (PP), einen mittleren Drehzahlregelkreis (PI) und einen inneren Stromregelkreis (PI), der direkt das Drehmoment vorgibt. Die inneren Kreise sind schnell, die äußeren langsamer, was die Einstellung jedes einzelnen Kreises erleichtert.

Modellbauservo und Industrieservo

Ein Modellbauservo (RC-Servo) vereint einen kleinen Gleichstrommotor, ein Getriebe, ein Potentiometer und eine Steuerplatine in einem Gehäuse. Der Befehl ist ein Impuls alle 20 ms, dessen Breite, typischerweise 1 bis 2 ms mit 1,5 ms in der Mittelstellung, den Zielwinkel innerhalb eines begrenzten Bereichs festlegt, oft etwa 180°. Das Potentiometer liefert die Rückführung, und die Platine arbeitet mit einem einfachen, meist proportionalen Regelgesetz. Ein solcher Servo ist günstig, hat aber eine grobe Auflösung und ein begrenztes Drehmoment.

Ein Industrieservo besteht aus einem separaten Motor, meist vom Typ PMSM oder BLDC mit Encoder, sowie einem Servoverstärker mit Strom-, Drehzahl- und Lageregelkreis. Angesteuert wird er über Schritt-/Richtungsimpulse, eine analoge Spannung oder einen Feldbus. Er bietet ein hohes Spitzenmoment, oft das Dreifache des Nennmoments für kurze Beschleunigungen, ein schnelles Ansprechverhalten und Einstellwerkzeuge im Antrieb. Dafür ist er teurer und muss eingestellt werden.

Wie der Simulator einen Servomotor modelliert

Der Servomotor-Simulator von Curvo Studio enthält weder einen PID-Regler noch ein Diagramm der Sprungantwort. Er bildet das stationäre Verhalten einer eingestellten Servoachse mit Encoder ab und verwendet eine einzige Lageregler-Verstärkung, KvK_v, um die Wirkung der Steifigkeit des Regelkreises zu zeigen.

Es wird angenommen, dass der Antrieb einen Stromregelkreis besitzt, der den Strom proportional zum Drehmoment macht. Der Motor folgt der Solldrehzahl bis zur Drehzahlobergrenze, die durch die Versorgungsspannung vorgegeben ist. Last erhöht den Strom proportional zum Drehmoment, bis der Antrieb seinen Spitzenwert erreicht, der mit dem Dreifachen des Nennmoments angesetzt wird. Darüber hinaus kann die Achse den Sollwert nicht halten, und der Simulator meldet die Drehmomentgrenze, statt stillschweigend langsamer zu werden.

Der Schleppfehler ist die Nacheilung des Proportionalregelkreises, 6×rpm/Kv6 \times \mathrm{rpm} / K_v in Grad, und verschwindet, wenn die Achse stillsteht. Das Anlaufverhalten ist eine Näherung erster Ordnung, deren Anstiegszeit von der Kreisverstärkung und der Last abhängt. Die Encoder-Auflösung wird in Bit eingestellt, und das Typenschild zeigt die Inkremente pro Umdrehung. Das Modell kennt keinen I-Anteil, keinen D-Anteil, kein Überschwingen und keine Schwingungen; diese Effekte werden hier also beschrieben, aber nicht simuliert.

Probieren Sie es im Servomotor-Simulator aus

Probieren Sie im Servomotor-Simulator folgende Experimente aus.

  • Stellen Sie die Solldrehzahl ein und lesen Sie die Drehzahl des Läufers und den Schleppfehler ab. Vergleichen Sie den Schleppfehler mit 6×rpm/Kv6 \times \mathrm{rpm} / K_v.
  • Erhöhen Sie die Lageregler-Verstärkung und beobachten Sie, wie der Schleppfehler proportional kleiner wird.
  • Geben Sie der Solldrehzahl ein negatives Vorzeichen, um die Drehrichtung umzukehren.
  • Erhöhen Sie den Schieberegler Mechanische Last (bis 350 %). Die Anzeigen für Drehmoment und Phasenstrom steigen gemeinsam, weil der Strom dem Drehmoment folgt. Erhöhen Sie die Last über 300 % des Nennmoments, und der Simulator meldet die Drehmomentgrenze.
  • Senken Sie die Versorgungsspannung unter den Nennwert und beobachten Sie, wie die Drehzahlobergrenze sinkt, während das Drehmoment verfügbar bleibt.
  • Ändern Sie die Encoder-Auflösung (8 bis 24 Bit) und lesen Sie den Hinweis zu den Inkrementen pro Umdrehung ab.

Quellen und weiterführende Literatur

  • G. F. Franklin, J. D. Powell und A. Emami-Naeini, "Feedback Control of Dynamic Systems", Pearson.
  • K. Ogata, "Modern Control Engineering", Pearson.
  • A. Hughes und B. Drury, "Electric Motors and Drives: Fundamentals, Types and Applications", Newnes.

Im Simulator ausprobieren

Häufig gestellte Fragen

Was ist PID-Regelung bei einem Servomotor?
Die PID-Regelung berechnet den Motorbefehl aus der Positionsabweichung mit drei Anteilen: proportional zur Abweichung, proportional zu ihrem zeitlichen Integral und proportional zu ihrer Änderungsgeschwindigkeit. Zusammen sorgen sie dafür, dass die Welle das Ziel schnell, mit wenig Überschwingen und ohne bleibende Abweichung erreicht.
Was bewirkt der P-Anteil bei einem Servo?
Der Proportionalanteil bestimmt die Steifigkeit. Eine höhere Verstärkung ergibt eine schnellere Antwort und eine kleinere Abweichung, aber auch mehr Überschwingen und, wenn sie zu hoch ist, Schwingungen. Mit reinem PP-Anteil hinterlässt eine konstante Last meist eine bleibende Regelabweichung.
Warum fügt man einen I-Anteil hinzu?
Der Integralanteil summiert jede verbleibende Abweichung auf und erhöht die Stellgröße, bis die Abweichung verschwunden ist. So beseitigt er die bleibende Regelabweichung durch konstante Lasten oder Reibung. Zu viel Integralwirkung verursacht Überschwingen und Windup, daher wird sie klein gehalten und begrenzt.
Was bewirkt der D-Anteil?
Der Differentialanteil reagiert darauf, wie schnell sich die Abweichung ändert, und wirkt wie eine Dämpfung. Er verringert Überschwingen und Nachschwingen, verstärkt aber Sensorrauschen, weshalb er meist mit einem Filter kombiniert und moderat eingestellt wird.
Was ist der Unterschied zwischen einem Schrittmotor und einem Servo?
Ein Schrittmotor arbeitet ohne Rückführung und hält die Position durch Zählen der Schritte, kann aber bei Überlast Schritte verlieren, ohne es zu bemerken. Ein Servo misst die Position mit einem Encoder und korrigiert die Abweichung kontinuierlich. Das ergibt höhere Drehzahl, Drehmomentreserve und Positionssicherheit, allerdings zu höheren Kosten.
Worin unterscheiden sich Modellbauservos von Industrieservos?
Ein Modellbauservo ist eine kleine integrierte Einheit mit Potentiometer und einfachem Regler, die mit Impulsen von 1 bis 2 ms angesteuert wird. Ein Industrieservo verwendet einen separaten Motor mit hochauflösendem Encoder und einen Antrieb mit verschachtelten Strom-, Drehzahl- und Lageregelkreisen und erreicht so mehr Drehmoment und Genauigkeit.
Was bedeutet die Geberauflösung bei einem Servomotor?
Die Geberauflösung gibt an, wie viele unterscheidbare Positionen der Geber pro Umdrehung meldet. Ein 17-Bit-Geber liefert 2^17 = 131.072 Impulse pro Umdrehung, etwa 0,003° je Impuls. Höhere Auflösung erlaubt dem Antrieb eine feinere Lage- und Drehzahlregelung bei niedriger Drehzahl, doch mechanisches Spiel und Reglereinstellung begrenzen die reale Genauigkeit.