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 MM rollt auf einer waagerechten Schiene; viskose Reibung bb bremst seine Bewegung. Ein Stab der Masse mm ist gelenkig am Wagen befestigt und kann sich in der senkrechten Ebene drehen. Die Kraft uu wirkt waagerecht auf den Wagen — sie ist das Einzige, was wir steuern. Der Winkel θ\theta wird von der Senkrechten nach oben gemessen: θ=0\theta = 0 ist balanciert, positives θ\theta heißt, der Stab ist zu einer Seite gekippt.

SymbolBedeutungWert
MMWagenmasse0.5 kg0.5\ \text{kg}
mmPendelmasse0.2 kg0.2\ \text{kg}
bbReibungskoeffizient des Wagens0.1 N⋅s/m0.1\ \text{N}\cdot\text{s/m}
llGelenk bis Schwerpunkt0.3 m0.3\ \text{m}
IITrägheit des Stabs um den Schwerpunkt13ml2=0.006 kg⋅m2\tfrac{1}{3}ml^2 = 0.006\ \text{kg}\cdot\text{m}^2
ggErdbeschleunigung9.81 m/s29.81\ \text{m/s}^2

Bewegungsgleichungen

Wagen und Stab werden getrennt betrachtet; das Gelenk überträgt Kräfte zwischen ihnen. Die waagerechte Gelenkkraft heißt NN, die senkrechte PP.

Newtons zweites Gesetz entlang der Schiene, nur für den Wagen:

Mx¨+bx˙+N=uM\ddot{x} + b\dot{x} + N = u

Der Schwerpunkt des Stabs liegt waagerecht bei x−lsin⁡θx - l\sin\theta (positives θ\theta neigt den Stab nach hinten, Richtung −x-x); zweimal abgeleitet ergibt sich die waagerechte Kraft, die der Stab braucht:

N=mx¨−mlθ¨cos⁡θ+mlθ˙2sin⁡θN = m\ddot{x} - ml\ddot{\theta}\cos\theta + ml\dot{\theta}^2\sin\theta

Einsetzen eliminiert NN und liefert die erste Bewegungsgleichung:

(M+m)x¨+bx˙−mlθ¨cos⁡θ+mlθ˙2sin⁡θ=u(M + m)\ddot{x} + b\dot{x} - ml\ddot{\theta}\cos\theta + ml\dot{\theta}^2\sin\theta = u

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:

(I+ml2)θ¨−mglsin⁡θ=mlx¨cos⁡θ(I + ml^2)\ddot{\theta} - mgl\sin\theta = ml\ddot{x}\cos\theta

Zwei gekoppelte nichtlineare Gleichungen. Beachten Sie das Vorzeichen des Schwerkraftterms: Auf die rechte Seite gebracht ist er +mglsin⁡θ+mgl\sin\theta, wenn θ\theta von oben gemessen wird; er treibt θ¨\ddot\theta also in die Richtung, in die θ\theta schon zeigt — genau deshalb fällt dieses System um, statt zurückzuschwingen.

Linearisierung um die aufrechte Lage

Balancieren heißt, nahe bei θ=0\theta = 0 zu bleiben. Für kleine Winkel gilt sin⁡θ≈θ\sin\theta \approx \theta, cos⁡θ≈1\cos\theta \approx 1, und θ˙2\dot{\theta}^2 ist klein zweiter Ordnung und fällt ganz weg:

(I+ml2)θ¨−mglθ=mlx¨(I + ml^2)\ddot{\theta} - mgl\theta = ml\ddot{x}

(M+m)x¨+bx˙−mlθ¨=u(M + m)\ddot{x} + b\dot{x} - ml\ddot{\theta} = u

Laplace-Transformation mit Anfangswerten null und Elimination von X(s)X(s) ergeben die Übertragungsfunktion von der Kraft zum Pendelwinkel:

Θ(s)U(s)=mlq ss3+b(I+ml2)qs2−(M+m)mglqs−bmglq\frac{\Theta(s)}{U(s)} = \frac{\dfrac{ml}{q}\,s}{s^3 + \dfrac{b(I + ml^2)}{q}s^2 - \dfrac{(M+m)mgl}{q}s - \dfrac{bmgl}{q}}

mit

q=(M+m)(I+ml2)−(ml)2q = (M + m)(I + ml^2) - (ml)^2

Mit den Werten oben ist q=0.0132q = 0.0132, und die Übertragungsfunktion lautet

Θ(s)U(s)=4.54545 ss3+0.18182 s2−31.21364 s−4.45909\frac{\Theta(s)}{U(s)} = \frac{4.54545\,s}{s^3 + 0.18182\,s^2 - 31.21364\,s - 4.45909}

Warum es umfällt

Die beiden Minuszeichen im Nenner erzählen die ganze Geschichte. Zerlegt man ihn, liegen die Pole bei

s=+5.568,s=−5.607,s=−0.143s = +5.568,\qquad s = -5.607,\qquad s = -0.143

Einer liegt in der rechten Halbebene. Jede noch so kleine Störung regt eine Antwort an, die wie e5.568te^{5.568t} wächst — der Winkel verdoppelt sich etwa alle 0.120.12 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:

x˙=Ax+Bu,x=[xx˙θθ˙]T\dot{\mathbf{x}} = A\mathbf{x} + Bu,\qquad \mathbf{x} = \begin{bmatrix} x & \dot{x} & \theta & \dot{\theta} \end{bmatrix}^\mathsf{T}

A=[01000−(I+ml2)bqm2gl2q000010−mlbqmgl(M+m)q0],B=[0I+ml2q0mlq]A = \begin{bmatrix} 0 & 1 & 0 & 0 \\ 0 & -\dfrac{(I+ml^2)b}{q} & \dfrac{m^2gl^2}{q} & 0 \\ 0 & 0 & 0 & 1 \\ 0 & -\dfrac{mlb}{q} & \dfrac{mgl(M+m)}{q} & 0 \end{bmatrix},\qquad B = \begin{bmatrix} 0 \\ \dfrac{I+ml^2}{q} \\ 0 \\ \dfrac{ml}{q} \end{bmatrix}

Seine Pole sind die drei von oben und ein weiterer bei s=0s = 0: der Wagen, der überhaupt keine bevorzugte Position hat. Ausgeschrieben lautet die Winkel-Übertragungsfunktion dieses Modells

Θ(s)U(s)=4.545 s2s (s3+0.182 s2−31.21 s−4.459)\frac{\Theta(s)}{U(s)} = \frac{4.545\,s^2}{s\,(s^3 + 0.182\,s^2 - 31.21\,s - 4.459)}

und ein ss 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 θ\theta aus ist der Wagenpol unsichtbar.

Die Wagenposition hat eigene Nullstellen bei s=±mgl/(I+ml2)=±4.95s = \pm\sqrt{mgl/(I+ml^2)} = \pm 4.95. 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 MM, folgen AA und BB; die Engine baut die Matrizen des Blocks an Ort und Stelle neu, ohne Neustart. CC 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 ±90°\pm 90° — 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 10 N10\ \text{N} für 0.1 s0.1\ \text{s} bei t=0.2 st = 0.2\ \text{s} — ein Impuls von 1 N⋅s1\ \text{N}\cdot\text{s} —, 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 −θ-\theta. Fünf Parametersätze, jeder über 5 s5\ \text{s} mit einer Abtastzeit von 0.001 s0.001\ \text{s} gemessen:

KpK_pKiK_iKdK_dmax. θ\thetain Gradzurück innerhalb 0.0050.005 rad
1001200.04110.04112.35°2.35°0.750.75 s
1000200.04110.04112.35°2.35°0.750.75 s
3205.50.13960.13968.00°8.00°1.051.05 s
501100.08190.08194.69°4.69°0.940.94 s
2001400.02050.02051.17°1.17°0.590.59 s

Reiner P-Anteil ist eine Feder. Mit Kp=100K_p = 100 und sonst nichts liegen die Pole des geschlossenen Kreises bei −0.10±20.6j-0.10 \pm 20.6j: Der Stab schwingt mit 3.3 Hz3.3\ \text{Hz} und einem Dämpfungsgrad von 0.0050.005 durch die Senkrechte und hört nicht auf. Ein dritter Pol bei +0.011+0.011 ist noch instabil — langsam.

Der D-Anteil nimmt die Energie heraus. Er reagiert auf θ˙\dot\theta, darauf, wie schnell der Stab fällt, und drückt deshalb schon, solange der Stab fast noch senkrecht steht. Mit Kd=20K_d = 20 klingt die Schwingung binnen einer Sekunde ab.

Der I-Anteil verschiebt den letzten langsamen Pol. Ohne ihn ist das konstante Glied des charakteristischen Polynoms, −bmgl/q+Ki ml/q-bmgl/q + K_i\,ml/q, negativ, und ein Pol bleibt bei +0.011+0.011. Ki=1K_i = 1 (die CTMS-Wahl) macht daraus −0.0002-0.0002: 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 KpK_p, KiK_i und KdK_d kann den Pol bei s=0s = 0 verschieben.

Zustandsrückführung: Der Wagen kommt zurück

Alle vier Zustände messen und jeden zurückführen:

u=−K [x−xrefx˙θθ˙]Tu = -K\,\begin{bmatrix} x - x_\text{ref} & \dot{x} & \theta & \dot{\theta} \end{bmatrix}^\mathsf{T}

Das Modell nutzt den LQR-Entwurf aus CTMS, der ∫(xTQ x+u2) dt\int (\mathbf{x}^\mathsf{T} Q\,\mathbf{x} + u^2)\,dt mit Q=diag⁡(5000,0,100,0)Q = \operatorname{diag}(5000, 0, 100, 0) minimiert:

K=[−70.7−37.8105.620.9]K = \begin{bmatrix} -70.7 & -37.8 & 105.6 & 20.9 \end{bmatrix}

Damit liegen die Pole des geschlossenen Kreises bei −8.49±7.93j-8.49 \pm 7.93j und −4.76±0.83j-4.76 \pm 0.83j. Nach dem Stoß erreicht der Stab höchstens 5.4°5.4°, und der Wagen kehrt in die Mitte zurück. Ein Sollwertsprung von 0.2 m0.2\ \text{m} bei t=1.5 st = 1.5\ \text{s} dauert etwa eine Sekunde, braucht eine maximale Neigung von 9°9° und 14 N14\ \text{N} — und beginnt damit, dass der Wagen 58 mm58\ \text{mm} in die falsche Richtung rollt. Das ist die Nullstelle bei +4.95+4.95: 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 L(s)=K(sI−A)−1BL(s) = K(sI - A)^{-1}B bei 26.1 rad/s26.1\ \text{rad/s} die 0 dB0\ \text{dB} mit 61.3°61.3° Phasenreserve. Eine Totzeit (Delay) τd\tau_d lässt den Betrag unverändert und zieht ωτd\omega\tau_d von der Phase ab; die Totzeitreserve ist also

τmax=61.3°⋅π/18026.1 rad/s≈41 ms\tau_\text{max} = \frac{61.3° \cdot \pi/180}{26.1\ \text{rad/s}} \approx 41\ \text{ms}

Gemessen: 30 ms30\ \text{ms} erhöhen die maximale Neigung von 9°9° auf 13°13° und lassen 16°16° Reserve; 40 ms40\ \text{ms} schwingen an der Grenze; bei 50 ms50\ \text{ms} 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 0.50.5 kostet eine Sollwertänderung 0.9 N0.9\ \text{N}, bei 1.51.5 sind es 72 N72\ \text{N} und 21°21° Neigung.
  • Kombinieren Sie Geschwindigkeit 1.51.5 mit 30 ms30\ \text{ms} Totzeit. Der schnellere Regler hat eine höhere Durchtrittsfrequenz und nur etwa 28 ms28\ \text{ms} Totzeitreserve: Der Stab fällt.
  • Stellen Sie den Wind auf 5 N5\ \text{N}. Der Stab bleibt aufrecht, aber der Wagen bleibt etwa 7 cm7\ \text{cm} neben seinem Sollwert stehen: In Ruhe muss der Regler mit −5 N-5\ \text{N} dagegenhalten, und die Positionsverstärkung tut das nur mit einem Fehler, F/kxF/k_x. Ein I-Anteil auf xx würde ihn beseitigen.
  • Ziehen Sie ll 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: sin⁡θ≈θ\sin\theta \approx \theta gilt bis etwa 14°14° auf 1%1\% 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 E=12(I+ml2)θ˙2+mgl(cos⁡θ−1)E = \tfrac12 (I+ml^2)\dot\theta^2 + mgl(\cos\theta - 1) 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 (MM, mm, bb, ll) 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 g=9.81 m/s2g = 9.81\ \text{m/s}^2.

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 ±90∘\pm 90^\circ).
  • XYPlot: Trajektorie in der Phasenebene (θ\theta gegen θ˙\dot{\theta}).
  • 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.

Häufig gestellte Fragen (FAQ)

Q: Wie linearisiert man die Bewegungsgleichungen eines invertierten Pendels um theta = 0?

Die gekoppelten Euler-Lagrange-Gleichungen lauten (M+m)x¨+mLθ¨cos⁡θ−mLθ˙2sin⁡θ=F(M + m)\ddot{x} + m L \ddot{\theta}\cos\theta - m L \dot{\theta}^2\sin\theta = F und mLx¨cos⁡θ+(I+mL2)θ¨−mgLsin⁡θ=0m L \ddot{x}\cos\theta + (I + m L^2)\ddot{\theta} - m g L \sin\theta = 0. Die Linearisierung um die Ruhelage x0=[0,0,0,0]Tx_0 = [0, 0, 0, 0]^T mit sin⁡θ≈θ\sin\theta \approx \theta, cos⁡θ≈1\cos\theta \approx 1 und θ˙2≈0\dot{\theta}^2 \approx 0 führt zum linearen Zustandsraummodell x˙=Ax+Bu\dot{x} = A x + B u. Mit dem Trägheitsterm Jt=(M+m)(I+mL2)−(mL)2J_t = (M+m)(I+mL^2) - (mL)^2 besitzt das System einen instabilen Pol bei s=+(M+m)mgLJts = +\sqrt{\frac{(M+m)mgL}{J_t}}.

Q: Warum ist Zustandsrückführung (LQR) doppelten PID-Kreisen bei der Pendelstabilisierung überlegen?

Das Pendel auf dem Wagen ist ein unteraktuiertes System (1 Kraft FF steuert 2 Freiheitsgrade: Position pp und Winkel θ\theta). Dezentrale PID-Regler leiden unter starker Kreuzkopplung und Phasenverzögerungen durch Allpass-Nullstellen. Der LQR-Entwurf löst die Riccati-Gleichung ATP+PA−PBR−1BTP+Q=0A^T P + P A - P B R^{-1} B^T P + Q = 0 und berechnet die optimale Rückführmatrix K=R−1BTPK = R^{-1} B^T P, die Wagenführung und Pendelstabilisierung simultan mit garantierter Phasenreserve (mindestens 60∘60^\circ) koordiniert.

Q: Was geschieht bei Stellgrößenbegrenzung des Wagens, und wie simuliert BlockWerk dies?

Übersteigt die Stellkraft die Motorgrenze ∣u∣>Fmax⁡|u| > F_{\max}, bricht die Regelwirkung ein. Überschreitet der Winkel eine kritische Schwelle ∣θ∣>θcrit|\theta| > \theta_{\text{crit}}, übertrifft das Gravitationsmoment das maximal erzeugbare Stellmoment, und das Pendel kippt um. In BlockWerk begrenzt ein Saturation-Block zwischen Rückführverstärkung KK und Strecke das Signal auf u(t)=clamp(u,−Fmax⁡,Fmax⁡)u(t) = \text{clamp}(u, -F_{\max}, F_{\max}), um die reale Störfestigkeitsgrenze exakt zu simulieren.

In BlockWerk simulieren

Interaktive Sandbox direkt im Browser — keine Installation, WebAssembly-Engine.

In BlockWerk simulieren →