Inverses Pendel auf einem Wagen
Ein Pendel, das an einem Gelenk hängt, ist langweilig: Stößt man es an, schwingt es zurück. Stellt man dasselbe Pendel aufrecht auf einen Wagen, der sich nur seitwärts bewegen kann, wird es zum schärfsten Lehrbeispiel der Regelungstechnik. Das System kann nicht von allein stillstehen. Sich selbst überlassen, fällt es — und je weiter es schon gefallen ist, desto schneller. Aufrecht halten lässt es sich nur, indem man das bewegt, worauf es steht: Man fängt es, indem man den Wagen darunter fährt.
Deshalb lohnt sich eine ganze Fallstudie. Fast jede Idee der klassischen Regelungstechnik taucht hier ohne Versteck auf: eine instabile Strecke, ein Regler, der handeln muss, bevor der Fehler wächst, der Unterschied zwischen dem Reagieren auf einen Fehler und seinem Vorwegnehmen, und der Kompromiss zwischen einer schnellen und einer heftigen Antwort.
Der physikalische Aufbau
Ein Wagen der Masse rollt auf einer waagerechten Schiene; viskose Reibung bremst seine Bewegung. Ein Stab der Masse ist gelenkig am Wagen befestigt und kann sich in der senkrechten Ebene drehen. Die Kraft wirkt waagerecht auf den Wagen — sie ist das Einzige, was wir steuern. Der Winkel wird von der Senkrechten nach oben gemessen: ist balanciert, positives heißt, der Stab ist zu einer Seite gekippt.
| Symbol | Bedeutung | Wert |
|---|---|---|
| Wagenmasse | ||
| Pendelmasse | ||
| Reibungskoeffizient des Wagens | ||
| Gelenk bis Schwerpunkt | ||
| Trägheit des Stabs um den Schwerpunkt | ||
| Erdbeschleunigung |
Bewegungsgleichungen
Wagen und Stab werden getrennt betrachtet; das Gelenk überträgt Kräfte zwischen ihnen. Die waagerechte Gelenkkraft heißt , die senkrechte .
Newtons zweites Gesetz entlang der Schiene, nur für den Wagen:
Der Schwerpunkt des Stabs liegt waagerecht bei (positives neigt den Stab nach hinten, Richtung ); zweimal abgeleitet ergibt sich die waagerechte Kraft, die der Stab braucht:
Einsetzen eliminiert und liefert die erste Bewegungsgleichung:
Für die zweite bildet man die Momente um den Schwerpunkt des Stabs. Die Schwerkraft greift dort an und trägt nichts bei; nur die beiden Gelenkkräfte zählen:
Zwei gekoppelte nichtlineare Gleichungen. Beachten Sie das Vorzeichen des Schwerkraftterms: Auf die rechte Seite gebracht ist er , wenn von oben gemessen wird; er treibt also in die Richtung, in die schon zeigt — genau deshalb fällt dieses System um, statt zurückzuschwingen.
Linearisierung um die aufrechte Lage
Balancieren heißt, nahe bei zu bleiben. Für kleine Winkel gilt , , und ist klein zweiter Ordnung und fällt ganz weg:
Laplace-Transformation mit Anfangswerten null und Elimination von ergeben die Übertragungsfunktion von der Kraft zum Pendelwinkel:
mit
Mit den Werten oben ist , und die Übertragungsfunktion lautet
Warum es umfällt
Die beiden Minuszeichen im Nenner erzählen die ganze Geschichte. Zerlegt man ihn, liegen die Pole bei
Einer liegt in der rechten Halbebene. Jede noch so kleine Störung regt eine Antwort an, die wie wächst — der Winkel verdoppelt sich etwa alle Sekunden. Das ist kein Modellierungsartefakt. Es ist der umfallende Stab, in Algebra geschrieben.
Lassen Sie das Diagramm ohne Regler laufen, und Sie sehen genau das: ein Anstoß, dann eine Kurve, die oben aus dem Diagramm verschwindet und nie zurückkehrt.
Die ganze Strecke als ein Zustandsraummodell
Die Übertragungsfunktion oben beschreibt den Winkel und nur den Winkel. Nimmt man den Wagen dazu, hat das linearisierte System vier Zustände — Wagenposition und -geschwindigkeit, Stabwinkel und Winkelgeschwindigkeit — und einen Eingang:
Seine Pole sind die drei von oben und ein weiterer bei : der Wagen, der überhaupt keine bevorzugte Position hat. Ausgeschrieben lautet die Winkel-Übertragungsfunktion dieses Modells
und ein kürzt sich. Diese Kürzung ist der Grund, warum die Übertragungsfunktion dritter Ordnung stimmte — und der ganze Grund, warum ein Regler, der nur den Winkel sieht, den Wagen nicht zurückholen kann: Von aus ist der Wagenpol unsichtbar.
Die Wagenposition hat eigene Nullstellen bei . Die in der rechten Halbebene wird später wichtig.
Der Aufbau in BlockWerk
Die Strecke ist ein einziger StateSpace-Block. Seine Matrizen sind keine Dezimalzahlen: Jeder Eintrag ist ein Ausdruck über die Variablen des Diagramms — mgl(M+m)/q, (I+ml^2)/q — und wird beim Ausführen ausgewertet. Bewegen Sie den Regler für , folgen und ; die Engine baut die Matrizen des Blocks an Ort und Stelle neu, ohne Neustart. ist die Einheitsmatrix, der Block hat also vier Ausgänge, y_0 bis y_3, einen pro Zustand.
Anders als klassische Desktop-Simulationspakete mit Gigabytes an Installation (siehe unseren Vergleich Simulink-Alternative) löst BlockWerk dieses instabile System vierter Ordnung direkt im Browser per WebAssembly mit 60 fps — auf Schul-Laptops ohne Installation (siehe Regelungstechnik auf Chromebook & iPad).
Alles andere hängt an diesen Ausgängen. Der Winkel läuft durch eine Saturation bei — den Boden, von dem das lineare Modell nichts weiß — zum Scope und zum reinen Winkelregler. Alle vier Zustände gehen an die Gain-Blöcke der Zustandsrückführung.
Das System stören
Hier wartet eine Falle, um die man bewusst herumgehen sollte.
Der naheliegende Test ist ein Sollwertsprung. Für den Winkel bewirkt er nichts. Der Sollwert ist null — aufrecht —, und das Modell startet aufrecht; der Fehler ist null, der Regler gibt nichts aus, und das Diagramm bleibt für immer eine flache Linie. Nichts ist schiefgegangen; es gibt schlicht nichts zu korrigieren.
Ein Balancierproblem ist kein Folgeproblem. Die eigentliche Frage lautet _„Wenn etwas dagegenstößt — fängt der Regler es?“_ Der Eingang ist deshalb eine Störung auf der Kraft: ein kurzer Stoß, dann nichts. Dieses Modell verwendet einen Rechteckpuls von für bei — ein Impuls von —, gebaut aus zwei Step-Blöcken, die sich aufheben. Ohne Regler liegt der Stab eine halbe Sekunde später am Boden.
Ein Regler, der nur den Winkel sieht
Die erste Schleife ist ein PIDController auf . Fünf Parametersätze, jeder über mit einer Abtastzeit von gemessen:
| max. | in Grad | zurück innerhalb rad | |||
|---|---|---|---|---|---|
| 100 | 1 | 20 | s | ||
| 100 | 0 | 20 | s | ||
| 32 | 0 | 5.5 | s | ||
| 50 | 1 | 10 | s | ||
| 200 | 1 | 40 | s |
Reiner P-Anteil ist eine Feder. Mit und sonst nichts liegen die Pole des geschlossenen Kreises bei : Der Stab schwingt mit und einem Dämpfungsgrad von durch die Senkrechte und hört nicht auf. Ein dritter Pol bei ist noch instabil — langsam.
Der D-Anteil nimmt die Energie heraus. Er reagiert auf , darauf, wie schnell der Stab fällt, und drückt deshalb schon, solange der Stab fast noch senkrecht steht. Mit klingt die Schwingung binnen einer Sekunde ab.
Der I-Anteil verschiebt den letzten langsamen Pol. Ohne ihn ist das konstante Glied des charakteristischen Polynoms, , negativ, und ein Pol bleibt bei . (die CTMS-Wahl) macht daraus : stabil auf dem Papier, mit einer Zeitkonstante von etwa 80 Minuten.
Und bei alldem driftet der Wagen. Nach dem Stoß rollt er gleichmäßig davon — einen halben Meter in fünf Sekunden, zwei Meter in zwanzig —, denn keine Wahl von , und kann den Pol bei verschieben.
Zustandsrückführung: Der Wagen kommt zurück
Alle vier Zustände messen und jeden zurückführen:
Das Modell nutzt den LQR-Entwurf aus CTMS, der mit minimiert:
Damit liegen die Pole des geschlossenen Kreises bei und . Nach dem Stoß erreicht der Stab höchstens , und der Wagen kehrt in die Mitte zurück. Ein Sollwertsprung von bei dauert etwa eine Sekunde, braucht eine maximale Neigung von und — und beginnt damit, dass der Wagen in die falsche Richtung rollt. Das ist die Nullstelle bei : Um den Stab zum Ziel hin zu neigen, muss der Wagen erst unter ihm wegfahren, und Zustandsrückführung verschiebt jeden Pol, aber keine Nullstelle.
Totzeit
Ein echter Kreis hat Latenz — Filterung, Abtastung, ein Bus, der Antrieb. Schneidet man den Kreis am Eingang des Wagens auf, kreuzt die Kreisverstärkung bei die mit Phasenreserve. Eine Totzeit (Delay) lässt den Betrag unverändert und zieht von der Phase ab; die Totzeitreserve ist also
Gemessen: erhöhen die maximale Neigung von auf und lassen Reserve; schwingen an der Grenze; bei fällt der Stab.
Zum Ausprobieren
- Der Regler Geschwindigkeit skaliert alle vier LQR-Pole um einen Faktor, und die Verstärkungen werden für die Strecke neu entworfen, die die anderen Regler beschreiben. Bei kostet eine Sollwertänderung , bei sind es und Neigung.
- Kombinieren Sie Geschwindigkeit mit Totzeit. Der schnellere Regler hat eine höhere Durchtrittsfrequenz und nur etwa Totzeitreserve: Der Stab fällt.
- Stellen Sie den Wind auf . Der Stab bleibt aufrecht, aber der Wagen bleibt etwa neben seinem Sollwert stehen: In Ruhe muss der Regler mit dagegenhalten, und die Positionsverstärkung tut das nur mit einem Fehler, . Ein I-Anteil auf würde ihn beseitigen.
- Ziehen Sie nach oben. Ein längerer Stab fällt langsamer — der instabile Pol wandert zum Ursprung —, deshalb balancieren Artisten lange Stangen, keine kurzen.
Was dieses Modell weglässt
Das Modell ist linear und damit nur nahe der Senkrechten ehrlich: gilt bis etwa auf genau. Das lineare Modell fängt brav einen Stab aus Winkeln auf, aus denen ein echter nicht zurückkäme. Den Stab aus der hängenden Lage hochzuschwingen braucht zuerst einen nichtlinearen Regler — die Energieregelung nach Åström–Furuta treibt auf null, bestärkendes Lernen ist ein anderer Weg —, und nahe der Spitze übernimmt ein linearer Regler wie dieser.
Der Wagen läuft hier auf einer endlosen Schiene, und der Motor liefert jede verlangte Kraft.
Quellen
Der hier verwendete Parametersatz (, , , ) und die Wahl dieses Systems als Rechenbeispiel stammen aus den Control Tutorials for MATLAB & Simulink (CTMS) von Prof. Dawn Tilbury (University of Michigan) und Prof. Bill Messner (Carnegie Mellon University), später erweitert von Prof. Rick Hill (Detroit Mercy), JD Taylor (CMU) und Prof. Shuvra Das (Detroit Mercy), gefördert von der NSF (Förderung DUE 9554819) und MathWorks. CTMS steht unter der Lizenz CC BY-SA 4.0.
Herleitung, Text, Blockdiagramm und jede gemessene Zahl auf dieser Seite sind unsere eigene Arbeit, erstellt mit der Engine von BlockWerk. Wir verwenden .
Die Bewegungsgleichungen eines inversen Pendels auf einem Wagen sind Standard und stehen in im Wesentlichen dieser Form in den meisten Regelungstechnik-Lehrbüchern, darunter Ogatas Modern Control Engineering, Nises Control Systems Engineering und Feedback Control of Dynamic Systems von Franklin, Powell & Emami-Naeini.
Siehe auch
- StateSpace: Das vollständige Streckenmodell Wagen-Pendel mit vier Zuständen.
- Gain: Umsetzung des LQR-Verstärkungsvektors für die vollständige Zustandsrückführung.
- PIDController: Stabilisierungsschleife nur auf den Winkel.
- Delay: Modellierung von Stellglied-Totzeit und Phasenverzug.
- Saturation: Mechanische Winkelgrenzen (Bodenanschlag bei ).
- XYPlot: Trajektorie in der Phasenebene ( gegen ).
- uPlotDisplay: Schnelle mehrkanalige Zeitverläufe.
- Simulink-Alternative: Regelungstechnik direkt im Browser, ohne Desktop-Lizenzhürden.
- Regelungstechnik auf Chromebook & iPad: Echtzeit-Simulation des inversen Pendels auf mobiler Schulhardware.
- Leitfaden zur interaktiven Simulation: Runge-Kutta-Löser, Abtastzeiten und Stabilität.