Simulation des inversen Pendels: PID vs. LQR

Vergleichen Sie PID und LQR an einem nichtlinearen Wagen-Pendel-System mit Stellkraftbegrenzung. Spielen Sie die Bewegung ab, geben Sie zeitlich festgelegte Störstöße vor und untersuchen Sie Ausregelverhalten, Wagenweg und Regelkreispole.

#inverted-pendulum #LQR #nonlinear-dynamics #ode45 #PID

Diese Simulation eines inversen Pendels vergleicht zwei Verfahren, mit denen ein starres Pendel auf einem beweglichen Wagen in der aufrechten Lage gehalten wird. Sie richtet sich an Studierende der Regelungstechnik, Lehrende bei der Vorbereitung eines Laborversuchs und Ingenieure, die den Unterschied zwischen reiner Winkelregelung und Regelung des gesamten mechanischen Zustands untersuchen. Beide Regler wirken auf dasselbe nichtlineare Wagen-Pendel-System mit identischem Anfangszustand, derselben Stellkraftgrenze und denselben aufgezeichneten Störstößen.

Beginnen Sie mit den bereits eingetragenen Parametern des Michigan-Tutorials. Starten Sie die Wiedergabe, um das Verhalten des ausgewählten Reglers zu beobachten, oder verschieben Sie den Regler „Wiedergabezeit“, um einen bestimmten Zeitpunkt zu betrachten. Die Diagramme vergleichen stets beide Regler. Während der Wiedergabe lösen Sie mit der Leertaste oder durch Antippen der Zeichnung einen horizontalen Kraftstoß am Schwerpunkt des Pendels aus. Die aufgezeichnete Stoßfolge wird für jeden Regler wiederholt. Ein positiver Kraftstoß wirkt nach rechts. Ziehen Sie den blauen Griff für den Anfangswinkel, um die Anfangsneigung zu ändern; er stellt die Anfangslage dar, nicht die aktuell simulierte Lage.

Stellen Sie für den LQR-Regler die vier Diagonalgewichtungen von Q und die Gewichtung R des Stellaufwands ein. Der Rechner löst die zeitkontinuierliche algebraische Riccati-Gleichung für die eingegebenen Streckenparameter erneut. Er verwendet keinen gespeicherten Verstärkungsvektor. Die Gewichtungen beziehen sich auf numerische Zustandswerte in SI-Einheiten in der Reihenfolge Wagenposition, Wagengeschwindigkeit, Winkel in Radiant und Winkelgeschwindigkeit in Radiant pro Sekunde. Eine Umstellung der Anzeige auf US-Einheiten ändert diese Entwurfskonvention nicht.

Beginnen Sie beim PID-Regler für das Wagen-Pendel-System mit den Verstärkungen der Winkelregelung aus dem Tutorial. Eine reine Winkelrückführung kann die Neigung ausregeln, während der Wagen wegdriftet. Aktivieren Sie den optionalen Wagenpositionsregelkreis, um aus Wagenposition und Wagengeschwindigkeit einen begrenzten Neigungssollwert zu erzeugen. Der innere PID-Regler differenziert den gemessenen Winkel und hält seinen Integratorzustand fest, wenn weiteres Integrieren die Stellkraft noch weiter in die Sättigung treiben würde. Der äußere Regelkreis muss gesondert abgestimmt werden; seine Aktivierung garantiert keine Rückkehr in die aufrechte Lage.

Betrachten Sie die beiden Stabilisierungsergebnisse gemeinsam mit dem maximalen Kraftbetrag und den Ausregelzeiten. Die Ausregelzeiten werden ab Simulationsbeginn gemessen und nach dem letzten vorgesehenen Störstoß anhand der eingegebenen Toleranzbänder für die Beträge von Winkel und Position bestimmt. Eine Zeit wird nur ausgegeben, wenn anschließend mindestens eine halbe Sekunde lang Beobachtungswerte innerhalb des Bands liegen. „Kein Wert“ bedeutet, dass bis zum Simulationsende oder bis zum Erreichen einer Grenze kein Ausregeln festgestellt wurde. Die Poltabellen beschreiben das lineare Modell ohne Stellkraftbegrenzung in aufrechter Lage; stabile Pole allein sagen daher nicht voraus, ob sich das Pendel aus großer Neigung wieder stabilisieren lässt.

Dieser Rechner für das inverse Pendel berücksichtigt Starrkörperträgheit, Schwerkraft, Wagenreibung und Stellkraftbegrenzung. Elektrische Motordynamik, Verzögerungen, Sensorrauschen, Nachgiebigkeit, Spiel und Kollisionen mit Anschlägen werden vernachlässigt. Jeder Simulationslauf endet, sobald das Pendel waagerecht liegt oder der Wagen eine Verfahrgrenze erreicht; Aufprall- oder Aufschwingbewegungen werden nicht berechnet. Nutzen Sie den Rechner zum Lernen, zum Reglervergleich und für Voruntersuchungen vor einem realen Versuch.

So wird gerechnet

Die nichtlinearen Gleichungen verwenden die CTMS-Winkelkonvention um die aufrechte Lage: ϕ>0phi>0 bedeutet eine Neigung nach links, x>0x>0 zeigt nach rechts. Mit J=Icm+mℓ2J=I_{cm}+mell^2, c=mℓcos⁡ϕc=mellcosphi und D=(M+m)J−c2D=(M+m)J-c^2 lauten die gekoppelten Starrkörpergleichungen

[M+m−c−cJ][x¨ϕ¨]=[u−bx˙−mℓsin⁡ϕ ϕ˙2mgℓsin⁡ϕ].begin{bmatrix}M+m&-c\-c&Jend{bmatrix}begin{bmatrix}ddot x\ddotphiend{bmatrix}=begin{bmatrix}u-bdot x-mellsinphi,dotphi^2\mgellsinphiend{bmatrix}.

Die explizite Inverse dieser positiv definiten Massenmatrix liefert die nichtlinearen Zustandsableitungen. Die Linearisierung um die aufrechte Lage verwendet die Zustandsreihenfolge [x,x˙,ϕ,ϕ˙][x,dot x,phi,dotphi] und die Matrizen A und B aus CTMS. Numerische SI-Basiseinheiten machen die unterschiedlichen Einheiten der Zustandsgrößen explizit.

LQR minimiert ∫0∞(zTQz+Ru2) dtint_0^infty(z^TQz+Ru^2),dt. Eine skalierte Matrix-Signum-Iteration mit der Hamilton-Matrix liefert die stabilisierende Lösung von ATP+PA−PBR−1BTP+Q=0A^TP+PA-PBR^{-1}B^TP+Q=0; es gelten K=R−1BTPK=R^{-1}B^TP und uc=−Kzu_c=-Kz. Das Riccati-Residuum und die veröffentlichten Reglerverstärkungen des Tutorials werden geprüft.

PID verwendet e=ϕ−ϕre=phi-phi_r und uc=−Kpe−Kdϕ˙−Ki∫e dtu_c=-K_pe-K_ddotphi-K_iint e,dt. Mit dem optionalen äußeren Regelkreis gilt ϕr=clip(Gxx+Gvx˙,±ϕr,max)phi_r=mathrm{clip}(G_xx+G_vdot x,pmphi_{r,max}). Bedingte Integration verhindert bei Sättigung ein weiteres Aufladen des Integrators (Windup). Beide Regler verwenden u=clip(uc,±Flimit)u=mathrm{clip}(u_c,pm F_{limit}).

Das adaptive Dormand–Prince-Verfahren ode45 integriert jeden Regler unabhängig mit einer relativen Toleranz von 10⁻⁶ und angeforderten Abtastwerten im Abstand von höchstens 0,01 s. Es startet an jeder Grenze eines Integrationsintervalls und exakt bei jedem aufgezeichneten Störstoß neu. Zwischengespeicherte Werte der ungestörten Trajektorie dienen nur als Startwerte für einen Neustart vor dem ersten Störstoß; ode45 integriert den verbleibenden Zeitabschnitt bis zum Stoßzeitpunkt. Ein nach rechts gerichteter Kraftstoß JpJ_p am Schwerpunkt bewirkt Δx˙=(Icm+mℓ2sin⁡2ϕ)Jp/DDeltadot x=(I_{cm}+mell^2sin^2phi)J_p/D und Δϕ˙=−Mℓcos⁡ϕ Jp/DDeltadotphi=-Mellcosphi,J_p/D. Die mechanische Energie umfasst Translations-, Rotations- und Kopplungsanteile; Aktorarbeit, stoßbedingte Energieänderung und viskose Verluste schließen die Energiebilanz.

Annahmen

Ebenes, starres Pendel mit unabhängig vorgegebenem Trägheitsmoment um den Schwerpunkt; reibungsfreier Drehpunkt; viskose Wagenreibung; ideale kontinuierliche Messung aller Zustandsgrößen; Sollposition null; direkt wirkender Aktor mit symmetrischer Stellkraftgrenze. Für die Dynamik werden Anfangswinkel und Anfangswinkelgeschwindigkeit in Radiant beziehungsweise Radiant pro Sekunde umgerechnet. Die Schwerpunktmarkierung liegt im Abstand ℓ vom Drehpunkt; ihr gezeichneter Radius und die Wagendarstellung legen weder Trägheitsmoment noch Kollisionsgeometrie fest.

Die Vorgabewerte für Massen, Länge, Reibung, Trägheitsmoment und Erdbeschleunigung folgen den ausführbaren Beispielen von CTMS. Die einleitende Tabelle der älteren Modellierungsseite nennt m = 0,5 kg; deren Code, numerische Matrizen und das LQR-Beispiel verwenden jedoch durchgängig m = 0,2 kg. Dieser Rechner folgt dem letztgenannten Wert. Die Vorgaben für den äußeren PID-Regelkreis sind beispielhafte Abstimmungswerte, keine veröffentlichten Reglerverstärkungen des Tutorials.

Anwendungsbereich

Nur Stabilisierung in aufrechter Lage: Die Simulation endet, sobald erstmals |φ| = 90° oder |x| = Verfahrgrenze des Wagens gilt; ein Modell für Kollisionen, Rückprall oder Aufschwingen ist nicht enthalten. Ein Stopp an der Verfahrgrenze wird getrennt vom Umfallen des Pendels gemeldet. Der Eingabebereich |φ| ≤ 60° für den Anfangswinkel ist kein garantierter Einzugsbereich. Riccati-Lösung und Polergebnisse gelten für das lokale Modell ohne Sättigung in aufrechter Lage; Schienenanschläge, Stellkraftgrenzen und die Begrenzung des Neigungssollwerts im äußeren Regelkreis können das nichtlineare Verhalten dominieren.

Als Ausregelzeit gilt der erste Abtastzeitpunkt nach dem letzten im Simulationszeitfenster liegenden Störstoß, ab dem die zugehörigen Toleranzbänder für die Absolutwerte bis zum Ende eingehalten werden; die Bestätigungsdauer beträgt mindestens 0,5 s. Die Zeiten sind absolute Simulationszeiten, keine seit einem Störstoß verstrichenen Zeiten. „Kein Wert“ bei einer Ausregelzeit bedeutet, dass kein Ausregeln festgestellt wurde. Der maximale Kraftbetrag wird in Abständen von ≤ 0,01 s abgetastet; ein kurzzeitiges internes Maximum kann unzureichend aufgelöst werden, wenn es die Stellkraftgrenze nicht erreicht. Halbieren Sie „Maximales Integrationsintervall“, um die Konvergenz zu prüfen; die Toleranzen des adaptiven Lösers bleiben unverändert.

Die Animation interpoliert die berechnete Position und den Winkel mit formtreuer kubischer Interpolation, die Stellkraft hingegen linear. Für jeden Regler hält sie bei dessen eigenem Abbruchereignis an. Die verblassende Bewegungsspur zeigt die vorangegangenen 0,8 s. Die Poltabellen berücksichtigen den Integratorzustand des PID-Reglers, wenn Ki > 0; bei reiner Winkelregelung bleiben die Wagenmoden ungeregelt. Der Eigenwertlöser kann Pole nahe null runden. Die Ergebnisse berücksichtigen weder die Dynamik von Motorspannung und -strom noch digitale Abtastung, Verzögerung, Rauschen, Trockenreibung, Nachgiebigkeit oder Parameterunsicherheit.

Ungestörte Trajektorien werden zwischengespeichert. Beim ersten aufgezeichneten Störstoß setzt die Integration am zuvor gespeicherten Zustand der ungestörten Trajektorie wieder ein und läuft bis zum exakten Stoßzeitpunkt weiter, bevor der Kraftstoß angewendet wird. Auch alle weiteren Störstöße unterteilen die nichtlineare Integration exakt an ihren Zeitpunkten. Die Wiedergabe stoppt, sobald eine physikalische Winkel- oder Verfahrgrenze erreicht wird.

Unterstützter numerischer Bereich. Diese explizite ode45-Implementierung akzeptiert Einstellungen, bei denen die Simulationsdauer multipliziert mit dem größten Betrag aller PID- und LQR-Regelkreispole in aufrechter Lage höchstens 2000 ergibt. Dieses konservative Rechenbudget begrenzt den numerisch unterstützten Bereich; es ist keine Stabilitäts- oder Sicherheitsgrenze. Das Budget wird vor jeder Integration geprüft; nicht unterstützte Einstellungen führen zu einem Eingabefehler und liefern weder Trajektorien noch Ergebnisse zur Regelgüte. Verringern Sie Reglerverstärkungen oder Simulationsdauer oder erhöhen Sie Wagenmasse, Pendellänge oder Trägheitsmoment um den Schwerpunkt. Unterstützte Simulationsläufe verwenden weiterhin die vollständigen nichtlinearen Gleichungen, die Toleranz des adaptiven Lösers und Ausgabeabstände von ≤ 0,01 s.

Der feste Szenenausschnitt umfasst die volle Reichweite des Pendels über beide Verfahrgrenzen hinaus, den Umriss der Schwerpunktmarkierung und eine 14 px große Greiffläche des Winkelgriffs. Seine Grenzen hängen ausschließlich vom Verfahrweg des Wagens und der Pendellänge ab; beim Ziehen zur Änderung von Anfangsneigung oder Anfangsposition bleiben daher Bodenlage und Szenenmaßstab unverändert.

Quellen

  • University of Michigan and Carnegie Mellon University, Control Tutorials for MATLAB: Inverted Pendulum, state-space design. Published baseline and tuned LQR gains and open-loop poles. https://www2.ensc.sfu.ca/people/faculty/saif/ctm/examples/pend/invSS.html
  • University of Michigan and Carnegie Mellon University, Control Tutorials for MATLAB: Inverted Pendulum, PID control. Angle gains Kp = 100, Ki = 1, Kd = 20 and cart-drift example. https://www2.ensc.sfu.ca/people/faculty/saif/ctm/examples/pend/invPID.html
  • CTMS Inverted Pendulum: System Modeling, nonlinear equations and upright state-space model. https://ctms.engin.umich.edu/CTMS/index.php?example=InvertedPendulum&section=SystemModeling
  • Åström, K. J. and Murray, R. M., Feedback Systems: An Introduction for Scientists and Engineers, 2nd ed. (2021), state feedback and PID. Open electronic edition and companion material: https://fbsbook.org/

Eingaben

EingabeSymbolEinheitVorgabe
Animierter ReglercontrollerLQR
Wiedergabezeit
Starten Sie die Wiedergabe; drücken Sie dann die Leertaste oder tippen Sie auf die Szene, um das Pendel anzustoßen.
ts0.22
SimulationsdauerT_runs5
Anfangsneigung
Eine positive Neigung weist von der Aufrechten nach links.
theta0deg15
Anfangsposition des Wagensx0m0
Anfangsgeschwindigkeit des Wagensv0m/s0
Anfangswinkelgeschwindigkeitomega0deg/s0
Zeitpunkte der Störstöße
Die Leertaste oder Antippen der Szene löst den eingegebenen Kraftstoß am Schwerpunkt aus.
pushes3.2
Kraftstoß am PendelJ_pushN*s0.035
WagenmasseM_cartkg0.5
Pendelmassem_polekg0.2
Abstand Drehpunkt–Schwerpunktellm0.3
Pendelträgheitsmoment um den SchwerpunktI_cmkg*m^20.006
Viskose Wagenreibungb_cartN*s/m0.1
Erdbeschleunigungg_accm/s^29.8
Verfahrweg je Seite
Die Verfahrgrenzen gelten für die Wagenmitte; der Simulationslauf endet beim Erreichen einer der beiden Grenzen.
railm0.5
StellkraftgrenzeF_limitN12
Q: Wagenpositionq_x5000
Q: Wagengeschwindigkeitq_v0
Q: Winkelq_theta100
Q: Winkelgeschwindigkeitq_omega0
R: Stellaufwand
Die Gewichtungen gelten für numerische Zustandswerte in m, m/s, rad, rad/s und die Kraft in N.
r_force1
P-Verstärkung der WinkelregelungK_pN/rad100
I-Verstärkung der WinkelregelungK_iN/(rad*s)1
D-Verstärkung der WinkelregelungK_dN*s/rad20
PID-Wagenpositionsregelkreisposition_loopfalse
Verstärkung Position → NeigungG_xrad/m0.7
Verstärkung Geschw. → NeigungG_vrad*s/m0.38
Grenze des Neigungssollwertstheta_ref_maxdeg12
Maximales Integrationsintervall
In jedem Intervall startet der adaptive Löser ode45 neu; halbieren Sie das Intervall, um die numerische Konvergenz zu prüfen.
h_maxs0.2
Winkeltoleranzbandtheta_banddeg1
Positionstoleranzbandx_bandm0.01

Ergebnisse

Mit den obigen Vorgabewerten liefert der Rechner:

ErgebnisWert
LQR-StabilisierungsergebnisVerfahr- und Winkelgrenzen eingehalten
PID-StabilisierungsergebnisWagen hat Verfahrgrenze erreicht
Maximaler LQR-Kraftbetrag12 N
Maximaler PID-Kraftbetrag12 N
LQR-Ausregelzeit des Winkels3,63 s
LQR-Ausregelzeit für Winkel und Wagenposition3,85 s
LQR simuliert bis5 s
PID simuliert bis0,879 s

Außerdem zeigt er: PID-Ausregelzeit des Winkels, s; PID-Ausregelzeit für Winkel und Wagenposition, s.

Mit Quellen abgeglichen

Jeder Fall unten wurde mit diesem Rechner berechnet und stimmt mit dem Wert aus seiner Quelle überein (innerhalb der Toleranz, wo eine angegeben ist).

LQR-Basisverstärkungen nach CTMS

Quelle: University of Michigan/Carnegie Mellon Control Tutorials, state-space inverted pendulum, LQR design: Q = diag(1,0,1,0), R = 1. Published K = [-1.0000 -1.6567 18.6854 3.4594]. https://www2.ensc.sfu.ca/people/faculty/saif/ctm/examples/pend/invSS.html

Eingaben: Q: Wagenposition = 1; Q: Winkel = 1; die übrigen wie oben.

ErgebnisQuelleDieser Rechner
LQR-Rückführverstärkungen [1]-1-1
LQR-Rückführverstärkungen [2]-1,657-1,657
LQR-Rückführverstärkungen [3]18,68518,685
LQR-Rückführverstärkungen [4]3,4593,459

Abgestimmte LQR-Verstärkungen nach CTMS

Quelle: University of Michigan/Carnegie Mellon Control Tutorials, state-space inverted pendulum, LQR design: Q = diag(5000,0,100,0), R = 1. Published K = [-70.7107 -37.8345 105.5298 20.9238]. https://www2.ensc.sfu.ca/people/faculty/saif/ctm/examples/pend/invSS.html

Eingaben: die obigen Vorgabewerte.

ErgebnisQuelleDieser Rechner
LQR-Rückführverstärkungen [1]-70,711-70,711
LQR-Rückführverstärkungen [2]-37,835-37,834
LQR-Rückführverstärkungen [3]105,5105,5
LQR-Rückführverstärkungen [4]20,92420,924

Instabilität der ungeregelten CTMS-Strecke

Quelle: CTMS state-space inverted pendulum, open-loop poles: 0, -0.1428, 5.5651, -5.6041. https://www2.ensc.sfu.ca/people/faculty/saif/ctm/examples/pend/invSS.html

Eingaben: die obigen Vorgabewerte.

ErgebnisQuelleDieser Rechner
Instabilster Pol der ungeregelten Strecke5,565 1/s5,565 1/s

Related Resources

Responses

Deine E-Mail-Adresse wird nicht veröffentlicht. Erforderliche Felder sind mit * markiert

L ading...