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.
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: bedeutet eine Neigung nach links, zeigt nach rechts. Mit , und lauten die gekoppelten Starrkörpergleichungen
Die explizite Inverse dieser positiv definiten Massenmatrix liefert die nichtlinearen Zustandsableitungen. Die Linearisierung um die aufrechte Lage verwendet die Zustandsreihenfolge und die Matrizen A und B aus CTMS. Numerische SI-Basiseinheiten machen die unterschiedlichen Einheiten der Zustandsgrößen explizit.
LQR minimiert . Eine skalierte Matrix-Signum-Iteration mit der Hamilton-Matrix liefert die stabilisierende Lösung von ; es gelten und . Das Riccati-Residuum und die veröffentlichten Reglerverstärkungen des Tutorials werden geprüft.
PID verwendet und . Mit dem optionalen äußeren Regelkreis gilt . Bedingte Integration verhindert bei Sättigung ein weiteres Aufladen des Integrators (Windup). Beide Regler verwenden .
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ß am Schwerpunkt bewirkt und . 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§ion=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
| Eingabe | Symbol | Einheit | Vorgabe |
|---|---|---|---|
| Animierter Regler | controller | LQR | |
| Wiedergabezeit Starten Sie die Wiedergabe; drücken Sie dann die Leertaste oder tippen Sie auf die Szene, um das Pendel anzustoßen. | t | s | 0.22 |
| Simulationsdauer | T_run | s | 5 |
| Anfangsneigung Eine positive Neigung weist von der Aufrechten nach links. | theta0 | deg | 15 |
| Anfangsposition des Wagens | x0 | m | 0 |
| Anfangsgeschwindigkeit des Wagens | v0 | m/s | 0 |
| Anfangswinkelgeschwindigkeit | omega0 | deg/s | 0 |
| Zeitpunkte der Störstöße Die Leertaste oder Antippen der Szene löst den eingegebenen Kraftstoß am Schwerpunkt aus. | pushes | 3.2 | |
| Kraftstoß am Pendel | J_push | N*s | 0.035 |
| Wagenmasse | M_cart | kg | 0.5 |
| Pendelmasse | m_pole | kg | 0.2 |
| Abstand Drehpunkt–Schwerpunkt | ell | m | 0.3 |
| Pendelträgheitsmoment um den Schwerpunkt | I_cm | kg*m^2 | 0.006 |
| Viskose Wagenreibung | b_cart | N*s/m | 0.1 |
| Erdbeschleunigung | g_acc | m/s^2 | 9.8 |
| Verfahrweg je Seite Die Verfahrgrenzen gelten für die Wagenmitte; der Simulationslauf endet beim Erreichen einer der beiden Grenzen. | rail | m | 0.5 |
| Stellkraftgrenze | F_limit | N | 12 |
| Q: Wagenposition | q_x | 5000 | |
| Q: Wagengeschwindigkeit | q_v | 0 | |
| Q: Winkel | q_theta | 100 | |
| Q: Winkelgeschwindigkeit | q_omega | 0 | |
| R: Stellaufwand Die Gewichtungen gelten für numerische Zustandswerte in m, m/s, rad, rad/s und die Kraft in N. | r_force | 1 | |
| P-Verstärkung der Winkelregelung | K_p | N/rad | 100 |
| I-Verstärkung der Winkelregelung | K_i | N/(rad*s) | 1 |
| D-Verstärkung der Winkelregelung | K_d | N*s/rad | 20 |
| PID-Wagenpositionsregelkreis | position_loop | false | |
| Verstärkung Position → Neigung | G_x | rad/m | 0.7 |
| Verstärkung Geschw. → Neigung | G_v | rad*s/m | 0.38 |
| Grenze des Neigungssollwerts | theta_ref_max | deg | 12 |
| Maximales Integrationsintervall In jedem Intervall startet der adaptive Löser ode45 neu; halbieren Sie das Intervall, um die numerische Konvergenz zu prüfen. | h_max | s | 0.2 |
| Winkeltoleranzband | theta_band | deg | 1 |
| Positionstoleranzband | x_band | m | 0.01 |
Ergebnisse
Mit den obigen Vorgabewerten liefert der Rechner:
| Ergebnis | Wert |
|---|---|
| LQR-Stabilisierungsergebnis | Verfahr- und Winkelgrenzen eingehalten |
| PID-Stabilisierungsergebnis | Wagen hat Verfahrgrenze erreicht |
| Maximaler LQR-Kraftbetrag | 12 N |
| Maximaler PID-Kraftbetrag | 12 N |
| LQR-Ausregelzeit des Winkels | 3,63 s |
| LQR-Ausregelzeit für Winkel und Wagenposition | 3,85 s |
| LQR simuliert bis | 5 s |
| PID simuliert bis | 0,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.
| Ergebnis | Quelle | Dieser 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,685 | 18,685 |
| LQR-Rückführverstärkungen [4] | 3,459 | 3,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.
| Ergebnis | Quelle | Dieser 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,5 | 105,5 |
| LQR-Rückführverstärkungen [4] | 20,924 | 20,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.
| Ergebnis | Quelle | Dieser Rechner |
|---|---|---|
| Instabilster Pol der ungeregelten Strecke | 5,565 1/s | 5,565 1/s |

Responses